drivers: sensor: lis2dh: Add self-test attribute

Add support for enabling and configuring the self-test mode of the
LIS2DH accelerometer through a dedicated sensor attribute.

Signed-off-by: Arthur Gay <[email protected]>

Author: arthur-mmlw

drivers/sensor/st/lis2dh/Kconfig

@@ -161,4 +161,11 @@ config LIS2DH_MEASURE_TEMPERATURE
 	  the reported temperature to a reference.
 	  This option does not apply to the LSM330DLHC.
 
+config LIS2DH_SELF_TEST
+	bool "Self test attribute"
+	help
+	  Enable support for configuring the sensor self test bits.
+	  Refer to the datasheet of the sensor for a description of
+	  the appropriate self test procedure.
+
 endif # LIS2DH

drivers/sensor/st/lis2dh/lis2dh.c

@@ -12,6 +12,7 @@
 #include <zephyr/sys/__assert.h>
 #include <zephyr/logging/log.h>
 #include <zephyr/pm/device.h>
+#include <zephyr/drivers/sensor/lis2dh.h>
 
 LOG_MODULE_REGISTER(lis2dh, CONFIG_SENSOR_LOG_LEVEL);
 #include "lis2dh.h"
@@ -286,6 +287,16 @@ static int lis2dh_acc_hp_filter_set(const struct device *dev, int32_t val)
 }
 #endif
 
+#ifdef CONFIG_LIS2DH_SELF_TEST
+static int lis2dh_self_test_set(const struct device *dev, int32_t val)
+{
+	struct lis2dh_data *lis2dh = dev->data;
+	uint8_t value = (val << LIS2DH_CTRL4_ST_SHIFT) & LIS2DH_CTRL4_ST_MASK;
+
+	return lis2dh->hw_tf->update_reg(dev, LIS2DH_REG_CTRL4, LIS2DH_CTRL4_ST_MASK, value);
+}
+#endif
+
 static int lis2dh_acc_config(const struct device *dev,
 			     enum sensor_channel chan,
 			     enum sensor_attribute attr,
@@ -308,6 +319,10 @@ static int lis2dh_acc_config(const struct device *dev,
 #ifdef CONFIG_LIS2DH_ACCEL_HP_FILTERS
 	case SENSOR_ATTR_CONFIGURATION:
 		return lis2dh_acc_hp_filter_set(dev, val->val1);
+#endif
+#ifdef CONFIG_LIS2DH_SELF_TEST
+	case SENSOR_ATTR_LIS2DH_SELF_TEST:
+		return lis2dh_self_test_set(dev, val->val1);
 #endif
 	default:
 		LOG_DBG("Accel attribute not supported.");

drivers/sensor/st/lis2dh/lis2dh.h

@@ -101,6 +101,8 @@
 #define LIS2DH_EN_DRDY1_INT1		BIT(4)
 
 #define LIS2DH_REG_CTRL4		0x23
+#define LIS2DH_CTRL4_ST_SHIFT		1
+#define LIS2DH_CTRL4_ST_MASK		(BIT_MASK(2) << LIS2DH_CTRL4_ST_SHIFT)
 #define LIS2DH_CTRL4_BDU_BIT		BIT(7)
 #define LIS2DH_FS_SHIFT			4
 #define LIS2DH_FS_MASK			(BIT_MASK(2) << LIS2DH_FS_SHIFT)

include/zephyr/drivers/sensor/lis2dh.h

@@ -0,0 +1,22 @@
+/*
+ * Copyright The Zephyr Project Contributors
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ */
+
+#ifndef ZEPHYR_INCLUDE_DRIVERS_SENSOR_LIS2DH_H_
+#define ZEPHYR_INCLUDE_DRIVERS_SENSOR_LIS2DH_H_
+
+#include <zephyr/drivers/sensor.h>
+
+enum lis2dh_self_test {
+	LIS2DH_SELF_TEST_DISABLE = 0,
+	LIS2DH_SELF_TEST_POSITIVE = 1,
+	LIS2DH_SELF_TEST_NEGATIVE = 2,
+};
+
+enum sensor_attribute_lis2dh {
+	SENSOR_ATTR_LIS2DH_SELF_TEST = SENSOR_ATTR_PRIV_START,
+};
+
+#endif /* ZEPHYR_INCLUDE_DRIVERS_SENSOR_LIS2DH_H_ */