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.
30 lines
708 B
30 lines
708 B
6 years ago
|
#include "mode.h"
|
||
|
|
#include "Plane.h"
|
||
|
|
|
||
|
|
bool ModeAcro::_enter()
|
||
|
|
{
|
||
|
|
plane.throttle_allows_nudging = false;
|
||
|
|
plane.auto_throttle_mode = false;
|
||
|
|
plane.auto_navigation_mode = false;
|
||
|
|
plane.acro_state.locked_roll = false;
|
||
|
|
plane.acro_state.locked_pitch = false;
|
||
|
|
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
void ModeAcro::update()
|
||
|
|
{
|
||
|
|
// handle locked/unlocked control
|
||
|
|
if (plane.acro_state.locked_roll) {
|
||
|
|
plane.nav_roll_cd = plane.acro_state.locked_roll_err;
|
||
|
|
} else {
|
||
|
|
plane.nav_roll_cd = plane.ahrs.roll_sensor;
|
||
|
|
}
|
||
|
|
if (plane.acro_state.locked_pitch) {
|
||
|
|
plane.nav_pitch_cd = plane.acro_state.locked_pitch_cd;
|
||
|
|
} else {
|
||
|
|
plane.nav_pitch_cd = plane.ahrs.pitch_sensor;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|