mirror of https://github.com/ArduPilot/ardupilot
29 lines
605 B
C++
29 lines
605 B
C++
#include "mode.h"
|
|
#include "Plane.h"
|
|
|
|
bool ModeFBWB::_enter()
|
|
{
|
|
plane.throttle_allows_nudging = false;
|
|
plane.auto_throttle_mode = true;
|
|
plane.auto_navigation_mode = false;
|
|
|
|
#if HAL_SOARING_ENABLED
|
|
// for ArduSoar soaring_controller
|
|
plane.g2.soaring_controller.init_cruising();
|
|
#endif
|
|
|
|
plane.set_target_altitude_current();
|
|
|
|
return true;
|
|
}
|
|
|
|
void ModeFBWB::update()
|
|
{
|
|
// Thanks to Yury MonZon for the altitude limit code!
|
|
plane.nav_roll_cd = plane.channel_roll->norm_input() * plane.roll_limit_cd;
|
|
plane.update_load_factor();
|
|
plane.update_fbwb_speed_height();
|
|
|
|
}
|
|
|