aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Rover: Reset home to AHRS location rather then snapshotting GPS

Browse Source 
Also corrects rover locking home altitude to EKF origin altitude
This commit is contained in:
Michael du Breuil 2017-02-27 12:14:51 -07:00 committed by Andrew Tridgell
parent fbf6050876
commit 51c97af5b5
1 changed files with 5 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
APMrover2/commands.cpp
View File

@ -95,17 +95,12 @@ void Rover::restart_nav()
void Rover::update_home()
{
if (home_is_set == HOME_SET_NOT_LOCKED) {
Location loc = gps.location();
Location origin;
// if an EKF origin is available then we leave home equal to
// the height of that origin. This ensures that our relative
// height calculations are using the same origin
if (ahrs.get_origin(origin)) {
loc.alt = origin.alt;
}
Location loc;
if (ahrs.get_position(loc)) {
ahrs.set_home(loc);
Log_Write_Home_And_Origin();
GCS_MAVLINK::send_home_all(gps.location());
}
}
barometer.update_calibration();
}