Browse Source

IO firmware: Do not apply trim values a second time

sbg
Lorenz Meier 10 years ago
parent
commit
f0f3ffaec1
  1. 7
      src/modules/px4iofirmware/mixer.cpp

7
src/modules/px4iofirmware/mixer.cpp

@ -311,13 +311,6 @@ mixer_callback(uintptr_t handle,
case MIX_FMU: case MIX_FMU:
if (control_index < PX4IO_CONTROL_CHANNELS && control_group < PX4IO_CONTROL_GROUPS ) { if (control_index < PX4IO_CONTROL_CHANNELS && control_group < PX4IO_CONTROL_GROUPS ) {
control = REG_TO_FLOAT(r_page_controls[CONTROL_PAGE_INDEX(control_group, control_index)]); control = REG_TO_FLOAT(r_page_controls[CONTROL_PAGE_INDEX(control_group, control_index)]);
if (control_group == 0 && control_index == 0) {
control += REG_TO_FLOAT(r_setup_trim_roll);
} else if (control_group == 0 && control_index == 1) {
control += REG_TO_FLOAT(r_setup_trim_pitch);
} else if (control_group == 0 && control_index == 2) {
control += REG_TO_FLOAT(r_setup_trim_yaw);
}
break; break;
} }
return -1; return -1;

Loading…
Cancel
Save