|  | // 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 <knaack.h@gmx.de> 2012-07-22 | 
|  | * based on lm75.c by Frodo Looijaard <frodol@dds.nl> | 
|  | * and adt7410.c from iio-staging by Sonic Zhang <sonic.zhang@analog.com> | 
|  | */ | 
|  |  | 
|  | #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 * const 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"); |