Link activity and inactivity to indicate the internal power-saving state. Add auto-sleep to be linked to inactivity. Signed-off-by: Lothar Rubusch <l.rubusch@xxxxxxxxx> --- drivers/iio/accel/adxl313.h | 3 +++ drivers/iio/accel/adxl313_core.c | 29 ++++++++++++++++++++++++++--- 2 files changed, 29 insertions(+), 3 deletions(-) diff --git a/drivers/iio/accel/adxl313.h b/drivers/iio/accel/adxl313.h index 1398ac54d19b..eafdf8f57816 100644 --- a/drivers/iio/accel/adxl313.h +++ b/drivers/iio/accel/adxl313.h @@ -41,6 +41,9 @@ #define ADXL313_RATE_BASE 6 #define ADXL313_POWER_CTL_MSK BIT(3) +#define ADXL313_POWER_CTL_INACT_MSK GENMASK(5, 4) +#define ADXL313_POWER_CTL_LINK BIT(5) +#define ADXL313_POWER_CTL_AUTO_SLEEP BIT(4) #define ADXL313_MEASUREMENT_MODE BIT(3) #define ADXL313_MEASUREMENT_STANDBY 0x00 diff --git a/drivers/iio/accel/adxl313_core.c b/drivers/iio/accel/adxl313_core.c index 46ca30abc7fd..aabb4a1b9b9b 100644 --- a/drivers/iio/accel/adxl313_core.c +++ b/drivers/iio/accel/adxl313_core.c @@ -392,6 +392,7 @@ static int adxl313_set_act_inact_en(struct adxl313_data *data, unsigned int axis_ctrl; unsigned int threshold; unsigned int inact_time_s; + bool act_en, inact_en; bool en; int ret; @@ -423,9 +424,31 @@ static int adxl313_set_act_inact_en(struct adxl313_data *data, en = cmd_en && threshold && inact_time_s; } - return regmap_update_bits(data->regmap, ADXL313_REG_INT_ENABLE, - adxl313_act_int_reg[type], - en ? adxl313_act_int_reg[type] : 0); + ret = regmap_update_bits(data->regmap, ADXL313_REG_INT_ENABLE, + adxl313_act_int_reg[type], + en ? adxl313_act_int_reg[type] : 0); + if (ret) + return ret; + + /* + * Advanced power saving: Set sleep and link bit only when ACT and INACT + * are set. Check enable against regmap cached values. + */ + ret = adxl313_is_act_inact_en(data, ADXL313_ACTIVITY, &act_en); + if (ret) + return ret; + + ret = adxl313_is_act_inact_en(data, ADXL313_INACTIVITY, &inact_en); + if (ret) + return ret; + + en = en && act_en && inact_en; + + return regmap_update_bits(data->regmap, + ADXL313_REG_POWER_CTL, + ADXL313_POWER_CTL_INACT_MSK, + en ? (ADXL313_POWER_CTL_AUTO_SLEEP | ADXL313_POWER_CTL_LINK) + : 0); } static int adxl313_read_raw(struct iio_dev *indio_dev, -- 2.39.5
