2019-01-15 13:46:13 -04:00
|
|
|
#include "mode.h"
|
|
|
|
|
#include "Plane.h"
|
|
|
|
|
|
|
|
|
|
void ModeStabilize::update()
|
|
|
|
|
{
|
2022-01-02 15:59:18 -04:00
|
|
|
plane.nav_roll_cd = 0;
|
|
|
|
|
plane.nav_pitch_cd = 0;
|
2019-01-15 13:46:13 -04:00
|
|
|
}
|
|
|
|
|
|
2023-04-24 21:31:04 -03:00
|
|
|
void ModeStabilize::run()
|
|
|
|
|
{
|
|
|
|
|
plane.stabilize_roll();
|
|
|
|
|
plane.stabilize_pitch();
|
|
|
|
|
stabilize_stick_mixing_direct();
|
|
|
|
|
plane.stabilize_yaw();
|
2024-01-31 11:16:30 -04:00
|
|
|
|
|
|
|
|
output_pilot_throttle();
|
2023-04-24 21:31:04 -03:00
|
|
|
}
|
