diff --git a/libraries/AP_HAL_Linux/OpticalFlow_Onboard.cpp b/libraries/AP_HAL_Linux/OpticalFlow_Onboard.cpp index 55a5054e99..a65952d40d 100644 --- a/libraries/AP_HAL_Linux/OpticalFlow_Onboard.cpp +++ b/libraries/AP_HAL_Linux/OpticalFlow_Onboard.cpp @@ -41,7 +41,7 @@ extern const AP_HAL::HAL& hal; using namespace Linux; -void OpticalFlow_Onboard::init(AP_HAL::OpticalFlow::Gyro_Cb get_gyro) +void OpticalFlow_Onboard::init() { uint32_t top, left; uint32_t crop_width, crop_height; @@ -57,7 +57,6 @@ void OpticalFlow_Onboard::init(AP_HAL::OpticalFlow::Gyro_Cb get_gyro) return; } - _get_gyro = get_gyro; _videoin = new VideoIn; const char* device_path = HAL_OPTFLOW_ONBOARD_VDEV_PATH; memtype = V4L2_MEMORY_MMAP; diff --git a/libraries/AP_HAL_Linux/OpticalFlow_Onboard.h b/libraries/AP_HAL_Linux/OpticalFlow_Onboard.h index 62e6890944..7d38d5304b 100644 --- a/libraries/AP_HAL_Linux/OpticalFlow_Onboard.h +++ b/libraries/AP_HAL_Linux/OpticalFlow_Onboard.h @@ -36,7 +36,7 @@ public: class OpticalFlow_Onboard : public AP_HAL::OpticalFlow { public: - void init(AP_HAL::OpticalFlow::Gyro_Cb); + void init(); bool read(AP_HAL::OpticalFlow::Data_Frame& frame); void push_gyro(float gyro_x, float gyro_y, float dt); void push_gyro_bias(float gyro_bias_x, float gyro_bias_y); @@ -69,7 +69,6 @@ private: float _gyro_y_integral; uint64_t _integration_timespan; uint8_t _surface_quality; - AP_HAL::OpticalFlow::Gyro_Cb _get_gyro; Vector2f _last_gyro_rate; Vector2f _gyro_bias; Vector2f _integrated_gyro;