From 2bcae2a3e4834548281cdca1d67d5dd438553f69 Mon Sep 17 00:00:00 2001
From: BlueAndi <web@blue-andi.de>
Date: Sat, 20 Jan 2024 20:59:27 +0100
Subject: [PATCH 1/2] Magnetic, accelerometer and gyroscope sensing can be
 enabled or set in power-down mode separately for smart power management.

---
 Adafruit_LSM9DS0.cpp | 126 +++++++++++++++++++++++++++++++++++++++++++
 Adafruit_LSM9DS0.h   |   8 +++
 2 files changed, 134 insertions(+)

diff --git a/Adafruit_LSM9DS0.cpp b/Adafruit_LSM9DS0.cpp
index ab16cdb..5e06f7b 100644
--- a/Adafruit_LSM9DS0.cpp
+++ b/Adafruit_LSM9DS0.cpp
@@ -419,6 +419,132 @@ void Adafruit_LSM9DS0::setupGyro(lsm9ds0GyroScale_t scale) {
   }
 }
 
+/**************************************************************************/
+/*!
+    @brief Power the accelerometer, magnetomer and gyroscope down
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerDown(void)
+{
+  powerAccelDown();
+  powerMagDown();
+  powerGyroDown();
+}
+
+/**************************************************************************/
+/*!
+    @brief Power the accelerometer, magnetomer and gyroscope up
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerUp(void)
+{
+  powerAccelUp();
+  powerMagUp();
+  powerGyroUp();
+}
+
+/**************************************************************************/
+/*!
+    @brief Power the accelerometer down
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerAccelDown(void)
+{
+  uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG1_XM);
+  const uint8_t CTRL_REG1_XM_ADOR_MASK = 0xF0;
+  const uint8_t CTRL_REG1_XM_AODR_POWER_DOWN = 0x00;
+
+  value &= ~(CTRL_REG1_XM_ADOR_MASK);
+  value |= CTRL_REG1_XM_AODR_POWER_DOWN;
+
+  write8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG1_XM, value);
+}
+
+/**************************************************************************/
+/*!
+    @brief Power the accelerometer up
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerAccelUp(void)
+{
+  uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG1_XM);
+  const uint8_t CTRL_REG1_XM_ADOR_MASK = 0xF0;
+  const uint8_t CTRL_REG1_XM_AODR_100_HZ = 0x60;
+
+  value &= ~(CTRL_REG1_XM_ADOR_MASK);
+  value |= CTRL_REG1_XM_AODR_100_HZ;
+
+  write8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG1_XM, value);
+}
+
+/**************************************************************************/
+/*!
+    @brief Power the magnetometer down
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerMagDown(void)
+{
+  uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG7_XM);
+  const uint8_t CTRL_REG7_XM_MD_MASK = 0x03;
+  const uint8_t CTRL_REG7_XM_MD_POWER_DOWN = 0x03;
+
+  value &= ~(CTRL_REG7_XM_MD_MASK);
+  value |= CTRL_REG7_XM_MD_POWER_DOWN;
+
+  write8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG7_XM, value);
+}
+
+/**************************************************************************/
+/*!
+    @brief Power the magnetometer up
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerMagUp(void)
+{
+  uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG7_XM);
+  const uint8_t CTRL_REG7_XM_MD_MASK = 0x03;
+  const uint8_t CTRL_REG7_XM_MD_CONTINUOUIS_CONVERSION = 0x00;
+
+  value &= ~(CTRL_REG7_XM_MD_MASK);
+  value |= CTRL_REG7_XM_MD_CONTINUOUIS_CONVERSION;
+
+  write8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG7_XM, value);
+}
+
+/**************************************************************************/
+/*!
+    @brief Power the gyroscope down
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerGyroDown(void)
+{
+  uint8_t value = read8(GYROTYPE, LSM9DS0_REGISTER_CTRL_REG1_G);
+  const uint8_t CTRL_REG1_G_PD_MASK = 0x08;
+  const uint8_t CTRL_REG1_G_PD_POWER_DOWN = 0x00;
+
+  value &= ~(CTRL_REG1_G_PD_MASK);
+  value |= CTRL_REG1_G_PD_POWER_DOWN;
+
+  write8(GYROTYPE, LSM9DS0_REGISTER_CTRL_REG1_G, value);
+}
+
+/**************************************************************************/
+/*!
+    @brief Power the gyroscope up
+*/
+/**************************************************************************/
+void Adafruit_LSM9DS0::powerGyroUp(void)
+{
+  uint8_t value = read8(GYROTYPE, LSM9DS0_REGISTER_CTRL_REG1_G);
+  const uint8_t CTRL_REG1_G_PD_MASK = 0x08;
+  const uint8_t CTRL_REG1_G_PD_NORMAL = 0x08;
+
+  value &= ~(CTRL_REG1_G_PD_MASK);
+  value |= CTRL_REG1_G_PD_NORMAL;
+
+  write8(GYROTYPE, LSM9DS0_REGISTER_CTRL_REG1_G, value);
+}
+
 /***************************************************************************
  UNIFIED SENSOR FUNCTIONS
  ***************************************************************************/
diff --git a/Adafruit_LSM9DS0.h b/Adafruit_LSM9DS0.h
index f932b9b..a026fb6 100644
--- a/Adafruit_LSM9DS0.h
+++ b/Adafruit_LSM9DS0.h
@@ -199,6 +199,14 @@ class Adafruit_LSM9DS0 {
   void setupAccel(lsm9ds0AccelRange_t range);
   void setupMag(lsm9ds0MagGain_t gain);
   void setupGyro(lsm9ds0GyroScale_t scale);
+  void powerDown(void);
+  void powerUp(void);
+  void powerAccelDown(void);
+  void powerAccelUp(void);
+  void powerMagDown(void);
+  void powerMagUp(void);
+  void powerGyroDown(void);
+  void powerGyroUp(void);
 
   /* Adafruit Unified Sensor Functions (not standard yet ... the current base
    * class only */

From eba0bede6cbe84f7b6f5d3196d505dc92b6675e9 Mon Sep 17 00:00:00 2001
From: BlueAndi <web@blue-andi.de>
Date: Sat, 20 Jan 2024 22:00:00 +0100
Subject: [PATCH 2/2] Brace style fixed.

---
 Adafruit_LSM9DS0.cpp | 24 ++++++++----------------
 1 file changed, 8 insertions(+), 16 deletions(-)

diff --git a/Adafruit_LSM9DS0.cpp b/Adafruit_LSM9DS0.cpp
index 5e06f7b..b94d9a5 100644
--- a/Adafruit_LSM9DS0.cpp
+++ b/Adafruit_LSM9DS0.cpp
@@ -424,8 +424,7 @@ void Adafruit_LSM9DS0::setupGyro(lsm9ds0GyroScale_t scale) {
     @brief Power the accelerometer, magnetomer and gyroscope down
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerDown(void)
-{
+void Adafruit_LSM9DS0::powerDown(void) {
   powerAccelDown();
   powerMagDown();
   powerGyroDown();
@@ -436,8 +435,7 @@ void Adafruit_LSM9DS0::powerDown(void)
     @brief Power the accelerometer, magnetomer and gyroscope up
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerUp(void)
-{
+void Adafruit_LSM9DS0::powerUp(void) {
   powerAccelUp();
   powerMagUp();
   powerGyroUp();
@@ -448,8 +446,7 @@ void Adafruit_LSM9DS0::powerUp(void)
     @brief Power the accelerometer down
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerAccelDown(void)
-{
+void Adafruit_LSM9DS0::powerAccelDown(void) {
   uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG1_XM);
   const uint8_t CTRL_REG1_XM_ADOR_MASK = 0xF0;
   const uint8_t CTRL_REG1_XM_AODR_POWER_DOWN = 0x00;
@@ -465,8 +462,7 @@ void Adafruit_LSM9DS0::powerAccelDown(void)
     @brief Power the accelerometer up
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerAccelUp(void)
-{
+void Adafruit_LSM9DS0::powerAccelUp(void) {
   uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG1_XM);
   const uint8_t CTRL_REG1_XM_ADOR_MASK = 0xF0;
   const uint8_t CTRL_REG1_XM_AODR_100_HZ = 0x60;
@@ -482,8 +478,7 @@ void Adafruit_LSM9DS0::powerAccelUp(void)
     @brief Power the magnetometer down
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerMagDown(void)
-{
+void Adafruit_LSM9DS0::powerMagDown(void) {
   uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG7_XM);
   const uint8_t CTRL_REG7_XM_MD_MASK = 0x03;
   const uint8_t CTRL_REG7_XM_MD_POWER_DOWN = 0x03;
@@ -499,8 +494,7 @@ void Adafruit_LSM9DS0::powerMagDown(void)
     @brief Power the magnetometer up
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerMagUp(void)
-{
+void Adafruit_LSM9DS0::powerMagUp(void) {
   uint8_t value = read8(XMTYPE, LSM9DS0_REGISTER_CTRL_REG7_XM);
   const uint8_t CTRL_REG7_XM_MD_MASK = 0x03;
   const uint8_t CTRL_REG7_XM_MD_CONTINUOUIS_CONVERSION = 0x00;
@@ -516,8 +510,7 @@ void Adafruit_LSM9DS0::powerMagUp(void)
     @brief Power the gyroscope down
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerGyroDown(void)
-{
+void Adafruit_LSM9DS0::powerGyroDown(void) {
   uint8_t value = read8(GYROTYPE, LSM9DS0_REGISTER_CTRL_REG1_G);
   const uint8_t CTRL_REG1_G_PD_MASK = 0x08;
   const uint8_t CTRL_REG1_G_PD_POWER_DOWN = 0x00;
@@ -533,8 +526,7 @@ void Adafruit_LSM9DS0::powerGyroDown(void)
     @brief Power the gyroscope up
 */
 /**************************************************************************/
-void Adafruit_LSM9DS0::powerGyroUp(void)
-{
+void Adafruit_LSM9DS0::powerGyroUp(void) {
   uint8_t value = read8(GYROTYPE, LSM9DS0_REGISTER_CTRL_REG1_G);
   const uint8_t CTRL_REG1_G_PD_MASK = 0x08;
   const uint8_t CTRL_REG1_G_PD_NORMAL = 0x08;