diff --git a/quad/src/quad_app/sensor_processing.c b/quad/src/quad_app/sensor_processing.c index e3e2c3d6111e6d78420a3b9413ed02a31652c66a..cdd5a8c347895ed6c557f37b4e72659a1af39ab3 100644 --- a/quad/src/quad_app/sensor_processing.c +++ b/quad/src/quad_app/sensor_processing.c @@ -122,8 +122,10 @@ int sensor_processing(log_t* log_struct, user_input_t *user_input_struct, raw_se sensor_struct->optical_flow = raw_sensor_struct->optical_flow; flow_to_vel(&sensor_struct->optical_flow, raw_sensor_struct->lidar_distance_m); - sensor_struct->optical_flow.xVel = biquad_execute(&sensor_struct->flow_x_filt, -sensor_struct->optical_flow.xVel); - sensor_struct->optical_flow.yVel = biquad_execute(&sensor_struct->flow_y_filt, -sensor_struct->optical_flow.yVel); +// sensor_struct->optical_flow.xVel = biquad_execute(&sensor_struct->flow_x_filt, -sensor_struct->optical_flow.xVel); +// sensor_struct->optical_flow.yVel = biquad_execute(&sensor_struct->flow_y_filt, -sensor_struct->optical_flow.yVel); + sensor_struct->optical_flow.xVel *= -1; + sensor_struct->optical_flow.yVel *= -1; /* * Altitude double complementary filter