add WOMLogic() function

to configure the WOM algorithm

Author: daescobarh

examples/Arduino/Example4_WakeOnMotion/Example4_WakeOnMotion.ino

@@ -221,6 +221,8 @@ void setup()
   SERIAL_PORT.print(F("Set threshold returned: "));
   SERIAL_PORT.println(myICM.statusString());
 
+  myICM.WOMLogic(true, 1); // enable WoM Logic mode 1
+
   myICM.intEnableWOM(true); // enable interrupts on WakeOnMotion
   SERIAL_PORT.print(F("intEnableWOM returned: "));
   SERIAL_PORT.println(myICM.statusString());

keywords.txt

@@ -65,6 +65,7 @@ intEnableWOF	KEYWORD2
 intEnableRawDataReady	KEYWORD2
 intEnableOverflowFIFO	KEYWORD2
 intEnableWatermarkFIFO	KEYWORD2
+WOMLogic	KEYWORD2
 WOMThreshold	KEYWORD2
 i2cMasterPassthrough	KEYWORD2
 i2cMasterEnable	KEYWORD2

src/ICM_20948.cpp

@@ -1017,6 +1017,30 @@ ICM_20948_Status_e ICM_20948::intEnableWatermarkFIFO(uint8_t bm_enable)
   return status;
 }
 
+ICM_20948_Status_e ICM_20948::WOMLogic(uint8_t enable, uint8_t mode)
+{
+  ICM_20948_ACCEL_INTEL_CTRL_t ctrl;                   // storage
+  status = ICM_20948_wom_logic(&_device, NULL, &ctrl); // read phase
+  if (status != ICM_20948_Stat_Ok)
+  {
+    return status;
+  }
+  ctrl.ACCEL_INTEL_EN = enable;     // enable the WOM logic
+  ctrl.ACCEL_INTEL_MODE_INT = mode; // config mode
+
+  status = ICM_20948_wom_logic(&_device, &ctrl, &ctrl); // write new config
+  if (status != ICM_20948_Stat_Ok)
+  {
+    return status;
+  }
+  if (ctrl.ACCEL_INTEL_MODE_INT != mode)
+  {
+    status = ICM_20948_Stat_Err;
+    return status;
+  }
+  return status;
+}
+
 ICM_20948_Status_e ICM_20948::WOMThreshold(uint8_t threshold)
 {
   ICM_20948_ACCEL_WOM_THR_t thr;                          // storage

src/ICM_20948.h

@@ -130,6 +130,7 @@ class ICM_20948
   ICM_20948_Status_e intEnableOverflowFIFO(uint8_t bm_enable);
   ICM_20948_Status_e intEnableWatermarkFIFO(uint8_t bm_enable);
 
+  ICM_20948_Status_e WOMLogic(uint8_t enable, uint8_t mode);
   ICM_20948_Status_e WOMThreshold(uint8_t threshold);
 
   // Interface Options

src/util/ICM_20948_C.c

@@ -555,6 +555,41 @@ ICM_20948_Status_e ICM_20948_int_enable(ICM_20948_Device_t *pdev, ICM_20948_INT_
   return retval;
 }
 
+ICM_20948_Status_e ICM_20948_wom_logic(ICM_20948_Device_t *pdev, ICM_20948_ACCEL_INTEL_CTRL_t *write, ICM_20948_ACCEL_INTEL_CTRL_t *read)
+{
+  ICM_20948_Status_e retval = ICM_20948_Stat_Ok;
+
+  ICM_20948_ACCEL_INTEL_CTRL_t ctrl;
+
+  retval = ICM_20948_set_bank(pdev, 2); // Must be in the right bank
+
+  if (write != NULL)
+  { // If the write pointer is not NULL then write to the registers BEFORE reading
+    ctrl.ACCEL_INTEL_EN = write->ACCEL_INTEL_EN;
+    ctrl.ACCEL_INTEL_MODE_INT = write->ACCEL_INTEL_MODE_INT;
+
+    retval = ICM_20948_execute_w(pdev, AGB2_REG_ACCEL_INTEL_CTRL, (uint8_t *)&ctrl, sizeof(ICM_20948_ACCEL_INTEL_CTRL_t));
+    if (retval != ICM_20948_Stat_Ok)
+    {
+      return retval;
+    }
+  }
+
+  if (read != NULL)
+  { // If read pointer is not NULL then read the registers (if write is not NULL then this should read back the results of write into read)
+    retval = ICM_20948_execute_r(pdev, AGB2_REG_ACCEL_INTEL_CTRL, (uint8_t *)&ctrl, sizeof(ICM_20948_ACCEL_INTEL_CTRL_t));
+    if (retval != ICM_20948_Stat_Ok)
+    {
+      return retval;
+    }
+
+    read->ACCEL_INTEL_EN = ctrl.ACCEL_INTEL_EN;
+    read->ACCEL_INTEL_MODE_INT = ctrl.ACCEL_INTEL_MODE_INT;
+  }
+
+  return retval;
+}
+
 ICM_20948_Status_e ICM_20948_wom_threshold(ICM_20948_Device_t *pdev, ICM_20948_ACCEL_WOM_THR_t *write, ICM_20948_ACCEL_WOM_THR_t *read)
 {
   ICM_20948_Status_e retval = ICM_20948_Stat_Ok;

src/util/ICM_20948_C.h

@@ -213,6 +213,9 @@ extern int memcmp(const void *, const void *, size_t); // Avoid compiler warning
   ICM_20948_Status_e ICM_20948_int_pin_cfg(ICM_20948_Device_t *pdev, ICM_20948_INT_PIN_CFG_t *write, ICM_20948_INT_PIN_CFG_t *read); // Set the INT pin configuration
   ICM_20948_Status_e ICM_20948_int_enable(ICM_20948_Device_t *pdev, ICM_20948_INT_enable_t *write, ICM_20948_INT_enable_t *read);    // Write and or read the interrupt enable information. If non-null the write operation occurs before the read, so as to verify that the write was successful
 
+  // WoM Enable Logic configuration
+  ICM_20948_Status_e ICM_20948_wom_logic(ICM_20948_Device_t *pdev, ICM_20948_ACCEL_INTEL_CTRL_t *write, ICM_20948_ACCEL_INTEL_CTRL_t *read); //Enable or disable WoM Logic
+
   // WoM Threshold Level Configuration
   ICM_20948_Status_e ICM_20948_wom_threshold(ICM_20948_Device_t *pdev, ICM_20948_ACCEL_WOM_THR_t *write, ICM_20948_ACCEL_WOM_THR_t *read); // Write and or read the Wake on Motion threshold. If non-null the write operation occurs before the read, so as to verify that the write was successful