rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-03-15 07:29:15 +01:00
Code Issues Releases Activity

Added a return code test when calling WMM_GetMagVector() function. If returned code is error then don't set home location.

Browse Source 
git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@2382 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
pip 2011-01-11 11:15:27 +00:00 committed by pip
parent 7b50e09eb9
commit b3d1c1f822
1 changed files with 7 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
flight/OpenPilot/Modules/GPS/GPS.c
View File

@ -219,7 +219,8 @@ static void setHomeLocation(GPSPositionData * gpsData)
GPSTimeData gps;
GPSTimeGet(&gps);
if (gps.Year >= 2000) {
if (gps.Year >= 2000)
{
// Store LLA
home.Latitude = gpsData->Latitude;
home.Longitude = gpsData->Longitude;
@ -237,10 +238,12 @@ static void setHomeLocation(GPSPositionData * gpsData)
home.ECEF[2] = (int32_t) (ECEF[2] * 100);
// Compute magnetic flux direction at home location
WMM_GetMagVector(LLA[0], LLA[1], LLA[2], gps.Month, gps.Day, gps.Year, &home.Be[0]);
if (WMM_GetMagVector(LLA[0], LLA[1], LLA[2], gps.Month, gps.Day, gps.Year, &home.Be[0]) >= 0)
{ // calculations appeared to go OK
home.Set = HOMELOCATION_SET_TRUE;
HomeLocationSet(&home);
home.Set = HOMELOCATION_SET_TRUE;
HomeLocationSet(&home);
}
}
}