ardupilot/Rover/mode_manual.cpp

42 lines
1.5 KiB
C++
Raw Normal View History

2017-07-18 23:17:45 -03:00
#include "Rover.h"
void ModeManual::_exit()
{
// clear lateral when exiting manual mode
g2.motors.set_lateral(0);
}
2017-07-18 23:17:45 -03:00
void ModeManual::update()
{
float desired_steering, desired_throttle, desired_lateral;
get_pilot_desired_steering_and_throttle(desired_steering, desired_throttle);
get_pilot_desired_lateral(desired_lateral);
// if vehicle is balance bot, calculate actual throttle required for balancing
if (rover.is_balancebot()) {
rover.balancebot_pitch_control(desired_throttle);
}
// walking robots support roll, pitch and walking_height
float desired_roll, desired_pitch, desired_walking_height;
get_pilot_desired_roll_and_pitch(desired_roll, desired_pitch);
get_pilot_desired_walking_height(desired_walking_height);
g2.motors.set_roll(desired_roll);
g2.motors.set_pitch(desired_pitch);
g2.motors.set_walking_height(desired_walking_height);
2019-09-27 16:33:33 -03:00
// set sailboat sails
2019-05-25 15:42:18 -03:00
float desired_mainsail;
2019-09-27 16:33:33 -03:00
float desired_wingsail;
float desired_mast_rotation;
g2.sailboat.get_pilot_desired_mainsail(desired_mainsail, desired_wingsail, desired_mast_rotation);
2019-05-25 15:42:18 -03:00
g2.motors.set_mainsail(desired_mainsail);
2019-09-27 16:33:33 -03:00
g2.motors.set_wingsail(desired_wingsail);
g2.motors.set_mast_rotation(desired_wingsail);
2018-09-25 10:09:47 -03:00
// copy RC scaled inputs to outputs
g2.motors.set_throttle(desired_throttle);
g2.motors.set_steering(desired_steering, (g2.manual_options & ManualOptions::SPEED_SCALING));
g2.motors.set_lateral(desired_lateral);
2017-07-18 23:17:45 -03:00
}