Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | adm1031.c - Part of lm_sensors, Linux kernel modules for hardware |
| 3 | monitoring |
| 4 | Based on lm75.c and lm85.c |
| 5 | Supports adm1030 / adm1031 |
| 6 | Copyright (C) 2004 Alexandre d'Alton <alex@alexdalton.org> |
| 7 | Reworked by 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> |
| 30 | #include <linux/err.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | |
| 32 | /* Following macros takes channel parameter starting from 0 to 2 */ |
| 33 | #define ADM1031_REG_FAN_SPEED(nr) (0x08 + (nr)) |
| 34 | #define ADM1031_REG_FAN_DIV(nr) (0x20 + (nr)) |
| 35 | #define ADM1031_REG_PWM (0x22) |
| 36 | #define ADM1031_REG_FAN_MIN(nr) (0x10 + (nr)) |
| 37 | |
| 38 | #define ADM1031_REG_TEMP_MAX(nr) (0x14 + 4*(nr)) |
| 39 | #define ADM1031_REG_TEMP_MIN(nr) (0x15 + 4*(nr)) |
| 40 | #define ADM1031_REG_TEMP_CRIT(nr) (0x16 + 4*(nr)) |
| 41 | |
| 42 | #define ADM1031_REG_TEMP(nr) (0xa + (nr)) |
| 43 | #define ADM1031_REG_AUTO_TEMP(nr) (0x24 + (nr)) |
| 44 | |
| 45 | #define ADM1031_REG_STATUS(nr) (0x2 + (nr)) |
| 46 | |
| 47 | #define ADM1031_REG_CONF1 0x0 |
| 48 | #define ADM1031_REG_CONF2 0x1 |
| 49 | #define ADM1031_REG_EXT_TEMP 0x6 |
| 50 | |
| 51 | #define ADM1031_CONF1_MONITOR_ENABLE 0x01 /* Monitoring enable */ |
| 52 | #define ADM1031_CONF1_PWM_INVERT 0x08 /* PWM Invert */ |
| 53 | #define ADM1031_CONF1_AUTO_MODE 0x80 /* Auto FAN */ |
| 54 | |
| 55 | #define ADM1031_CONF2_PWM1_ENABLE 0x01 |
| 56 | #define ADM1031_CONF2_PWM2_ENABLE 0x02 |
| 57 | #define ADM1031_CONF2_TACH1_ENABLE 0x04 |
| 58 | #define ADM1031_CONF2_TACH2_ENABLE 0x08 |
| 59 | #define ADM1031_CONF2_TEMP_ENABLE(chan) (0x10 << (chan)) |
| 60 | |
| 61 | /* Addresses to scan */ |
| 62 | static unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | |
| 64 | /* Insmod parameters */ |
Jean Delvare | f4b5026 | 2005-07-31 21:49:03 +0200 | [diff] [blame] | 65 | I2C_CLIENT_INSMOD_2(adm1030, adm1031); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 66 | |
| 67 | typedef u8 auto_chan_table_t[8][2]; |
| 68 | |
| 69 | /* Each client has this additional data */ |
| 70 | struct adm1031_data { |
| 71 | struct i2c_client client; |
Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 72 | struct class_device *class_dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | struct semaphore update_lock; |
| 74 | int chip_type; |
| 75 | char valid; /* !=0 if following fields are valid */ |
| 76 | unsigned long last_updated; /* In jiffies */ |
| 77 | /* The chan_select_table contains the possible configurations for |
| 78 | * auto fan control. |
| 79 | */ |
| 80 | auto_chan_table_t *chan_select_table; |
| 81 | u16 alarm; |
| 82 | u8 conf1; |
| 83 | u8 conf2; |
| 84 | u8 fan[2]; |
| 85 | u8 fan_div[2]; |
| 86 | u8 fan_min[2]; |
| 87 | u8 pwm[2]; |
| 88 | u8 old_pwm[2]; |
| 89 | s8 temp[3]; |
| 90 | u8 ext_temp[3]; |
| 91 | u8 auto_temp[3]; |
| 92 | u8 auto_temp_min[3]; |
| 93 | u8 auto_temp_off[3]; |
| 94 | u8 auto_temp_max[3]; |
| 95 | s8 temp_min[3]; |
| 96 | s8 temp_max[3]; |
| 97 | s8 temp_crit[3]; |
| 98 | }; |
| 99 | |
| 100 | static int adm1031_attach_adapter(struct i2c_adapter *adapter); |
| 101 | static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind); |
| 102 | static void adm1031_init_client(struct i2c_client *client); |
| 103 | static int adm1031_detach_client(struct i2c_client *client); |
| 104 | static struct adm1031_data *adm1031_update_device(struct device *dev); |
| 105 | |
| 106 | /* This is the driver that will be inserted */ |
| 107 | static struct i2c_driver adm1031_driver = { |
Laurent Riffard | cdaf793 | 2005-11-26 20:37:41 +0100 | [diff] [blame] | 108 | .driver = { |
Laurent Riffard | cdaf793 | 2005-11-26 20:37:41 +0100 | [diff] [blame] | 109 | .name = "adm1031", |
| 110 | }, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 111 | .attach_adapter = adm1031_attach_adapter, |
| 112 | .detach_client = adm1031_detach_client, |
| 113 | }; |
| 114 | |
| 115 | static inline u8 adm1031_read_value(struct i2c_client *client, u8 reg) |
| 116 | { |
| 117 | return i2c_smbus_read_byte_data(client, reg); |
| 118 | } |
| 119 | |
| 120 | static inline int |
| 121 | adm1031_write_value(struct i2c_client *client, u8 reg, unsigned int value) |
| 122 | { |
| 123 | return i2c_smbus_write_byte_data(client, reg, value); |
| 124 | } |
| 125 | |
| 126 | |
| 127 | #define TEMP_TO_REG(val) (((val) < 0 ? ((val - 500) / 1000) : \ |
| 128 | ((val + 500) / 1000))) |
| 129 | |
| 130 | #define TEMP_FROM_REG(val) ((val) * 1000) |
| 131 | |
| 132 | #define TEMP_FROM_REG_EXT(val, ext) (TEMP_FROM_REG(val) + (ext) * 125) |
| 133 | |
| 134 | #define FAN_FROM_REG(reg, div) ((reg) ? (11250 * 60) / ((reg) * (div)) : 0) |
| 135 | |
| 136 | static int FAN_TO_REG(int reg, int div) |
| 137 | { |
| 138 | int tmp; |
| 139 | tmp = FAN_FROM_REG(SENSORS_LIMIT(reg, 0, 65535), div); |
| 140 | return tmp > 255 ? 255 : tmp; |
| 141 | } |
| 142 | |
| 143 | #define FAN_DIV_FROM_REG(reg) (1<<(((reg)&0xc0)>>6)) |
| 144 | |
| 145 | #define PWM_TO_REG(val) (SENSORS_LIMIT((val), 0, 255) >> 4) |
| 146 | #define PWM_FROM_REG(val) ((val) << 4) |
| 147 | |
| 148 | #define FAN_CHAN_FROM_REG(reg) (((reg) >> 5) & 7) |
| 149 | #define FAN_CHAN_TO_REG(val, reg) \ |
| 150 | (((reg) & 0x1F) | (((val) << 5) & 0xe0)) |
| 151 | |
| 152 | #define AUTO_TEMP_MIN_TO_REG(val, reg) \ |
| 153 | ((((val)/500) & 0xf8)|((reg) & 0x7)) |
| 154 | #define AUTO_TEMP_RANGE_FROM_REG(reg) (5000 * (1<< ((reg)&0x7))) |
| 155 | #define AUTO_TEMP_MIN_FROM_REG(reg) (1000 * ((((reg) >> 3) & 0x1f) << 2)) |
| 156 | |
| 157 | #define AUTO_TEMP_MIN_FROM_REG_DEG(reg) ((((reg) >> 3) & 0x1f) << 2) |
| 158 | |
| 159 | #define AUTO_TEMP_OFF_FROM_REG(reg) \ |
| 160 | (AUTO_TEMP_MIN_FROM_REG(reg) - 5000) |
| 161 | |
| 162 | #define AUTO_TEMP_MAX_FROM_REG(reg) \ |
| 163 | (AUTO_TEMP_RANGE_FROM_REG(reg) + \ |
| 164 | AUTO_TEMP_MIN_FROM_REG(reg)) |
| 165 | |
| 166 | static int AUTO_TEMP_MAX_TO_REG(int val, int reg, int pwm) |
| 167 | { |
| 168 | int ret; |
| 169 | int range = val - AUTO_TEMP_MIN_FROM_REG(reg); |
| 170 | |
| 171 | range = ((val - AUTO_TEMP_MIN_FROM_REG(reg))*10)/(16 - pwm); |
| 172 | ret = ((reg & 0xf8) | |
| 173 | (range < 10000 ? 0 : |
| 174 | range < 20000 ? 1 : |
| 175 | range < 40000 ? 2 : range < 80000 ? 3 : 4)); |
| 176 | return ret; |
| 177 | } |
| 178 | |
| 179 | /* FAN auto control */ |
| 180 | #define GET_FAN_AUTO_BITFIELD(data, idx) \ |
| 181 | (*(data)->chan_select_table)[FAN_CHAN_FROM_REG((data)->conf1)][idx%2] |
| 182 | |
| 183 | /* The tables below contains the possible values for the auto fan |
| 184 | * control bitfields. the index in the table is the register value. |
| 185 | * MSb is the auto fan control enable bit, so the four first entries |
| 186 | * in the table disables auto fan control when both bitfields are zero. |
| 187 | */ |
| 188 | static auto_chan_table_t auto_channel_select_table_adm1031 = { |
| 189 | {0, 0}, {0, 0}, {0, 0}, {0, 0}, |
| 190 | {2 /*0b010 */ , 4 /*0b100 */ }, |
| 191 | {2 /*0b010 */ , 2 /*0b010 */ }, |
| 192 | {4 /*0b100 */ , 4 /*0b100 */ }, |
| 193 | {7 /*0b111 */ , 7 /*0b111 */ }, |
| 194 | }; |
| 195 | |
| 196 | static auto_chan_table_t auto_channel_select_table_adm1030 = { |
| 197 | {0, 0}, {0, 0}, {0, 0}, {0, 0}, |
| 198 | {2 /*0b10 */ , 0}, |
| 199 | {0xff /*invalid */ , 0}, |
| 200 | {0xff /*invalid */ , 0}, |
| 201 | {3 /*0b11 */ , 0}, |
| 202 | }; |
| 203 | |
| 204 | /* That function checks if a bitfield is valid and returns the other bitfield |
| 205 | * nearest match if no exact match where found. |
| 206 | */ |
| 207 | static int |
| 208 | get_fan_auto_nearest(struct adm1031_data *data, |
| 209 | int chan, u8 val, u8 reg, u8 * new_reg) |
| 210 | { |
| 211 | int i; |
| 212 | int first_match = -1, exact_match = -1; |
| 213 | u8 other_reg_val = |
| 214 | (*data->chan_select_table)[FAN_CHAN_FROM_REG(reg)][chan ? 0 : 1]; |
| 215 | |
| 216 | if (val == 0) { |
| 217 | *new_reg = 0; |
| 218 | return 0; |
| 219 | } |
| 220 | |
| 221 | for (i = 0; i < 8; i++) { |
| 222 | if ((val == (*data->chan_select_table)[i][chan]) && |
| 223 | ((*data->chan_select_table)[i][chan ? 0 : 1] == |
| 224 | other_reg_val)) { |
| 225 | /* We found an exact match */ |
| 226 | exact_match = i; |
| 227 | break; |
| 228 | } else if (val == (*data->chan_select_table)[i][chan] && |
| 229 | first_match == -1) { |
| 230 | /* Save the first match in case of an exact match has not been |
| 231 | * found |
| 232 | */ |
| 233 | first_match = i; |
| 234 | } |
| 235 | } |
| 236 | |
| 237 | if (exact_match >= 0) { |
| 238 | *new_reg = exact_match; |
| 239 | } else if (first_match >= 0) { |
| 240 | *new_reg = first_match; |
| 241 | } else { |
| 242 | return -EINVAL; |
| 243 | } |
| 244 | return 0; |
| 245 | } |
| 246 | |
| 247 | static ssize_t show_fan_auto_channel(struct device *dev, char *buf, int nr) |
| 248 | { |
| 249 | struct adm1031_data *data = adm1031_update_device(dev); |
| 250 | return sprintf(buf, "%d\n", GET_FAN_AUTO_BITFIELD(data, nr)); |
| 251 | } |
| 252 | |
| 253 | static ssize_t |
| 254 | set_fan_auto_channel(struct device *dev, const char *buf, size_t count, int nr) |
| 255 | { |
| 256 | struct i2c_client *client = to_i2c_client(dev); |
| 257 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 258 | int val = simple_strtol(buf, NULL, 10); |
| 259 | u8 reg; |
| 260 | int ret; |
| 261 | u8 old_fan_mode; |
| 262 | |
| 263 | old_fan_mode = data->conf1; |
| 264 | |
| 265 | down(&data->update_lock); |
| 266 | |
| 267 | if ((ret = get_fan_auto_nearest(data, nr, val, data->conf1, ®))) { |
| 268 | up(&data->update_lock); |
| 269 | return ret; |
| 270 | } |
| 271 | if (((data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1)) & ADM1031_CONF1_AUTO_MODE) ^ |
| 272 | (old_fan_mode & ADM1031_CONF1_AUTO_MODE)) { |
| 273 | if (data->conf1 & ADM1031_CONF1_AUTO_MODE){ |
| 274 | /* Switch to Auto Fan Mode |
| 275 | * Save PWM registers |
| 276 | * Set PWM registers to 33% Both */ |
| 277 | data->old_pwm[0] = data->pwm[0]; |
| 278 | data->old_pwm[1] = data->pwm[1]; |
| 279 | adm1031_write_value(client, ADM1031_REG_PWM, 0x55); |
| 280 | } else { |
| 281 | /* Switch to Manual Mode */ |
| 282 | data->pwm[0] = data->old_pwm[0]; |
| 283 | data->pwm[1] = data->old_pwm[1]; |
| 284 | /* Restore PWM registers */ |
| 285 | adm1031_write_value(client, ADM1031_REG_PWM, |
| 286 | data->pwm[0] | (data->pwm[1] << 4)); |
| 287 | } |
| 288 | } |
| 289 | data->conf1 = FAN_CHAN_TO_REG(reg, data->conf1); |
| 290 | adm1031_write_value(client, ADM1031_REG_CONF1, data->conf1); |
| 291 | up(&data->update_lock); |
| 292 | return count; |
| 293 | } |
| 294 | |
| 295 | #define fan_auto_channel_offset(offset) \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 296 | static ssize_t show_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 297 | { \ |
| 298 | return show_fan_auto_channel(dev, buf, offset - 1); \ |
| 299 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 300 | static ssize_t set_fan_auto_channel_##offset (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 | const char *buf, size_t count) \ |
| 302 | { \ |
| 303 | return set_fan_auto_channel(dev, buf, count, offset - 1); \ |
| 304 | } \ |
| 305 | static DEVICE_ATTR(auto_fan##offset##_channel, S_IRUGO | S_IWUSR, \ |
| 306 | show_fan_auto_channel_##offset, \ |
| 307 | set_fan_auto_channel_##offset) |
| 308 | |
| 309 | fan_auto_channel_offset(1); |
| 310 | fan_auto_channel_offset(2); |
| 311 | |
| 312 | /* Auto Temps */ |
| 313 | static ssize_t show_auto_temp_off(struct device *dev, char *buf, int nr) |
| 314 | { |
| 315 | struct adm1031_data *data = adm1031_update_device(dev); |
| 316 | return sprintf(buf, "%d\n", |
| 317 | AUTO_TEMP_OFF_FROM_REG(data->auto_temp[nr])); |
| 318 | } |
| 319 | static ssize_t show_auto_temp_min(struct device *dev, char *buf, int nr) |
| 320 | { |
| 321 | struct adm1031_data *data = adm1031_update_device(dev); |
| 322 | return sprintf(buf, "%d\n", |
| 323 | AUTO_TEMP_MIN_FROM_REG(data->auto_temp[nr])); |
| 324 | } |
| 325 | static ssize_t |
| 326 | set_auto_temp_min(struct device *dev, const char *buf, size_t count, int nr) |
| 327 | { |
| 328 | struct i2c_client *client = to_i2c_client(dev); |
| 329 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 330 | int val = simple_strtol(buf, NULL, 10); |
| 331 | |
| 332 | down(&data->update_lock); |
| 333 | data->auto_temp[nr] = AUTO_TEMP_MIN_TO_REG(val, data->auto_temp[nr]); |
| 334 | adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr), |
| 335 | data->auto_temp[nr]); |
| 336 | up(&data->update_lock); |
| 337 | return count; |
| 338 | } |
| 339 | static ssize_t show_auto_temp_max(struct device *dev, char *buf, int nr) |
| 340 | { |
| 341 | struct adm1031_data *data = adm1031_update_device(dev); |
| 342 | return sprintf(buf, "%d\n", |
| 343 | AUTO_TEMP_MAX_FROM_REG(data->auto_temp[nr])); |
| 344 | } |
| 345 | static ssize_t |
| 346 | set_auto_temp_max(struct device *dev, const char *buf, size_t count, int nr) |
| 347 | { |
| 348 | struct i2c_client *client = to_i2c_client(dev); |
| 349 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 350 | int val = simple_strtol(buf, NULL, 10); |
| 351 | |
| 352 | down(&data->update_lock); |
| 353 | data->temp_max[nr] = AUTO_TEMP_MAX_TO_REG(val, data->auto_temp[nr], data->pwm[nr]); |
| 354 | adm1031_write_value(client, ADM1031_REG_AUTO_TEMP(nr), |
| 355 | data->temp_max[nr]); |
| 356 | up(&data->update_lock); |
| 357 | return count; |
| 358 | } |
| 359 | |
| 360 | #define auto_temp_reg(offset) \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 361 | static ssize_t show_auto_temp_##offset##_off (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | { \ |
| 363 | return show_auto_temp_off(dev, buf, offset - 1); \ |
| 364 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 365 | static ssize_t show_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 366 | { \ |
| 367 | return show_auto_temp_min(dev, buf, offset - 1); \ |
| 368 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 369 | static ssize_t show_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | { \ |
| 371 | return show_auto_temp_max(dev, buf, offset - 1); \ |
| 372 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 373 | static ssize_t set_auto_temp_##offset##_min (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 374 | const char *buf, size_t count) \ |
| 375 | { \ |
| 376 | return set_auto_temp_min(dev, buf, count, offset - 1); \ |
| 377 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 378 | static ssize_t set_auto_temp_##offset##_max (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 379 | const char *buf, size_t count) \ |
| 380 | { \ |
| 381 | return set_auto_temp_max(dev, buf, count, offset - 1); \ |
| 382 | } \ |
| 383 | static DEVICE_ATTR(auto_temp##offset##_off, S_IRUGO, \ |
| 384 | show_auto_temp_##offset##_off, NULL); \ |
| 385 | static DEVICE_ATTR(auto_temp##offset##_min, S_IRUGO | S_IWUSR, \ |
| 386 | show_auto_temp_##offset##_min, set_auto_temp_##offset##_min);\ |
| 387 | static DEVICE_ATTR(auto_temp##offset##_max, S_IRUGO | S_IWUSR, \ |
| 388 | show_auto_temp_##offset##_max, set_auto_temp_##offset##_max) |
| 389 | |
| 390 | auto_temp_reg(1); |
| 391 | auto_temp_reg(2); |
| 392 | auto_temp_reg(3); |
| 393 | |
| 394 | /* pwm */ |
| 395 | static ssize_t show_pwm(struct device *dev, char *buf, int nr) |
| 396 | { |
| 397 | struct adm1031_data *data = adm1031_update_device(dev); |
| 398 | return sprintf(buf, "%d\n", PWM_FROM_REG(data->pwm[nr])); |
| 399 | } |
| 400 | static ssize_t |
| 401 | set_pwm(struct device *dev, const char *buf, size_t count, int nr) |
| 402 | { |
| 403 | struct i2c_client *client = to_i2c_client(dev); |
| 404 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 405 | int val = simple_strtol(buf, NULL, 10); |
| 406 | int reg; |
| 407 | |
| 408 | down(&data->update_lock); |
| 409 | if ((data->conf1 & ADM1031_CONF1_AUTO_MODE) && |
| 410 | (((val>>4) & 0xf) != 5)) { |
| 411 | /* In automatic mode, the only PWM accepted is 33% */ |
| 412 | up(&data->update_lock); |
| 413 | return -EINVAL; |
| 414 | } |
| 415 | data->pwm[nr] = PWM_TO_REG(val); |
| 416 | reg = adm1031_read_value(client, ADM1031_REG_PWM); |
| 417 | adm1031_write_value(client, ADM1031_REG_PWM, |
| 418 | nr ? ((data->pwm[nr] << 4) & 0xf0) | (reg & 0xf) |
| 419 | : (data->pwm[nr] & 0xf) | (reg & 0xf0)); |
| 420 | up(&data->update_lock); |
| 421 | return count; |
| 422 | } |
| 423 | |
| 424 | #define pwm_reg(offset) \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 425 | static ssize_t show_pwm_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 426 | { \ |
| 427 | return show_pwm(dev, buf, offset - 1); \ |
| 428 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 429 | static ssize_t set_pwm_##offset (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 430 | const char *buf, size_t count) \ |
| 431 | { \ |
| 432 | return set_pwm(dev, buf, count, offset - 1); \ |
| 433 | } \ |
| 434 | static DEVICE_ATTR(pwm##offset, S_IRUGO | S_IWUSR, \ |
| 435 | show_pwm_##offset, set_pwm_##offset) |
| 436 | |
| 437 | pwm_reg(1); |
| 438 | pwm_reg(2); |
| 439 | |
| 440 | /* Fans */ |
| 441 | |
| 442 | /* |
| 443 | * That function checks the cases where the fan reading is not |
Steven Cole | 44bbe87 | 2005-05-03 18:21:25 -0600 | [diff] [blame] | 444 | * relevant. It is used to provide 0 as fan reading when the fan is |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 445 | * not supposed to run |
| 446 | */ |
| 447 | static int trust_fan_readings(struct adm1031_data *data, int chan) |
| 448 | { |
| 449 | int res = 0; |
| 450 | |
| 451 | if (data->conf1 & ADM1031_CONF1_AUTO_MODE) { |
| 452 | switch (data->conf1 & 0x60) { |
| 453 | case 0x00: /* remote temp1 controls fan1 remote temp2 controls fan2 */ |
| 454 | res = data->temp[chan+1] >= |
| 455 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[chan+1]); |
| 456 | break; |
| 457 | case 0x20: /* remote temp1 controls both fans */ |
| 458 | res = |
| 459 | data->temp[1] >= |
| 460 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]); |
| 461 | break; |
| 462 | case 0x40: /* remote temp2 controls both fans */ |
| 463 | res = |
| 464 | data->temp[2] >= |
| 465 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2]); |
| 466 | break; |
| 467 | case 0x60: /* max controls both fans */ |
| 468 | res = |
| 469 | data->temp[0] >= |
| 470 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[0]) |
| 471 | || data->temp[1] >= |
| 472 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[1]) |
| 473 | || (data->chip_type == adm1031 |
| 474 | && data->temp[2] >= |
| 475 | AUTO_TEMP_MIN_FROM_REG_DEG(data->auto_temp[2])); |
| 476 | break; |
| 477 | } |
| 478 | } else { |
| 479 | res = data->pwm[chan] > 0; |
| 480 | } |
| 481 | return res; |
| 482 | } |
| 483 | |
| 484 | |
| 485 | static ssize_t show_fan(struct device *dev, char *buf, int nr) |
| 486 | { |
| 487 | struct adm1031_data *data = adm1031_update_device(dev); |
| 488 | int value; |
| 489 | |
| 490 | value = trust_fan_readings(data, nr) ? FAN_FROM_REG(data->fan[nr], |
| 491 | FAN_DIV_FROM_REG(data->fan_div[nr])) : 0; |
| 492 | return sprintf(buf, "%d\n", value); |
| 493 | } |
| 494 | |
| 495 | static ssize_t show_fan_div(struct device *dev, char *buf, int nr) |
| 496 | { |
| 497 | struct adm1031_data *data = adm1031_update_device(dev); |
| 498 | return sprintf(buf, "%d\n", FAN_DIV_FROM_REG(data->fan_div[nr])); |
| 499 | } |
| 500 | static ssize_t show_fan_min(struct device *dev, char *buf, int nr) |
| 501 | { |
| 502 | struct adm1031_data *data = adm1031_update_device(dev); |
| 503 | return sprintf(buf, "%d\n", |
| 504 | FAN_FROM_REG(data->fan_min[nr], |
| 505 | FAN_DIV_FROM_REG(data->fan_div[nr]))); |
| 506 | } |
| 507 | static ssize_t |
| 508 | set_fan_min(struct device *dev, const char *buf, size_t count, int nr) |
| 509 | { |
| 510 | struct i2c_client *client = to_i2c_client(dev); |
| 511 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 512 | int val = simple_strtol(buf, NULL, 10); |
| 513 | |
| 514 | down(&data->update_lock); |
| 515 | if (val) { |
| 516 | data->fan_min[nr] = |
| 517 | FAN_TO_REG(val, FAN_DIV_FROM_REG(data->fan_div[nr])); |
| 518 | } else { |
| 519 | data->fan_min[nr] = 0xff; |
| 520 | } |
| 521 | adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), data->fan_min[nr]); |
| 522 | up(&data->update_lock); |
| 523 | return count; |
| 524 | } |
| 525 | static ssize_t |
| 526 | set_fan_div(struct device *dev, const char *buf, size_t count, int nr) |
| 527 | { |
| 528 | struct i2c_client *client = to_i2c_client(dev); |
| 529 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 530 | int val = simple_strtol(buf, NULL, 10); |
| 531 | u8 tmp; |
| 532 | int old_div; |
| 533 | int new_min; |
| 534 | |
| 535 | tmp = val == 8 ? 0xc0 : |
| 536 | val == 4 ? 0x80 : |
| 537 | val == 2 ? 0x40 : |
| 538 | val == 1 ? 0x00 : |
| 539 | 0xff; |
| 540 | if (tmp == 0xff) |
| 541 | return -EINVAL; |
| 542 | |
| 543 | down(&data->update_lock); |
| 544 | old_div = FAN_DIV_FROM_REG(data->fan_div[nr]); |
| 545 | data->fan_div[nr] = (tmp & 0xC0) | (0x3f & data->fan_div[nr]); |
| 546 | new_min = data->fan_min[nr] * old_div / |
| 547 | FAN_DIV_FROM_REG(data->fan_div[nr]); |
| 548 | data->fan_min[nr] = new_min > 0xff ? 0xff : new_min; |
| 549 | data->fan[nr] = data->fan[nr] * old_div / |
| 550 | FAN_DIV_FROM_REG(data->fan_div[nr]); |
| 551 | |
| 552 | adm1031_write_value(client, ADM1031_REG_FAN_DIV(nr), |
| 553 | data->fan_div[nr]); |
| 554 | adm1031_write_value(client, ADM1031_REG_FAN_MIN(nr), |
| 555 | data->fan_min[nr]); |
| 556 | up(&data->update_lock); |
| 557 | return count; |
| 558 | } |
| 559 | |
| 560 | #define fan_offset(offset) \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 561 | static ssize_t show_fan_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 562 | { \ |
| 563 | return show_fan(dev, buf, offset - 1); \ |
| 564 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 565 | static ssize_t show_fan_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 566 | { \ |
| 567 | return show_fan_min(dev, buf, offset - 1); \ |
| 568 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 569 | static ssize_t show_fan_##offset##_div (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 570 | { \ |
| 571 | return show_fan_div(dev, buf, offset - 1); \ |
| 572 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 573 | static ssize_t set_fan_##offset##_min (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 574 | const char *buf, size_t count) \ |
| 575 | { \ |
| 576 | return set_fan_min(dev, buf, count, offset - 1); \ |
| 577 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 578 | static ssize_t set_fan_##offset##_div (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 579 | const char *buf, size_t count) \ |
| 580 | { \ |
| 581 | return set_fan_div(dev, buf, count, offset - 1); \ |
| 582 | } \ |
| 583 | static DEVICE_ATTR(fan##offset##_input, S_IRUGO, show_fan_##offset, \ |
| 584 | NULL); \ |
| 585 | static DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR, \ |
| 586 | show_fan_##offset##_min, set_fan_##offset##_min); \ |
| 587 | static DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR, \ |
| 588 | show_fan_##offset##_div, set_fan_##offset##_div); \ |
| 589 | static DEVICE_ATTR(auto_fan##offset##_min_pwm, S_IRUGO | S_IWUSR, \ |
| 590 | show_pwm_##offset, set_pwm_##offset) |
| 591 | |
| 592 | fan_offset(1); |
| 593 | fan_offset(2); |
| 594 | |
| 595 | |
| 596 | /* Temps */ |
| 597 | static ssize_t show_temp(struct device *dev, char *buf, int nr) |
| 598 | { |
| 599 | struct adm1031_data *data = adm1031_update_device(dev); |
| 600 | int ext; |
| 601 | ext = nr == 0 ? |
| 602 | ((data->ext_temp[nr] >> 6) & 0x3) * 2 : |
| 603 | (((data->ext_temp[nr] >> ((nr - 1) * 3)) & 7)); |
| 604 | return sprintf(buf, "%d\n", TEMP_FROM_REG_EXT(data->temp[nr], ext)); |
| 605 | } |
| 606 | static ssize_t show_temp_min(struct device *dev, char *buf, int nr) |
| 607 | { |
| 608 | struct adm1031_data *data = adm1031_update_device(dev); |
| 609 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_min[nr])); |
| 610 | } |
| 611 | static ssize_t show_temp_max(struct device *dev, char *buf, int nr) |
| 612 | { |
| 613 | struct adm1031_data *data = adm1031_update_device(dev); |
| 614 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[nr])); |
| 615 | } |
| 616 | static ssize_t show_temp_crit(struct device *dev, char *buf, int nr) |
| 617 | { |
| 618 | struct adm1031_data *data = adm1031_update_device(dev); |
| 619 | return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_crit[nr])); |
| 620 | } |
| 621 | static ssize_t |
| 622 | set_temp_min(struct device *dev, const char *buf, size_t count, int nr) |
| 623 | { |
| 624 | struct i2c_client *client = to_i2c_client(dev); |
| 625 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 626 | int val; |
| 627 | |
| 628 | val = simple_strtol(buf, NULL, 10); |
| 629 | val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875); |
| 630 | down(&data->update_lock); |
| 631 | data->temp_min[nr] = TEMP_TO_REG(val); |
| 632 | adm1031_write_value(client, ADM1031_REG_TEMP_MIN(nr), |
| 633 | data->temp_min[nr]); |
| 634 | up(&data->update_lock); |
| 635 | return count; |
| 636 | } |
| 637 | static ssize_t |
| 638 | set_temp_max(struct device *dev, const char *buf, size_t count, int nr) |
| 639 | { |
| 640 | struct i2c_client *client = to_i2c_client(dev); |
| 641 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 642 | int val; |
| 643 | |
| 644 | val = simple_strtol(buf, NULL, 10); |
| 645 | val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875); |
| 646 | down(&data->update_lock); |
| 647 | data->temp_max[nr] = TEMP_TO_REG(val); |
| 648 | adm1031_write_value(client, ADM1031_REG_TEMP_MAX(nr), |
| 649 | data->temp_max[nr]); |
| 650 | up(&data->update_lock); |
| 651 | return count; |
| 652 | } |
| 653 | static ssize_t |
| 654 | set_temp_crit(struct device *dev, const char *buf, size_t count, int nr) |
| 655 | { |
| 656 | struct i2c_client *client = to_i2c_client(dev); |
| 657 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 658 | int val; |
| 659 | |
| 660 | val = simple_strtol(buf, NULL, 10); |
| 661 | val = SENSORS_LIMIT(val, -55000, nr == 0 ? 127750 : 127875); |
| 662 | down(&data->update_lock); |
| 663 | data->temp_crit[nr] = TEMP_TO_REG(val); |
| 664 | adm1031_write_value(client, ADM1031_REG_TEMP_CRIT(nr), |
| 665 | data->temp_crit[nr]); |
| 666 | up(&data->update_lock); |
| 667 | return count; |
| 668 | } |
| 669 | |
| 670 | #define temp_reg(offset) \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 671 | static ssize_t show_temp_##offset (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 672 | { \ |
| 673 | return show_temp(dev, buf, offset - 1); \ |
| 674 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 675 | static ssize_t show_temp_##offset##_min (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 676 | { \ |
| 677 | return show_temp_min(dev, buf, offset - 1); \ |
| 678 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 679 | static ssize_t show_temp_##offset##_max (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 680 | { \ |
| 681 | return show_temp_max(dev, buf, offset - 1); \ |
| 682 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 683 | static ssize_t show_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, char *buf) \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 684 | { \ |
| 685 | return show_temp_crit(dev, buf, offset - 1); \ |
| 686 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 687 | static ssize_t set_temp_##offset##_min (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 688 | const char *buf, size_t count) \ |
| 689 | { \ |
| 690 | return set_temp_min(dev, buf, count, offset - 1); \ |
| 691 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 692 | static ssize_t set_temp_##offset##_max (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 693 | const char *buf, size_t count) \ |
| 694 | { \ |
| 695 | return set_temp_max(dev, buf, count, offset - 1); \ |
| 696 | } \ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 697 | static ssize_t set_temp_##offset##_crit (struct device *dev, struct device_attribute *attr, \ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 698 | const char *buf, size_t count) \ |
| 699 | { \ |
| 700 | return set_temp_crit(dev, buf, count, offset - 1); \ |
| 701 | } \ |
| 702 | static DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp_##offset, \ |
| 703 | NULL); \ |
| 704 | static DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \ |
| 705 | show_temp_##offset##_min, set_temp_##offset##_min); \ |
| 706 | static DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \ |
| 707 | show_temp_##offset##_max, set_temp_##offset##_max); \ |
| 708 | static DEVICE_ATTR(temp##offset##_crit, S_IRUGO | S_IWUSR, \ |
| 709 | show_temp_##offset##_crit, set_temp_##offset##_crit) |
| 710 | |
| 711 | temp_reg(1); |
| 712 | temp_reg(2); |
| 713 | temp_reg(3); |
| 714 | |
| 715 | /* Alarms */ |
Yani Ioannou | 30f7429 | 2005-05-17 06:41:35 -0400 | [diff] [blame] | 716 | static ssize_t show_alarms(struct device *dev, struct device_attribute *attr, char *buf) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 717 | { |
| 718 | struct adm1031_data *data = adm1031_update_device(dev); |
| 719 | return sprintf(buf, "%d\n", data->alarm); |
| 720 | } |
| 721 | |
| 722 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); |
| 723 | |
| 724 | |
| 725 | static int adm1031_attach_adapter(struct i2c_adapter *adapter) |
| 726 | { |
| 727 | if (!(adapter->class & I2C_CLASS_HWMON)) |
| 728 | return 0; |
Jean Delvare | 2ed2dc3 | 2005-07-31 21:42:02 +0200 | [diff] [blame] | 729 | return i2c_probe(adapter, &addr_data, adm1031_detect); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 730 | } |
| 731 | |
Jean Delvare | 2ed2dc3 | 2005-07-31 21:42:02 +0200 | [diff] [blame] | 732 | /* This function is called by i2c_probe */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 733 | static int adm1031_detect(struct i2c_adapter *adapter, int address, int kind) |
| 734 | { |
| 735 | struct i2c_client *new_client; |
| 736 | struct adm1031_data *data; |
| 737 | int err = 0; |
| 738 | const char *name = ""; |
| 739 | |
| 740 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) |
| 741 | goto exit; |
| 742 | |
Deepak Saxena | ba9c2e8 | 2005-10-17 23:08:32 +0200 | [diff] [blame] | 743 | if (!(data = kzalloc(sizeof(struct adm1031_data), GFP_KERNEL))) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 744 | err = -ENOMEM; |
| 745 | goto exit; |
| 746 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 747 | |
| 748 | new_client = &data->client; |
| 749 | i2c_set_clientdata(new_client, data); |
| 750 | new_client->addr = address; |
| 751 | new_client->adapter = adapter; |
| 752 | new_client->driver = &adm1031_driver; |
| 753 | new_client->flags = 0; |
| 754 | |
| 755 | if (kind < 0) { |
| 756 | int id, co; |
| 757 | id = i2c_smbus_read_byte_data(new_client, 0x3d); |
| 758 | co = i2c_smbus_read_byte_data(new_client, 0x3e); |
| 759 | |
| 760 | if (!((id == 0x31 || id == 0x30) && co == 0x41)) |
| 761 | goto exit_free; |
| 762 | kind = (id == 0x30) ? adm1030 : adm1031; |
| 763 | } |
| 764 | |
| 765 | if (kind <= 0) |
| 766 | kind = adm1031; |
| 767 | |
| 768 | /* Given the detected chip type, set the chip name and the |
| 769 | * auto fan control helper table. */ |
| 770 | if (kind == adm1030) { |
| 771 | name = "adm1030"; |
| 772 | data->chan_select_table = &auto_channel_select_table_adm1030; |
| 773 | } else if (kind == adm1031) { |
| 774 | name = "adm1031"; |
| 775 | data->chan_select_table = &auto_channel_select_table_adm1031; |
| 776 | } |
| 777 | data->chip_type = kind; |
| 778 | |
| 779 | strlcpy(new_client->name, name, I2C_NAME_SIZE); |
| 780 | data->valid = 0; |
| 781 | init_MUTEX(&data->update_lock); |
| 782 | |
| 783 | /* Tell the I2C layer a new client has arrived */ |
| 784 | if ((err = i2c_attach_client(new_client))) |
| 785 | goto exit_free; |
| 786 | |
| 787 | /* Initialize the ADM1031 chip */ |
| 788 | adm1031_init_client(new_client); |
| 789 | |
| 790 | /* Register sysfs hooks */ |
Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 791 | data->class_dev = hwmon_device_register(&new_client->dev); |
| 792 | if (IS_ERR(data->class_dev)) { |
| 793 | err = PTR_ERR(data->class_dev); |
| 794 | goto exit_detach; |
| 795 | } |
| 796 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 797 | device_create_file(&new_client->dev, &dev_attr_fan1_input); |
| 798 | device_create_file(&new_client->dev, &dev_attr_fan1_div); |
| 799 | device_create_file(&new_client->dev, &dev_attr_fan1_min); |
| 800 | device_create_file(&new_client->dev, &dev_attr_pwm1); |
| 801 | device_create_file(&new_client->dev, &dev_attr_auto_fan1_channel); |
| 802 | device_create_file(&new_client->dev, &dev_attr_temp1_input); |
| 803 | device_create_file(&new_client->dev, &dev_attr_temp1_min); |
| 804 | device_create_file(&new_client->dev, &dev_attr_temp1_max); |
| 805 | device_create_file(&new_client->dev, &dev_attr_temp1_crit); |
| 806 | device_create_file(&new_client->dev, &dev_attr_temp2_input); |
| 807 | device_create_file(&new_client->dev, &dev_attr_temp2_min); |
| 808 | device_create_file(&new_client->dev, &dev_attr_temp2_max); |
| 809 | device_create_file(&new_client->dev, &dev_attr_temp2_crit); |
| 810 | |
| 811 | device_create_file(&new_client->dev, &dev_attr_auto_temp1_off); |
| 812 | device_create_file(&new_client->dev, &dev_attr_auto_temp1_min); |
| 813 | device_create_file(&new_client->dev, &dev_attr_auto_temp1_max); |
| 814 | |
| 815 | device_create_file(&new_client->dev, &dev_attr_auto_temp2_off); |
| 816 | device_create_file(&new_client->dev, &dev_attr_auto_temp2_min); |
| 817 | device_create_file(&new_client->dev, &dev_attr_auto_temp2_max); |
| 818 | |
| 819 | device_create_file(&new_client->dev, &dev_attr_auto_fan1_min_pwm); |
| 820 | |
| 821 | device_create_file(&new_client->dev, &dev_attr_alarms); |
| 822 | |
| 823 | if (kind == adm1031) { |
| 824 | device_create_file(&new_client->dev, &dev_attr_fan2_input); |
| 825 | device_create_file(&new_client->dev, &dev_attr_fan2_div); |
| 826 | device_create_file(&new_client->dev, &dev_attr_fan2_min); |
| 827 | device_create_file(&new_client->dev, &dev_attr_pwm2); |
| 828 | device_create_file(&new_client->dev, |
| 829 | &dev_attr_auto_fan2_channel); |
| 830 | device_create_file(&new_client->dev, &dev_attr_temp3_input); |
| 831 | device_create_file(&new_client->dev, &dev_attr_temp3_min); |
| 832 | device_create_file(&new_client->dev, &dev_attr_temp3_max); |
| 833 | device_create_file(&new_client->dev, &dev_attr_temp3_crit); |
| 834 | device_create_file(&new_client->dev, &dev_attr_auto_temp3_off); |
| 835 | device_create_file(&new_client->dev, &dev_attr_auto_temp3_min); |
| 836 | device_create_file(&new_client->dev, &dev_attr_auto_temp3_max); |
| 837 | device_create_file(&new_client->dev, &dev_attr_auto_fan2_min_pwm); |
| 838 | } |
| 839 | |
| 840 | return 0; |
| 841 | |
Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 842 | exit_detach: |
| 843 | i2c_detach_client(new_client); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 | exit_free: |
Alexey Dobriyan | 1f57ff8 | 2005-08-26 01:49:14 +0400 | [diff] [blame] | 845 | kfree(data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 846 | exit: |
| 847 | return err; |
| 848 | } |
| 849 | |
| 850 | static int adm1031_detach_client(struct i2c_client *client) |
| 851 | { |
Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 852 | struct adm1031_data *data = i2c_get_clientdata(client); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 853 | int ret; |
Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 854 | |
| 855 | hwmon_device_unregister(data->class_dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 856 | if ((ret = i2c_detach_client(client)) != 0) { |
| 857 | return ret; |
| 858 | } |
Mark M. Hoffman | 943b083 | 2005-07-15 21:39:18 -0400 | [diff] [blame] | 859 | kfree(data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 860 | return 0; |
| 861 | } |
| 862 | |
| 863 | static void adm1031_init_client(struct i2c_client *client) |
| 864 | { |
| 865 | unsigned int read_val; |
| 866 | unsigned int mask; |
| 867 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 868 | |
| 869 | mask = (ADM1031_CONF2_PWM1_ENABLE | ADM1031_CONF2_TACH1_ENABLE); |
| 870 | if (data->chip_type == adm1031) { |
| 871 | mask |= (ADM1031_CONF2_PWM2_ENABLE | |
| 872 | ADM1031_CONF2_TACH2_ENABLE); |
| 873 | } |
| 874 | /* Initialize the ADM1031 chip (enables fan speed reading ) */ |
| 875 | read_val = adm1031_read_value(client, ADM1031_REG_CONF2); |
| 876 | if ((read_val | mask) != read_val) { |
| 877 | adm1031_write_value(client, ADM1031_REG_CONF2, read_val | mask); |
| 878 | } |
| 879 | |
| 880 | read_val = adm1031_read_value(client, ADM1031_REG_CONF1); |
| 881 | if ((read_val | ADM1031_CONF1_MONITOR_ENABLE) != read_val) { |
| 882 | adm1031_write_value(client, ADM1031_REG_CONF1, read_val | |
| 883 | ADM1031_CONF1_MONITOR_ENABLE); |
| 884 | } |
| 885 | |
| 886 | } |
| 887 | |
| 888 | static struct adm1031_data *adm1031_update_device(struct device *dev) |
| 889 | { |
| 890 | struct i2c_client *client = to_i2c_client(dev); |
| 891 | struct adm1031_data *data = i2c_get_clientdata(client); |
| 892 | int chan; |
| 893 | |
| 894 | down(&data->update_lock); |
| 895 | |
| 896 | if (time_after(jiffies, data->last_updated + HZ + HZ / 2) |
| 897 | || !data->valid) { |
| 898 | |
| 899 | dev_dbg(&client->dev, "Starting adm1031 update\n"); |
| 900 | for (chan = 0; |
| 901 | chan < ((data->chip_type == adm1031) ? 3 : 2); chan++) { |
| 902 | u8 oldh, newh; |
| 903 | |
| 904 | oldh = |
| 905 | adm1031_read_value(client, ADM1031_REG_TEMP(chan)); |
| 906 | data->ext_temp[chan] = |
| 907 | adm1031_read_value(client, ADM1031_REG_EXT_TEMP); |
| 908 | newh = |
| 909 | adm1031_read_value(client, ADM1031_REG_TEMP(chan)); |
| 910 | if (newh != oldh) { |
| 911 | data->ext_temp[chan] = |
| 912 | adm1031_read_value(client, |
| 913 | ADM1031_REG_EXT_TEMP); |
| 914 | #ifdef DEBUG |
| 915 | oldh = |
| 916 | adm1031_read_value(client, |
| 917 | ADM1031_REG_TEMP(chan)); |
| 918 | |
| 919 | /* oldh is actually newer */ |
| 920 | if (newh != oldh) |
| 921 | dev_warn(&client->dev, |
| 922 | "Remote temperature may be " |
| 923 | "wrong.\n"); |
| 924 | #endif |
| 925 | } |
| 926 | data->temp[chan] = newh; |
| 927 | |
| 928 | data->temp_min[chan] = |
| 929 | adm1031_read_value(client, |
| 930 | ADM1031_REG_TEMP_MIN(chan)); |
| 931 | data->temp_max[chan] = |
| 932 | adm1031_read_value(client, |
| 933 | ADM1031_REG_TEMP_MAX(chan)); |
| 934 | data->temp_crit[chan] = |
| 935 | adm1031_read_value(client, |
| 936 | ADM1031_REG_TEMP_CRIT(chan)); |
| 937 | data->auto_temp[chan] = |
| 938 | adm1031_read_value(client, |
| 939 | ADM1031_REG_AUTO_TEMP(chan)); |
| 940 | |
| 941 | } |
| 942 | |
| 943 | data->conf1 = adm1031_read_value(client, ADM1031_REG_CONF1); |
| 944 | data->conf2 = adm1031_read_value(client, ADM1031_REG_CONF2); |
| 945 | |
| 946 | data->alarm = adm1031_read_value(client, ADM1031_REG_STATUS(0)) |
| 947 | | (adm1031_read_value(client, ADM1031_REG_STATUS(1)) |
| 948 | << 8); |
| 949 | if (data->chip_type == adm1030) { |
| 950 | data->alarm &= 0xc0ff; |
| 951 | } |
| 952 | |
| 953 | for (chan=0; chan<(data->chip_type == adm1030 ? 1 : 2); chan++) { |
| 954 | data->fan_div[chan] = |
| 955 | adm1031_read_value(client, ADM1031_REG_FAN_DIV(chan)); |
| 956 | data->fan_min[chan] = |
| 957 | adm1031_read_value(client, ADM1031_REG_FAN_MIN(chan)); |
| 958 | data->fan[chan] = |
| 959 | adm1031_read_value(client, ADM1031_REG_FAN_SPEED(chan)); |
| 960 | data->pwm[chan] = |
| 961 | 0xf & (adm1031_read_value(client, ADM1031_REG_PWM) >> |
| 962 | (4*chan)); |
| 963 | } |
| 964 | data->last_updated = jiffies; |
| 965 | data->valid = 1; |
| 966 | } |
| 967 | |
| 968 | up(&data->update_lock); |
| 969 | |
| 970 | return data; |
| 971 | } |
| 972 | |
| 973 | static int __init sensors_adm1031_init(void) |
| 974 | { |
| 975 | return i2c_add_driver(&adm1031_driver); |
| 976 | } |
| 977 | |
| 978 | static void __exit sensors_adm1031_exit(void) |
| 979 | { |
| 980 | i2c_del_driver(&adm1031_driver); |
| 981 | } |
| 982 | |
| 983 | MODULE_AUTHOR("Alexandre d'Alton <alex@alexdalton.org>"); |
| 984 | MODULE_DESCRIPTION("ADM1031/ADM1030 driver"); |
| 985 | MODULE_LICENSE("GPL"); |
| 986 | |
| 987 | module_init(sensors_adm1031_init); |
| 988 | module_exit(sensors_adm1031_exit); |