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