| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | ds1621.c - Part of lm_sensors, Linux kernel modules for hardware | 
|  | 3 | monitoring | 
|  | 4 | Christian W. Zuckschwerdt  <zany@triq.net>  2000-11-23 | 
|  | 5 | based on lm75.c by Frodo Looijaard <frodol@dds.nl> | 
|  | 6 | Ported to Linux 2.6 by Aurelien Jarno <aurelien@aurel32.net> with | 
|  | 7 | the help of Jean Delvare <khali@linux-fr.org> | 
|  | 8 |  | 
|  | 9 | This program is free software; you can redistribute it and/or modify | 
|  | 10 | it under the terms of the GNU General Public License as published by | 
|  | 11 | the Free Software Foundation; either version 2 of the License, or | 
|  | 12 | (at your option) any later version. | 
|  | 13 |  | 
|  | 14 | This program is distributed in the hope that it will be useful, | 
|  | 15 | but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 16 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | 17 | GNU General Public License for more details. | 
|  | 18 |  | 
|  | 19 | You should have received a copy of the GNU General Public License | 
|  | 20 | along with this program; if not, write to the Free Software | 
|  | 21 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
|  | 22 | */ | 
|  | 23 |  | 
|  | 24 | #include <linux/module.h> | 
|  | 25 | #include <linux/init.h> | 
|  | 26 | #include <linux/slab.h> | 
|  | 27 | #include <linux/jiffies.h> | 
|  | 28 | #include <linux/i2c.h> | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 29 | #include <linux/hwmon.h> | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 30 | #include <linux/hwmon-sysfs.h> | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 31 | #include <linux/err.h> | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 32 | #include <linux/mutex.h> | 
| Jean Delvare | a5ebe66 | 2006-09-24 21:24:46 +0200 | [diff] [blame] | 33 | #include <linux/sysfs.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | #include "lm75.h" | 
|  | 35 |  | 
|  | 36 | /* Addresses to scan */ | 
| Mark M. Hoffman | 25e9c86 | 2008-02-17 22:28:03 -0500 | [diff] [blame] | 37 | static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b, 0x4c, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | 0x4d, 0x4e, 0x4f, I2C_CLIENT_END }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 |  | 
|  | 40 | /* Insmod parameters */ | 
| Jean Delvare | f4b5026 | 2005-07-31 21:49:03 +0200 | [diff] [blame] | 41 | I2C_CLIENT_INSMOD_1(ds1621); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | static int polarity = -1; | 
|  | 43 | module_param(polarity, int, 0); | 
|  | 44 | MODULE_PARM_DESC(polarity, "Output's polarity: 0 = active high, 1 = active low"); | 
|  | 45 |  | 
|  | 46 | /* Many DS1621 constants specified below */ | 
|  | 47 | /* Config register used for detection         */ | 
|  | 48 | /*  7    6    5    4    3    2    1    0      */ | 
|  | 49 | /* |Done|THF |TLF |NVB | X  | X  |POL |1SHOT| */ | 
|  | 50 | #define DS1621_REG_CONFIG_NVB		0x10 | 
|  | 51 | #define DS1621_REG_CONFIG_POLARITY	0x02 | 
|  | 52 | #define DS1621_REG_CONFIG_1SHOT		0x01 | 
|  | 53 | #define DS1621_REG_CONFIG_DONE		0x80 | 
|  | 54 |  | 
|  | 55 | /* The DS1621 registers */ | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 56 | static const u8 DS1621_REG_TEMP[3] = { | 
|  | 57 | 0xAA,		/* input, word, RO */ | 
|  | 58 | 0xA2,		/* min, word, RW */ | 
|  | 59 | 0xA1,		/* max, word, RW */ | 
|  | 60 | }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 | #define DS1621_REG_CONF			0xAC /* byte, RW */ | 
|  | 62 | #define DS1621_COM_START		0xEE /* no data */ | 
|  | 63 | #define DS1621_COM_STOP			0x22 /* no data */ | 
|  | 64 |  | 
|  | 65 | /* The DS1621 configuration register */ | 
|  | 66 | #define DS1621_ALARM_TEMP_HIGH		0x40 | 
|  | 67 | #define DS1621_ALARM_TEMP_LOW		0x20 | 
|  | 68 |  | 
| Jean Delvare | 75819f0 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 69 | /* Conversions */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | #define ALARMS_FROM_REG(val) ((val) & \ | 
|  | 71 | (DS1621_ALARM_TEMP_HIGH | DS1621_ALARM_TEMP_LOW)) | 
|  | 72 |  | 
|  | 73 | /* Each client has this additional data */ | 
|  | 74 | struct ds1621_data { | 
| Tony Jones | 1beeffe | 2007-08-20 13:46:20 -0700 | [diff] [blame] | 75 | struct device *hwmon_dev; | 
| Ingo Molnar | 9a61bf6 | 2006-01-18 23:19:26 +0100 | [diff] [blame] | 76 | struct mutex update_lock; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | char valid;			/* !=0 if following fields are valid */ | 
|  | 78 | unsigned long last_updated;	/* In jiffies */ | 
|  | 79 |  | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 80 | u16 temp[3];			/* Register values, word */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | u8 conf;			/* Register encoding, combined */ | 
|  | 82 | }; | 
|  | 83 |  | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 84 | /* Temperature registers are word-sized. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | DS1621 uses a high-byte first convention, which is exactly opposite to | 
| Jean Delvare | 75819f0 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 86 | the SMBus standard. */ | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 87 | static int ds1621_read_temp(struct i2c_client *client, u8 reg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | { | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 89 | int ret; | 
|  | 90 |  | 
|  | 91 | ret = i2c_smbus_read_word_data(client, reg); | 
|  | 92 | if (ret < 0) | 
|  | 93 | return ret; | 
|  | 94 | return swab16(ret); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 95 | } | 
|  | 96 |  | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 97 | static int ds1621_write_temp(struct i2c_client *client, u8 reg, u16 value) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | { | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 99 | return i2c_smbus_write_word_data(client, reg, swab16(value)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | } | 
|  | 101 |  | 
|  | 102 | static void ds1621_init_client(struct i2c_client *client) | 
|  | 103 | { | 
| Jean Delvare | e4879e2 | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 104 | u8 conf, new_conf; | 
|  | 105 |  | 
|  | 106 | new_conf = conf = i2c_smbus_read_byte_data(client, DS1621_REG_CONF); | 
| Steven Cole | 44bbe87 | 2005-05-03 18:21:25 -0600 | [diff] [blame] | 107 | /* switch to continuous conversion mode */ | 
| Jean Delvare | e4879e2 | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 108 | new_conf &= ~DS1621_REG_CONFIG_1SHOT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 |  | 
|  | 110 | /* setup output polarity */ | 
|  | 111 | if (polarity == 0) | 
| Jean Delvare | e4879e2 | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 112 | new_conf &= ~DS1621_REG_CONFIG_POLARITY; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | else if (polarity == 1) | 
| Jean Delvare | e4879e2 | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 114 | new_conf |= DS1621_REG_CONFIG_POLARITY; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 |  | 
| Jean Delvare | e4879e2 | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 116 | if (conf != new_conf) | 
|  | 117 | i2c_smbus_write_byte_data(client, DS1621_REG_CONF, new_conf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 |  | 
|  | 119 | /* start conversion */ | 
|  | 120 | i2c_smbus_write_byte(client, DS1621_COM_START); | 
|  | 121 | } | 
|  | 122 |  | 
| Jean Delvare | 9202add | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 123 | static struct ds1621_data *ds1621_update_client(struct device *dev) | 
|  | 124 | { | 
|  | 125 | struct i2c_client *client = to_i2c_client(dev); | 
|  | 126 | struct ds1621_data *data = i2c_get_clientdata(client); | 
|  | 127 | u8 new_conf; | 
|  | 128 |  | 
|  | 129 | mutex_lock(&data->update_lock); | 
|  | 130 |  | 
|  | 131 | if (time_after(jiffies, data->last_updated + HZ + HZ / 2) | 
|  | 132 | || !data->valid) { | 
|  | 133 | int i; | 
|  | 134 |  | 
|  | 135 | dev_dbg(&client->dev, "Starting ds1621 update\n"); | 
|  | 136 |  | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 137 | data->conf = i2c_smbus_read_byte_data(client, DS1621_REG_CONF); | 
| Jean Delvare | 9202add | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 138 |  | 
|  | 139 | for (i = 0; i < ARRAY_SIZE(data->temp); i++) | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 140 | data->temp[i] = ds1621_read_temp(client, | 
|  | 141 | DS1621_REG_TEMP[i]); | 
| Jean Delvare | 9202add | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 142 |  | 
|  | 143 | /* reset alarms if necessary */ | 
|  | 144 | new_conf = data->conf; | 
|  | 145 | if (data->temp[0] > data->temp[1])	/* input > min */ | 
|  | 146 | new_conf &= ~DS1621_ALARM_TEMP_LOW; | 
|  | 147 | if (data->temp[0] < data->temp[2])	/* input < max */ | 
|  | 148 | new_conf &= ~DS1621_ALARM_TEMP_HIGH; | 
|  | 149 | if (data->conf != new_conf) | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 150 | i2c_smbus_write_byte_data(client, DS1621_REG_CONF, | 
|  | 151 | new_conf); | 
| Jean Delvare | 9202add | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 152 |  | 
|  | 153 | data->last_updated = jiffies; | 
|  | 154 | data->valid = 1; | 
|  | 155 | } | 
|  | 156 |  | 
|  | 157 | mutex_unlock(&data->update_lock); | 
|  | 158 |  | 
|  | 159 | return data; | 
|  | 160 | } | 
|  | 161 |  | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 162 | static ssize_t show_temp(struct device *dev, struct device_attribute *da, | 
|  | 163 | char *buf) | 
|  | 164 | { | 
|  | 165 | struct sensor_device_attribute *attr = to_sensor_dev_attr(da); | 
|  | 166 | struct ds1621_data *data = ds1621_update_client(dev); | 
|  | 167 | return sprintf(buf, "%d\n", | 
|  | 168 | LM75_TEMP_FROM_REG(data->temp[attr->index])); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 169 | } | 
|  | 170 |  | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 171 | static ssize_t set_temp(struct device *dev, struct device_attribute *da, | 
|  | 172 | const char *buf, size_t count) | 
|  | 173 | { | 
|  | 174 | struct sensor_device_attribute *attr = to_sensor_dev_attr(da); | 
|  | 175 | struct i2c_client *client = to_i2c_client(dev); | 
| Jean Delvare | e4879e2 | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 176 | struct ds1621_data *data = i2c_get_clientdata(client); | 
| Christian Hohnstaedt | 5bfedac | 2007-08-16 11:40:10 +0200 | [diff] [blame] | 177 | u16 val = LM75_TEMP_TO_REG(simple_strtol(buf, NULL, 10)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 178 |  | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 179 | mutex_lock(&data->update_lock); | 
|  | 180 | data->temp[attr->index] = val; | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 181 | ds1621_write_temp(client, DS1621_REG_TEMP[attr->index], | 
|  | 182 | data->temp[attr->index]); | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 183 | mutex_unlock(&data->update_lock); | 
|  | 184 | return count; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | } | 
|  | 186 |  | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 187 | static ssize_t show_alarms(struct device *dev, struct device_attribute *da, | 
|  | 188 | char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 | { | 
|  | 190 | struct ds1621_data *data = ds1621_update_client(dev); | 
|  | 191 | return sprintf(buf, "%d\n", ALARMS_FROM_REG(data->conf)); | 
|  | 192 | } | 
|  | 193 |  | 
| Jean Delvare | 87f0f31 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 194 | static ssize_t show_alarm(struct device *dev, struct device_attribute *da, | 
|  | 195 | char *buf) | 
|  | 196 | { | 
|  | 197 | struct sensor_device_attribute *attr = to_sensor_dev_attr(da); | 
|  | 198 | struct ds1621_data *data = ds1621_update_client(dev); | 
|  | 199 | return sprintf(buf, "%d\n", !!(data->conf & attr->index)); | 
|  | 200 | } | 
|  | 201 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 203 | static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0); | 
|  | 204 | static SENSOR_DEVICE_ATTR(temp1_min, S_IWUSR | S_IRUGO, show_temp, set_temp, 1); | 
|  | 205 | static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp, set_temp, 2); | 
| Jean Delvare | 87f0f31 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 206 | static SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_alarm, NULL, | 
|  | 207 | DS1621_ALARM_TEMP_LOW); | 
|  | 208 | static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, | 
|  | 209 | DS1621_ALARM_TEMP_HIGH); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 210 |  | 
| Jean Delvare | a5ebe66 | 2006-09-24 21:24:46 +0200 | [diff] [blame] | 211 | static struct attribute *ds1621_attributes[] = { | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 212 | &sensor_dev_attr_temp1_input.dev_attr.attr, | 
|  | 213 | &sensor_dev_attr_temp1_min.dev_attr.attr, | 
|  | 214 | &sensor_dev_attr_temp1_max.dev_attr.attr, | 
| Jean Delvare | 87f0f31 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 215 | &sensor_dev_attr_temp1_min_alarm.dev_attr.attr, | 
|  | 216 | &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, | 
| Jean Delvare | a5ebe66 | 2006-09-24 21:24:46 +0200 | [diff] [blame] | 217 | &dev_attr_alarms.attr, | 
|  | 218 | NULL | 
|  | 219 | }; | 
|  | 220 |  | 
|  | 221 | static const struct attribute_group ds1621_group = { | 
|  | 222 | .attrs = ds1621_attributes, | 
|  | 223 | }; | 
|  | 224 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 225 |  | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 226 | /* Return 0 if detection is successful, -ENODEV otherwise */ | 
|  | 227 | static int ds1621_detect(struct i2c_client *client, int kind, | 
|  | 228 | struct i2c_board_info *info) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 | { | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 230 | struct i2c_adapter *adapter = client->adapter; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 231 | int conf, temp; | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 232 | int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 233 |  | 
|  | 234 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA | 
|  | 235 | | I2C_FUNC_SMBUS_WORD_DATA | 
|  | 236 | | I2C_FUNC_SMBUS_WRITE_BYTE)) | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 237 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 |  | 
|  | 239 | /* Now, we do the remaining detection. It is lousy. */ | 
|  | 240 | if (kind < 0) { | 
|  | 241 | /* The NVB bit should be low if no EEPROM write has been | 
|  | 242 | requested during the latest 10ms, which is highly | 
|  | 243 | improbable in our case. */ | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 244 | conf = i2c_smbus_read_byte_data(client, DS1621_REG_CONF); | 
|  | 245 | if (conf < 0 || conf & DS1621_REG_CONFIG_NVB) | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 246 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 247 | /* The 7 lowest bits of a temperature should always be 0. */ | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 248 | for (i = 0; i < ARRAY_SIZE(DS1621_REG_TEMP); i++) { | 
| Jean Delvare | 594592d | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 249 | temp = i2c_smbus_read_word_data(client, | 
|  | 250 | DS1621_REG_TEMP[i]); | 
|  | 251 | if (temp < 0 || (temp & 0x7f00)) | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 252 | return -ENODEV; | 
| Jean Delvare | 46a2e71 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 253 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 254 | } | 
|  | 255 |  | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 256 | strlcpy(info->type, "ds1621", I2C_NAME_SIZE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 257 |  | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 258 | return 0; | 
|  | 259 | } | 
|  | 260 |  | 
|  | 261 | static int ds1621_probe(struct i2c_client *client, | 
|  | 262 | const struct i2c_device_id *id) | 
|  | 263 | { | 
|  | 264 | struct ds1621_data *data; | 
|  | 265 | int err; | 
|  | 266 |  | 
|  | 267 | data = kzalloc(sizeof(struct ds1621_data), GFP_KERNEL); | 
|  | 268 | if (!data) { | 
|  | 269 | err = -ENOMEM; | 
|  | 270 | goto exit; | 
|  | 271 | } | 
|  | 272 |  | 
|  | 273 | i2c_set_clientdata(client, data); | 
|  | 274 | mutex_init(&data->update_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 275 |  | 
|  | 276 | /* Initialize the DS1621 chip */ | 
| Jean Delvare | 75819f0 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 277 | ds1621_init_client(client); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 278 |  | 
|  | 279 | /* Register sysfs hooks */ | 
| Jean Delvare | 75819f0 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 280 | if ((err = sysfs_create_group(&client->dev.kobj, &ds1621_group))) | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 281 | goto exit_free; | 
| Jean Delvare | a5ebe66 | 2006-09-24 21:24:46 +0200 | [diff] [blame] | 282 |  | 
| Tony Jones | 1beeffe | 2007-08-20 13:46:20 -0700 | [diff] [blame] | 283 | data->hwmon_dev = hwmon_device_register(&client->dev); | 
|  | 284 | if (IS_ERR(data->hwmon_dev)) { | 
|  | 285 | err = PTR_ERR(data->hwmon_dev); | 
| Jean Delvare | a5ebe66 | 2006-09-24 21:24:46 +0200 | [diff] [blame] | 286 | goto exit_remove_files; | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 287 | } | 
|  | 288 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 289 | return 0; | 
|  | 290 |  | 
| Jean Delvare | a5ebe66 | 2006-09-24 21:24:46 +0200 | [diff] [blame] | 291 | exit_remove_files: | 
| Jean Delvare | 75819f0 | 2007-06-09 10:11:15 -0400 | [diff] [blame] | 292 | sysfs_remove_group(&client->dev.kobj, &ds1621_group); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 293 | exit_free: | 
|  | 294 | kfree(data); | 
|  | 295 | exit: | 
|  | 296 | return err; | 
|  | 297 | } | 
|  | 298 |  | 
| Jean Delvare | 70313ea | 2008-07-16 19:30:11 +0200 | [diff] [blame] | 299 | static int ds1621_remove(struct i2c_client *client) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | { | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 301 | struct ds1621_data *data = i2c_get_clientdata(client); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 302 |  | 
| Tony Jones | 1beeffe | 2007-08-20 13:46:20 -0700 | [diff] [blame] | 303 | hwmon_device_unregister(data->hwmon_dev); | 
| Jean Delvare | a5ebe66 | 2006-09-24 21:24:46 +0200 | [diff] [blame] | 304 | sysfs_remove_group(&client->dev.kobj, &ds1621_group); | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 305 |  | 
| Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 306 | kfree(data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 307 |  | 
|  | 308 | return 0; | 
|  | 309 | } | 
|  | 310 |  | 
| Jean Delvare | 9202add | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 311 | static const struct i2c_device_id ds1621_id[] = { | 
|  | 312 | { "ds1621", ds1621 }, | 
|  | 313 | { "ds1625", ds1621 }, | 
|  | 314 | { } | 
|  | 315 | }; | 
|  | 316 | MODULE_DEVICE_TABLE(i2c, ds1621_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 317 |  | 
| Jean Delvare | 9202add | 2009-03-30 21:46:40 +0200 | [diff] [blame] | 318 | /* This is the driver that will be inserted */ | 
|  | 319 | static struct i2c_driver ds1621_driver = { | 
|  | 320 | .class		= I2C_CLASS_HWMON, | 
|  | 321 | .driver = { | 
|  | 322 | .name	= "ds1621", | 
|  | 323 | }, | 
|  | 324 | .probe		= ds1621_probe, | 
|  | 325 | .remove		= ds1621_remove, | 
|  | 326 | .id_table	= ds1621_id, | 
|  | 327 | .detect		= ds1621_detect, | 
|  | 328 | .address_data	= &addr_data, | 
|  | 329 | }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 |  | 
|  | 331 | static int __init ds1621_init(void) | 
|  | 332 | { | 
|  | 333 | return i2c_add_driver(&ds1621_driver); | 
|  | 334 | } | 
|  | 335 |  | 
|  | 336 | static void __exit ds1621_exit(void) | 
|  | 337 | { | 
|  | 338 | i2c_del_driver(&ds1621_driver); | 
|  | 339 | } | 
|  | 340 |  | 
|  | 341 |  | 
|  | 342 | MODULE_AUTHOR("Christian W. Zuckschwerdt <zany@triq.net>"); | 
|  | 343 | MODULE_DESCRIPTION("DS1621 driver"); | 
|  | 344 | MODULE_LICENSE("GPL"); | 
|  | 345 |  | 
|  | 346 | module_init(ds1621_init); | 
|  | 347 | module_exit(ds1621_exit); |