Commit e65365fe authored by Guenter Roeck's avatar Guenter Roeck

hwmon: (lm75) Convert to use regmap

Convert to use regmap. Leave caching to regmap and drop the register
update function. While this can result in additional read operations
if the temperature register is read continuously, it avoids re-reading
the limit registers and thus overall reduces complexity.
Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
parent 5f7e5e29
...@@ -958,6 +958,7 @@ config SENSORS_LM75 ...@@ -958,6 +958,7 @@ config SENSORS_LM75
tristate "National Semiconductor LM75 and compatibles" tristate "National Semiconductor LM75 and compatibles"
depends on I2C depends on I2C
depends on THERMAL || !THERMAL_OF depends on THERMAL || !THERMAL_OF
select REGMAP_I2C
help help
If you say yes here you get support for one common type of If you say yes here you get support for one common type of
temperature sensor chip, with models including: temperature sensor chip, with models including:
......
...@@ -26,8 +26,8 @@ ...@@ -26,8 +26,8 @@
#include <linux/hwmon.h> #include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h> #include <linux/hwmon-sysfs.h>
#include <linux/err.h> #include <linux/err.h>
#include <linux/mutex.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/regmap.h>
#include <linux/thermal.h> #include <linux/thermal.h>
#include "lm75.h" #include "lm75.h"
...@@ -66,32 +66,21 @@ static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b, 0x4c, ...@@ -66,32 +66,21 @@ static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b, 0x4c,
/* The LM75 registers */ /* The LM75 registers */
#define LM75_REG_TEMP 0x00
#define LM75_REG_CONF 0x01 #define LM75_REG_CONF 0x01
static const u8 LM75_REG_TEMP[3] = { #define LM75_REG_HYST 0x02
0x00, /* input */ #define LM75_REG_MAX 0x03
0x03, /* max */
0x02, /* hyst */
};
/* Each client has this additional data */ /* Each client has this additional data */
struct lm75_data { struct lm75_data {
struct i2c_client *client; struct i2c_client *client;
struct mutex update_lock; struct regmap *regmap;
u8 orig_conf; u8 orig_conf;
u8 resolution; /* In bits, between 9 and 12 */ u8 resolution; /* In bits, between 9 and 12 */
u8 resolution_limits; u8 resolution_limits;
char valid; /* !=0 if registers are valid */ unsigned int sample_time; /* In ms */
unsigned long last_updated; /* In jiffies */
unsigned long sample_time; /* In jiffies */
s16 temp[3]; /* Register values,
0 = input
1 = max
2 = hyst */
}; };
static struct lm75_data *lm75_update_device(struct device *dev);
/*-----------------------------------------------------------------------*/ /*-----------------------------------------------------------------------*/
static inline long lm75_reg_to_mc(s16 temp, u8 resolution) static inline long lm75_reg_to_mc(s16 temp, u8 resolution)
...@@ -103,12 +92,15 @@ static inline long lm75_reg_to_mc(s16 temp, u8 resolution) ...@@ -103,12 +92,15 @@ static inline long lm75_reg_to_mc(s16 temp, u8 resolution)
static int lm75_read_temp(void *dev, int *temp) static int lm75_read_temp(void *dev, int *temp)
{ {
struct lm75_data *data = lm75_update_device(dev); struct lm75_data *data = dev_get_drvdata(dev);
unsigned int _temp;
int err;
if (IS_ERR(data)) err = regmap_read(data->regmap, LM75_REG_TEMP, &_temp);
return PTR_ERR(data); if (err < 0)
return err;
*temp = lm75_reg_to_mc(data->temp[0], data->resolution); *temp = lm75_reg_to_mc(_temp, data->resolution);
return 0; return 0;
} }
...@@ -117,13 +109,15 @@ static ssize_t show_temp(struct device *dev, struct device_attribute *da, ...@@ -117,13 +109,15 @@ static ssize_t show_temp(struct device *dev, struct device_attribute *da,
char *buf) char *buf)
{ {
struct sensor_device_attribute *attr = to_sensor_dev_attr(da); struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
struct lm75_data *data = lm75_update_device(dev); struct lm75_data *data = dev_get_drvdata(dev);
unsigned int temp = 0;
int err;
if (IS_ERR(data)) err = regmap_read(data->regmap, attr->index, &temp);
return PTR_ERR(data); if (err < 0)
return err;
return sprintf(buf, "%ld\n", lm75_reg_to_mc(data->temp[attr->index], return sprintf(buf, "%ld\n", lm75_reg_to_mc(temp, data->resolution));
data->resolution));
} }
static ssize_t set_temp(struct device *dev, struct device_attribute *da, static ssize_t set_temp(struct device *dev, struct device_attribute *da,
...@@ -131,8 +125,6 @@ static ssize_t set_temp(struct device *dev, struct device_attribute *da, ...@@ -131,8 +125,6 @@ static ssize_t set_temp(struct device *dev, struct device_attribute *da,
{ {
struct sensor_device_attribute *attr = to_sensor_dev_attr(da); struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
struct lm75_data *data = dev_get_drvdata(dev); struct lm75_data *data = dev_get_drvdata(dev);
struct i2c_client *client = data->client;
int nr = attr->index;
long temp; long temp;
int error; int error;
u8 resolution; u8 resolution;
...@@ -150,31 +142,29 @@ static ssize_t set_temp(struct device *dev, struct device_attribute *da, ...@@ -150,31 +142,29 @@ static ssize_t set_temp(struct device *dev, struct device_attribute *da,
else else
resolution = data->resolution; resolution = data->resolution;
mutex_lock(&data->update_lock);
temp = clamp_val(temp, LM75_TEMP_MIN, LM75_TEMP_MAX); temp = clamp_val(temp, LM75_TEMP_MIN, LM75_TEMP_MAX);
data->temp[nr] = DIV_ROUND_CLOSEST(temp << (resolution - 8), temp = DIV_ROUND_CLOSEST(temp << (resolution - 8),
1000) << (16 - resolution); 1000) << (16 - resolution);
i2c_smbus_write_word_swapped(client, LM75_REG_TEMP[nr], data->temp[nr]); error = regmap_write(data->regmap, attr->index, temp);
mutex_unlock(&data->update_lock); if (error < 0)
return error;
return count; return count;
} }
static ssize_t show_update_interval(struct device *dev, static ssize_t show_update_interval(struct device *dev,
struct device_attribute *da, char *buf) struct device_attribute *da, char *buf)
{ {
struct lm75_data *data = lm75_update_device(dev); struct lm75_data *data = dev_get_drvdata(dev);
if (IS_ERR(data))
return PTR_ERR(data);
return sprintf(buf, "%u\n", jiffies_to_msecs(data->sample_time)); return sprintf(buf, "%u\n", data->sample_time);
} }
static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO,
show_temp, set_temp, 1); show_temp, set_temp, LM75_REG_MAX);
static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO, static SENSOR_DEVICE_ATTR(temp1_max_hyst, S_IWUSR | S_IRUGO,
show_temp, set_temp, 2); show_temp, set_temp, LM75_REG_HYST);
static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0); static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, LM75_REG_TEMP);
static DEVICE_ATTR(update_interval, S_IRUGO, show_update_interval, NULL); static DEVICE_ATTR(update_interval, S_IRUGO, show_update_interval, NULL);
static struct attribute *lm75_attrs[] = { static struct attribute *lm75_attrs[] = {
...@@ -195,6 +185,27 @@ static const struct thermal_zone_of_device_ops lm75_of_thermal_ops = { ...@@ -195,6 +185,27 @@ static const struct thermal_zone_of_device_ops lm75_of_thermal_ops = {
/* device probe and removal */ /* device probe and removal */
static bool lm75_is_writeable_reg(struct device *dev, unsigned int reg)
{
return reg != LM75_REG_TEMP;
}
static bool lm75_is_volatile_reg(struct device *dev, unsigned int reg)
{
return reg == LM75_REG_TEMP;
}
static const struct regmap_config lm75_regmap_config = {
.reg_bits = 8,
.val_bits = 16,
.max_register = LM75_REG_MAX,
.writeable_reg = lm75_is_writeable_reg,
.volatile_reg = lm75_is_volatile_reg,
.val_format_endian = REGMAP_ENDIAN_BIG,
.cache_type = REGCACHE_RBTREE,
.use_single_rw = true,
};
static void lm75_remove(void *data) static void lm75_remove(void *data)
{ {
struct lm75_data *lm75 = data; struct lm75_data *lm75 = data;
...@@ -223,8 +234,10 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id) ...@@ -223,8 +234,10 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
return -ENOMEM; return -ENOMEM;
data->client = client; data->client = client;
i2c_set_clientdata(client, data);
mutex_init(&data->update_lock); data->regmap = devm_regmap_init_i2c(client, &lm75_regmap_config);
if (IS_ERR(data->regmap))
return PTR_ERR(data->regmap);
/* Set to LM75 resolution (9 bits, 1/2 degree C) and range. /* Set to LM75 resolution (9 bits, 1/2 degree C) and range.
* Then tweak to be more precise when appropriate. * Then tweak to be more precise when appropriate.
...@@ -236,7 +249,7 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id) ...@@ -236,7 +249,7 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
case adt75: case adt75:
clr_mask |= 1 << 5; /* not one-shot mode */ clr_mask |= 1 << 5; /* not one-shot mode */
data->resolution = 12; data->resolution = 12;
data->sample_time = HZ / 8; data->sample_time = MSEC_PER_SEC / 8;
break; break;
case ds1775: case ds1775:
case ds75: case ds75:
...@@ -244,35 +257,35 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id) ...@@ -244,35 +257,35 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
clr_mask |= 3 << 5; clr_mask |= 3 << 5;
set_mask |= 2 << 5; /* 11-bit mode */ set_mask |= 2 << 5; /* 11-bit mode */
data->resolution = 11; data->resolution = 11;
data->sample_time = HZ; data->sample_time = MSEC_PER_SEC;
break; break;
case ds7505: case ds7505:
set_mask |= 3 << 5; /* 12-bit mode */ set_mask |= 3 << 5; /* 12-bit mode */
data->resolution = 12; data->resolution = 12;
data->sample_time = HZ / 4; data->sample_time = MSEC_PER_SEC / 4;
break; break;
case g751: case g751:
case lm75: case lm75:
case lm75a: case lm75a:
data->resolution = 9; data->resolution = 9;
data->sample_time = HZ / 2; data->sample_time = MSEC_PER_SEC / 2;
break; break;
case lm75b: case lm75b:
data->resolution = 11; data->resolution = 11;
data->sample_time = HZ / 4; data->sample_time = MSEC_PER_SEC / 4;
break; break;
case max6625: case max6625:
data->resolution = 9; data->resolution = 9;
data->sample_time = HZ / 4; data->sample_time = MSEC_PER_SEC / 4;
break; break;
case max6626: case max6626:
data->resolution = 12; data->resolution = 12;
data->resolution_limits = 9; data->resolution_limits = 9;
data->sample_time = HZ / 4; data->sample_time = MSEC_PER_SEC / 4;
break; break;
case tcn75: case tcn75:
data->resolution = 9; data->resolution = 9;
data->sample_time = HZ / 8; data->sample_time = MSEC_PER_SEC / 8;
break; break;
case mcp980x: case mcp980x:
data->resolution_limits = 9; data->resolution_limits = 9;
...@@ -281,14 +294,14 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id) ...@@ -281,14 +294,14 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
case tmp101: case tmp101:
set_mask |= 3 << 5; /* 12-bit mode */ set_mask |= 3 << 5; /* 12-bit mode */
data->resolution = 12; data->resolution = 12;
data->sample_time = HZ; data->sample_time = MSEC_PER_SEC;
clr_mask |= 1 << 7; /* not one-shot mode */ clr_mask |= 1 << 7; /* not one-shot mode */
break; break;
case tmp112: case tmp112:
set_mask |= 3 << 5; /* 12-bit mode */ set_mask |= 3 << 5; /* 12-bit mode */
clr_mask |= 1 << 7; /* not one-shot mode */ clr_mask |= 1 << 7; /* not one-shot mode */
data->resolution = 12; data->resolution = 12;
data->sample_time = HZ / 4; data->sample_time = MSEC_PER_SEC / 4;
break; break;
case tmp105: case tmp105:
case tmp175: case tmp175:
...@@ -297,12 +310,12 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id) ...@@ -297,12 +310,12 @@ lm75_probe(struct i2c_client *client, const struct i2c_device_id *id)
set_mask |= 3 << 5; /* 12-bit mode */ set_mask |= 3 << 5; /* 12-bit mode */
clr_mask |= 1 << 7; /* not one-shot mode */ clr_mask |= 1 << 7; /* not one-shot mode */
data->resolution = 12; data->resolution = 12;
data->sample_time = HZ / 2; data->sample_time = MSEC_PER_SEC / 2;
break; break;
case tmp75c: case tmp75c:
clr_mask |= 1 << 5; /* not one-shot mode */ clr_mask |= 1 << 5; /* not one-shot mode */
data->resolution = 12; data->resolution = 12;
data->sample_time = HZ / 4; data->sample_time = MSEC_PER_SEC / 4;
break; break;
} }
...@@ -506,45 +519,6 @@ static struct i2c_driver lm75_driver = { ...@@ -506,45 +519,6 @@ static struct i2c_driver lm75_driver = {
.address_list = normal_i2c, .address_list = normal_i2c,
}; };
/*-----------------------------------------------------------------------*/
static struct lm75_data *lm75_update_device(struct device *dev)
{
struct lm75_data *data = dev_get_drvdata(dev);
struct i2c_client *client = data->client;
struct lm75_data *ret = data;
mutex_lock(&data->update_lock);
if (time_after(jiffies, data->last_updated + data->sample_time)
|| !data->valid) {
int i;
dev_dbg(&client->dev, "Starting lm75 update\n");
for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
int status;
status = i2c_smbus_read_word_swapped(client,
LM75_REG_TEMP[i]);
if (unlikely(status < 0)) {
dev_dbg(dev,
"LM75: Failed to read value: reg %d, error %d\n",
LM75_REG_TEMP[i], status);
ret = ERR_PTR(status);
data->valid = 0;
goto abort;
}
data->temp[i] = status;
}
data->last_updated = jiffies;
data->valid = 1;
}
abort:
mutex_unlock(&data->update_lock);
return ret;
}
module_i2c_driver(lm75_driver); module_i2c_driver(lm75_driver);
MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>"); MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment