|
|
@ -127,6 +127,8 @@ bool InputRC::_read_control_data_from_subscription(ControlData &control_data, bo |
|
|
|
|
|
|
|
|
|
|
|
if (already_active || major_movement || _first_time) { |
|
|
|
if (already_active || major_movement || _first_time) { |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
_first_time = false; |
|
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < 3; ++i) { |
|
|
|
for (int i = 0; i < 3; ++i) { |
|
|
|
control_data.type_data.angle.is_speed[i] = false; |
|
|
|
control_data.type_data.angle.is_speed[i] = false; |
|
|
|
control_data.type_data.angle.angles[i] = new_aux_values[i] * M_PI_F; |
|
|
|
control_data.type_data.angle.angles[i] = new_aux_values[i] * M_PI_F; |
|
|
|