sensor/lsm6dso16is: add upload_fw API support

Add support to upload_fw API in order to be able to upload a ISPU
configuration.

Signed-off-by: Armando Visconti <[email protected]>

Author: avisconti

drivers/sensor/st/lsm6dso16is/Kconfig

@@ -18,6 +18,10 @@ menuconfig LSM6DSO16IS
 
 if LSM6DSO16IS
 
+config LSM6DSO16IS_ISPU_ENABLE
+	bool "ISPU Enable"
+	select USE_ST_MEMS_ISPU
+
 choice LSM6DSO16IS_TRIGGER_MODE
 	prompt "Trigger mode"
 	help

drivers/sensor/st/lsm6dso16is/lsm6dso16is.c

@@ -710,13 +710,39 @@ static int lsm6dso16is_channel_get(const struct device *dev,
 	return 0;
 }
 
+static int lsm6dso16is_upload_ispu(const struct device *dev,
+				   const void *fw_buf,
+				   size_t fw_len)
+{
+	const struct lsm6dso16is_config *cfg = dev->config;
+	stmdev_ctx_t *ctx = (stmdev_ctx_t *)&cfg->ctx;
+	const struct mems_conf_op *bufp = (const struct mems_conf_op *)fw_buf;
+	int i;
+
+	/* Load ISPU configuration */
+	for ( i = 0; i < fw_len; i++ ) {
+		switch(bufp[i].type) {
+		case MEMS_CONF_OP_TYPE_DELAY:
+			k_msleep(bufp[i].data);
+			break;
+
+		case MEMS_CONF_OP_TYPE_WRITE:
+			ctx->write_reg(ctx->handle, bufp[i].address, (uint8_t *)&bufp[i].data, 1);
+			break;
+		}
+	}
+
+	return 0;
+}
+
 static DEVICE_API(sensor, lsm6dso16is_driver_api) = {
 	.attr_set = lsm6dso16is_attr_set,
 #if CONFIG_LSM6DSO16IS_TRIGGER
 	.trigger_set = lsm6dso16is_trigger_set,
 #endif
 	.sample_fetch = lsm6dso16is_sample_fetch,
 	.channel_get = lsm6dso16is_channel_get,
+	.upload_fw = lsm6dso16is_upload_ispu,
 };
 
 static int lsm6dso16is_init_chip(const struct device *dev)

drivers/sensor/st/lsm6dso16is/lsm6dso16is.h

@@ -17,6 +17,7 @@
 #include <zephyr/sys/util.h>
 #include <stmemsc.h>
 #include "lsm6dso16is_reg.h"
+#include "mems_conf_shared_types.h"
 
 #if DT_ANY_INST_ON_BUS_STATUS_OKAY(spi)
 #include <zephyr/drivers/spi.h>