fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed GPS Date on frsky SPort

Browse Source
This commit is contained in:
Fredmcc 2017-02-14 19:26:08 +01:00 committed by Lorenz Meier
parent 90a05a0f55
commit 4ffbaed500
1 changed files with 17 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

18
src/drivers/frsky_telemetry/sPort_data.c
View File

@ -325,7 +325,23 @@ void sPort_send_GPS_CRS(int uart)
void sPort_send_GPS_TIME(int uart)
{
sPort_send_data(uart, SMARTPORT_ID_GPS_TIME, gps_position->time_utc_usec);
static int date = 0;
/* send formatted frame */
time_t time_gps = gps_position->time_utc_usec / 1000000ULL;
struct tm *tm_gps = gmtime(&time_gps);
if(date){
sPort_send_data(uart, SMARTPORT_ID_GPS_TIME, (uint32_t) 0xff | (tm_gps->tm_mday << 8 ) | ((tm_gps->tm_mon + 1) << 16 ) | ((tm_gps->tm_year -100) << 24 ) );
date = 0;
} else {
sPort_send_data(uart, SMARTPORT_ID_GPS_TIME, (uint32_t) 0x00 | (tm_gps->tm_sec << 8 ) | (tm_gps->tm_min << 16 ) | (tm_gps->tm_hour << 24 ));
date = 1;
}
}
void sPort_send_GPS_SPD(int uart)