Browse Source

AP_OpticalFlow: Change division to multiplication

gps-1.3.1
murata 3 years ago committed by Peter Barker
parent
commit
42d1fd984c
  1. 4
      libraries/AP_OpticalFlow/AP_OpticalFlow.cpp

4
libraries/AP_OpticalFlow/AP_OpticalFlow.cpp

@ -189,8 +189,8 @@ void OpticalFlow::update(void)
if (_calibrator->update()) { if (_calibrator->update()) {
// apply new calibration values // apply new calibration values
const Vector2f new_scaling = _calibrator->get_scalars(); const Vector2f new_scaling = _calibrator->get_scalars();
const float flow_scalerx_as_multiplier = (1.0 + (_flowScalerX / 1000.0)) * new_scaling.x; const float flow_scalerx_as_multiplier = (1.0 + (_flowScalerX * 0.001)) * new_scaling.x;
const float flow_scalery_as_multiplier = (1.0 + (_flowScalerY / 1000.0)) * new_scaling.y; const float flow_scalery_as_multiplier = (1.0 + (_flowScalerY * 0.001)) * new_scaling.y;
_flowScalerX.set_and_save_ifchanged((flow_scalerx_as_multiplier - 1.0) * 1000.0); _flowScalerX.set_and_save_ifchanged((flow_scalerx_as_multiplier - 1.0) * 1000.0);
_flowScalerY.set_and_save_ifchanged((flow_scalery_as_multiplier - 1.0) * 1000.0); _flowScalerY.set_and_save_ifchanged((flow_scalery_as_multiplier - 1.0) * 1000.0);
_flowScalerX.notify(); _flowScalerX.notify();

Loading…
Cancel
Save