drivers: iis2dlpc: adding activity interrupt

This commit adds the activity/inactivity recognition as well as the
stationary/motion detection as defined in the IIS2DLPC application
note.

For now, there is no possibility to configure this interrupt using
device tree binding, as I would like to keep the configuration updatable
and not set at boot time. This behaviour is fine for prototypes and
samples, but is too restrictive on products that may want to change the
interrupt configuration at run-time.

The interrupt is configured using the attributes SENSOR_ATTR_SLOPE_TH and
SENSOR_ATTR_SLOPE_DUR.

Signed-off-by: Giuliano Franchetto <[email protected]>

Author: GiulianoFranchetto

drivers/sensor/iis2dlpc/Kconfig

@@ -60,6 +60,11 @@ config IIS2DLPC_TAP
 	help
 	  Enable tap (single/double) detection
 
+config IIS2DLPC_ACTIVITY
+	bool "Activity detection"
+	help
+	  Enable activity/inactivity detection
+
 endif # IIS2DLPC_TRIGGER
 
 endif # IIS2DLPC

drivers/sensor/iis2dlpc/iis2dlpc.c

@@ -69,7 +69,7 @@ static int iis2dlpc_set_odr(const struct device *dev, uint16_t odr)
 		return iis2dlpc_data_rate_set(ctx, IIS2DLPC_XL_ODR_OFF);
 	}
 
-	val =  IIS2DLPC_ODR_TO_REG(odr);
+	val = IIS2DLPC_ODR_TO_REG(odr);
 	if (val > IIS2DLPC_XL_ODR_1k6Hz) {
 		LOG_ERR("ODR too high");
 		return -ENOTSUP;
@@ -138,6 +138,46 @@ static int iis2dlpc_channel_get(const struct device *dev,
 	return -ENOTSUP;
 }
 
+#ifdef CONFIG_IIS2DLPC_ACTIVITY
+static int ii2sdlpc_set_slope_th(const struct device *dev, uint16_t th)
+{
+	int err;
+	const struct iis2dlpc_config *cfg = dev->config;
+	stmdev_ctx_t *ctx = (stmdev_ctx_t *) &cfg->ctx;
+
+	err = iis2dlpc_wkup_threshold_set(ctx, th & 0x3F);
+	if (err) {
+		LOG_ERR("Could not set WK_THS to 0x%02X, error %d",
+			th & 0x03, err);
+		return err;
+	}
+	return 0;
+}
+static int ii2sdlpc_set_slope_dur(const struct device *dev, uint16_t dur)
+{
+	int err;
+	const struct iis2dlpc_config *cfg = dev->config;
+	stmdev_ctx_t *ctx = (stmdev_ctx_t *) &cfg->ctx;
+	uint8_t val;
+
+	val = (dur & 0x0F);
+	err = iis2dlpc_act_sleep_dur_set(ctx, val);
+	if (err) {
+		LOG_ERR("Could not set SLEEP_DUR to 0x%02X, error %d",
+			val, err);
+		return err;
+	}
+	val = ((dur >> 5) & 0x03);
+	err = iis2dlpc_wkup_dur_set(ctx, val);
+	if (err) {
+		LOG_ERR("Could not set WAKE_DUR to 0x%02X, error %d",
+			val, err);
+		return err;
+	}
+	return 0;
+}
+#endif /* CONFIG_IIS2DLPC_ACTIVITY */
+
 static int iis2dlpc_dev_config(const struct device *dev,
 			       enum sensor_channel chan,
 			       enum sensor_attribute attr,
@@ -149,6 +189,12 @@ static int iis2dlpc_dev_config(const struct device *dev,
 				IIS2DLPC_FS_TO_REG(sensor_ms2_to_g(val)));
 	case SENSOR_ATTR_SAMPLING_FREQUENCY:
 		return iis2dlpc_set_odr(dev, val->val1);
+#ifdef CONFIG_IIS2DLPC_ACTIVITY
+	case SENSOR_ATTR_SLOPE_TH:
+		return ii2sdlpc_set_slope_th(dev, val->val1);
+	case SENSOR_ATTR_SLOPE_DUR:
+		return ii2sdlpc_set_slope_dur(dev, val->val1);
+#endif /* CONFIG_IIS2DLPC_ACTIVITY */
 	default:
 		LOG_DBG("Acc attribute not supported");
 		break;

drivers/sensor/iis2dlpc/iis2dlpc.h

@@ -99,6 +99,9 @@ struct iis2dlpc_data {
 	sensor_trigger_handler_t tap_handler;
 	sensor_trigger_handler_t double_tap_handler;
 #endif /* CONFIG_IIS2DLPC_TAP */
+#ifdef CONFIG_IIS2DLPC_ACTIVITY
+	sensor_trigger_handler_t activity_handler;
+#endif /* CONFIG_IIS2DLPC_ACTIVITY */
 #if defined(CONFIG_IIS2DLPC_TRIGGER_OWN_THREAD)
 	K_KERNEL_STACK_MEMBER(thread_stack, CONFIG_IIS2DLPC_THREAD_STACK_SIZE);
 	struct k_thread thread;

drivers/sensor/iis2dlpc/iis2dlpc_trigger.c

@@ -67,6 +67,19 @@ static int iis2dlpc_enable_int(const struct device *dev,
 		return iis2dlpc_pin_int1_route_set(ctx,
 				&int_route.ctrl4_int1_pad_ctrl);
 #endif /* CONFIG_IIS2DLPC_TAP */
+#ifdef CONFIG_IIS2DLPC_ACTIVITY
+	case SENSOR_TRIG_DELTA:
+		/* set interrupt for pin INT1 */
+		iis2dlpc_pin_int1_route_get(ctx,
+			    &int_route.ctrl4_int1_pad_ctrl);
+		int_route.ctrl4_int1_pad_ctrl.int1_wu = enable;
+
+		iis2dlpc_act_mode_set(ctx, enable ? IIS2DLPC_DETECT_ACT_INACT
+						  : IIS2DLPC_NO_DETECTION);
+
+		return iis2dlpc_pin_int1_route_set(ctx,
+			   &int_route.ctrl4_int1_pad_ctrl);
+#endif /* CONFIG_IIS2DLPC_ACTIVITY */
 	default:
 		LOG_ERR("Unsupported trigger interrupt route %d", type);
 		return -ENOTSUP;
@@ -102,6 +115,11 @@ int iis2dlpc_trigger_set(const struct device *dev,
 		iis2dlpc->double_tap_handler = handler;
 		return iis2dlpc_enable_int(dev, SENSOR_TRIG_DOUBLE_TAP, state);
 #endif /* CONFIG_IIS2DLPC_TAP */
+#ifdef CONFIG_IIS2DLPC_ACTIVITY
+	case SENSOR_TRIG_DELTA:
+		iis2dlpc->activity_handler = handler;
+		return iis2dlpc_enable_int(dev, SENSOR_TRIG_DELTA, state);
+#endif /* CONFIG_IIS2DLPC_ACTIVITY */
 	default:
 		LOG_ERR("Unsupported sensor trigger");
 		return -ENOTSUP;
@@ -124,6 +142,25 @@ static int iis2dlpc_handle_drdy_int(const struct device *dev)
 	return 0;
 }
 
+#ifdef CONFIG_IIS2DLPC_ACTIVITY
+static int iis2dlpc_handle_activity_int(const struct device *dev)
+{
+	struct iis2dlpc_data *data = dev->data;
+	sensor_trigger_handler_t handler = data->activity_handler;
+
+	struct sensor_trigger tap_trig = {
+		.type = SENSOR_TRIG_DELTA,
+		.chan = SENSOR_CHAN_ALL,
+	};
+
+	if (handler) {
+		handler(dev, &tap_trig);
+	}
+
+	return 0;
+}
+#endif /* CONFIG_IIS2DLPC_ACTIVITY */
+
 #ifdef CONFIG_IIS2DLPC_TAP
 static int iis2dlpc_handle_single_tap_int(const struct device *dev)
 {
@@ -183,6 +220,11 @@ static void iis2dlpc_handle_interrupt(const struct device *dev)
 		iis2dlpc_handle_double_tap_int(dev);
 	}
 #endif /* CONFIG_IIS2DLPC_TAP */
+#ifdef CONFIG_IIS2DLPC_ACTIVITY
+	if (sources.all_int_src.wu_ia) {
+		iis2dlpc_handle_activity_int(dev);
+	}
+#endif /* CONFIG_IIS2DLPC_ACTIVITY */
 
 	gpio_pin_interrupt_configure_dt(&cfg->gpio_drdy,
 					GPIO_INT_EDGE_TO_ACTIVE);