rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-17 02:52:12 +01:00
Code Issues Releases Activity

ET-174 Adapted ET OSD Drv to current GPS coordinate format

Browse Source 
git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@2910 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
FredericG 2011-02-27 19:58:34 +00:00 committed by FredericG
parent f15bd6259e
commit 7d679e01f0
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/Modules/Osd/OsdEtStd/OsdEtStd.c
View File

@ -149,13 +149,16 @@ static void WriteToMsg32(uint8_t index, uint32_t value)
WriteToMsg16(index + 2, value / 10000);
}
static void SetCoord(uint8_t index, float coord)
static void SetCoord(uint8_t index, uint32_t coord)
{
uint32_t deg = (uint32_t) coord;
float sec = (coord - deg) * 60;
WriteToMsg24(index, sec * 10000);
#define E7 10000000
uint8_t deg = coord / E7;
float sec = (float)(coord - deg*E7) / ((float)E7/(60.0*10000));
WriteToMsg8(index + 3, deg);
WriteToMsg24(index, sec);
}
static void SetCourse(uint16_t dir)