Eigen Revision

Dependencies:   mbed LPS25HB_I2C LSM9DS1 PIDcontroller Autopilot_Eigen LoopTicker GPSUBX_UART_Eigen SBUS_without_mainfile MedianFilter Eigen UsaPack solaESKF_Eigen Vector3 CalibrateMagneto FastPWM

autopilot.cpp

Committer:
osaka
Date:
2021-11-25
Revision:
128:e94453d3f699
Parent:
124:7d6b1b62483b
Child:
131:45542fcc886f

File content as of revision 128:e94453d3f699:

#include "global.hpp"
 
void level_flight()
{
    autopilot.update_val(rpy, -palt, pi, vi);
    autopilot.level();
    autopilot.keep_alt();
    autopilot.return_val(roll_obj, pitch_obj, dT_obj);
}
 
void point_guide()
{
    autopilot.update_val(rpy, -palt, pi, vi);
    autopilot.guide();
    autopilot.keep_alt();
    autopilot.return_val(roll_obj, pitch_obj, dT_obj);  
}
 
void turning()
{
    autopilot.update_val(rpy, -palt, pi, vi);
    autopilot.turn();
    autopilot.keep_alt();
    autopilot.return_val(roll_obj, pitch_obj, dT_obj);
}