mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
synced 2025-08-29 11:42:36 +00:00
dfdc31e7cc
Temperature sensor returns the temperature of the mechanical parts
of the chip. If both accel and gyro are off, the temperature sensor is
also automatically turned off and returns invalid data.
In this case, returning -EBUSY error code is better then -EINVAL and
indicates userspace that it needs to retry reading temperature in
another context.
Fixes: bc3eb0207f ("iio: imu: inv_icm42600: add temperature sensor support")
Signed-off-by: Jean-Baptiste Maneyrol <jean-baptiste.maneyrol@tdk.com>
Cc: stable@vger.kernel.org
Reviewed-by: Andy Shevchenko <andy@kernel.org>
Reviewed-by: Sean Nyekjaer <sean@geanix.com>
Link: https://patch.msgid.link/20250808-inv-icm42600-change-temperature-error-code-v1-1-986fbf63b77d@tdk.com
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
90 lines
1.9 KiB
C
90 lines
1.9 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Copyright (C) 2020 Invensense, Inc.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/device.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/iio/iio.h>
|
|
|
|
#include "inv_icm42600.h"
|
|
#include "inv_icm42600_temp.h"
|
|
|
|
static int inv_icm42600_temp_read(struct inv_icm42600_state *st, s16 *temp)
|
|
{
|
|
struct device *dev = regmap_get_device(st->map);
|
|
__be16 *raw;
|
|
int ret;
|
|
|
|
pm_runtime_get_sync(dev);
|
|
mutex_lock(&st->lock);
|
|
|
|
ret = inv_icm42600_set_temp_conf(st, true, NULL);
|
|
if (ret)
|
|
goto exit;
|
|
|
|
raw = (__be16 *)&st->buffer[0];
|
|
ret = regmap_bulk_read(st->map, INV_ICM42600_REG_TEMP_DATA, raw, sizeof(*raw));
|
|
if (ret)
|
|
goto exit;
|
|
|
|
*temp = (s16)be16_to_cpup(raw);
|
|
/*
|
|
* Temperature data is invalid if both accel and gyro are off.
|
|
* Return -EBUSY in this case.
|
|
*/
|
|
if (*temp == INV_ICM42600_DATA_INVALID)
|
|
ret = -EBUSY;
|
|
|
|
exit:
|
|
mutex_unlock(&st->lock);
|
|
pm_runtime_mark_last_busy(dev);
|
|
pm_runtime_put_autosuspend(dev);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int inv_icm42600_temp_read_raw(struct iio_dev *indio_dev,
|
|
struct iio_chan_spec const *chan,
|
|
int *val, int *val2, long mask)
|
|
{
|
|
struct inv_icm42600_state *st = iio_device_get_drvdata(indio_dev);
|
|
s16 temp;
|
|
int ret;
|
|
|
|
if (chan->type != IIO_TEMP)
|
|
return -EINVAL;
|
|
|
|
switch (mask) {
|
|
case IIO_CHAN_INFO_RAW:
|
|
if (!iio_device_claim_direct(indio_dev))
|
|
return -EBUSY;
|
|
ret = inv_icm42600_temp_read(st, &temp);
|
|
iio_device_release_direct(indio_dev);
|
|
if (ret)
|
|
return ret;
|
|
*val = temp;
|
|
return IIO_VAL_INT;
|
|
/*
|
|
* T°C = (temp / 132.48) + 25
|
|
* Tm°C = 1000 * ((temp / 132.48) + 25)
|
|
* Tm°C = 7.548309 * temp + 25000
|
|
* Tm°C = (temp + 3312) * 7.548309
|
|
* scale: 100000 / 13248 ~= 7.548309
|
|
* offset: 3312
|
|
*/
|
|
case IIO_CHAN_INFO_SCALE:
|
|
*val = 7;
|
|
*val2 = 548309;
|
|
return IIO_VAL_INT_PLUS_MICRO;
|
|
case IIO_CHAN_INFO_OFFSET:
|
|
*val = 3312;
|
|
return IIO_VAL_INT;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|