Functional presence begin example

The issues with delays have been sorted and is now functional printing out data to the terminal in arduino.

Author: MadisonC-SparkFun

examples/Example01_PresenceBasicReadings/Example01_PresenceBasicReadings.ino

@@ -61,8 +61,6 @@ void setup()
         while(1); // Runs forever
     }
 
-    delay(200);
-
     // Start the sensor with default register values
     int32_t setupError = radarSensor.presenceDetectorStart();
     if(setupError != 0)
@@ -73,7 +71,7 @@ void setup()
 
     // New line and delay for easier reading
     Serial.println();
-    delay(1000);
+    delay(500);
 }
 
 void loop()
@@ -82,17 +80,17 @@ void loop()
 
     // Get the presence distance value and print out if no errors
     presValError = radarSensor.getPresenceDistanceValuemm(distance);
-    if(presValError != 0)
+    if(presValError == 0)
     {
       Serial.print("Presence Detected: ");
       Serial.print(distance);
       Serial.println("mm");
     }
     else
     {
-      Serial.println("Error returning presence distance value");
+      Serial.print("Error returning presence distance value");
     }
 
-    // Delay 1 second between readings
-    delay(1000);
+    // Delay 0.5 seconds between readings
+    delay(50);
 }

src/sfeQwiicXM125.cpp

@@ -68,21 +68,20 @@ int32_t QwDevXM125::distanceBegin()
     {
         return 2;
     }
-    delay(100);
 
     // Set Start register 
     if(setDistanceStart(300) != 0)
     {
         return 3;
     }
-    delay(100);
+    delay(100);  // give time for command to set 
 
     // Set End register 
     if(setDistanceEnd(2500) != 0)
     {
         return 4;
     }
-    delay(100);
+    delay(100);  // give time for command to set 
 
     // Apply configuration 
     if(setDistanceCommand(SFE_XM125_DISTANCE_APPLY_CONFIGURATION) != 0)
@@ -132,6 +131,7 @@ int32_t QwDevXM125::distanceDetectorReadingSetup()
     {
         return 2;
     }
+    delay(100); // give time for command to set 
 
     // Poll detector status until busy bit is cleared - CHECK ON THIS!
     if(distanceBusyWait() != 0)
@@ -769,37 +769,38 @@ int32_t QwDevXM125::distanceBusyWait()
 int32_t QwDevXM125::presenceDetectorStart()
 {
   // Presence Sensor Setup
-    uint32_t errorStatus;
+    uint32_t errorStatus = 0;
 
     // Reset sensor configuration to reapply configuration registers
     if(setPresenceCommand(SFE_XM125_PRESENCE_RESET_MODULE) != 0)
     {
         return 1;
     }
+    delay(100); // give time for command to set 
 
     // Check detector status error and busy bits 
-    getPresenceDetectorErrorStatus(errorStatus);
+    if(getPresenceDetectorErrorStatus(errorStatus) != 0)
+    {
+        return 2;
+    }
     if(errorStatus != 0)
     {
-        Serial.println("Error status errrrrr");
-        return errorStatus;
-        // return 2;
+        return 3;
     }
-    delay(100);
 
     // Set Presence Start register 
     if(setPresenceStart(300) != 0)
     {
-        return 3;
+        return 4;
     }
-    delay(100);
+    delay(100); // give time for command to set 
 
     // Set End register 
     if(setPresenceEnd(2500) != 0)
     {
-        return 4;
+        return 5;
     }
-    delay(100);
+    delay(100); // give time for command to set 
 
     // Apply configuration 
     if(setPresenceCommand(SFE_XM125_PRESENCE_APPLY_CONFIGURATION) != 0)
@@ -808,23 +809,24 @@ int32_t QwDevXM125::presenceDetectorStart()
       getPresenceDetectorErrorStatus(errorStatus);
       if(errorStatus != 0)
       {
-        return 5;
+        return 6;
       }
 
-      return 6;
+      return 7;
     }
+    delay(100); // give time for command to set 
 
     // Poll detector status until busy bit is cleared
     if(presenceBusyWait() != 0)
     {
-      return 7;
+      return 8;
     }
 
     // Check detector error status 
     getPresenceDetectorErrorStatus(errorStatus);
     if(errorStatus != 0)
     {
-      return 8;
+      return 9;
     }
 
     // If no errors, return 0
@@ -849,6 +851,7 @@ int32_t QwDevXM125::getPresenceDistanceValuemm(uint32_t &presenceVal)
     {
         return 2;
     }
+    delay(100);
 
     // Poll detector status until busy bit is cleared - CHECK ON THIS!
     if(presenceBusyWait() != 0)
@@ -863,7 +866,6 @@ int32_t QwDevXM125::getPresenceDistanceValuemm(uint32_t &presenceVal)
         return 4;
     }
 
-
     // Read detector result register and determine detection status
     getPresenceDetectorPresenceDetected(presenceDetected);
     getPresenceDetectorPresenceStickyDetected(presenceDetectedSticky);
@@ -908,7 +910,7 @@ int32_t QwDevXM125::getPresenceDetectorStatus(uint32_t &status)
 
 int32_t QwDevXM125::getPresenceDetectorErrorStatus(uint32_t &status)
 {
-    int32_t retVal;
+    int32_t retVal = 0;
     uint32_t regVal = 0;
     retVal = _theBus->readRegister16Region(SFE_XM125_PRESENCE_DETECTOR_STATUS, (uint8_t*)&regVal, 4);
     flipBytes(regVal);