82,6 → 82,7 |
#include "fat16.h" |
#include "crc16.h" |
#include "eeprom.h" |
#include "triggerlog.h" |
|
#define LIC_CMD_READ_LICENSE 1 |
#define LIC_CMD_WRITE_LICENSE 2 |
1181,6 → 1182,21 |
NaviData_Home.HomeLatitude = NaviData.HomePosition.Latitude; |
NaviData_Home.HomeAltitude = NaviData.HomePosition.Altitude; |
NaviData_Home.WP_OperatingRadius = MaxWP_Radius_in_m; |
// ++++++++++++++ |
// + Fix Type |
// ++++++++++++++ |
if(!(GPSData.Flags & FLAG_GPSFIXOK)) NaviData_Home.OSDStatusFlags3 = (NaviData_Home.OSDStatusFlags3 & 0xf8) | OSD_FIX_NONE; |
else |
if(GPSData.SatFix == SATFIX_2D) NaviData_Home.OSDStatusFlags3 = (NaviData_Home.OSDStatusFlags3 & 0xf8) | OSD_FIX_2D; |
else |
if(GPSData.Flags & FLAG_DIFFSOLN) NaviData_Home.OSDStatusFlags3 = (NaviData_Home.OSDStatusFlags3 & 0xf8) | OSD_FIX_DGPS; |
else |
if(GPSData.SatFix == SATFIX_3D) NaviData_Home.OSDStatusFlags3 = (NaviData_Home.OSDStatusFlags3 & 0xf8) | OSD_FIX_3D; |
// ++++++++++++++ |
if(BlitzSchuhConnected) NaviData_Home.OSDStatusFlags3 |= OSD3_FLAG_HOTSHOE; else NaviData_Home.OSDStatusFlags3 &= ~OSD3_FLAG_HOTSHOE; |
// ++++++++++++++ |
if(FC.StatusFlags3 & FC_STATUS3_BOAT) NaviData_Home.OSDStatusFlags3 |= OSD3_FLAG_BOAT_MODE; else NaviData_Home.OSDStatusFlags3 &= ~OSD3_FLAG_BOAT_MODE; |
// ++++++++++++++ |
crc_home = CRC16((unsigned char*)(&NaviData_Home.HomeLongitude), sizeof(NaviData_Home_t) - START_PAYLOAD_DATA); // update crc for the structure |
if((crc_home != CRC_Home) || (--count_home == 0)) |
{ |