rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2024-11-29 07:24:13 +01:00
Code Issues Releases Activity

OP-1477 - Board support for updated SYS message

Browse Source
This commit is contained in:
Alessio Morale 2014-09-24 01:03:33 +02:00
parent c772442723
commit 8712a1dfdc
3 changed files with 13 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
flight/modules/GPS/UBX.c
View File

@ -464,10 +464,11 @@ static void parse_ubx_op_sys(struct UBXPacket *ubx, __attribute__((unused)) GPSP
struct UBX_OP_SYSINFO *sysinfo = &ubx->payload.op_sysinfo; struct UBX_OP_SYSINFO *sysinfo = &ubx->payload.op_sysinfo;
GPSExtendedStatusData data; GPSExtendedStatusData data;
data.FlightTime = sysinfo->flightTime; data.FlightTime = sysinfo->flightTime;
data.HeapRemaining = sysinfo->HeapRemaining; data.BoardType[0] = sysinfo->board_type;
data.IRQStackRemaining = sysinfo->IRQStackRemaining; data.BoardType[1] = sysinfo->board_revision;
data.SysModStackRemaining = sysinfo->SystemModStackRemaining; memcpy(&data.FirmwareHash, &sysinfo->sha1sum, GPSEXTENDEDSTATUS_FIRMWAREHASH_NUMELEM);
memcpy(&data.FirmwareTag, &sysinfo->commit_tag_name, GPSEXTENDEDSTATUS_FIRMWARETAG_NUMELEM);
data.Options = sysinfo->options; data.Options = sysinfo->options;
data.Status = GPSEXTENDEDSTATUS_STATUS_GPSV9; data.Status = GPSEXTENDEDSTATUS_STATUS_GPSV9;
GPSExtendedStatusSet(&data); GPSExtendedStatusSet(&data);

9
flight/modules/GPS/inc/UBX.h
View File

@ -343,11 +343,12 @@ struct UBX_MON_VER {
// OP custom messages // OP custom messages
struct UBX_OP_SYSINFO { struct UBX_OP_SYSINFO {
uint32_t flightTime; uint32_t flightTime;
uint16_t HeapRemaining;
uint16_t IRQStackRemaining;
uint16_t SystemModStackRemaining;
uint16_t options; uint16_t options;
}; uint8_t board_type;
uint8_t board_revision;
uint8_t commit_tag_name[26];
uint8_t sha1sum[8];
} __attribute__((packed));
// OP custom messages // OP custom messages
struct UBX_OP_MAG { struct UBX_OP_MAG {

6
shared/uavobjectdefinition/gpsextendedstatus.xml
View File

@ -3,9 +3,9 @@
<description>Extended GPS status.</description> <description>Extended GPS status.</description>
<field name="Status" units="" type="enum" elements="1" options="NONE,GPSV9" defaultvalue="NONE"/> <field name="Status" units="" type="enum" elements="1" options="NONE,GPSV9" defaultvalue="NONE"/>
<field name="FlightTime" units="" type="uint32" elements="1"/> <field name="FlightTime" units="" type="uint32" elements="1"/>
<field name="HeapRemaining" units="bytes" type="uint32" elements="1"/> <field name="BoardType" units="bytes" type="uint8" elements="2"/>
<field name="IRQStackRemaining" units="bytes" type="uint16" elements="1"/> <field name="FirmwareHash" units=" bytes" type="uint8" elements="8"/>
<field name="SysModStackRemaining" units="bytes" type="uint16" elements="1"/> <field name="FirmwareTag" units="bytes" type="uint8" elements="26"/>
<field name="Options" units="" type="uint16" elements="1"/> <field name="Options" units="" type="uint16" elements="1"/>
<access gcs="readwrite" flight="readwrite"/> <access gcs="readwrite" flight="readwrite"/>
<telemetrygcs acked="false" updatemode="manual" period="0"/> <telemetrygcs acked="false" updatemode="manual" period="0"/>