123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419 |
- // SPDX-License-Identifier: GPL-2.0-or-later
- /*
- * adt7x10.c - Part of lm_sensors, Linux kernel modules for hardware
- * monitoring
- * This driver handles the ADT7410 and compatible digital temperature sensors.
- * Hartmut Knaack <[email protected]> 2012-07-22
- * based on lm75.c by Frodo Looijaard <[email protected]>
- * and adt7410.c from iio-staging by Sonic Zhang <[email protected]>
- */
- #include <linux/device.h>
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/slab.h>
- #include <linux/jiffies.h>
- #include <linux/hwmon.h>
- #include <linux/err.h>
- #include <linux/mutex.h>
- #include <linux/delay.h>
- #include <linux/interrupt.h>
- #include <linux/regmap.h>
- #include "adt7x10.h"
- /*
- * ADT7X10 status
- */
- #define ADT7X10_STAT_T_LOW (1 << 4)
- #define ADT7X10_STAT_T_HIGH (1 << 5)
- #define ADT7X10_STAT_T_CRIT (1 << 6)
- #define ADT7X10_STAT_NOT_RDY (1 << 7)
- /*
- * ADT7X10 config
- */
- #define ADT7X10_FAULT_QUEUE_MASK (1 << 0 | 1 << 1)
- #define ADT7X10_CT_POLARITY (1 << 2)
- #define ADT7X10_INT_POLARITY (1 << 3)
- #define ADT7X10_EVENT_MODE (1 << 4)
- #define ADT7X10_MODE_MASK (1 << 5 | 1 << 6)
- #define ADT7X10_FULL (0 << 5 | 0 << 6)
- #define ADT7X10_PD (1 << 5 | 1 << 6)
- #define ADT7X10_RESOLUTION (1 << 7)
- /*
- * ADT7X10 masks
- */
- #define ADT7X10_T13_VALUE_MASK 0xFFF8
- #define ADT7X10_T_HYST_MASK 0xF
- /* straight from the datasheet */
- #define ADT7X10_TEMP_MIN (-55000)
- #define ADT7X10_TEMP_MAX 150000
- /* Each client has this additional data */
- struct adt7x10_data {
- struct regmap *regmap;
- struct mutex update_lock;
- u8 config;
- u8 oldconfig;
- bool valid; /* true if temperature valid */
- };
- enum {
- adt7x10_temperature = 0,
- adt7x10_t_alarm_high,
- adt7x10_t_alarm_low,
- adt7x10_t_crit,
- };
- static const u8 ADT7X10_REG_TEMP[] = {
- [adt7x10_temperature] = ADT7X10_TEMPERATURE, /* input */
- [adt7x10_t_alarm_high] = ADT7X10_T_ALARM_HIGH, /* high */
- [adt7x10_t_alarm_low] = ADT7X10_T_ALARM_LOW, /* low */
- [adt7x10_t_crit] = ADT7X10_T_CRIT, /* critical */
- };
- static irqreturn_t adt7x10_irq_handler(int irq, void *private)
- {
- struct device *dev = private;
- struct adt7x10_data *d = dev_get_drvdata(dev);
- unsigned int status;
- int ret;
- ret = regmap_read(d->regmap, ADT7X10_STATUS, &status);
- if (ret < 0)
- return IRQ_HANDLED;
- if (status & ADT7X10_STAT_T_HIGH)
- hwmon_notify_event(dev, hwmon_temp, hwmon_temp_max_alarm, 0);
- if (status & ADT7X10_STAT_T_LOW)
- hwmon_notify_event(dev, hwmon_temp, hwmon_temp_min_alarm, 0);
- if (status & ADT7X10_STAT_T_CRIT)
- hwmon_notify_event(dev, hwmon_temp, hwmon_temp_crit_alarm, 0);
- return IRQ_HANDLED;
- }
- static int adt7x10_temp_ready(struct regmap *regmap)
- {
- unsigned int status;
- int i, ret;
- for (i = 0; i < 6; i++) {
- ret = regmap_read(regmap, ADT7X10_STATUS, &status);
- if (ret < 0)
- return ret;
- if (!(status & ADT7X10_STAT_NOT_RDY))
- return 0;
- msleep(60);
- }
- return -ETIMEDOUT;
- }
- static s16 ADT7X10_TEMP_TO_REG(long temp)
- {
- return DIV_ROUND_CLOSEST(clamp_val(temp, ADT7X10_TEMP_MIN,
- ADT7X10_TEMP_MAX) * 128, 1000);
- }
- static int ADT7X10_REG_TO_TEMP(struct adt7x10_data *data, s16 reg)
- {
- /* in 13 bit mode, bits 0-2 are status flags - mask them out */
- if (!(data->config & ADT7X10_RESOLUTION))
- reg &= ADT7X10_T13_VALUE_MASK;
- /*
- * temperature is stored in twos complement format, in steps of
- * 1/128°C
- */
- return DIV_ROUND_CLOSEST(reg * 1000, 128);
- }
- /*-----------------------------------------------------------------------*/
- static int adt7x10_temp_read(struct adt7x10_data *data, int index, long *val)
- {
- unsigned int regval;
- int ret;
- mutex_lock(&data->update_lock);
- if (index == adt7x10_temperature && !data->valid) {
- /* wait for valid temperature */
- ret = adt7x10_temp_ready(data->regmap);
- if (ret) {
- mutex_unlock(&data->update_lock);
- return ret;
- }
- data->valid = true;
- }
- mutex_unlock(&data->update_lock);
- ret = regmap_read(data->regmap, ADT7X10_REG_TEMP[index], ®val);
- if (ret)
- return ret;
- *val = ADT7X10_REG_TO_TEMP(data, regval);
- return 0;
- }
- static int adt7x10_temp_write(struct adt7x10_data *data, int index, long temp)
- {
- int ret;
- mutex_lock(&data->update_lock);
- ret = regmap_write(data->regmap, ADT7X10_REG_TEMP[index],
- ADT7X10_TEMP_TO_REG(temp));
- mutex_unlock(&data->update_lock);
- return ret;
- }
- static int adt7x10_hyst_read(struct adt7x10_data *data, int index, long *val)
- {
- int hyst, temp, ret;
- mutex_lock(&data->update_lock);
- ret = regmap_read(data->regmap, ADT7X10_T_HYST, &hyst);
- if (ret) {
- mutex_unlock(&data->update_lock);
- return ret;
- }
- ret = regmap_read(data->regmap, ADT7X10_REG_TEMP[index], &temp);
- mutex_unlock(&data->update_lock);
- if (ret)
- return ret;
- hyst = (hyst & ADT7X10_T_HYST_MASK) * 1000;
- /*
- * hysteresis is stored as a 4 bit offset in the device, convert it
- * to an absolute value
- */
- /* min has positive offset, others have negative */
- if (index == adt7x10_t_alarm_low)
- hyst = -hyst;
- *val = ADT7X10_REG_TO_TEMP(data, temp) - hyst;
- return 0;
- }
- static int adt7x10_hyst_write(struct adt7x10_data *data, long hyst)
- {
- unsigned int regval;
- int limit, ret;
- mutex_lock(&data->update_lock);
- /* convert absolute hysteresis value to a 4 bit delta value */
- ret = regmap_read(data->regmap, ADT7X10_T_ALARM_HIGH, ®val);
- if (ret < 0)
- goto abort;
- limit = ADT7X10_REG_TO_TEMP(data, regval);
- hyst = clamp_val(hyst, ADT7X10_TEMP_MIN, ADT7X10_TEMP_MAX);
- regval = clamp_val(DIV_ROUND_CLOSEST(limit - hyst, 1000), 0,
- ADT7X10_T_HYST_MASK);
- ret = regmap_write(data->regmap, ADT7X10_T_HYST, regval);
- abort:
- mutex_unlock(&data->update_lock);
- return ret;
- }
- static int adt7x10_alarm_read(struct adt7x10_data *data, int index, long *val)
- {
- unsigned int status;
- int ret;
- ret = regmap_read(data->regmap, ADT7X10_STATUS, &status);
- if (ret < 0)
- return ret;
- *val = !!(status & index);
- return 0;
- }
- static umode_t adt7x10_is_visible(const void *data,
- enum hwmon_sensor_types type,
- u32 attr, int channel)
- {
- switch (attr) {
- case hwmon_temp_max:
- case hwmon_temp_min:
- case hwmon_temp_crit:
- case hwmon_temp_max_hyst:
- return 0644;
- case hwmon_temp_input:
- case hwmon_temp_min_alarm:
- case hwmon_temp_max_alarm:
- case hwmon_temp_crit_alarm:
- case hwmon_temp_min_hyst:
- case hwmon_temp_crit_hyst:
- return 0444;
- default:
- break;
- }
- return 0;
- }
- static int adt7x10_read(struct device *dev, enum hwmon_sensor_types type,
- u32 attr, int channel, long *val)
- {
- struct adt7x10_data *data = dev_get_drvdata(dev);
- switch (attr) {
- case hwmon_temp_input:
- return adt7x10_temp_read(data, adt7x10_temperature, val);
- case hwmon_temp_max:
- return adt7x10_temp_read(data, adt7x10_t_alarm_high, val);
- case hwmon_temp_min:
- return adt7x10_temp_read(data, adt7x10_t_alarm_low, val);
- case hwmon_temp_crit:
- return adt7x10_temp_read(data, adt7x10_t_crit, val);
- case hwmon_temp_max_hyst:
- return adt7x10_hyst_read(data, adt7x10_t_alarm_high, val);
- case hwmon_temp_min_hyst:
- return adt7x10_hyst_read(data, adt7x10_t_alarm_low, val);
- case hwmon_temp_crit_hyst:
- return adt7x10_hyst_read(data, adt7x10_t_crit, val);
- case hwmon_temp_min_alarm:
- return adt7x10_alarm_read(data, ADT7X10_STAT_T_LOW, val);
- case hwmon_temp_max_alarm:
- return adt7x10_alarm_read(data, ADT7X10_STAT_T_HIGH, val);
- case hwmon_temp_crit_alarm:
- return adt7x10_alarm_read(data, ADT7X10_STAT_T_CRIT, val);
- default:
- return -EOPNOTSUPP;
- }
- }
- static int adt7x10_write(struct device *dev, enum hwmon_sensor_types type,
- u32 attr, int channel, long val)
- {
- struct adt7x10_data *data = dev_get_drvdata(dev);
- switch (attr) {
- case hwmon_temp_max:
- return adt7x10_temp_write(data, adt7x10_t_alarm_high, val);
- case hwmon_temp_min:
- return adt7x10_temp_write(data, adt7x10_t_alarm_low, val);
- case hwmon_temp_crit:
- return adt7x10_temp_write(data, adt7x10_t_crit, val);
- case hwmon_temp_max_hyst:
- return adt7x10_hyst_write(data, val);
- default:
- return -EOPNOTSUPP;
- }
- }
- static const struct hwmon_channel_info *adt7x10_info[] = {
- HWMON_CHANNEL_INFO(temp, HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_MIN |
- HWMON_T_CRIT | HWMON_T_MAX_HYST | HWMON_T_MIN_HYST |
- HWMON_T_CRIT_HYST | HWMON_T_MIN_ALARM |
- HWMON_T_MAX_ALARM | HWMON_T_CRIT_ALARM),
- NULL,
- };
- static const struct hwmon_ops adt7x10_hwmon_ops = {
- .is_visible = adt7x10_is_visible,
- .read = adt7x10_read,
- .write = adt7x10_write,
- };
- static const struct hwmon_chip_info adt7x10_chip_info = {
- .ops = &adt7x10_hwmon_ops,
- .info = adt7x10_info,
- };
- static void adt7x10_restore_config(void *private)
- {
- struct adt7x10_data *data = private;
- regmap_write(data->regmap, ADT7X10_CONFIG, data->oldconfig);
- }
- int adt7x10_probe(struct device *dev, const char *name, int irq,
- struct regmap *regmap)
- {
- struct adt7x10_data *data;
- unsigned int config;
- struct device *hdev;
- int ret;
- data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
- if (!data)
- return -ENOMEM;
- data->regmap = regmap;
- dev_set_drvdata(dev, data);
- mutex_init(&data->update_lock);
- /* configure as specified */
- ret = regmap_read(regmap, ADT7X10_CONFIG, &config);
- if (ret < 0) {
- dev_dbg(dev, "Can't read config? %d\n", ret);
- return ret;
- }
- data->oldconfig = config;
- /*
- * Set to 16 bit resolution, continous conversion and comparator mode.
- */
- data->config = data->oldconfig;
- data->config &= ~(ADT7X10_MODE_MASK | ADT7X10_CT_POLARITY |
- ADT7X10_INT_POLARITY);
- data->config |= ADT7X10_FULL | ADT7X10_RESOLUTION | ADT7X10_EVENT_MODE;
- if (data->config != data->oldconfig) {
- ret = regmap_write(regmap, ADT7X10_CONFIG, data->config);
- if (ret)
- return ret;
- ret = devm_add_action_or_reset(dev, adt7x10_restore_config, data);
- if (ret)
- return ret;
- }
- dev_dbg(dev, "Config %02x\n", data->config);
- hdev = devm_hwmon_device_register_with_info(dev, name, data,
- &adt7x10_chip_info, NULL);
- if (IS_ERR(hdev))
- return PTR_ERR(hdev);
- if (irq > 0) {
- ret = devm_request_threaded_irq(dev, irq, NULL,
- adt7x10_irq_handler,
- IRQF_TRIGGER_FALLING |
- IRQF_ONESHOT,
- dev_name(dev), hdev);
- if (ret)
- return ret;
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(adt7x10_probe);
- static int adt7x10_suspend(struct device *dev)
- {
- struct adt7x10_data *data = dev_get_drvdata(dev);
- return regmap_write(data->regmap, ADT7X10_CONFIG,
- data->config | ADT7X10_PD);
- }
- static int adt7x10_resume(struct device *dev)
- {
- struct adt7x10_data *data = dev_get_drvdata(dev);
- return regmap_write(data->regmap, ADT7X10_CONFIG, data->config);
- }
- EXPORT_SIMPLE_DEV_PM_OPS(adt7x10_dev_pm_ops, adt7x10_suspend, adt7x10_resume);
- MODULE_AUTHOR("Hartmut Knaack");
- MODULE_DESCRIPTION("ADT7410/ADT7420, ADT7310/ADT7320 common code");
- MODULE_LICENSE("GPL");
|