yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00: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
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) 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) void sPort_send_GPS_SPD(int uart)