[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / hwmon / thmc50.c

/*
 * thmc50.c - Part of lm_sensors, Linux kernel modules for hardware
 *	      monitoring
 * Copyright (C) 2007 Krzysztof Helt <krzysztof.h1@wp.pl>
 * Based on 2.4 driver by Frodo Looijaard <frodol@dds.nl> and
 * Philip Edelbrock <phil@netroedge.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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

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

MODULE_LICENSE("GPL");

/* Addresses to scan */
static const unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };

/* Insmod parameters */
enum chips { thmc50, adm1022 };

static unsigned short adm1022_temp3[16];
static unsigned int adm1022_temp3_num;
module_param_array(adm1022_temp3, ushort, &adm1022_temp3_num, 0);
MODULE_PARM_DESC(adm1022_temp3,
		 "List of adapter,address pairs to enable 3rd temperature (ADM1022 only)");

/* Many THMC50 constants specified below */

/* The THMC50 registers */
#define THMC50_REG_CONF				0x40
#define THMC50_REG_COMPANY_ID			0x3E
#define THMC50_REG_DIE_CODE			0x3F
#define THMC50_REG_ANALOG_OUT			0x19
/*
 * The mirror status register cannot be used as
 * reading it does not clear alarms.
 */
#define THMC50_REG_INTR				0x41

static const u8 THMC50_REG_TEMP[] = { 0x27, 0x26, 0x20 };
static const u8 THMC50_REG_TEMP_MIN[] = { 0x3A, 0x38, 0x2C };
static const u8 THMC50_REG_TEMP_MAX[] = { 0x39, 0x37, 0x2B };
static const u8 THMC50_REG_TEMP_CRITICAL[] = { 0x13, 0x14, 0x14 };
static const u8 THMC50_REG_TEMP_DEFAULT[] = { 0x17, 0x18, 0x18 };

#define THMC50_REG_CONF_nFANOFF			0x20
#define THMC50_REG_CONF_PROGRAMMED		0x08

/* Each client has this additional data */
struct thmc50_data {
	struct device *hwmon_dev;

	struct mutex update_lock;
	enum chips type;
	unsigned long last_updated;	/* In jiffies */
	char has_temp3;		/* !=0 if it is ADM1022 in temp3 mode */
	char valid;		/* !=0 if following fields are valid */

	/* Register values */
	s8 temp_input[3];
	s8 temp_max[3];
	s8 temp_min[3];
	s8 temp_critical[3];
	u8 analog_out;
	u8 alarms;
};

static int thmc50_detect(struct i2c_client *client,
			 struct i2c_board_info *info);
static int thmc50_probe(struct i2c_client *client,
			const struct i2c_device_id *id);
static int thmc50_remove(struct i2c_client *client);
static void thmc50_init_client(struct i2c_client *client);
static struct thmc50_data *thmc50_update_device(struct device *dev);

static const struct i2c_device_id thmc50_id[] = {
	{ "adm1022", adm1022 },
	{ "thmc50", thmc50 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, thmc50_id);

static struct i2c_driver thmc50_driver = {
	.class = I2C_CLASS_HWMON,
	.driver = {
		.name = "thmc50",
	},
	.probe = thmc50_probe,
	.remove = thmc50_remove,
	.id_table = thmc50_id,
	.detect = thmc50_detect,
	.address_list = normal_i2c,
};

static ssize_t show_analog_out(struct device *dev,
			       struct device_attribute *attr, char *buf)
{
	struct thmc50_data *data = thmc50_update_device(dev);
	return sprintf(buf, "%d\n", data->analog_out);
}

static ssize_t set_analog_out(struct device *dev,
			      struct device_attribute *attr,
			      const char *buf, size_t count)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct thmc50_data *data = i2c_get_clientdata(client);
	int config;
	unsigned long tmp;
	int err;

	err = kstrtoul(buf, 10, &tmp);
	if (err)
		return err;

	mutex_lock(&data->update_lock);
	data->analog_out = clamp_val(tmp, 0, 255);
	i2c_smbus_write_byte_data(client, THMC50_REG_ANALOG_OUT,
				  data->analog_out);

	config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
	if (data->analog_out == 0)
		config &= ~THMC50_REG_CONF_nFANOFF;
	else
		config |= THMC50_REG_CONF_nFANOFF;
	i2c_smbus_write_byte_data(client, THMC50_REG_CONF, config);

	mutex_unlock(&data->update_lock);
	return count;
}

/* There is only one PWM mode = DC */
static ssize_t show_pwm_mode(struct device *dev, struct device_attribute *attr,
			     char *buf)
{
	return sprintf(buf, "0\n");
}

/* Temperatures */
static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
			 char *buf)
{
	int nr = to_sensor_dev_attr(attr)->index;
	struct thmc50_data *data = thmc50_update_device(dev);
	return sprintf(buf, "%d\n", data->temp_input[nr] * 1000);
}

static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr,
			     char *buf)
{
	int nr = to_sensor_dev_attr(attr)->index;
	struct thmc50_data *data = thmc50_update_device(dev);
	return sprintf(buf, "%d\n", data->temp_min[nr] * 1000);
}

static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
			    const char *buf, size_t count)
{
	int nr = to_sensor_dev_attr(attr)->index;
	struct i2c_client *client = to_i2c_client(dev);
	struct thmc50_data *data = i2c_get_clientdata(client);
	long val;
	int err;

	err = kstrtol(buf, 10, &val);
	if (err)
		return err;

	mutex_lock(&data->update_lock);
	data->temp_min[nr] = clamp_val(val / 1000, -128, 127);
	i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MIN[nr],
				  data->temp_min[nr]);
	mutex_unlock(&data->update_lock);
	return count;
}

static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr,
			     char *buf)
{
	int nr = to_sensor_dev_attr(attr)->index;
	struct thmc50_data *data = thmc50_update_device(dev);
	return sprintf(buf, "%d\n", data->temp_max[nr] * 1000);
}

static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
			    const char *buf, size_t count)
{
	int nr = to_sensor_dev_attr(attr)->index;
	struct i2c_client *client = to_i2c_client(dev);
	struct thmc50_data *data = i2c_get_clientdata(client);
	long val;
	int err;

	err = kstrtol(buf, 10, &val);
	if (err)
		return err;

	mutex_lock(&data->update_lock);
	data->temp_max[nr] = clamp_val(val / 1000, -128, 127);
	i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MAX[nr],
				  data->temp_max[nr]);
	mutex_unlock(&data->update_lock);
	return count;
}

static ssize_t show_temp_critical(struct device *dev,
				  struct device_attribute *attr,
				  char *buf)
{
	int nr = to_sensor_dev_attr(attr)->index;
	struct thmc50_data *data = thmc50_update_device(dev);
	return sprintf(buf, "%d\n", data->temp_critical[nr] * 1000);
}

static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
			  char *buf)
{
	int index = to_sensor_dev_attr(attr)->index;
	struct thmc50_data *data = thmc50_update_device(dev);

	return sprintf(buf, "%u\n", (data->alarms >> index) & 1);
}

#define temp_reg(offset)						\
static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp,	\
			NULL, offset - 1);				\
static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR,	\
			show_temp_min, set_temp_min, offset - 1);	\
static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,	\
			show_temp_max, set_temp_max, offset - 1);	\
static SENSOR_DEVICE_ATTR(temp##offset##_crit, S_IRUGO,			\
			show_temp_critical, NULL, offset - 1);

temp_reg(1);
temp_reg(2);
temp_reg(3);

static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 0);
static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 1);
static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 7);
static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 2);

static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_analog_out,
			  set_analog_out, 0);
static SENSOR_DEVICE_ATTR(pwm1_mode, S_IRUGO, show_pwm_mode, NULL, 0);

static struct attribute *thmc50_attributes[] = {
	&sensor_dev_attr_temp1_max.dev_attr.attr,
	&sensor_dev_attr_temp1_min.dev_attr.attr,
	&sensor_dev_attr_temp1_input.dev_attr.attr,
	&sensor_dev_attr_temp1_crit.dev_attr.attr,
	&sensor_dev_attr_temp1_alarm.dev_attr.attr,
	&sensor_dev_attr_temp2_max.dev_attr.attr,
	&sensor_dev_attr_temp2_min.dev_attr.attr,
	&sensor_dev_attr_temp2_input.dev_attr.attr,
	&sensor_dev_attr_temp2_crit.dev_attr.attr,
	&sensor_dev_attr_temp2_alarm.dev_attr.attr,
	&sensor_dev_attr_temp2_fault.dev_attr.attr,
	&sensor_dev_attr_pwm1.dev_attr.attr,
	&sensor_dev_attr_pwm1_mode.dev_attr.attr,
	NULL
};

static const struct attribute_group thmc50_group = {
	.attrs = thmc50_attributes,
};

/* for ADM1022 3rd temperature mode */
static struct attribute *temp3_attributes[] = {
	&sensor_dev_attr_temp3_max.dev_attr.attr,
	&sensor_dev_attr_temp3_min.dev_attr.attr,
	&sensor_dev_attr_temp3_input.dev_attr.attr,
	&sensor_dev_attr_temp3_crit.dev_attr.attr,
	&sensor_dev_attr_temp3_alarm.dev_attr.attr,
	&sensor_dev_attr_temp3_fault.dev_attr.attr,
	NULL
};

static const struct attribute_group temp3_group = {
	.attrs = temp3_attributes,
};

/* Return 0 if detection is successful, -ENODEV otherwise */
static int thmc50_detect(struct i2c_client *client,
			 struct i2c_board_info *info)
{
	unsigned company;
	unsigned revision;
	unsigned config;
	struct i2c_adapter *adapter = client->adapter;
	const char *type_name;

	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
		pr_debug("thmc50: detect failed, smbus byte data not supported!\n");
		return -ENODEV;
	}

	pr_debug("thmc50: Probing for THMC50 at 0x%2X on bus %d\n",
		 client->addr, i2c_adapter_id(client->adapter));

	company = i2c_smbus_read_byte_data(client, THMC50_REG_COMPANY_ID);
	revision = i2c_smbus_read_byte_data(client, THMC50_REG_DIE_CODE);
	config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
	if (revision < 0xc0 || (config & 0x10))
		return -ENODEV;

	if (company == 0x41) {
		int id = i2c_adapter_id(client->adapter);
		int i;

		type_name = "adm1022";
		for (i = 0; i + 1 < adm1022_temp3_num; i += 2)
			if (adm1022_temp3[i] == id &&
			    adm1022_temp3[i + 1] == client->addr) {
				/* enable 2nd remote temp */
				config |= (1 << 7);
				i2c_smbus_write_byte_data(client,
							  THMC50_REG_CONF,
							  config);
				break;
			}
	} else if (company == 0x49) {
		type_name = "thmc50";
	} else {
		pr_debug("thmc50: Detection of THMC50/ADM1022 failed\n");
		return -ENODEV;
	}

	pr_debug("thmc50: Detected %s (version %x, revision %x)\n",
		 type_name, (revision >> 4) - 0xc, revision & 0xf);

	strlcpy(info->type, type_name, I2C_NAME_SIZE);

	return 0;
}

static int thmc50_probe(struct i2c_client *client,
			const struct i2c_device_id *id)
{
	struct thmc50_data *data;
	int err;

	data = devm_kzalloc(&client->dev, sizeof(struct thmc50_data),
			    GFP_KERNEL);
	if (!data)
		return -ENOMEM;

	i2c_set_clientdata(client, data);
	data->type = id->driver_data;
	mutex_init(&data->update_lock);

	thmc50_init_client(client);

	/* Register sysfs hooks */
	err = sysfs_create_group(&client->dev.kobj, &thmc50_group);
	if (err)
		return err;

	/* Register ADM1022 sysfs hooks */
	if (data->has_temp3) {
		err = sysfs_create_group(&client->dev.kobj, &temp3_group);
		if (err)
			goto exit_remove_sysfs_thmc50;
	}

	/* Register a new directory entry with module sensors */
	data->hwmon_dev = hwmon_device_register(&client->dev);
	if (IS_ERR(data->hwmon_dev)) {
		err = PTR_ERR(data->hwmon_dev);
		goto exit_remove_sysfs;
	}

	return 0;

exit_remove_sysfs:
	if (data->has_temp3)
		sysfs_remove_group(&client->dev.kobj, &temp3_group);
exit_remove_sysfs_thmc50:
	sysfs_remove_group(&client->dev.kobj, &thmc50_group);
	return err;
}

static int thmc50_remove(struct i2c_client *client)
{
	struct thmc50_data *data = i2c_get_clientdata(client);

	hwmon_device_unregister(data->hwmon_dev);
	sysfs_remove_group(&client->dev.kobj, &thmc50_group);
	if (data->has_temp3)
		sysfs_remove_group(&client->dev.kobj, &temp3_group);

	return 0;
}

static void thmc50_init_client(struct i2c_client *client)
{
	struct thmc50_data *data = i2c_get_clientdata(client);
	int config;

	data->analog_out = i2c_smbus_read_byte_data(client,
						    THMC50_REG_ANALOG_OUT);
	/* set up to at least 1 */
	if (data->analog_out == 0) {
		data->analog_out = 1;
		i2c_smbus_write_byte_data(client, THMC50_REG_ANALOG_OUT,
					  data->analog_out);
	}
	config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
	config |= 0x1;	/* start the chip if it is in standby mode */
	if (data->type == adm1022 && (config & (1 << 7)))
		data->has_temp3 = 1;
	i2c_smbus_write_byte_data(client, THMC50_REG_CONF, config);
}

static struct thmc50_data *thmc50_update_device(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct thmc50_data *data = i2c_get_clientdata(client);
	int timeout = HZ / 5 + (data->type == thmc50 ? HZ : 0);

	mutex_lock(&data->update_lock);

	if (time_after(jiffies, data->last_updated + timeout)
	    || !data->valid) {

		int temps = data->has_temp3 ? 3 : 2;
		int i;
		int prog = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);

		prog &= THMC50_REG_CONF_PROGRAMMED;

		for (i = 0; i < temps; i++) {
			data->temp_input[i] = i2c_smbus_read_byte_data(client,
						THMC50_REG_TEMP[i]);
			data->temp_max[i] = i2c_smbus_read_byte_data(client,
						THMC50_REG_TEMP_MAX[i]);
			data->temp_min[i] = i2c_smbus_read_byte_data(client,
						THMC50_REG_TEMP_MIN[i]);
			data->temp_critical[i] =
				i2c_smbus_read_byte_data(client,
					prog ? THMC50_REG_TEMP_CRITICAL[i]
					     : THMC50_REG_TEMP_DEFAULT[i]);
		}
		data->analog_out =
		    i2c_smbus_read_byte_data(client, THMC50_REG_ANALOG_OUT);
		data->alarms =
		    i2c_smbus_read_byte_data(client, THMC50_REG_INTR);
		data->last_updated = jiffies;
		data->valid = 1;
	}

	mutex_unlock(&data->update_lock);

	return data;
}

module_i2c_driver(thmc50_driver);

MODULE_AUTHOR("Krzysztof Helt <krzysztof.h1@wp.pl>");
MODULE_DESCRIPTION("THMC50 driver");
Commit	Line	Data
add77c64	1	/*
4d387df7 GR	2	* thmc50.c - Part of lm_sensors, Linux kernel modules for hardware
	3	* monitoring
	4	* Copyright (C) 2007 Krzysztof Helt <krzysztof.h1@wp.pl>
	5	* Based on 2.4 driver by Frodo Looijaard <frodol@dds.nl> and
	6	* Philip Edelbrock <phil@netroedge.com>
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License, or
	11	* (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	21	*/
add77c64 KH	22
	23	#include <linux/module.h>
	24	#include <linux/init.h>
	25	#include <linux/slab.h>
	26	#include <linux/i2c.h>
	27	#include <linux/hwmon.h>
	28	#include <linux/hwmon-sysfs.h>
	29	#include <linux/err.h>
	30	#include <linux/mutex.h>
dcd8f392	31	#include <linux/jiffies.h>
add77c64 KH	32
	33	MODULE_LICENSE("GPL");
	34
	35	/* Addresses to scan */
25e9c86d	36	static const unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
add77c64 KH	37
add77c64 KH	38	/* Insmod parameters */
e5e9f44c	39	enum chips { thmc50, adm1022 };
f95f0b4c JD	40
	41	static unsigned short adm1022_temp3[16];
	42	static unsigned int adm1022_temp3_num;
	43	module_param_array(adm1022_temp3, ushort, &adm1022_temp3_num, 0);
b55f3757 GR	44	MODULE_PARM_DESC(adm1022_temp3,
b55f3757 GR	45	"List of adapter,address pairs to enable 3rd temperature (ADM1022 only)");
add77c64 KH	46
	47	/* Many THMC50 constants specified below */
	48
	49	/* The THMC50 registers */
	50	#define THMC50_REG_CONF 0x40
	51	#define THMC50_REG_COMPANY_ID 0x3E
	52	#define THMC50_REG_DIE_CODE 0x3F
	53	#define THMC50_REG_ANALOG_OUT 0x19
dcf3b5fb	54	/*
bba891c2 KH	55	* The mirror status register cannot be used as
bba891c2 KH	56	* reading it does not clear alarms.
dcf3b5fb	57	*/
bba891c2	58	#define THMC50_REG_INTR 0x41
add77c64	59
5910a9b2 TK	60	static const u8 THMC50_REG_TEMP[] = { 0x27, 0x26, 0x20 };
	61	static const u8 THMC50_REG_TEMP_MIN[] = { 0x3A, 0x38, 0x2C };
	62	static const u8 THMC50_REG_TEMP_MAX[] = { 0x39, 0x37, 0x2B };
84f768c1 KH	63	static const u8 THMC50_REG_TEMP_CRITICAL[] = { 0x13, 0x14, 0x14 };
84f768c1 KH	64	static const u8 THMC50_REG_TEMP_DEFAULT[] = { 0x17, 0x18, 0x18 };
add77c64 KH	65
add77c64 KH	66	#define THMC50_REG_CONF_nFANOFF 0x20
84f768c1	67	#define THMC50_REG_CONF_PROGRAMMED 0x08
add77c64 KH	68
	69	/* Each client has this additional data */
	70	struct thmc50_data {
1beeffe4	71	struct device *hwmon_dev;
add77c64 KH	72
	73	struct mutex update_lock;
	74	enum chips type;
	75	unsigned long last_updated; /* In jiffies */
	76	char has_temp3; /* !=0 if it is ADM1022 in temp3 mode */
	77	char valid; /* !=0 if following fields are valid */
	78
	79	/* Register values */
	80	s8 temp_input[3];
	81	s8 temp_max[3];
	82	s8 temp_min[3];
84f768c1	83	s8 temp_critical[3];
add77c64	84	u8 analog_out;
dcf3b5fb	85	u8 alarms;
add77c64 KH	86	};
add77c64 KH	87
310ec792	88	static int thmc50_detect(struct i2c_client *client,
ccf37488 JD	89	struct i2c_board_info *info);
	90	static int thmc50_probe(struct i2c_client *client,
	91	const struct i2c_device_id *id);
	92	static int thmc50_remove(struct i2c_client *client);
add77c64 KH	93	static void thmc50_init_client(struct i2c_client *client);
	94	static struct thmc50_data thmc50_update_device(struct device dev);
	95
ccf37488 JD	96	static const struct i2c_device_id thmc50_id[] = {
	97	{ "adm1022", adm1022 },
	98	{ "thmc50", thmc50 },
	99	{ }
	100	};
	101	MODULE_DEVICE_TABLE(i2c, thmc50_id);
	102
add77c64	103	static struct i2c_driver thmc50_driver = {
ccf37488	104	.class = I2C_CLASS_HWMON,
add77c64 KH	105	.driver = {
	106	.name = "thmc50",
	107	},
ccf37488 JD	108	.probe = thmc50_probe,
	109	.remove = thmc50_remove,
	110	.id_table = thmc50_id,
	111	.detect = thmc50_detect,
c3813d6a	112	.address_list = normal_i2c,
add77c64 KH	113	};
	114
	115	static ssize_t show_analog_out(struct device *dev,
	116	struct device_attribute attr, char buf)
	117	{
	118	struct thmc50_data *data = thmc50_update_device(dev);
	119	return sprintf(buf, "%d\n", data->analog_out);
	120	}
	121
	122	static ssize_t set_analog_out(struct device *dev,
	123	struct device_attribute *attr,
	124	const char *buf, size_t count)
	125	{
	126	struct i2c_client *client = to_i2c_client(dev);
	127	struct thmc50_data *data = i2c_get_clientdata(client);
add77c64	128	int config;
4d387df7 GR	129	unsigned long tmp;
	130	int err;
	131
	132	err = kstrtoul(buf, 10, &tmp);
	133	if (err)
	134	return err;
add77c64 KH	135
add77c64 KH	136	mutex_lock(&data->update_lock);
2a844c14	137	data->analog_out = clamp_val(tmp, 0, 255);
add77c64 KH	138	i2c_smbus_write_byte_data(client, THMC50_REG_ANALOG_OUT,
	139	data->analog_out);
	140
	141	config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
	142	if (data->analog_out == 0)
	143	config &= ~THMC50_REG_CONF_nFANOFF;
	144	else
	145	config \|= THMC50_REG_CONF_nFANOFF;
	146	i2c_smbus_write_byte_data(client, THMC50_REG_CONF, config);
	147
	148	mutex_unlock(&data->update_lock);
	149	return count;
	150	}
	151
	152	/* There is only one PWM mode = DC */
	153	static ssize_t show_pwm_mode(struct device dev, struct device_attribute attr,
	154	char *buf)
	155	{
	156	return sprintf(buf, "0\n");
	157	}
	158
	159	/* Temperatures */
	160	static ssize_t show_temp(struct device dev, struct device_attribute attr,
	161	char *buf)
	162	{
	163	int nr = to_sensor_dev_attr(attr)->index;
	164	struct thmc50_data *data = thmc50_update_device(dev);
	165	return sprintf(buf, "%d\n", data->temp_input[nr] * 1000);
	166	}
	167
	168	static ssize_t show_temp_min(struct device dev, struct device_attribute attr,
	169	char *buf)
	170	{
	171	int nr = to_sensor_dev_attr(attr)->index;
	172	struct thmc50_data *data = thmc50_update_device(dev);
	173	return sprintf(buf, "%d\n", data->temp_min[nr] * 1000);
	174	}
	175
	176	static ssize_t set_temp_min(struct device dev, struct device_attribute attr,
	177	const char *buf, size_t count)
	178	{
	179	int nr = to_sensor_dev_attr(attr)->index;
	180	struct i2c_client *client = to_i2c_client(dev);
	181	struct thmc50_data *data = i2c_get_clientdata(client);
4d387df7 GR	182	long val;
	183	int err;
	184
	185	err = kstrtol(buf, 10, &val);
	186	if (err)
	187	return err;
add77c64 KH	188
add77c64 KH	189	mutex_lock(&data->update_lock);
2a844c14	190	data->temp_min[nr] = clamp_val(val / 1000, -128, 127);
add77c64 KH	191	i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MIN[nr],
	192	data->temp_min[nr]);
	193	mutex_unlock(&data->update_lock);
	194	return count;
	195	}
	196
	197	static ssize_t show_temp_max(struct device dev, struct device_attribute attr,
	198	char *buf)
	199	{
	200	int nr = to_sensor_dev_attr(attr)->index;
	201	struct thmc50_data *data = thmc50_update_device(dev);
	202	return sprintf(buf, "%d\n", data->temp_max[nr] * 1000);
	203	}
	204
	205	static ssize_t set_temp_max(struct device dev, struct device_attribute attr,
	206	const char *buf, size_t count)
	207	{
	208	int nr = to_sensor_dev_attr(attr)->index;
	209	struct i2c_client *client = to_i2c_client(dev);
	210	struct thmc50_data *data = i2c_get_clientdata(client);
4d387df7 GR	211	long val;
	212	int err;
	213
	214	err = kstrtol(buf, 10, &val);
	215	if (err)
	216	return err;
add77c64 KH	217
add77c64 KH	218	mutex_lock(&data->update_lock);
2a844c14	219	data->temp_max[nr] = clamp_val(val / 1000, -128, 127);
add77c64 KH	220	i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MAX[nr],
	221	data->temp_max[nr]);
	222	mutex_unlock(&data->update_lock);
	223	return count;
	224	}
	225
84f768c1 KH	226	static ssize_t show_temp_critical(struct device *dev,
	227	struct device_attribute *attr,
	228	char *buf)
	229	{
	230	int nr = to_sensor_dev_attr(attr)->index;
	231	struct thmc50_data *data = thmc50_update_device(dev);
	232	return sprintf(buf, "%d\n", data->temp_critical[nr] * 1000);
	233	}
	234
dcf3b5fb KH	235	static ssize_t show_alarm(struct device dev, struct device_attribute attr,
	236	char *buf)
	237	{
	238	int index = to_sensor_dev_attr(attr)->index;
	239	struct thmc50_data *data = thmc50_update_device(dev);
	240
	241	return sprintf(buf, "%u\n", (data->alarms >> index) & 1);
	242	}
	243
add77c64 KH	244	#define temp_reg(offset) \
	245	static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp, \
	246	NULL, offset - 1); \
	247	static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO \| S_IWUSR, \
	248	show_temp_min, set_temp_min, offset - 1); \
	249	static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO \| S_IWUSR, \
84f768c1 KH	250	show_temp_max, set_temp_max, offset - 1); \
	251	static SENSOR_DEVICE_ATTR(temp##offset##_crit, S_IRUGO, \
	252	show_temp_critical, NULL, offset - 1);
add77c64 KH	253
	254	temp_reg(1);
	255	temp_reg(2);
	256	temp_reg(3);
	257
dcf3b5fb KH	258	static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 0);
	259	static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
	260	static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 1);
	261	static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 7);
	262	static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 2);
	263
add77c64 KH	264	static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO \| S_IWUSR, show_analog_out,
	265	set_analog_out, 0);
	266	static SENSOR_DEVICE_ATTR(pwm1_mode, S_IRUGO, show_pwm_mode, NULL, 0);
	267
	268	static struct attribute *thmc50_attributes[] = {
	269	&sensor_dev_attr_temp1_max.dev_attr.attr,
	270	&sensor_dev_attr_temp1_min.dev_attr.attr,
	271	&sensor_dev_attr_temp1_input.dev_attr.attr,
84f768c1	272	&sensor_dev_attr_temp1_crit.dev_attr.attr,
dcf3b5fb	273	&sensor_dev_attr_temp1_alarm.dev_attr.attr,
add77c64 KH	274	&sensor_dev_attr_temp2_max.dev_attr.attr,
	275	&sensor_dev_attr_temp2_min.dev_attr.attr,
	276	&sensor_dev_attr_temp2_input.dev_attr.attr,
84f768c1	277	&sensor_dev_attr_temp2_crit.dev_attr.attr,
dcf3b5fb KH	278	&sensor_dev_attr_temp2_alarm.dev_attr.attr,
dcf3b5fb KH	279	&sensor_dev_attr_temp2_fault.dev_attr.attr,
add77c64 KH	280	&sensor_dev_attr_pwm1.dev_attr.attr,
	281	&sensor_dev_attr_pwm1_mode.dev_attr.attr,
	282	NULL
	283	};
	284
	285	static const struct attribute_group thmc50_group = {
	286	.attrs = thmc50_attributes,
	287	};
	288
	289	/* for ADM1022 3rd temperature mode */
894c00cf	290	static struct attribute *temp3_attributes[] = {
add77c64 KH	291	&sensor_dev_attr_temp3_max.dev_attr.attr,
	292	&sensor_dev_attr_temp3_min.dev_attr.attr,
	293	&sensor_dev_attr_temp3_input.dev_attr.attr,
84f768c1	294	&sensor_dev_attr_temp3_crit.dev_attr.attr,
dcf3b5fb KH	295	&sensor_dev_attr_temp3_alarm.dev_attr.attr,
dcf3b5fb KH	296	&sensor_dev_attr_temp3_fault.dev_attr.attr,
add77c64 KH	297	NULL
	298	};
	299
894c00cf JD	300	static const struct attribute_group temp3_group = {
894c00cf JD	301	.attrs = temp3_attributes,
add77c64 KH	302	};
add77c64 KH	303
ccf37488	304	/* Return 0 if detection is successful, -ENODEV otherwise */
310ec792	305	static int thmc50_detect(struct i2c_client *client,
ccf37488	306	struct i2c_board_info *info)
add77c64 KH	307	{
	308	unsigned company;
	309	unsigned revision;
	310	unsigned config;
ccf37488	311	struct i2c_adapter *adapter = client->adapter;
cc28a610	312	const char *type_name;
add77c64 KH	313
add77c64 KH	314	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
b55f3757	315	pr_debug("thmc50: detect failed, smbus byte data not supported!\n");
ccf37488	316	return -ENODEV;
add77c64 KH	317	}
add77c64 KH	318
add77c64 KH	319	pr_debug("thmc50: Probing for THMC50 at 0x%2X on bus %d\n",
	320	client->addr, i2c_adapter_id(client->adapter));
	321
add77c64 KH	322	company = i2c_smbus_read_byte_data(client, THMC50_REG_COMPANY_ID);
	323	revision = i2c_smbus_read_byte_data(client, THMC50_REG_DIE_CODE);
	324	config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
52df6440 JD	325	if (revision < 0xc0 \|\| (config & 0x10))
52df6440 JD	326	return -ENODEV;
add77c64	327
52df6440	328	if (company == 0x41) {
add77c64 KH	329	int id = i2c_adapter_id(client->adapter);
	330	int i;
	331
	332	type_name = "adm1022";
add77c64 KH	333	for (i = 0; i + 1 < adm1022_temp3_num; i += 2)
add77c64 KH	334	if (adm1022_temp3[i] == id &&
ccf37488	335	adm1022_temp3[i + 1] == client->addr) {
add77c64	336	/* enable 2nd remote temp */
ccf37488 JD	337	config \|= (1 << 7);
	338	i2c_smbus_write_byte_data(client,
	339	THMC50_REG_CONF,
	340	config);
add77c64 KH	341	break;
add77c64 KH	342	}
52df6440	343	} else if (company == 0x49) {
cc28a610	344	type_name = "thmc50";
52df6440 JD	345	} else {
	346	pr_debug("thmc50: Detection of THMC50/ADM1022 failed\n");
	347	return -ENODEV;
add77c64	348	}
52df6440	349
cc28a610 JD	350	pr_debug("thmc50: Detected %s (version %x, revision %x)\n",
cc28a610 JD	351	type_name, (revision >> 4) - 0xc, revision & 0xf);
add77c64	352
ccf37488	353	strlcpy(info->type, type_name, I2C_NAME_SIZE);
add77c64	354
ccf37488 JD	355	return 0;
	356	}
	357
	358	static int thmc50_probe(struct i2c_client *client,
	359	const struct i2c_device_id *id)
	360	{
	361	struct thmc50_data *data;
	362	int err;
	363
bd91d3ba GR	364	data = devm_kzalloc(&client->dev, sizeof(struct thmc50_data),
	365	GFP_KERNEL);
	366	if (!data)
	367	return -ENOMEM;
ccf37488 JD	368
	369	i2c_set_clientdata(client, data);
	370	data->type = id->driver_data;
	371	mutex_init(&data->update_lock);
add77c64 KH	372
	373	thmc50_init_client(client);
	374
	375	/* Register sysfs hooks */
4d387df7 GR	376	err = sysfs_create_group(&client->dev.kobj, &thmc50_group);
4d387df7 GR	377	if (err)
bd91d3ba	378	return err;
add77c64 KH	379
add77c64 KH	380	/* Register ADM1022 sysfs hooks */
4d387df7 GR	381	if (data->has_temp3) {
	382	err = sysfs_create_group(&client->dev.kobj, &temp3_group);
	383	if (err)
add77c64	384	goto exit_remove_sysfs_thmc50;
4d387df7	385	}
add77c64 KH	386
add77c64 KH	387	/* Register a new directory entry with module sensors */
1beeffe4 TJ	388	data->hwmon_dev = hwmon_device_register(&client->dev);
	389	if (IS_ERR(data->hwmon_dev)) {
	390	err = PTR_ERR(data->hwmon_dev);
add77c64 KH	391	goto exit_remove_sysfs;
	392	}
	393
	394	return 0;
	395
	396	exit_remove_sysfs:
894c00cf JD	397	if (data->has_temp3)
894c00cf JD	398	sysfs_remove_group(&client->dev.kobj, &temp3_group);
add77c64 KH	399	exit_remove_sysfs_thmc50:
add77c64 KH	400	sysfs_remove_group(&client->dev.kobj, &thmc50_group);
add77c64 KH	401	return err;
	402	}
	403
ccf37488	404	static int thmc50_remove(struct i2c_client *client)
add77c64 KH	405	{
add77c64 KH	406	struct thmc50_data *data = i2c_get_clientdata(client);
add77c64	407
1beeffe4	408	hwmon_device_unregister(data->hwmon_dev);
add77c64	409	sysfs_remove_group(&client->dev.kobj, &thmc50_group);
894c00cf JD	410	if (data->has_temp3)
894c00cf JD	411	sysfs_remove_group(&client->dev.kobj, &temp3_group);
add77c64	412
add77c64 KH	413	return 0;
	414	}
	415
	416	static void thmc50_init_client(struct i2c_client *client)
	417	{
	418	struct thmc50_data *data = i2c_get_clientdata(client);
	419	int config;
	420
	421	data->analog_out = i2c_smbus_read_byte_data(client,
	422	THMC50_REG_ANALOG_OUT);
	423	/* set up to at least 1 */
	424	if (data->analog_out == 0) {
	425	data->analog_out = 1;
	426	i2c_smbus_write_byte_data(client, THMC50_REG_ANALOG_OUT,
	427	data->analog_out);
	428	}
	429	config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
	430	config \|= 0x1; /* start the chip if it is in standby mode */
ccf37488 JD	431	if (data->type == adm1022 && (config & (1 << 7)))
ccf37488 JD	432	data->has_temp3 = 1;
add77c64 KH	433	i2c_smbus_write_byte_data(client, THMC50_REG_CONF, config);
	434	}
	435
	436	static struct thmc50_data thmc50_update_device(struct device dev)
	437	{
	438	struct i2c_client *client = to_i2c_client(dev);
	439	struct thmc50_data *data = i2c_get_clientdata(client);
	440	int timeout = HZ / 5 + (data->type == thmc50 ? HZ : 0);
	441
	442	mutex_lock(&data->update_lock);
	443
	444	if (time_after(jiffies, data->last_updated + timeout)
	445	\|\| !data->valid) {
	446
	447	int temps = data->has_temp3 ? 3 : 2;
	448	int i;
84f768c1 KH	449	int prog = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
	450
	451	prog &= THMC50_REG_CONF_PROGRAMMED;
	452
add77c64 KH	453	for (i = 0; i < temps; i++) {
	454	data->temp_input[i] = i2c_smbus_read_byte_data(client,
	455	THMC50_REG_TEMP[i]);
	456	data->temp_max[i] = i2c_smbus_read_byte_data(client,
	457	THMC50_REG_TEMP_MAX[i]);
	458	data->temp_min[i] = i2c_smbus_read_byte_data(client,
	459	THMC50_REG_TEMP_MIN[i]);
84f768c1 KH	460	data->temp_critical[i] =
	461	i2c_smbus_read_byte_data(client,
	462	prog ? THMC50_REG_TEMP_CRITICAL[i]
	463	: THMC50_REG_TEMP_DEFAULT[i]);
add77c64 KH	464	}
	465	data->analog_out =
	466	i2c_smbus_read_byte_data(client, THMC50_REG_ANALOG_OUT);
dcf3b5fb	467	data->alarms =
bba891c2	468	i2c_smbus_read_byte_data(client, THMC50_REG_INTR);
add77c64 KH	469	data->last_updated = jiffies;
	470	data->valid = 1;
	471	}
	472
	473	mutex_unlock(&data->update_lock);
	474
	475	return data;
	476	}
	477
f0967eea	478	module_i2c_driver(thmc50_driver);
add77c64 KH	479
	480	MODULE_AUTHOR("Krzysztof Helt <krzysztof.h1@wp.pl>");
	481	MODULE_DESCRIPTION("THMC50 driver");