[deliverable/linux.git] / drivers / hwmon / max31790.c

/*
 * max31790.c - Part of lm_sensors, Linux kernel modules for hardware
 *             monitoring.
 *
 * (C) 2015 by Il Han <corone.il.han@gmail.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#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_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 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_PWMOUT(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]);
		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:
		*val = !!(data->fault_status & (1 << channel));
		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 S_IRUGO;
		return 0;
	case hwmon_fan_target:
		if (channel < NR_CHANNEL &&
		    !(fan_config & MAX31790_FAN_CFG_TACH_INPUT))
			return S_IRUGO | S_IWUSR;
		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 = data->fan_config[channel];

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

	switch (attr) {
	case hwmon_pwm_input:
		*val = data->pwm[channel] >> 8;
		return 0;
	case hwmon_pwm_enable:
		if (fan_config & MAX31790_FAN_CFG_RPM_MODE)
			*val = 2;
		else if (fan_config & MAX31790_FAN_CFG_TACH_INPUT_EN)
			*val = 1;
		else
			*val = 0;
		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->pwm[channel] = val << 8;
		err = i2c_smbus_write_word_swapped(client,
						   MAX31790_REG_PWMOUT(channel),
						   val);
		break;
	case hwmon_pwm_enable:
		fan_config = data->fan_config[channel];
		if (val == 0) {
			fan_config &= ~(MAX31790_FAN_CFG_TACH_INPUT_EN |
					MAX31790_FAN_CFG_RPM_MODE);
		} else if (val == 1) {
			fan_config = (fan_config |
				      MAX31790_FAN_CFG_TACH_INPUT_EN) &
				     ~MAX31790_FAN_CFG_RPM_MODE;
		} else if (val == 2) {
			fan_config |= MAX31790_FAN_CFG_TACH_INPUT_EN |
				      MAX31790_FAN_CFG_RPM_MODE;
		} else {
			err = -EINVAL;
			break;
		}
		data->fan_config[channel] = fan_config;
		err = i2c_smbus_write_byte_data(client,
					MAX31790_REG_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 S_IRUGO | S_IWUSR;
		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 u32 max31790_fan_config[] = {
	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,
	0
};

static const struct hwmon_channel_info max31790_fan = {
	.type = hwmon_fan,
	.config = max31790_fan_config,
};

static const u32 max31790_pwm_config[] = {
	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,
	0
};

static const struct hwmon_channel_info max31790_pwm = {
	.type = hwmon_pwm,
	.config = max31790_pwm_config,
};

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