#include <linux/bitfield.h>
#include <linux/cleanup.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/iio/iio.h>
#include <linux/mutex.h>
#include <linux/pm_runtime.h>
#include <linux/regmap.h>
#include <linux/types.h>
#include <linux/unaligned.h>
#include "inv_icm42607.h"
#include "inv_icm42607_temp.h"
static int inv_icm42607_temp_read(struct inv_icm42607_state *st, s16 *temp)
{
struct inv_icm42607_sensor_conf conf = INV_ICM42607_SENSOR_CONF_INIT;
struct device *dev = regmap_get_device(st->map);
int ret, gyro_mode, accel_mode;
unsigned int val;
u8 raw[2];
PM_RUNTIME_ACQUIRE_AUTOSUSPEND(dev, pm);
ret = PM_RUNTIME_ACQUIRE_ERR(&pm);
if (ret)
return ret;
guard(mutex)(&st->lock);
ret = regmap_read(st->map, INV_ICM42607_REG_PWR_MGMT0, &val);
if (ret)
return ret;
accel_mode = FIELD_GET(INV_ICM42607_PWR_MGMT0_ACCEL_MODE_MASK, val);
gyro_mode = FIELD_GET(INV_ICM42607_PWR_MGMT0_GYRO_MODE_MASK, val);
if (!gyro_mode && !accel_mode) {
conf.mode = INV_ICM42607_SENSOR_MODE_LOW_NOISE;
ret = inv_icm42607_set_sensor_conf(st, &conf, IIO_ACCEL);
if (ret)
return ret;
}
ret = regmap_bulk_read(st->map, INV_ICM42607_REG_TEMP_DATA1,
raw, sizeof(raw));
if (ret)
return ret;
*temp = get_unaligned_be16(raw);
if (*temp == INV_ICM42607_DATA_INVALID)
return -EINVAL;
return 0;
}
int inv_icm42607_temp_read_raw(struct iio_dev *indio_dev,
struct iio_chan_spec const *chan,
int *val, int *val2, long mask)
{
struct inv_icm42607_state *st = iio_device_get_drvdata(indio_dev);
s16 temp;
int ret;
switch (mask) {
case IIO_CHAN_INFO_RAW:
ret = inv_icm42607_temp_read(st, &temp);
if (ret)
return ret;
*val = temp;
return IIO_VAL_INT;
case IIO_CHAN_INFO_SCALE:
*val = 7;
*val2 = 812500000;
return IIO_VAL_INT_PLUS_NANO;
case IIO_CHAN_INFO_OFFSET:
*val = 3200;
return IIO_VAL_INT;
default:
return -EINVAL;
}
}