Skip to content

Commit 51923bb

Browse files
committed
LP-556 Allow DiscoveryF4Bare to spoof own board id through FirmwareIAPObj.
1 parent 4c9c3c2 commit 51923bb

5 files changed

Lines changed: 47 additions & 2 deletions

File tree

flight/modules/FirmwareIAP/firmwareiap.c

Lines changed: 4 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -96,10 +96,12 @@ int32_t FirmwareIAPInitialize()
9696
FirmwareIAPObjData data;
9797
FirmwareIAPObjGet(&data);
9898

99-
data.BoardType = bdinfo->board_type;
10099
PIOS_BL_HELPER_FLASH_Read_Description(data.Description, FIRMWAREIAPOBJ_DESCRIPTION_NUMELEM);
101100
PIOS_SYS_SerialNumberGetBinary(data.CPUSerial);
102-
data.BoardRevision = bdinfo->board_rev;
101+
if (data.BoardRevision == 0 && data.BoardType == 0) {
102+
data.BoardRevision = bdinfo->board_rev;
103+
data.BoardType = bdinfo->board_type;
104+
}
103105
data.BootloaderRevision = bdinfo->bl_rev;
104106
data.ArmReset = 0;
105107
data.crc = 0;

flight/targets/boards/discoveryf4bare/firmware/UAVObjects.inc

Lines changed: 5 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -106,6 +106,11 @@ UAVOBJSRCFILENAMES += velocitydesired
106106
UAVOBJSRCFILENAMES += watchdogstatus
107107
UAVOBJSRCFILENAMES += flightstatus
108108
UAVOBJSRCFILENAMES += hwsettings
109+
UAVOBJSRCFILENAMES += hwdiscoveryf4baresettings
110+
UAVOBJSRCFILENAMES += hwpikoblxsettings
111+
UAVOBJSRCFILENAMES += hwspracingf3evosettings
112+
UAVOBJSRCFILENAMES += hwspracingf3settings
113+
UAVOBJSRCFILENAMES += hwtinyfishsettings
109114
UAVOBJSRCFILENAMES += receiveractivity
110115
UAVOBJSRCFILENAMES += receiverstatus
111116
UAVOBJSRCFILENAMES += cameradesired

flight/targets/boards/discoveryf4bare/firmware/pios_board.c

Lines changed: 27 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -32,6 +32,13 @@
3232
#include <hwsettings.h>
3333
#include <taskinfo.h>
3434
#include <pios_ws2811.h>
35+
#include "hwdiscoveryf4baresettings.h"
36+
#include "firmwareiapobj.h"
37+
38+
#include "hwpikoblxsettings.h"
39+
#include "hwspracingf3evosettings.h"
40+
#include "hwspracingf3settings.h"
41+
#include "hwtinyfishsettings.h"
3542

3643

3744
#ifdef PIOS_INCLUDE_INSTRUMENTATION
@@ -189,6 +196,26 @@ void PIOS_Board_Init(void)
189196
UAVObjInitialize();
190197
SETTINGS_INITIALISE_ALL;
191198

199+
HwPikoBLXSettingsInitialize();
200+
HwSPRacingF3EVOSettingsInitialize();
201+
HwSPRacingF3SettingsInitialize();
202+
HwTinyFISHSettingsInitialize();
203+
204+
HwDiscoveryF4BareSettingsInitialize();
205+
206+
uint16_t boardId;
207+
HwDiscoveryF4BareSettingsBoardIdGet(&boardId);
208+
209+
FirmwareIAPObjInitialize();
210+
211+
FirmwareIAPObjData iap;
212+
FirmwareIAPObjGet(&iap);
213+
214+
iap.BoardType = boardId >> 8;
215+
iap.BoardRevision = boardId & 0xff;
216+
217+
FirmwareIAPObjSet(&iap);
218+
192219
/* Initialize the alarms library */
193220
AlarmsInitialize();
194221

ground/gcs/src/plugins/uavobjects/uavobjects.pro

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -101,6 +101,7 @@ UAVOBJS = \
101101
$${UAVOBJ_XML_DIR}/hwspracingf3evosettings.xml \
102102
$${UAVOBJ_XML_DIR}/hwpikoblxsettings.xml \
103103
$${UAVOBJ_XML_DIR}/hwtinyfishsettings.xml \
104+
$${UAVOBJ_XML_DIR}/hwdiscoveryf4baresettings.xml \
104105
$${UAVOBJ_XML_DIR}/i2cstats.xml \
105106
$${UAVOBJ_XML_DIR}/magsensor.xml \
106107
$${UAVOBJ_XML_DIR}/magstate.xml \
Lines changed: 10 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,10 @@
1+
<xml>
2+
<object name="HwDiscoveryF4BareSettings" singleinstance="true" settings="true" category="System">
3+
<description>DiscoveryF4 Bare hardware configuration</description>
4+
<field name="BoardId" units="" type="uint16" elements="1" defaultvalue="0x0904" />
5+
<access gcs="readwrite" flight="readwrite"/>
6+
<telemetrygcs acked="true" updatemode="onchange" period="0"/>
7+
<telemetryflight acked="true" updatemode="onchange" period="0"/>
8+
<logging updatemode="manual" period="0"/>
9+
</object>
10+
</xml>

0 commit comments

Comments
 (0)