Browse Source

Copter: use cork/push wrapper

master
Andrew Tridgell 7 years ago
parent
commit
23b20307af
  1. 4
      ArduCopter/compassmot.cpp
  2. 8
      ArduCopter/esc_calibration.cpp
  3. 4
      ArduCopter/motors.cpp

4
ArduCopter/compassmot.cpp

@ -156,9 +156,9 @@ MAV_RESULT Copter::mavlink_compassmot(mavlink_channel_t chan) @@ -156,9 +156,9 @@ MAV_RESULT Copter::mavlink_compassmot(mavlink_channel_t chan)
read_radio();
// pass through throttle to motors
hal.rcout->cork();
SRV_Channels::cork();
motors->set_throttle_passthrough_for_esc_calibration(channel_throttle->get_control_in() / 1000.0f);
hal.rcout->push();
SRV_Channels::push();
// read some compass values
compass.read();

8
ArduCopter/esc_calibration.cpp

@ -116,9 +116,9 @@ void Copter::esc_calibration_passthrough() @@ -116,9 +116,9 @@ void Copter::esc_calibration_passthrough()
delay(3);
// pass through to motors
hal.rcout->cork();
SRV_Channels::cork();
motors->set_throttle_passthrough_for_esc_calibration(channel_throttle->get_control_in() / 1000.0f);
hal.rcout->push();
SRV_Channels::push();
}
#endif // FRAME_CONFIG != HELI_FRAME
}
@ -163,9 +163,9 @@ void Copter::esc_calibration_auto() @@ -163,9 +163,9 @@ void Copter::esc_calibration_auto()
gcs().send_text(MAV_SEVERITY_INFO,"ESC calibration: Push safety switch");
printed_msg = true;
}
hal.rcout->cork();
SRV_Channels::cork();
motors->set_throttle_passthrough_for_esc_calibration(1.0f);
hal.rcout->push();
SRV_Channels::push();
esc_calibration_notify();
delay(3);
}

4
ArduCopter/motors.cpp

@ -293,7 +293,7 @@ void Copter::motors_output() @@ -293,7 +293,7 @@ void Copter::motors_output()
SRV_Channels::calc_pwm();
// cork now, so that all channel outputs happen at once
hal.rcout->cork();
SRV_Channels::cork();
// update output on any aux channels, for manual passthru
SRV_Channels::output_ch_all();
@ -316,7 +316,7 @@ void Copter::motors_output() @@ -316,7 +316,7 @@ void Copter::motors_output()
}
// push all channels
hal.rcout->push();
SRV_Channels::push();
}
// check for pilot stick input to trigger lost vehicle alarm

Loading…
Cancel
Save