I2C Bus Functionality Added

Added the correct code to communicate over the I2C bus - need to finish printing and working the examples.

Author: MadisonC-SparkFun

examples/Example01_DistanceBasicReadings/Example01_DistanceBasicReadings.ino

@@ -36,6 +36,8 @@ void setup()
     Serial.println("XM125 Example 1: Basic Distance Readings");
     Serial.println("");
 
+    Wire.begin();
+
     // If begin is successful (0), then start example
     if(radarSensor.begin(i2cAddress, Wire) == 1)
     {

examples/Example02_DistanceThresholdSettings/Example02_DistanceThresholdSettings.ino

@@ -35,6 +35,8 @@ void setup()
     Serial.println("XM125 Example 2: Distance Threshold Settings");
     Serial.println("");
 
+    Wire.begin();
+
     // If begin is successful (0), then start example
     if(radarSensor.begin(i2cAddress, Wire) == 1)
     {
@@ -47,8 +49,10 @@ void setup()
     }
 
     // Set the fixed amplitude threshold
-    radarSensor.();
+    radarSensor.setDistanceFixedAmpThreshold();
     // Set the fixed strength threshold
+    radarSensor.setDistanceFixedStrengthThresholdValue(5);
+    // Set the distance threshold sensitivity
     radarSensor.();
 
 }

examples/Example03_DistanceSubsweeps/Example03_DistanceSubsweeps.ino

@@ -39,6 +39,8 @@ void setup()
     Serial.println("XM125 Example 3: Distance Subsweeps - Power Consumption Optimization");
     Serial.println("");
 
+    Wire.begin();
+
     // If begin is successful (0), then start example
     if(radarSensor.begin(i2cAddress, Wire) == 1)
     {

examples/Example04_PresenceBasicReadings/Example04_PresenceBasicReadings.ino

@@ -5,6 +5,7 @@
 
   This example shows how operate the XM125 when the device is in Presence Reading Mode.
   The sensor is initialized, then the presence values will print out to the terminal.
+  For full algorithm for 
 
   By: Madison Chodikov
   SparkFun Electronics
@@ -28,13 +29,19 @@ SfeXM125 radarSensor;
 // I2C default address
 uint8_t i2cAddress = SFE_XM125_I2C_ADDRESS;
 
+// Value to fill presence distance (in mm) 
+uint32_t distance; 
+uint32_t presenceDetected;
+
 void setup()
 {
     // Start serial
     Serial.begin(115200);
     Serial.println("XM125 Example 4: Basic Presence Readings");
     Serial.println("");
 
+    Wire.begin();
+
     // If begin is successful (0), then start example
     if(radarSensor.begin(i2cAddress, Wire) == 1)
     {
@@ -45,11 +52,34 @@ void setup()
         Serial.println("Device failed to setup - Freezing code.");
         while(1); // Runs forever
     }
+
+    // uint32_t regVal;
+    // int32_t retVal;
+    // retVal = radarSensor.returnRegister(&regVal);
+    // Serial.println(regVal, HEX);
+    // Serial.println(retVal);
+
+    delay(2000);
+
 }
 
 void loop()
 {
-    // Request Presence Data from the device 
+    // If Presence is detected, then print out distance from device 
+    radarSensor.getPresenceDistanceResult(&presenceDetected);
+    
+    radarSensor.getPresenceDistance(&distance);
+    Serial.print("Presence detected at ");
+    Serial.print(distance);
+    Serial.println("mm");
+
+    if(presenceDetected == 1)
+    {
+      radarSensor.getPresenceDistance(&distance);
+      Serial.print("Presence detected at ");
+      Serial.print(distance);
+      Serial.println("mm");
+    }
 
     delay(100);
 }

examples/Example05_PresenceSubsweeps/Example05_PresenceSubsweeps.ino

@@ -35,6 +35,8 @@ void setup()
     Serial.println("XM125 Example 5: Presence Subsweeps - Power Consumption Optimization");
     Serial.println("");
 
+    Wire.begin();
+
     // If begin is successful (0), then start example
     if(radarSensor.begin(i2cAddress, Wire) == 1)
     {
@@ -45,6 +47,9 @@ void setup()
         Serial.println("Device failed to setup - Freezing code.");
         while(1); // Runs forever
     }
+
+    // Set minimum start range for profile
+    radarSensor.setPresenceStart();
 }
 
 void loop()

src/SparkFun_Qwiic_XM125_Arduino_Library.h

@@ -19,7 +19,7 @@ class SfeXM125 : public QwDevXM125
             _i2cBus.init(wirePort, deviceAddress);
 
             // Initialize the system - return results
-            return this->QwDevXM125::begin(&_i2cBus);
+            return this->QwDevXM125::begin(&_i2cBus) == 0;
         }
 
     private: 

src/sfeQwiicXM125.cpp

@@ -44,6 +44,16 @@ bool QwDevXM125::begin(sfeTkII2C *theBus)
     return 0;
 }
 
+
+/*Test functions below - delete once complete with library */
+int32_t QwDevXM125::returnRegister(uint32_t *regVal)
+{
+    return _theBus->read16BitRegisterRegion(SFE_XM125_DISTANCE_VERSION, (uint8_t*)regVal, 4);
+}
+
+
+
+
 // --------------------- I2C Disance Detector Functions ---------------------
 
 int32_t QwDevXM125::getDistanceDetectorVersion(uint8_t *major, uint8_t *minor, uint8_t *patch)

src/sfeQwiicXM125.h

@@ -13,6 +13,8 @@ class QwDevXM125
         /// @return Error code (0 no error)
         bool begin(sfeTkII2C *theBus = nullptr);
 
+        int32_t returnRegister(uint32_t *regVal);
+
         // --------------------- I2C Disance Detector Functions ---------------------
 
         /// @brief This function returns the version number of the device 
@@ -376,7 +378,7 @@ class QwDevXM125
         /// @return Error code (0 no error)  
         int32_t getPresenceDetectorStatus(uint32_t *status);
 
-        /// @brief This function returns the number of detected distance. 
+        /// @brief This function returns if presence was detected
         /// @param detected Number of detected distance
         /// @return Error code (0 no error)  
         int32_t getPresenceDistanceResult(uint32_t *detected);