ardupilot/ArduCopter/commands.pde

45 lines
1.2 KiB
Plaintext
Raw Normal View History

// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
// run this at setup on the ground
// -------------------------------
static void init_home()
{
2012-11-10 01:55:51 -04:00
set_home_is_set(true);
2014-03-31 04:07:46 -03:00
// copter uses 0 home altitude
Location loc = gps.location();
ahrs.set_home(loc);
2012-08-16 21:50:03 -03:00
inertial_nav.setup_home_position();
2014-02-27 22:16:33 -04:00
// log new home position which mission library will pull from ahrs
2014-10-16 21:37:49 -03:00
if (should_log(MASK_LOG_CMD)) {
2014-02-27 22:16:33 -04:00
AP_Mission::Mission_Command temp_cmd;
if (mission.read_cmd_from_storage(0, temp_cmd)) {
Log_Write_Cmd(temp_cmd);
}
2014-02-27 22:16:33 -04:00
}
2012-08-16 21:50:03 -03:00
// update navigation scalers. used to offset the shrinking longitude as we go towards the poles
scaleLongDown = longitude_scale(loc);
scaleLongUp = 1.0f/scaleLongDown;
}
// update_home - reset home to current location
// should be called only when vehicle is disarmed
static void update_home()
{
// copter uses 0 home altitude
Location loc = gps.location();
// set ahrs object's home position
ahrs.set_home(loc);
// update navigation scalers. used to offset the shrinking longitude as we go towards the poles
scaleLongDown = longitude_scale(loc);
scaleLongUp = 1.0f/scaleLongDown;
}