mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-15 06:13:33 +08:00
flow: add scale factor parameter
This commit is contained in:
@@ -111,3 +111,13 @@ PARAM_DEFINE_FLOAT(SENS_FLOW_MAXR, 8.f);
|
||||
*
|
||||
*/
|
||||
PARAM_DEFINE_FLOAT(SENS_FLOW_RATE, 70.0f);
|
||||
|
||||
/**
|
||||
* Optical flow scale factor
|
||||
*
|
||||
* @min 0.5
|
||||
* @max 1.5
|
||||
* @decimal 2
|
||||
* @group Sensors
|
||||
*/
|
||||
PARAM_DEFINE_FLOAT(SENS_FLOW_SCALE, 1.f);
|
||||
|
||||
@@ -226,6 +226,7 @@ void VehicleOpticalFlow::Run()
|
||||
vehicle_optical_flow.timestamp_sample = sensor_optical_flow.timestamp_sample;
|
||||
vehicle_optical_flow.device_id = sensor_optical_flow.device_id;
|
||||
|
||||
_flow_integral *= _param_sens_flow_scale.get();
|
||||
_flow_integral.copyTo(vehicle_optical_flow.pixel_flow);
|
||||
_delta_angle.copyTo(vehicle_optical_flow.delta_angle);
|
||||
|
||||
|
||||
@@ -141,7 +141,8 @@ private:
|
||||
(ParamFloat<px4::params::SENS_FLOW_MINHGT>) _param_sens_flow_minhgt,
|
||||
(ParamFloat<px4::params::SENS_FLOW_MAXHGT>) _param_sens_flow_maxhgt,
|
||||
(ParamFloat<px4::params::SENS_FLOW_MAXR>) _param_sens_flow_maxr,
|
||||
(ParamFloat<px4::params::SENS_FLOW_RATE>) _param_sens_flow_rate
|
||||
(ParamFloat<px4::params::SENS_FLOW_RATE>) _param_sens_flow_rate,
|
||||
(ParamFloat<px4::params::SENS_FLOW_SCALE>) _param_sens_flow_scale
|
||||
)
|
||||
};
|
||||
}; // namespace sensors
|
||||
|
||||
Reference in New Issue
Block a user