[mirror_ubuntu-jammy-kernel.git] / drivers / hwmon / max31790.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * max31790.c - Part of lm_sensors, Linux kernel modules for hardware
 *             monitoring.
 *
 * (C) 2015 by Il Han <corone.il.han@gmail.com>
 */

#include <linux/err.h>
#include <linux/hwmon.h>
#include <linux/i2c.h>
#include <linux/init.h>
#include <linux/jiffies.h>
#include <linux/module.h>
#include <linux/slab.h>

/* MAX31790 registers */
#define MAX31790_REG_GLOBAL_CONFIG	0x00
#define MAX31790_REG_FAN_CONFIG(ch)	(0x02 + (ch))
#define MAX31790_REG_FAN_DYNAMICS(ch)	(0x08 + (ch))
#define MAX31790_REG_FAN_FAULT_STATUS2	0x10
#define MAX31790_REG_FAN_FAULT_STATUS1	0x11
#define MAX31790_REG_TACH_COUNT(ch)	(0x18 + (ch) * 2)
#define MAX31790_REG_PWM_DUTY_CYCLE(ch)	(0x30 + (ch) * 2)
#define MAX31790_REG_PWMOUT(ch)		(0x40 + (ch) * 2)
#define MAX31790_REG_TARGET_COUNT(ch)	(0x50 + (ch) * 2)

/* Fan Config register bits */
#define MAX31790_FAN_CFG_RPM_MODE	0x80
#define MAX31790_FAN_CFG_CTRL_MON	0x10
#define MAX31790_FAN_CFG_TACH_INPUT_EN	0x08
#define MAX31790_FAN_CFG_TACH_INPUT	0x01

/* Fan Dynamics register bits */
#define MAX31790_FAN_DYN_SR_SHIFT	5
#define MAX31790_FAN_DYN_SR_MASK	0xE0
#define SR_FROM_REG(reg)		(((reg) & MAX31790_FAN_DYN_SR_MASK) \
					 >> MAX31790_FAN_DYN_SR_SHIFT)

#define FAN_RPM_MIN			120
#define FAN_RPM_MAX			7864320

#define FAN_COUNT_REG_MAX		0xffe0

#define RPM_FROM_REG(reg, sr)		(((reg) >> 4) ? \
					 ((60 * (sr) * 8192) / ((reg) >> 4)) : \
					 FAN_RPM_MAX)
#define RPM_TO_REG(rpm, sr)		((60 * (sr) * 8192) / ((rpm) * 2))

#define NR_CHANNEL			6

/*
 * Client data (each client gets its own)
 */
struct max31790_data {
	struct i2c_client *client;
	struct mutex update_lock;
	bool valid; /* zero until following fields are valid */
	unsigned long last_updated; /* in jiffies */

	/* register values */
	u8 fan_config[NR_CHANNEL];
	u8 fan_dynamics[NR_CHANNEL];
	u16 fault_status;
	u16 tach[NR_CHANNEL * 2];
	u16 pwm[NR_CHANNEL];
	u16 target_count[NR_CHANNEL];
};

static struct max31790_data *max31790_update_device(struct device *dev)
{
	struct max31790_data *data = dev_get_drvdata(dev);
	struct i2c_client *client = data->client;
	struct max31790_data *ret = data;
	int i;
	int rv;

	mutex_lock(&data->update_lock);

	if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
		rv = i2c_smbus_read_byte_data(client,
				MAX31790_REG_FAN_FAULT_STATUS1);
		if (rv < 0)
			goto abort;
		data->fault_status |= rv & 0x3F;

		rv = i2c_smbus_read_byte_data(client,
				MAX31790_REG_FAN_FAULT_STATUS2);
		if (rv < 0)
			goto abort;
		data->fault_status |= (rv & 0x3F) << 6;

		for (i = 0; i < NR_CHANNEL; i++) {
			rv = i2c_smbus_read_word_swapped(client,
					MAX31790_REG_TACH_COUNT(i));
			if (rv < 0)
				goto abort;
			data->tach[i] = rv;

			if (data->fan_config[i]
			    & MAX31790_FAN_CFG_TACH_INPUT) {
				rv = i2c_smbus_read_word_swapped(client,
					MAX31790_REG_TACH_COUNT(NR_CHANNEL
								+ i));
				if (rv < 0)
					goto abort;
				data->tach[NR_CHANNEL + i] = rv;
			} else {
				rv = i2c_smbus_read_word_swapped(client,
						MAX31790_REG_PWM_DUTY_CYCLE(i));
				if (rv < 0)
					goto abort;
				data->pwm[i] = rv;

				rv = i2c_smbus_read_word_swapped(client,
						MAX31790_REG_TARGET_COUNT(i));
				if (rv < 0)
					goto abort;
				data->target_count[i] = rv;
			}
		}

		data->last_updated = jiffies;
		data->valid = true;
	}
	goto done;

abort:
	data->valid = false;
	ret = ERR_PTR(rv);

done:
	mutex_unlock(&data->update_lock);

	return ret;
}

static const u8 tach_period[8] = { 1, 2, 4, 8, 16, 32, 32, 32 };

static u8 get_tach_period(u8 fan_dynamics)
{
	return tach_period[SR_FROM_REG(fan_dynamics)];
}

static u8 bits_for_tach_period(int rpm)
{
	u8 bits;

	if (rpm < 500)
		bits = 0x0;
	else if (rpm < 1000)
		bits = 0x1;
	else if (rpm < 2000)
		bits = 0x2;
	else if (rpm < 4000)
		bits = 0x3;
	else if (rpm < 8000)
		bits = 0x4;
	else
		bits = 0x5;

	return bits;
}

static int max31790_read_fan(struct device *dev, u32 attr, int channel,
			     long *val)
{
	struct max31790_data *data = max31790_update_device(dev);
	int sr, rpm;

	if (IS_ERR(data))
		return PTR_ERR(data);

	switch (attr) {
	case hwmon_fan_input:
		sr = get_tach_period(data->fan_dynamics[channel % NR_CHANNEL]);
		if (data->tach[channel] == FAN_COUNT_REG_MAX)
			rpm = 0;
		else
			rpm = RPM_FROM_REG(data->tach[channel], sr);
		*val = rpm;
		return 0;
	case hwmon_fan_target:
		sr = get_tach_period(data->fan_dynamics[channel]);
		rpm = RPM_FROM_REG(data->target_count[channel], sr);
		*val = rpm;
		return 0;
	case hwmon_fan_fault:
		mutex_lock(&data->update_lock);
		*val = !!(data->fault_status & (1 << channel));
		data->fault_status &= ~(1 << channel);
		/*
		 * If a fault bit is set, we need to write into one of the fan
		 * configuration registers to clear it. Note that this also
		 * clears the fault for the companion channel if enabled.
		 */
		if (*val) {
			int reg = MAX31790_REG_TARGET_COUNT(channel % NR_CHANNEL);

			i2c_smbus_write_byte_data(data->client, reg,
						  data->target_count[channel % NR_CHANNEL] >> 8);
		}
		mutex_unlock(&data->update_lock);
		return 0;
	default:
		return -EOPNOTSUPP;
	}
}

static int max31790_write_fan(struct device *dev, u32 attr, int channel,
			      long val)
{
	struct max31790_data *data = dev_get_drvdata(dev);
	struct i2c_client *client = data->client;
	int target_count;
	int err = 0;
	u8 bits;
	int sr;

	mutex_lock(&data->update_lock);

	switch (attr) {
	case hwmon_fan_target:
		val = clamp_val(val, FAN_RPM_MIN, FAN_RPM_MAX);
		bits = bits_for_tach_period(val);
		data->fan_dynamics[channel] =
			((data->fan_dynamics[channel] &
			  ~MAX31790_FAN_DYN_SR_MASK) |
			 (bits << MAX31790_FAN_DYN_SR_SHIFT));
		err = i2c_smbus_write_byte_data(client,
					MAX31790_REG_FAN_DYNAMICS(channel),
					data->fan_dynamics[channel]);
		if (err < 0)
			break;

		sr = get_tach_period(data->fan_dynamics[channel]);
		target_count = RPM_TO_REG(val, sr);
		target_count = clamp_val(target_count, 0x1, 0x7FF);

		data->target_count[channel] = target_count << 5;

		err = i2c_smbus_write_word_swapped(client,
					MAX31790_REG_TARGET_COUNT(channel),
					data->target_count[channel]);
		break;
	default:
		err = -EOPNOTSUPP;
		break;
	}

	mutex_unlock(&data->update_lock);

	return err;
}

static umode_t max31790_fan_is_visible(const void *_data, u32 attr, int channel)
{
	const struct max31790_data *data = _data;
	u8 fan_config = data->fan_config[channel % NR_CHANNEL];

	switch (attr) {
	case hwmon_fan_input:
	case hwmon_fan_fault:
		if (channel < NR_CHANNEL ||
		    (fan_config & MAX31790_FAN_CFG_TACH_INPUT))
			return 0444;
		return 0;
	case hwmon_fan_target:
		if (channel < NR_CHANNEL &&
		    !(fan_config & MAX31790_FAN_CFG_TACH_INPUT))
			return 0644;
		return 0;
	default:
		return 0;
	}
}

static int max31790_read_pwm(struct device *dev, u32 attr, int channel,
			     long *val)
{
	struct max31790_data *data = max31790_update_device(dev);
	u8 fan_config;

	if (IS_ERR(data))
		return PTR_ERR(data);

	fan_config = data->fan_config[channel];

	switch (attr) {
	case hwmon_pwm_input:
		*val = data->pwm[channel] >> 8;
		return 0;
	case hwmon_pwm_enable:
		if (fan_config & MAX31790_FAN_CFG_CTRL_MON)
			*val = 0;
		else if (fan_config & MAX31790_FAN_CFG_RPM_MODE)
			*val = 2;
		else
			*val = 1;
		return 0;
	default:
		return -EOPNOTSUPP;
	}
}

static int max31790_write_pwm(struct device *dev, u32 attr, int channel,
			      long val)
{
	struct max31790_data *data = dev_get_drvdata(dev);
	struct i2c_client *client = data->client;
	u8 fan_config;
	int err = 0;

	mutex_lock(&data->update_lock);

	switch (attr) {
	case hwmon_pwm_input:
		if (val < 0 || val > 255) {
			err = -EINVAL;
			break;
		}
		data->valid = false;
		err = i2c_smbus_write_word_swapped(client,
						   MAX31790_REG_PWMOUT(channel),
						   val << 8);
		break;
	case hwmon_pwm_enable:
		fan_config = data->fan_config[channel];
		if (val == 0) {
			fan_config |= MAX31790_FAN_CFG_CTRL_MON;
			/*
			 * Disable RPM mode; otherwise disabling fan speed
			 * monitoring is not possible.
			 */
			fan_config &= ~MAX31790_FAN_CFG_RPM_MODE;
		} else if (val == 1) {
			fan_config &= ~(MAX31790_FAN_CFG_CTRL_MON | MAX31790_FAN_CFG_RPM_MODE);
		} else if (val == 2) {
			fan_config &= ~MAX31790_FAN_CFG_CTRL_MON;
			/*
			 * The chip sets MAX31790_FAN_CFG_TACH_INPUT_EN on its
			 * own if MAX31790_FAN_CFG_RPM_MODE is set.
			 * Do it here as well to reflect the actual register
			 * value in the cache.
			 */
			fan_config |= (MAX31790_FAN_CFG_RPM_MODE | MAX31790_FAN_CFG_TACH_INPUT_EN);
		} else {
			err = -EINVAL;
			break;
		}
		if (fan_config != data->fan_config[channel]) {
			err = i2c_smbus_write_byte_data(client, MAX31790_REG_FAN_CONFIG(channel),
							fan_config);
			if (!err)
				data->fan_config[channel] = fan_config;
		}
		break;
	default:
		err = -EOPNOTSUPP;
		break;
	}

	mutex_unlock(&data->update_lock);

	return err;
}

static umode_t max31790_pwm_is_visible(const void *_data, u32 attr, int channel)
{
	const struct max31790_data *data = _data;
	u8 fan_config = data->fan_config[channel];

	switch (attr) {
	case hwmon_pwm_input:
	case hwmon_pwm_enable:
		if (!(fan_config & MAX31790_FAN_CFG_TACH_INPUT))
			return 0644;
		return 0;
	default:
		return 0;
	}
}

static int max31790_read(struct device *dev, enum hwmon_sensor_types type,
			 u32 attr, int channel, long *val)
{
	switch (type) {
	case hwmon_fan:
		return max31790_read_fan(dev, attr, channel, val);
	case hwmon_pwm:
		return max31790_read_pwm(dev, attr, channel, val);
	default:
		return -EOPNOTSUPP;
	}
}

static int max31790_write(struct device *dev, enum hwmon_sensor_types type,
			  u32 attr, int channel, long val)
{
	switch (type) {
	case hwmon_fan:
		return max31790_write_fan(dev, attr, channel, val);
	case hwmon_pwm:
		return max31790_write_pwm(dev, attr, channel, val);
	default:
		return -EOPNOTSUPP;
	}
}

static umode_t max31790_is_visible(const void *data,
				   enum hwmon_sensor_types type,
				   u32 attr, int channel)
{
	switch (type) {
	case hwmon_fan:
		return max31790_fan_is_visible(data, attr, channel);
	case hwmon_pwm:
		return max31790_pwm_is_visible(data, attr, channel);
	default:
		return 0;
	}
}

static const struct hwmon_channel_info *max31790_info[] = {
	HWMON_CHANNEL_INFO(fan,
			   HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_TARGET | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_FAULT,
			   HWMON_F_INPUT | HWMON_F_FAULT),
	HWMON_CHANNEL_INFO(pwm,
			   HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
			   HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
			   HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
			   HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
			   HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
			   HWMON_PWM_INPUT | HWMON_PWM_ENABLE),
	NULL
};

static const struct hwmon_ops max31790_hwmon_ops = {
	.is_visible = max31790_is_visible,
	.read = max31790_read,
	.write = max31790_write,
};

static const struct hwmon_chip_info max31790_chip_info = {
	.ops = &max31790_hwmon_ops,
	.info = max31790_info,
};

static int max31790_init_client(struct i2c_client *client,
				struct max31790_data *data)
{
	int i, rv;

	for (i = 0; i < NR_CHANNEL; i++) {
		rv = i2c_smbus_read_byte_data(client,
				MAX31790_REG_FAN_CONFIG(i));
		if (rv < 0)
			return rv;
		data->fan_config[i] = rv;

		rv = i2c_smbus_read_byte_data(client,
				MAX31790_REG_FAN_DYNAMICS(i));
		if (rv < 0)
			return rv;
		data->fan_dynamics[i] = rv;
	}

	return 0;
}

static int max31790_probe(struct i2c_client *client)
{
	struct i2c_adapter *adapter = client->adapter;
	struct device *dev = &client->dev;
	struct max31790_data *data;
	struct device *hwmon_dev;
	int err;

	if (!i2c_check_functionality(adapter,
			I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA))
		return -ENODEV;

	data = devm_kzalloc(dev, sizeof(struct max31790_data), GFP_KERNEL);
	if (!data)
		return -ENOMEM;

	data->client = client;
	mutex_init(&data->update_lock);

	/*
	 * Initialize the max31790 chip
	 */
	err = max31790_init_client(client, data);
	if (err)
		return err;

	hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,
							 data,
							 &max31790_chip_info,
							 NULL);

	return PTR_ERR_OR_ZERO(hwmon_dev);
}

static const struct i2c_device_id max31790_id[] = {
	{ "max31790", 0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, max31790_id);

static struct i2c_driver max31790_driver = {
	.class		= I2C_CLASS_HWMON,
	.probe_new	= max31790_probe,
	.driver = {
		.name	= "max31790",
	},
	.id_table	= max31790_id,
};

module_i2c_driver(max31790_driver);

MODULE_AUTHOR("Il Han <corone.il.han@gmail.com>");
MODULE_DESCRIPTION("MAX31790 sensor driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
c942fddf	1	// SPDX-License-Identifier: GPL-2.0-or-later
195a4b42 IH	2	/*
	3	* max31790.c - Part of lm_sensors, Linux kernel modules for hardware
	4	* monitoring.
	5	*
	6	* (C) 2015 by Il Han <corone.il.han@gmail.com>
195a4b42 IH	7	*/
	8
	9	#include <linux/err.h>
	10	#include <linux/hwmon.h>
195a4b42 IH	11	#include <linux/i2c.h>
	12	#include <linux/init.h>
	13	#include <linux/jiffies.h>
	14	#include <linux/module.h>
	15	#include <linux/slab.h>
	16
	17	/* MAX31790 registers */
	18	#define MAX31790_REG_GLOBAL_CONFIG 0x00
	19	#define MAX31790_REG_FAN_CONFIG(ch) (0x02 + (ch))
	20	#define MAX31790_REG_FAN_DYNAMICS(ch) (0x08 + (ch))
	21	#define MAX31790_REG_FAN_FAULT_STATUS2 0x10
	22	#define MAX31790_REG_FAN_FAULT_STATUS1 0x11
	23	#define MAX31790_REG_TACH_COUNT(ch) (0x18 + (ch) * 2)
	24	#define MAX31790_REG_PWM_DUTY_CYCLE(ch) (0x30 + (ch) * 2)
	25	#define MAX31790_REG_PWMOUT(ch) (0x40 + (ch) * 2)
	26	#define MAX31790_REG_TARGET_COUNT(ch) (0x50 + (ch) * 2)
	27
	28	/* Fan Config register bits */
	29	#define MAX31790_FAN_CFG_RPM_MODE 0x80
148c847c	30	#define MAX31790_FAN_CFG_CTRL_MON 0x10
195a4b42 IH	31	#define MAX31790_FAN_CFG_TACH_INPUT_EN 0x08
	32	#define MAX31790_FAN_CFG_TACH_INPUT 0x01
	33
	34	/* Fan Dynamics register bits */
	35	#define MAX31790_FAN_DYN_SR_SHIFT 5
	36	#define MAX31790_FAN_DYN_SR_MASK 0xE0
	37	#define SR_FROM_REG(reg) (((reg) & MAX31790_FAN_DYN_SR_MASK) \
	38	>> MAX31790_FAN_DYN_SR_SHIFT)
	39
	40	#define FAN_RPM_MIN 120
	41	#define FAN_RPM_MAX 7864320
	42
1814c4e8 GR	43	#define FAN_COUNT_REG_MAX 0xffe0
1814c4e8 GR	44
195a4b42 IH	45	#define RPM_FROM_REG(reg, sr) (((reg) >> 4) ? \
	46	((60 * (sr) * 8192) / ((reg) >> 4)) : \
	47	FAN_RPM_MAX)
	48	#define RPM_TO_REG(rpm, sr) ((60 * (sr) * 8192) / ((rpm) * 2))
	49
	50	#define NR_CHANNEL 6
	51
	52	/*
	53	* Client data (each client gets its own)
	54	*/
	55	struct max31790_data {
	56	struct i2c_client *client;
	57	struct mutex update_lock;
	58	bool valid; /* zero until following fields are valid */
	59	unsigned long last_updated; /* in jiffies */
	60
	61	/* register values */
	62	u8 fan_config[NR_CHANNEL];
	63	u8 fan_dynamics[NR_CHANNEL];
	64	u16 fault_status;
	65	u16 tach[NR_CHANNEL * 2];
	66	u16 pwm[NR_CHANNEL];
	67	u16 target_count[NR_CHANNEL];
	68	};
	69
	70	static struct max31790_data max31790_update_device(struct device dev)
	71	{
	72	struct max31790_data *data = dev_get_drvdata(dev);
	73	struct i2c_client *client = data->client;
	74	struct max31790_data *ret = data;
	75	int i;
	76	int rv;
	77
	78	mutex_lock(&data->update_lock);
	79
	80	if (time_after(jiffies, data->last_updated + HZ) \|\| !data->valid) {
	81	rv = i2c_smbus_read_byte_data(client,
	82	MAX31790_REG_FAN_FAULT_STATUS1);
	83	if (rv < 0)
	84	goto abort;
2013607b	85	data->fault_status \|= rv & 0x3F;
195a4b42 IH	86
	87	rv = i2c_smbus_read_byte_data(client,
	88	MAX31790_REG_FAN_FAULT_STATUS2);
	89	if (rv < 0)
	90	goto abort;
	91	data->fault_status \|= (rv & 0x3F) << 6;
	92
	93	for (i = 0; i < NR_CHANNEL; i++) {
	94	rv = i2c_smbus_read_word_swapped(client,
	95	MAX31790_REG_TACH_COUNT(i));
	96	if (rv < 0)
	97	goto abort;
	98	data->tach[i] = rv;
	99
	100	if (data->fan_config[i]
	101	& MAX31790_FAN_CFG_TACH_INPUT) {
	102	rv = i2c_smbus_read_word_swapped(client,
	103	MAX31790_REG_TACH_COUNT(NR_CHANNEL
	104	+ i));
	105	if (rv < 0)
	106	goto abort;
	107	data->tach[NR_CHANNEL + i] = rv;
	108	} else {
	109	rv = i2c_smbus_read_word_swapped(client,
897f6339	110	MAX31790_REG_PWM_DUTY_CYCLE(i));
195a4b42 IH	111	if (rv < 0)
	112	goto abort;
	113	data->pwm[i] = rv;
	114
	115	rv = i2c_smbus_read_word_swapped(client,
	116	MAX31790_REG_TARGET_COUNT(i));
	117	if (rv < 0)
	118	goto abort;
	119	data->target_count[i] = rv;
	120	}
	121	}
	122
	123	data->last_updated = jiffies;
	124	data->valid = true;
	125	}
	126	goto done;
	127
	128	abort:
	129	data->valid = false;
	130	ret = ERR_PTR(rv);
	131
	132	done:
	133	mutex_unlock(&data->update_lock);
	134
	135	return ret;
	136	}
	137
	138	static const u8 tach_period[8] = { 1, 2, 4, 8, 16, 32, 32, 32 };
	139
	140	static u8 get_tach_period(u8 fan_dynamics)
	141	{
	142	return tach_period[SR_FROM_REG(fan_dynamics)];
	143	}
	144
	145	static u8 bits_for_tach_period(int rpm)
	146	{
	147	u8 bits;
	148
	149	if (rpm < 500)
	150	bits = 0x0;
	151	else if (rpm < 1000)
	152	bits = 0x1;
	153	else if (rpm < 2000)
	154	bits = 0x2;
	155	else if (rpm < 4000)
	156	bits = 0x3;
	157	else if (rpm < 8000)
	158	bits = 0x4;
	159	else
	160	bits = 0x5;
	161
	162	return bits;
	163	}
	164
54187ff9 GR	165	static int max31790_read_fan(struct device *dev, u32 attr, int channel,
54187ff9 GR	166	long *val)
195a4b42	167	{
195a4b42	168	struct max31790_data *data = max31790_update_device(dev);
791432cf	169	int sr, rpm;
195a4b42 IH	170
	171	if (IS_ERR(data))
	172	return PTR_ERR(data);
	173
54187ff9 GR	174	switch (attr) {
54187ff9 GR	175	case hwmon_fan_input:
cbbf244f	176	sr = get_tach_period(data->fan_dynamics[channel % NR_CHANNEL]);
1814c4e8 GR	177	if (data->tach[channel] == FAN_COUNT_REG_MAX)
	178	rpm = 0;
	179	else
	180	rpm = RPM_FROM_REG(data->tach[channel], sr);
54187ff9 GR	181	*val = rpm;
	182	return 0;
	183	case hwmon_fan_target:
	184	sr = get_tach_period(data->fan_dynamics[channel]);
	185	rpm = RPM_FROM_REG(data->target_count[channel], sr);
	186	*val = rpm;
	187	return 0;
	188	case hwmon_fan_fault:
2013607b	189	mutex_lock(&data->update_lock);
54187ff9	190	*val = !!(data->fault_status & (1 << channel));
2013607b GR	191	data->fault_status &= ~(1 << channel);
	192	/*
	193	* If a fault bit is set, we need to write into one of the fan
	194	* configuration registers to clear it. Note that this also
	195	* clears the fault for the companion channel if enabled.
	196	*/
	197	if (*val) {
	198	int reg = MAX31790_REG_TARGET_COUNT(channel % NR_CHANNEL);
	199
	200	i2c_smbus_write_byte_data(data->client, reg,
	201	data->target_count[channel % NR_CHANNEL] >> 8);
	202	}
	203	mutex_unlock(&data->update_lock);
54187ff9 GR	204	return 0;
	205	default:
	206	return -EOPNOTSUPP;
	207	}
195a4b42 IH	208	}
195a4b42 IH	209
54187ff9 GR	210	static int max31790_write_fan(struct device *dev, u32 attr, int channel,
54187ff9 GR	211	long val)
195a4b42	212	{
195a4b42 IH	213	struct max31790_data *data = dev_get_drvdata(dev);
195a4b42 IH	214	struct i2c_client *client = data->client;
54187ff9 GR	215	int target_count;
54187ff9 GR	216	int err = 0;
195a4b42 IH	217	u8 bits;
195a4b42 IH	218	int sr;
195a4b42 IH	219
	220	mutex_lock(&data->update_lock);
	221
54187ff9 GR	222	switch (attr) {
	223	case hwmon_fan_target:
	224	val = clamp_val(val, FAN_RPM_MIN, FAN_RPM_MAX);
	225	bits = bits_for_tach_period(val);
	226	data->fan_dynamics[channel] =
	227	((data->fan_dynamics[channel] &
	228	~MAX31790_FAN_DYN_SR_MASK) \|
	229	(bits << MAX31790_FAN_DYN_SR_SHIFT));
	230	err = i2c_smbus_write_byte_data(client,
	231	MAX31790_REG_FAN_DYNAMICS(channel),
	232	data->fan_dynamics[channel]);
	233	if (err < 0)
	234	break;
	235
	236	sr = get_tach_period(data->fan_dynamics[channel]);
	237	target_count = RPM_TO_REG(val, sr);
	238	target_count = clamp_val(target_count, 0x1, 0x7FF);
	239
	240	data->target_count[channel] = target_count << 5;
	241
	242	err = i2c_smbus_write_word_swapped(client,
	243	MAX31790_REG_TARGET_COUNT(channel),
	244	data->target_count[channel]);
	245	break;
	246	default:
	247	err = -EOPNOTSUPP;
	248	break;
195a4b42 IH	249	}
195a4b42 IH	250
195a4b42 IH	251	mutex_unlock(&data->update_lock);
195a4b42 IH	252
54187ff9 GR	253	return err;
54187ff9 GR	254	}
195a4b42	255
54187ff9 GR	256	static umode_t max31790_fan_is_visible(const void *_data, u32 attr, int channel)
	257	{
	258	const struct max31790_data *data = _data;
	259	u8 fan_config = data->fan_config[channel % NR_CHANNEL];
	260
	261	switch (attr) {
	262	case hwmon_fan_input:
	263	case hwmon_fan_fault:
	264	if (channel < NR_CHANNEL \|\|
	265	(fan_config & MAX31790_FAN_CFG_TACH_INPUT))
dc8dbb4d	266	return 0444;
54187ff9 GR	267	return 0;
	268	case hwmon_fan_target:
	269	if (channel < NR_CHANNEL &&
	270	!(fan_config & MAX31790_FAN_CFG_TACH_INPUT))
dc8dbb4d	271	return 0644;
54187ff9 GR	272	return 0;
	273	default:
	274	return 0;
	275	}
195a4b42 IH	276	}
195a4b42 IH	277
54187ff9 GR	278	static int max31790_read_pwm(struct device *dev, u32 attr, int channel,
54187ff9 GR	279	long *val)
195a4b42	280	{
195a4b42	281	struct max31790_data *data = max31790_update_device(dev);
94cdc560	282	u8 fan_config;
195a4b42 IH	283
	284	if (IS_ERR(data))
	285	return PTR_ERR(data);
	286
94cdc560 DC	287	fan_config = data->fan_config[channel];
94cdc560 DC	288
54187ff9 GR	289	switch (attr) {
	290	case hwmon_pwm_input:
	291	*val = data->pwm[channel] >> 8;
	292	return 0;
	293	case hwmon_pwm_enable:
148c847c GR	294	if (fan_config & MAX31790_FAN_CFG_CTRL_MON)
	295	*val = 0;
	296	else if (fan_config & MAX31790_FAN_CFG_RPM_MODE)
54187ff9	297	*val = 2;
54187ff9	298	else
148c847c	299	*val = 1;
54187ff9 GR	300	return 0;
	301	default:
	302	return -EOPNOTSUPP;
	303	}
195a4b42 IH	304	}
195a4b42 IH	305
54187ff9 GR	306	static int max31790_write_pwm(struct device *dev, u32 attr, int channel,
54187ff9 GR	307	long val)
195a4b42	308	{
195a4b42 IH	309	struct max31790_data *data = dev_get_drvdata(dev);
195a4b42 IH	310	struct i2c_client *client = data->client;
54187ff9 GR	311	u8 fan_config;
54187ff9 GR	312	int err = 0;
195a4b42 IH	313
	314	mutex_lock(&data->update_lock);
	315
54187ff9 GR	316	switch (attr) {
	317	case hwmon_pwm_input:
	318	if (val < 0 \|\| val > 255) {
	319	err = -EINVAL;
	320	break;
	321	}
897f6339	322	data->valid = false;
54187ff9 GR	323	err = i2c_smbus_write_word_swapped(client,
54187ff9 GR	324	MAX31790_REG_PWMOUT(channel),
897f6339	325	val << 8);
54187ff9 GR	326	break;
	327	case hwmon_pwm_enable:
	328	fan_config = data->fan_config[channel];
	329	if (val == 0) {
148c847c GR	330	fan_config \|= MAX31790_FAN_CFG_CTRL_MON;
	331	/*
	332	* Disable RPM mode; otherwise disabling fan speed
	333	* monitoring is not possible.
	334	*/
	335	fan_config &= ~MAX31790_FAN_CFG_RPM_MODE;
54187ff9	336	} else if (val == 1) {
148c847c	337	fan_config &= ~(MAX31790_FAN_CFG_CTRL_MON \| MAX31790_FAN_CFG_RPM_MODE);
54187ff9	338	} else if (val == 2) {
148c847c GR	339	fan_config &= ~MAX31790_FAN_CFG_CTRL_MON;
	340	/*
	341	* The chip sets MAX31790_FAN_CFG_TACH_INPUT_EN on its
	342	* own if MAX31790_FAN_CFG_RPM_MODE is set.
	343	* Do it here as well to reflect the actual register
	344	* value in the cache.
	345	*/
	346	fan_config \|= (MAX31790_FAN_CFG_RPM_MODE \| MAX31790_FAN_CFG_TACH_INPUT_EN);
54187ff9 GR	347	} else {
	348	err = -EINVAL;
	349	break;
	350	}
148c847c GR	351	if (fan_config != data->fan_config[channel]) {
	352	err = i2c_smbus_write_byte_data(client, MAX31790_REG_FAN_CONFIG(channel),
	353	fan_config);
	354	if (!err)
	355	data->fan_config[channel] = fan_config;
	356	}
54187ff9 GR	357	break;
	358	default:
	359	err = -EOPNOTSUPP;
	360	break;
	361	}
195a4b42 IH	362
	363	mutex_unlock(&data->update_lock);
	364
54187ff9	365	return err;
195a4b42 IH	366	}
195a4b42 IH	367
54187ff9	368	static umode_t max31790_pwm_is_visible(const void *_data, u32 attr, int channel)
195a4b42	369	{
54187ff9 GR	370	const struct max31790_data *data = _data;
	371	u8 fan_config = data->fan_config[channel];
	372
	373	switch (attr) {
	374	case hwmon_pwm_input:
	375	case hwmon_pwm_enable:
	376	if (!(fan_config & MAX31790_FAN_CFG_TACH_INPUT))
dc8dbb4d	377	return 0644;
54187ff9 GR	378	return 0;
	379	default:
	380	return 0;
	381	}
195a4b42 IH	382	}
195a4b42 IH	383
54187ff9 GR	384	static int max31790_read(struct device *dev, enum hwmon_sensor_types type,
54187ff9 GR	385	u32 attr, int channel, long *val)
195a4b42	386	{
54187ff9 GR	387	switch (type) {
	388	case hwmon_fan:
	389	return max31790_read_fan(dev, attr, channel, val);
	390	case hwmon_pwm:
	391	return max31790_read_pwm(dev, attr, channel, val);
195a4b42	392	default:
54187ff9	393	return -EOPNOTSUPP;
195a4b42	394	}
195a4b42 IH	395	}
195a4b42 IH	396
54187ff9 GR	397	static int max31790_write(struct device *dev, enum hwmon_sensor_types type,
54187ff9 GR	398	u32 attr, int channel, long val)
195a4b42	399	{
54187ff9 GR	400	switch (type) {
	401	case hwmon_fan:
	402	return max31790_write_fan(dev, attr, channel, val);
	403	case hwmon_pwm:
	404	return max31790_write_pwm(dev, attr, channel, val);
	405	default:
	406	return -EOPNOTSUPP;
	407	}
	408	}
195a4b42	409
54187ff9 GR	410	static umode_t max31790_is_visible(const void *data,
	411	enum hwmon_sensor_types type,
	412	u32 attr, int channel)
	413	{
	414	switch (type) {
	415	case hwmon_fan:
	416	return max31790_fan_is_visible(data, attr, channel);
	417	case hwmon_pwm:
	418	return max31790_pwm_is_visible(data, attr, channel);
	419	default:
	420	return 0;
	421	}
195a4b42 IH	422	}
195a4b42 IH	423
54187ff9	424	static const struct hwmon_channel_info *max31790_info[] = {
b605e671 GR	425	HWMON_CHANNEL_INFO(fan,
	426	HWMON_F_INPUT \| HWMON_F_TARGET \| HWMON_F_FAULT,
	427	HWMON_F_INPUT \| HWMON_F_TARGET \| HWMON_F_FAULT,
	428	HWMON_F_INPUT \| HWMON_F_TARGET \| HWMON_F_FAULT,
	429	HWMON_F_INPUT \| HWMON_F_TARGET \| HWMON_F_FAULT,
	430	HWMON_F_INPUT \| HWMON_F_TARGET \| HWMON_F_FAULT,
	431	HWMON_F_INPUT \| HWMON_F_TARGET \| HWMON_F_FAULT,
	432	HWMON_F_INPUT \| HWMON_F_FAULT,
	433	HWMON_F_INPUT \| HWMON_F_FAULT,
	434	HWMON_F_INPUT \| HWMON_F_FAULT,
	435	HWMON_F_INPUT \| HWMON_F_FAULT,
	436	HWMON_F_INPUT \| HWMON_F_FAULT,
	437	HWMON_F_INPUT \| HWMON_F_FAULT),
	438	HWMON_CHANNEL_INFO(pwm,
	439	HWMON_PWM_INPUT \| HWMON_PWM_ENABLE,
	440	HWMON_PWM_INPUT \| HWMON_PWM_ENABLE,
	441	HWMON_PWM_INPUT \| HWMON_PWM_ENABLE,
	442	HWMON_PWM_INPUT \| HWMON_PWM_ENABLE,
	443	HWMON_PWM_INPUT \| HWMON_PWM_ENABLE,
	444	HWMON_PWM_INPUT \| HWMON_PWM_ENABLE),
54187ff9 GR	445	NULL
	446	};
	447
	448	static const struct hwmon_ops max31790_hwmon_ops = {
	449	.is_visible = max31790_is_visible,
	450	.read = max31790_read,
	451	.write = max31790_write,
	452	};
195a4b42	453
54187ff9 GR	454	static const struct hwmon_chip_info max31790_chip_info = {
	455	.ops = &max31790_hwmon_ops,
	456	.info = max31790_info,
195a4b42	457	};
195a4b42 IH	458
	459	static int max31790_init_client(struct i2c_client *client,
	460	struct max31790_data *data)
	461	{
	462	int i, rv;
	463
	464	for (i = 0; i < NR_CHANNEL; i++) {
	465	rv = i2c_smbus_read_byte_data(client,
	466	MAX31790_REG_FAN_CONFIG(i));
	467	if (rv < 0)
	468	return rv;
	469	data->fan_config[i] = rv;
	470
	471	rv = i2c_smbus_read_byte_data(client,
	472	MAX31790_REG_FAN_DYNAMICS(i));
	473	if (rv < 0)
	474	return rv;
	475	data->fan_dynamics[i] = rv;
	476	}
	477
	478	return 0;
	479	}
	480
67487038	481	static int max31790_probe(struct i2c_client *client)
195a4b42 IH	482	{
	483	struct i2c_adapter *adapter = client->adapter;
	484	struct device *dev = &client->dev;
	485	struct max31790_data *data;
	486	struct device *hwmon_dev;
	487	int err;
	488
	489	if (!i2c_check_functionality(adapter,
	490	I2C_FUNC_SMBUS_BYTE_DATA \| I2C_FUNC_SMBUS_WORD_DATA))
	491	return -ENODEV;
	492
	493	data = devm_kzalloc(dev, sizeof(struct max31790_data), GFP_KERNEL);
	494	if (!data)
	495	return -ENOMEM;
	496
	497	data->client = client;
	498	mutex_init(&data->update_lock);
	499
	500	/*
	501	* Initialize the max31790 chip
	502	*/
	503	err = max31790_init_client(client, data);
	504	if (err)
	505	return err;
	506
54187ff9 GR	507	hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,
	508	data,
	509	&max31790_chip_info,
	510	NULL);
195a4b42 IH	511
	512	return PTR_ERR_OR_ZERO(hwmon_dev);
	513	}
	514
	515	static const struct i2c_device_id max31790_id[] = {
	516	{ "max31790", 0 },
	517	{ }
	518	};
	519	MODULE_DEVICE_TABLE(i2c, max31790_id);
	520
	521	static struct i2c_driver max31790_driver = {
	522	.class = I2C_CLASS_HWMON,
67487038	523	.probe_new = max31790_probe,
195a4b42 IH	524	.driver = {
	525	.name = "max31790",
	526	},
	527	.id_table = max31790_id,
	528	};
	529
	530	module_i2c_driver(max31790_driver);
	531
	532	MODULE_AUTHOR("Il Han <corone.il.han@gmail.com>");
	533	MODULE_DESCRIPTION("MAX31790 sensor driver");
	534	MODULE_LICENSE("GPL");