commit 61e484ff759191a6ae5bcbcbc6a58235a0f1d346
author Armando Visconti <armando.visconti@st.com> Wed Jun 07 11:34:07 2017 +0200
committer Armando Visconti <armando.visconti@st.com> Wed Jun 07 11:34:07 2017 +0200
tree ce767ac695667d9fc158c4068a6efda08dc76c9f
parent 0607403836ceff203aa3194e2fe4c7a3892fefe4

nanohub: drivers/st_mag40: added magCfgData function

This patch adds to the driver the capability to be configured with
magnetometer bias data sent by host.

Change-Id: Ibf43af4cee8fc57ae267ce89b666a62da78ffaf7
Signed-off-by: Armando Visconti <armando.visconti@st.com>

firmware/os/drivers/st_mag40/st_mag40.c

diff --git a/firmware/os/drivers/st_mag40/st_mag40.c b/firmware/os/drivers/st_mag40/st_mag40.c
index a594883..c96e340 100644
--- a/firmware/os/drivers/st_mag40/st_mag40.c
+++ b/firmware/os/drivers/st_mag40/st_mag40.c
@@ -501,6 +501,20 @@
     return osEnqueueEvt(sensorGetMyEventType(SENS_TYPE_MAG), SENSOR_DATA_EVENT_FLUSH, NULL);
 }
 
+static bool magCfgData(void *data, void *cookie)
+{
+#if defined(ST_MAG40_CAL_ENABLED)
+    float *values = data;
+
+    INFO_PRINT("magCfgData: (values in uT * 1000) %ld, %ld, %ld\n",
+            (int32_t)(values[0] * 1000), (int32_t)(values[1] * 1000), (int32_t)(values[2] * 1000));
+
+    magCalAddBias(&mTask.moc, values[0], values[1], values[2]);
+#endif
+
+    return true;
+}
+
 static void sendTestResult(uint8_t status, uint8_t sensorType)
 {
     struct TestResultData *data = heapAlloc(sizeof(struct TestResultData));
@@ -636,7 +650,7 @@
 
 static const struct SensorOps st_mag40_SensorOps =
 {
-    DEC_OPS(magPower, magFwUpload, magSetRate, magFlush, magSelfTest, NULL, NULL),
+    DEC_OPS(magPower, magFwUpload, magSetRate, magFlush, magSelfTest, NULL, magCfgData),
 };
 
 static void enableInterrupt(struct Gpio *pin, struct ChainedIsr *isr)