mirror of
				git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
				synced 2025-09-04 20:19:47 +08:00 
			
		
		
		
	 c843b382e6
			
		
	
	
		c843b382e6
		
	
	
	
	
		
			
			The jc42 driver passes I2C client's name as hwmon device name. In case of device tree probed devices this ends up being part of the compatible string, "jc-42.4-temp". This name contains hyphens and the hwmon core doesn't like this: jc42 2-0018: hwmon: 'jc-42.4-temp' is not a valid name attribute, please fix This changes the name to "jc42" which doesn't have any illegal characters. Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de> Link: https://lore.kernel.org/r/20200417092853.31206-1-s.hauer@pengutronix.de Signed-off-by: Guenter Roeck <linux@roeck-us.net>
		
			
				
	
	
		
			596 lines
		
	
	
		
			15 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			596 lines
		
	
	
		
			15 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| /*
 | |
|  * jc42.c - driver for Jedec JC42.4 compliant temperature sensors
 | |
|  *
 | |
|  * Copyright (c) 2010  Ericsson AB.
 | |
|  *
 | |
|  * Derived from lm77.c by Andras BALI <drewie@freemail.hu>.
 | |
|  *
 | |
|  * JC42.4 compliant temperature sensors are typically used on memory modules.
 | |
|  */
 | |
| 
 | |
| #include <linux/bitops.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/jiffies.h>
 | |
| #include <linux/i2c.h>
 | |
| #include <linux/hwmon.h>
 | |
| #include <linux/err.h>
 | |
| #include <linux/mutex.h>
 | |
| #include <linux/of.h>
 | |
| 
 | |
| /* Addresses to scan */
 | |
| static const unsigned short normal_i2c[] = {
 | |
| 	0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f, I2C_CLIENT_END };
 | |
| 
 | |
| /* JC42 registers. All registers are 16 bit. */
 | |
| #define JC42_REG_CAP		0x00
 | |
| #define JC42_REG_CONFIG		0x01
 | |
| #define JC42_REG_TEMP_UPPER	0x02
 | |
| #define JC42_REG_TEMP_LOWER	0x03
 | |
| #define JC42_REG_TEMP_CRITICAL	0x04
 | |
| #define JC42_REG_TEMP		0x05
 | |
| #define JC42_REG_MANID		0x06
 | |
| #define JC42_REG_DEVICEID	0x07
 | |
| #define JC42_REG_SMBUS		0x22 /* NXP and Atmel, possibly others? */
 | |
| 
 | |
| /* Status bits in temperature register */
 | |
| #define JC42_ALARM_CRIT_BIT	15
 | |
| #define JC42_ALARM_MAX_BIT	14
 | |
| #define JC42_ALARM_MIN_BIT	13
 | |
| 
 | |
| /* Configuration register defines */
 | |
| #define JC42_CFG_CRIT_ONLY	(1 << 2)
 | |
| #define JC42_CFG_TCRIT_LOCK	(1 << 6)
 | |
| #define JC42_CFG_EVENT_LOCK	(1 << 7)
 | |
| #define JC42_CFG_SHUTDOWN	(1 << 8)
 | |
| #define JC42_CFG_HYST_SHIFT	9
 | |
| #define JC42_CFG_HYST_MASK	(0x03 << 9)
 | |
| 
 | |
| /* Capabilities */
 | |
| #define JC42_CAP_RANGE		(1 << 2)
 | |
| 
 | |
| /* Manufacturer IDs */
 | |
| #define ADT_MANID		0x11d4  /* Analog Devices */
 | |
| #define ATMEL_MANID		0x001f  /* Atmel */
 | |
| #define ATMEL_MANID2		0x1114	/* Atmel */
 | |
| #define MAX_MANID		0x004d  /* Maxim */
 | |
| #define IDT_MANID		0x00b3  /* IDT */
 | |
| #define MCP_MANID		0x0054  /* Microchip */
 | |
| #define NXP_MANID		0x1131  /* NXP Semiconductors */
 | |
| #define ONS_MANID		0x1b09  /* ON Semiconductor */
 | |
| #define STM_MANID		0x104a  /* ST Microelectronics */
 | |
| #define GT_MANID		0x1c68	/* Giantec */
 | |
| #define GT_MANID2		0x132d	/* Giantec, 2nd mfg ID */
 | |
| 
 | |
| /* SMBUS register */
 | |
| #define SMBUS_STMOUT		BIT(7)  /* SMBus time-out, active low */
 | |
| 
 | |
| /* Supported chips */
 | |
| 
 | |
| /* Analog Devices */
 | |
| #define ADT7408_DEVID		0x0801
 | |
| #define ADT7408_DEVID_MASK	0xffff
 | |
| 
 | |
| /* Atmel */
 | |
| #define AT30TS00_DEVID		0x8201
 | |
| #define AT30TS00_DEVID_MASK	0xffff
 | |
| 
 | |
| #define AT30TSE004_DEVID	0x2200
 | |
| #define AT30TSE004_DEVID_MASK	0xffff
 | |
| 
 | |
| /* Giantec */
 | |
| #define GT30TS00_DEVID		0x2200
 | |
| #define GT30TS00_DEVID_MASK	0xff00
 | |
| 
 | |
| #define GT34TS02_DEVID		0x3300
 | |
| #define GT34TS02_DEVID_MASK	0xff00
 | |
| 
 | |
| /* IDT */
 | |
| #define TSE2004_DEVID		0x2200
 | |
| #define TSE2004_DEVID_MASK	0xff00
 | |
| 
 | |
| #define TS3000_DEVID		0x2900  /* Also matches TSE2002 */
 | |
| #define TS3000_DEVID_MASK	0xff00
 | |
| 
 | |
| #define TS3001_DEVID		0x3000
 | |
| #define TS3001_DEVID_MASK	0xff00
 | |
| 
 | |
| /* Maxim */
 | |
| #define MAX6604_DEVID		0x3e00
 | |
| #define MAX6604_DEVID_MASK	0xffff
 | |
| 
 | |
| /* Microchip */
 | |
| #define MCP9804_DEVID		0x0200
 | |
| #define MCP9804_DEVID_MASK	0xfffc
 | |
| 
 | |
| #define MCP9808_DEVID		0x0400
 | |
| #define MCP9808_DEVID_MASK	0xfffc
 | |
| 
 | |
| #define MCP98242_DEVID		0x2000
 | |
| #define MCP98242_DEVID_MASK	0xfffc
 | |
| 
 | |
| #define MCP98243_DEVID		0x2100
 | |
| #define MCP98243_DEVID_MASK	0xfffc
 | |
| 
 | |
| #define MCP98244_DEVID		0x2200
 | |
| #define MCP98244_DEVID_MASK	0xfffc
 | |
| 
 | |
| #define MCP9843_DEVID		0x0000	/* Also matches mcp9805 */
 | |
| #define MCP9843_DEVID_MASK	0xfffe
 | |
| 
 | |
| /* NXP */
 | |
| #define SE97_DEVID		0xa200
 | |
| #define SE97_DEVID_MASK		0xfffc
 | |
| 
 | |
| #define SE98_DEVID		0xa100
 | |
| #define SE98_DEVID_MASK		0xfffc
 | |
| 
 | |
| /* ON Semiconductor */
 | |
| #define CAT6095_DEVID		0x0800	/* Also matches CAT34TS02 */
 | |
| #define CAT6095_DEVID_MASK	0xffe0
 | |
| 
 | |
| #define CAT34TS02C_DEVID	0x0a00
 | |
| #define CAT34TS02C_DEVID_MASK	0xfff0
 | |
| 
 | |
| #define CAT34TS04_DEVID		0x2200
 | |
| #define CAT34TS04_DEVID_MASK	0xfff0
 | |
| 
 | |
| /* ST Microelectronics */
 | |
| #define STTS424_DEVID		0x0101
 | |
| #define STTS424_DEVID_MASK	0xffff
 | |
| 
 | |
| #define STTS424E_DEVID		0x0000
 | |
| #define STTS424E_DEVID_MASK	0xfffe
 | |
| 
 | |
| #define STTS2002_DEVID		0x0300
 | |
| #define STTS2002_DEVID_MASK	0xffff
 | |
| 
 | |
| #define STTS2004_DEVID		0x2201
 | |
| #define STTS2004_DEVID_MASK	0xffff
 | |
| 
 | |
| #define STTS3000_DEVID		0x0200
 | |
| #define STTS3000_DEVID_MASK	0xffff
 | |
| 
 | |
| static u16 jc42_hysteresis[] = { 0, 1500, 3000, 6000 };
 | |
| 
 | |
| struct jc42_chips {
 | |
| 	u16 manid;
 | |
| 	u16 devid;
 | |
| 	u16 devid_mask;
 | |
| };
 | |
| 
 | |
| static struct jc42_chips jc42_chips[] = {
 | |
| 	{ ADT_MANID, ADT7408_DEVID, ADT7408_DEVID_MASK },
 | |
| 	{ ATMEL_MANID, AT30TS00_DEVID, AT30TS00_DEVID_MASK },
 | |
| 	{ ATMEL_MANID2, AT30TSE004_DEVID, AT30TSE004_DEVID_MASK },
 | |
| 	{ GT_MANID, GT30TS00_DEVID, GT30TS00_DEVID_MASK },
 | |
| 	{ GT_MANID2, GT34TS02_DEVID, GT34TS02_DEVID_MASK },
 | |
| 	{ IDT_MANID, TSE2004_DEVID, TSE2004_DEVID_MASK },
 | |
| 	{ IDT_MANID, TS3000_DEVID, TS3000_DEVID_MASK },
 | |
| 	{ IDT_MANID, TS3001_DEVID, TS3001_DEVID_MASK },
 | |
| 	{ MAX_MANID, MAX6604_DEVID, MAX6604_DEVID_MASK },
 | |
| 	{ MCP_MANID, MCP9804_DEVID, MCP9804_DEVID_MASK },
 | |
| 	{ MCP_MANID, MCP9808_DEVID, MCP9808_DEVID_MASK },
 | |
| 	{ MCP_MANID, MCP98242_DEVID, MCP98242_DEVID_MASK },
 | |
| 	{ MCP_MANID, MCP98243_DEVID, MCP98243_DEVID_MASK },
 | |
| 	{ MCP_MANID, MCP98244_DEVID, MCP98244_DEVID_MASK },
 | |
| 	{ MCP_MANID, MCP9843_DEVID, MCP9843_DEVID_MASK },
 | |
| 	{ NXP_MANID, SE97_DEVID, SE97_DEVID_MASK },
 | |
| 	{ ONS_MANID, CAT6095_DEVID, CAT6095_DEVID_MASK },
 | |
| 	{ ONS_MANID, CAT34TS02C_DEVID, CAT34TS02C_DEVID_MASK },
 | |
| 	{ ONS_MANID, CAT34TS04_DEVID, CAT34TS04_DEVID_MASK },
 | |
| 	{ NXP_MANID, SE98_DEVID, SE98_DEVID_MASK },
 | |
| 	{ STM_MANID, STTS424_DEVID, STTS424_DEVID_MASK },
 | |
| 	{ STM_MANID, STTS424E_DEVID, STTS424E_DEVID_MASK },
 | |
| 	{ STM_MANID, STTS2002_DEVID, STTS2002_DEVID_MASK },
 | |
| 	{ STM_MANID, STTS2004_DEVID, STTS2004_DEVID_MASK },
 | |
| 	{ STM_MANID, STTS3000_DEVID, STTS3000_DEVID_MASK },
 | |
| };
 | |
| 
 | |
| enum temp_index {
 | |
| 	t_input = 0,
 | |
| 	t_crit,
 | |
| 	t_min,
 | |
| 	t_max,
 | |
| 	t_num_temp
 | |
| };
 | |
| 
 | |
| static const u8 temp_regs[t_num_temp] = {
 | |
| 	[t_input] = JC42_REG_TEMP,
 | |
| 	[t_crit] = JC42_REG_TEMP_CRITICAL,
 | |
| 	[t_min] = JC42_REG_TEMP_LOWER,
 | |
| 	[t_max] = JC42_REG_TEMP_UPPER,
 | |
| };
 | |
| 
 | |
| /* Each client has this additional data */
 | |
| struct jc42_data {
 | |
| 	struct i2c_client *client;
 | |
| 	struct mutex	update_lock;	/* protect register access */
 | |
| 	bool		extended;	/* true if extended range supported */
 | |
| 	bool		valid;
 | |
| 	unsigned long	last_updated;	/* In jiffies */
 | |
| 	u16		orig_config;	/* original configuration */
 | |
| 	u16		config;		/* current configuration */
 | |
| 	u16		temp[t_num_temp];/* Temperatures */
 | |
| };
 | |
| 
 | |
| #define JC42_TEMP_MIN_EXTENDED	(-40000)
 | |
| #define JC42_TEMP_MIN		0
 | |
| #define JC42_TEMP_MAX		125000
 | |
| 
 | |
| static u16 jc42_temp_to_reg(long temp, bool extended)
 | |
| {
 | |
| 	int ntemp = clamp_val(temp,
 | |
| 			      extended ? JC42_TEMP_MIN_EXTENDED :
 | |
| 			      JC42_TEMP_MIN, JC42_TEMP_MAX);
 | |
| 
 | |
| 	/* convert from 0.001 to 0.0625 resolution */
 | |
| 	return (ntemp * 2 / 125) & 0x1fff;
 | |
| }
 | |
| 
 | |
| static int jc42_temp_from_reg(s16 reg)
 | |
| {
 | |
| 	reg = sign_extend32(reg, 12);
 | |
| 
 | |
| 	/* convert from 0.0625 to 0.001 resolution */
 | |
| 	return reg * 125 / 2;
 | |
| }
 | |
| 
 | |
| static struct jc42_data *jc42_update_device(struct device *dev)
 | |
| {
 | |
| 	struct jc42_data *data = dev_get_drvdata(dev);
 | |
| 	struct i2c_client *client = data->client;
 | |
| 	struct jc42_data *ret = data;
 | |
| 	int i, val;
 | |
| 
 | |
| 	mutex_lock(&data->update_lock);
 | |
| 
 | |
| 	if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
 | |
| 		for (i = 0; i < t_num_temp; i++) {
 | |
| 			val = i2c_smbus_read_word_swapped(client, temp_regs[i]);
 | |
| 			if (val < 0) {
 | |
| 				ret = ERR_PTR(val);
 | |
| 				goto abort;
 | |
| 			}
 | |
| 			data->temp[i] = val;
 | |
| 		}
 | |
| 		data->last_updated = jiffies;
 | |
| 		data->valid = true;
 | |
| 	}
 | |
| abort:
 | |
| 	mutex_unlock(&data->update_lock);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int jc42_read(struct device *dev, enum hwmon_sensor_types type,
 | |
| 		     u32 attr, int channel, long *val)
 | |
| {
 | |
| 	struct jc42_data *data = jc42_update_device(dev);
 | |
| 	int temp, hyst;
 | |
| 
 | |
| 	if (IS_ERR(data))
 | |
| 		return PTR_ERR(data);
 | |
| 
 | |
| 	switch (attr) {
 | |
| 	case hwmon_temp_input:
 | |
| 		*val = jc42_temp_from_reg(data->temp[t_input]);
 | |
| 		return 0;
 | |
| 	case hwmon_temp_min:
 | |
| 		*val = jc42_temp_from_reg(data->temp[t_min]);
 | |
| 		return 0;
 | |
| 	case hwmon_temp_max:
 | |
| 		*val = jc42_temp_from_reg(data->temp[t_max]);
 | |
| 		return 0;
 | |
| 	case hwmon_temp_crit:
 | |
| 		*val = jc42_temp_from_reg(data->temp[t_crit]);
 | |
| 		return 0;
 | |
| 	case hwmon_temp_max_hyst:
 | |
| 		temp = jc42_temp_from_reg(data->temp[t_max]);
 | |
| 		hyst = jc42_hysteresis[(data->config & JC42_CFG_HYST_MASK)
 | |
| 						>> JC42_CFG_HYST_SHIFT];
 | |
| 		*val = temp - hyst;
 | |
| 		return 0;
 | |
| 	case hwmon_temp_crit_hyst:
 | |
| 		temp = jc42_temp_from_reg(data->temp[t_crit]);
 | |
| 		hyst = jc42_hysteresis[(data->config & JC42_CFG_HYST_MASK)
 | |
| 						>> JC42_CFG_HYST_SHIFT];
 | |
| 		*val = temp - hyst;
 | |
| 		return 0;
 | |
| 	case hwmon_temp_min_alarm:
 | |
| 		*val = (data->temp[t_input] >> JC42_ALARM_MIN_BIT) & 1;
 | |
| 		return 0;
 | |
| 	case hwmon_temp_max_alarm:
 | |
| 		*val = (data->temp[t_input] >> JC42_ALARM_MAX_BIT) & 1;
 | |
| 		return 0;
 | |
| 	case hwmon_temp_crit_alarm:
 | |
| 		*val = (data->temp[t_input] >> JC42_ALARM_CRIT_BIT) & 1;
 | |
| 		return 0;
 | |
| 	default:
 | |
| 		return -EOPNOTSUPP;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int jc42_write(struct device *dev, enum hwmon_sensor_types type,
 | |
| 		      u32 attr, int channel, long val)
 | |
| {
 | |
| 	struct jc42_data *data = dev_get_drvdata(dev);
 | |
| 	struct i2c_client *client = data->client;
 | |
| 	int diff, hyst;
 | |
| 	int ret;
 | |
| 
 | |
| 	mutex_lock(&data->update_lock);
 | |
| 
 | |
| 	switch (attr) {
 | |
| 	case hwmon_temp_min:
 | |
| 		data->temp[t_min] = jc42_temp_to_reg(val, data->extended);
 | |
| 		ret = i2c_smbus_write_word_swapped(client, temp_regs[t_min],
 | |
| 						   data->temp[t_min]);
 | |
| 		break;
 | |
| 	case hwmon_temp_max:
 | |
| 		data->temp[t_max] = jc42_temp_to_reg(val, data->extended);
 | |
| 		ret = i2c_smbus_write_word_swapped(client, temp_regs[t_max],
 | |
| 						   data->temp[t_max]);
 | |
| 		break;
 | |
| 	case hwmon_temp_crit:
 | |
| 		data->temp[t_crit] = jc42_temp_to_reg(val, data->extended);
 | |
| 		ret = i2c_smbus_write_word_swapped(client, temp_regs[t_crit],
 | |
| 						   data->temp[t_crit]);
 | |
| 		break;
 | |
| 	case hwmon_temp_crit_hyst:
 | |
| 		/*
 | |
| 		 * JC42.4 compliant chips only support four hysteresis values.
 | |
| 		 * Pick best choice and go from there.
 | |
| 		 */
 | |
| 		val = clamp_val(val, (data->extended ? JC42_TEMP_MIN_EXTENDED
 | |
| 						     : JC42_TEMP_MIN) - 6000,
 | |
| 				JC42_TEMP_MAX);
 | |
| 		diff = jc42_temp_from_reg(data->temp[t_crit]) - val;
 | |
| 		hyst = 0;
 | |
| 		if (diff > 0) {
 | |
| 			if (diff < 2250)
 | |
| 				hyst = 1;	/* 1.5 degrees C */
 | |
| 			else if (diff < 4500)
 | |
| 				hyst = 2;	/* 3.0 degrees C */
 | |
| 			else
 | |
| 				hyst = 3;	/* 6.0 degrees C */
 | |
| 		}
 | |
| 		data->config = (data->config & ~JC42_CFG_HYST_MASK) |
 | |
| 				(hyst << JC42_CFG_HYST_SHIFT);
 | |
| 		ret = i2c_smbus_write_word_swapped(data->client,
 | |
| 						   JC42_REG_CONFIG,
 | |
| 						   data->config);
 | |
| 		break;
 | |
| 	default:
 | |
| 		ret = -EOPNOTSUPP;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	mutex_unlock(&data->update_lock);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static umode_t jc42_is_visible(const void *_data, enum hwmon_sensor_types type,
 | |
| 			       u32 attr, int channel)
 | |
| {
 | |
| 	const struct jc42_data *data = _data;
 | |
| 	unsigned int config = data->config;
 | |
| 	umode_t mode = 0444;
 | |
| 
 | |
| 	switch (attr) {
 | |
| 	case hwmon_temp_min:
 | |
| 	case hwmon_temp_max:
 | |
| 		if (!(config & JC42_CFG_EVENT_LOCK))
 | |
| 			mode |= 0200;
 | |
| 		break;
 | |
| 	case hwmon_temp_crit:
 | |
| 		if (!(config & JC42_CFG_TCRIT_LOCK))
 | |
| 			mode |= 0200;
 | |
| 		break;
 | |
| 	case hwmon_temp_crit_hyst:
 | |
| 		if (!(config & (JC42_CFG_EVENT_LOCK | JC42_CFG_TCRIT_LOCK)))
 | |
| 			mode |= 0200;
 | |
| 		break;
 | |
| 	case hwmon_temp_input:
 | |
| 	case hwmon_temp_max_hyst:
 | |
| 	case hwmon_temp_min_alarm:
 | |
| 	case hwmon_temp_max_alarm:
 | |
| 	case hwmon_temp_crit_alarm:
 | |
| 		break;
 | |
| 	default:
 | |
| 		mode = 0;
 | |
| 		break;
 | |
| 	}
 | |
| 	return mode;
 | |
| }
 | |
| 
 | |
| /* Return 0 if detection is successful, -ENODEV otherwise */
 | |
| static int jc42_detect(struct i2c_client *client, struct i2c_board_info *info)
 | |
| {
 | |
| 	struct i2c_adapter *adapter = client->adapter;
 | |
| 	int i, config, cap, manid, devid;
 | |
| 
 | |
| 	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
 | |
| 				     I2C_FUNC_SMBUS_WORD_DATA))
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	cap = i2c_smbus_read_word_swapped(client, JC42_REG_CAP);
 | |
| 	config = i2c_smbus_read_word_swapped(client, JC42_REG_CONFIG);
 | |
| 	manid = i2c_smbus_read_word_swapped(client, JC42_REG_MANID);
 | |
| 	devid = i2c_smbus_read_word_swapped(client, JC42_REG_DEVICEID);
 | |
| 
 | |
| 	if (cap < 0 || config < 0 || manid < 0 || devid < 0)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	if ((cap & 0xff00) || (config & 0xf800))
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	for (i = 0; i < ARRAY_SIZE(jc42_chips); i++) {
 | |
| 		struct jc42_chips *chip = &jc42_chips[i];
 | |
| 		if (manid == chip->manid &&
 | |
| 		    (devid & chip->devid_mask) == chip->devid) {
 | |
| 			strlcpy(info->type, "jc42", I2C_NAME_SIZE);
 | |
| 			return 0;
 | |
| 		}
 | |
| 	}
 | |
| 	return -ENODEV;
 | |
| }
 | |
| 
 | |
| static const struct hwmon_channel_info *jc42_info[] = {
 | |
| 	HWMON_CHANNEL_INFO(temp,
 | |
| 			   HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX |
 | |
| 			   HWMON_T_CRIT | HWMON_T_MAX_HYST |
 | |
| 			   HWMON_T_CRIT_HYST | HWMON_T_MIN_ALARM |
 | |
| 			   HWMON_T_MAX_ALARM | HWMON_T_CRIT_ALARM),
 | |
| 	NULL
 | |
| };
 | |
| 
 | |
| static const struct hwmon_ops jc42_hwmon_ops = {
 | |
| 	.is_visible = jc42_is_visible,
 | |
| 	.read = jc42_read,
 | |
| 	.write = jc42_write,
 | |
| };
 | |
| 
 | |
| static const struct hwmon_chip_info jc42_chip_info = {
 | |
| 	.ops = &jc42_hwmon_ops,
 | |
| 	.info = jc42_info,
 | |
| };
 | |
| 
 | |
| static int jc42_probe(struct i2c_client *client, const struct i2c_device_id *id)
 | |
| {
 | |
| 	struct device *dev = &client->dev;
 | |
| 	struct device *hwmon_dev;
 | |
| 	struct jc42_data *data;
 | |
| 	int config, cap;
 | |
| 
 | |
| 	data = devm_kzalloc(dev, sizeof(struct jc42_data), GFP_KERNEL);
 | |
| 	if (!data)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	data->client = client;
 | |
| 	i2c_set_clientdata(client, data);
 | |
| 	mutex_init(&data->update_lock);
 | |
| 
 | |
| 	cap = i2c_smbus_read_word_swapped(client, JC42_REG_CAP);
 | |
| 	if (cap < 0)
 | |
| 		return cap;
 | |
| 
 | |
| 	data->extended = !!(cap & JC42_CAP_RANGE);
 | |
| 
 | |
| 	if (device_property_read_bool(dev, "smbus-timeout-disable")) {
 | |
| 		int smbus;
 | |
| 
 | |
| 		/*
 | |
| 		 * Not all chips support this register, but from a
 | |
| 		 * quick read of various datasheets no chip appears
 | |
| 		 * incompatible with the below attempt to disable
 | |
| 		 * the timeout. And the whole thing is opt-in...
 | |
| 		 */
 | |
| 		smbus = i2c_smbus_read_word_swapped(client, JC42_REG_SMBUS);
 | |
| 		if (smbus < 0)
 | |
| 			return smbus;
 | |
| 		i2c_smbus_write_word_swapped(client, JC42_REG_SMBUS,
 | |
| 					     smbus | SMBUS_STMOUT);
 | |
| 	}
 | |
| 
 | |
| 	config = i2c_smbus_read_word_swapped(client, JC42_REG_CONFIG);
 | |
| 	if (config < 0)
 | |
| 		return config;
 | |
| 
 | |
| 	data->orig_config = config;
 | |
| 	if (config & JC42_CFG_SHUTDOWN) {
 | |
| 		config &= ~JC42_CFG_SHUTDOWN;
 | |
| 		i2c_smbus_write_word_swapped(client, JC42_REG_CONFIG, config);
 | |
| 	}
 | |
| 	data->config = config;
 | |
| 
 | |
| 	hwmon_dev = devm_hwmon_device_register_with_info(dev, "jc42",
 | |
| 							 data, &jc42_chip_info,
 | |
| 							 NULL);
 | |
| 	return PTR_ERR_OR_ZERO(hwmon_dev);
 | |
| }
 | |
| 
 | |
| static int jc42_remove(struct i2c_client *client)
 | |
| {
 | |
| 	struct jc42_data *data = i2c_get_clientdata(client);
 | |
| 
 | |
| 	/* Restore original configuration except hysteresis */
 | |
| 	if ((data->config & ~JC42_CFG_HYST_MASK) !=
 | |
| 	    (data->orig_config & ~JC42_CFG_HYST_MASK)) {
 | |
| 		int config;
 | |
| 
 | |
| 		config = (data->orig_config & ~JC42_CFG_HYST_MASK)
 | |
| 		  | (data->config & JC42_CFG_HYST_MASK);
 | |
| 		i2c_smbus_write_word_swapped(client, JC42_REG_CONFIG, config);
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_PM
 | |
| 
 | |
| static int jc42_suspend(struct device *dev)
 | |
| {
 | |
| 	struct jc42_data *data = dev_get_drvdata(dev);
 | |
| 
 | |
| 	data->config |= JC42_CFG_SHUTDOWN;
 | |
| 	i2c_smbus_write_word_swapped(data->client, JC42_REG_CONFIG,
 | |
| 				     data->config);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int jc42_resume(struct device *dev)
 | |
| {
 | |
| 	struct jc42_data *data = dev_get_drvdata(dev);
 | |
| 
 | |
| 	data->config &= ~JC42_CFG_SHUTDOWN;
 | |
| 	i2c_smbus_write_word_swapped(data->client, JC42_REG_CONFIG,
 | |
| 				     data->config);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct dev_pm_ops jc42_dev_pm_ops = {
 | |
| 	.suspend = jc42_suspend,
 | |
| 	.resume = jc42_resume,
 | |
| };
 | |
| 
 | |
| #define JC42_DEV_PM_OPS (&jc42_dev_pm_ops)
 | |
| #else
 | |
| #define JC42_DEV_PM_OPS NULL
 | |
| #endif /* CONFIG_PM */
 | |
| 
 | |
| static const struct i2c_device_id jc42_id[] = {
 | |
| 	{ "jc42", 0 },
 | |
| 	{ }
 | |
| };
 | |
| MODULE_DEVICE_TABLE(i2c, jc42_id);
 | |
| 
 | |
| #ifdef CONFIG_OF
 | |
| static const struct of_device_id jc42_of_ids[] = {
 | |
| 	{ .compatible = "jedec,jc-42.4-temp", },
 | |
| 	{ }
 | |
| };
 | |
| MODULE_DEVICE_TABLE(of, jc42_of_ids);
 | |
| #endif
 | |
| 
 | |
| static struct i2c_driver jc42_driver = {
 | |
| 	.class		= I2C_CLASS_SPD | I2C_CLASS_HWMON,
 | |
| 	.driver = {
 | |
| 		.name	= "jc42",
 | |
| 		.pm = JC42_DEV_PM_OPS,
 | |
| 		.of_match_table = of_match_ptr(jc42_of_ids),
 | |
| 	},
 | |
| 	.probe		= jc42_probe,
 | |
| 	.remove		= jc42_remove,
 | |
| 	.id_table	= jc42_id,
 | |
| 	.detect		= jc42_detect,
 | |
| 	.address_list	= normal_i2c,
 | |
| };
 | |
| 
 | |
| module_i2c_driver(jc42_driver);
 | |
| 
 | |
| MODULE_AUTHOR("Guenter Roeck <linux@roeck-us.net>");
 | |
| MODULE_DESCRIPTION("JC42 driver");
 | |
| MODULE_LICENSE("GPL");
 |