Line data    Source code

       1             : #include "mode.h"
       2             : #include "Plane.h"
       3             : 
       4        1389 : void ModeStabilize::update()
       5             : {
       6        1389 :     plane.nav_roll_cd = 0;
       7        1389 :     plane.nav_pitch_cd = 0;
       8        1389 : }
       9             : 
      10        1389 : void ModeStabilize::run()
      11             : {
      12        1389 :     plane.stabilize_roll();
      13        1389 :     plane.stabilize_pitch();
      14        1389 :     stabilize_stick_mixing_direct();
      15        1389 :     plane.stabilize_yaw();
      16             : 
      17        1389 :     output_pilot_throttle();
      18        1389 : }