You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
19 lines
469 B
19 lines
469 B
#include "Rover.h" |
|
|
|
void ModeHold::update() |
|
{ |
|
float throttle = 0.0f; |
|
|
|
// if vehicle is balance bot, calculate actual throttle required for balancing |
|
if (rover.is_balancebot()) { |
|
rover.balancebot_pitch_control(throttle); |
|
} |
|
|
|
// relax mainsail |
|
g2.motors.set_mainsail(100.0f); |
|
g2.motors.set_wingsail(0.0f); |
|
|
|
// hold position - stop motors and center steering |
|
g2.motors.set_throttle(throttle); |
|
g2.motors.set_steering(0.0f); |
|
}
|
|
|