Merge pull request #9 from arduino-libraries/fix-#7

Enable temperature readout of LSM5DSOX sensor.

Author: aentinger

examples/SimpleTemperature/SimpleTemperature.ino

@@ -0,0 +1,42 @@
+/*
+  Arduino LSM6DSOX - Simple Temperature
+
+  This example reads the temperature values from the LSM6DSOX
+  sensor and continuously prints them to the Serial Monitor
+  or Serial Plotter.
+
+  The circuit:
+  - Arduino Nano RP2040 Connect
+
+  created 30 August 2021
+  by Alexander Entinger
+
+  This example code is in the public domain.
+*/
+
+#include <Arduino_LSM6DSOX.h>
+
+void setup()
+{
+  Serial.begin(9600);
+  while (!Serial);
+
+  if (!IMU.begin())
+  {
+    Serial.println("Failed to initialize IMU!");
+    while (1);
+  }
+}
+
+void loop()
+{
+  if (IMU.temperatureAvailable())
+  {
+    int temperature_deg = 0;
+    IMU.readTemperature(temperature_deg);
+
+    Serial.print("LSM6DSOX Temperature = ");
+    Serial.print(temperature_deg);
+    Serial.println(" °C");
+  }
+}

keywords.txt

@@ -21,6 +21,8 @@ gyroscopeAvailable	KEYWORD2
 accelerationAvailable	KEYWORD2
 accelerationSampleRate	KEYWORD2
 gyroscopeSampleRate	KEYWORD2
+readTemperature	KEYWORD2
+temperatureAvailable	KEYWORD2
 
 #######################################
 # Constants

src/LSM6DSOX.cpp

@@ -31,6 +31,9 @@
 #define LSM6DSOX_CTRL7_G            0X16
 #define LSM6DSOX_CTRL8_XL           0X17
 
+#define LSM6DSOX_OUT_TEMP_L         0X20
+#define LSM6DSOX_OUT_TEMP_H         0X21
+
 #define LSM6DSOX_OUTX_L_G           0X22
 #define LSM6DSOX_OUTX_H_G           0X23
 #define LSM6DSOX_OUTY_L_G           0X24
@@ -171,6 +174,33 @@ int LSM6DSOXClass::gyroscopeAvailable()
   return 0;
 }
 
+int LSM6DSOXClass::readTemperature(int & temperature_deg)
+{
+  /* Read the raw temperature from the sensor. */
+  int16_t temperature_raw = 0;
+
+  if (readRegisters(LSM6DSOX_OUT_TEMP_L, reinterpret_cast<uint8_t*>(&temperature_raw), sizeof(temperature_raw)) != 1) {
+    return 0;
+  }
+
+  /* Convert to °C. */
+  static int const TEMPERATURE_LSB_per_DEG = 256;
+  static int const TEMPERATURE_OFFSET_DEG = 25;
+
+  temperature_deg = (static_cast<int>(temperature_raw) / TEMPERATURE_LSB_per_DEG) + TEMPERATURE_OFFSET_DEG;
+
+  return 1;
+}
+
+int LSM6DSOXClass::temperatureAvailable()
+{
+  if (readRegister(LSM6DSOX_STATUS_REG) & 0x04) {
+    return 1;
+  }
+
+  return 0;
+}
+
 float LSM6DSOXClass::gyroscopeSampleRate()
 {
   return 104.0F;

src/LSM6DSOX.h

@@ -41,6 +41,9 @@ class LSM6DSOXClass {
     virtual float gyroscopeSampleRate(); // Sampling rate of the sensor.
     virtual int gyroscopeAvailable(); // Check for available data from gyroscope
 
+    // Temperature
+    int readTemperature(int & temperature_deg);
+    int temperatureAvailable();
 
   private:
     int readRegister(uint8_t address);