0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015 #include <linux/kernel.h>
0016 #include <linux/module.h>
0017 #include <linux/init.h>
0018 #include <linux/slab.h>
0019 #include <linux/i2c.h>
0020 #include <linux/hwmon.h>
0021 #include <linux/hwmon-sysfs.h>
0022 #include <linux/err.h>
0023 #include <linux/mutex.h>
0024 #include <linux/jiffies.h>
0025 #include <linux/util_macros.h>
0026
0027
0028 static const unsigned short normal_i2c[] = {
0029 0x2c, 0x2d, 0x2e, 0x2f, I2C_CLIENT_END
0030 };
0031
0032
0033 static bool reset;
0034 module_param(reset, bool, 0);
0035 MODULE_PARM_DESC(reset, "Set to 1 to reset chip, not recommended");
0036
0037
0038 #define W83795_REG_BANKSEL 0x00
0039 #define W83795_REG_VENDORID 0xfd
0040 #define W83795_REG_CHIPID 0xfe
0041 #define W83795_REG_DEVICEID 0xfb
0042 #define W83795_REG_DEVICEID_A 0xff
0043
0044 #define W83795_REG_I2C_ADDR 0xfc
0045 #define W83795_REG_CONFIG 0x01
0046 #define W83795_REG_CONFIG_CONFIG48 0x04
0047 #define W83795_REG_CONFIG_START 0x01
0048
0049
0050 #define W83795_REG_VOLT_CTRL1 0x02
0051 #define W83795_REG_VOLT_CTRL2 0x03
0052 #define W83795_REG_TEMP_CTRL1 0x04
0053 #define W83795_REG_TEMP_CTRL2 0x05
0054 #define W83795_REG_FANIN_CTRL1 0x06
0055 #define W83795_REG_FANIN_CTRL2 0x07
0056 #define W83795_REG_VMIGB_CTRL 0x08
0057
0058 #define TEMP_READ 0
0059 #define TEMP_CRIT 1
0060 #define TEMP_CRIT_HYST 2
0061 #define TEMP_WARN 3
0062 #define TEMP_WARN_HYST 4
0063
0064
0065
0066
0067 static const u16 W83795_REG_TEMP[][5] = {
0068 {0x21, 0x96, 0x97, 0x98, 0x99},
0069 {0x22, 0x9a, 0x9b, 0x9c, 0x9d},
0070 {0x23, 0x9e, 0x9f, 0xa0, 0xa1},
0071 {0x24, 0xa2, 0xa3, 0xa4, 0xa5},
0072 {0x1f, 0xa6, 0xa7, 0xa8, 0xa9},
0073 {0x20, 0xaa, 0xab, 0xac, 0xad},
0074 };
0075
0076 #define IN_READ 0
0077 #define IN_MAX 1
0078 #define IN_LOW 2
0079 static const u16 W83795_REG_IN[][3] = {
0080
0081 {0x10, 0x70, 0x71},
0082 {0x11, 0x72, 0x73},
0083 {0x12, 0x74, 0x75},
0084 {0x13, 0x76, 0x77},
0085 {0x14, 0x78, 0x79},
0086 {0x15, 0x7a, 0x7b},
0087 {0x16, 0x7c, 0x7d},
0088 {0x17, 0x7e, 0x7f},
0089 {0x18, 0x80, 0x81},
0090 {0x19, 0x82, 0x83},
0091 {0x1A, 0x84, 0x85},
0092 {0x1B, 0x86, 0x87},
0093 {0x1C, 0x88, 0x89},
0094 {0x1D, 0x8a, 0x8b},
0095 {0x1E, 0x8c, 0x8d},
0096 {0x1F, 0xa6, 0xa7},
0097 {0x20, 0xaa, 0xab},
0098 {0x21, 0x96, 0x97},
0099 {0x22, 0x9a, 0x9b},
0100 {0x23, 0x9e, 0x9f},
0101 {0x24, 0xa2, 0xa3},
0102 };
0103 #define W83795_REG_VRLSB 0x3C
0104
0105 static const u8 W83795_REG_IN_HL_LSB[] = {
0106 0x8e,
0107 0x90,
0108 0x92,
0109 0x94,
0110 0xa8,
0111 0xac,
0112 0x98,
0113 0x9c,
0114 0xa0,
0115 0xa4,
0116 };
0117
0118 #define IN_LSB_REG(index, type) \
0119 (((type) == 1) ? W83795_REG_IN_HL_LSB[(index)] \
0120 : (W83795_REG_IN_HL_LSB[(index)] + 1))
0121
0122 #define IN_LSB_SHIFT 0
0123 #define IN_LSB_IDX 1
0124 static const u8 IN_LSB_SHIFT_IDX[][2] = {
0125
0126 {0x00, 0x00},
0127 {0x02, 0x00},
0128 {0x04, 0x00},
0129 {0x06, 0x00},
0130 {0x00, 0x01},
0131 {0x02, 0x01},
0132 {0x04, 0x01},
0133 {0x06, 0x01},
0134 {0x00, 0x02},
0135 {0x02, 0x02},
0136 {0x04, 0x02},
0137 {0x00, 0x03},
0138 {0x02, 0x03},
0139 {0x04, 0x03},
0140 {0x06, 0x03},
0141 {0x06, 0x04},
0142 {0x06, 0x05},
0143 {0x06, 0x06},
0144 {0x06, 0x07},
0145 {0x06, 0x08},
0146 {0x06, 0x09},
0147 };
0148
0149
0150 #define W83795_REG_FAN(index) (0x2E + (index))
0151 #define W83795_REG_FAN_MIN_HL(index) (0xB6 + (index))
0152 #define W83795_REG_FAN_MIN_LSB(index) (0xC4 + (index) / 2)
0153 #define W83795_REG_FAN_MIN_LSB_SHIFT(index) \
0154 (((index) & 1) ? 4 : 0)
0155
0156 #define W83795_REG_VID_CTRL 0x6A
0157
0158 #define W83795_REG_ALARM_CTRL 0x40
0159 #define ALARM_CTRL_RTSACS (1 << 7)
0160 #define W83795_REG_ALARM(index) (0x41 + (index))
0161 #define W83795_REG_CLR_CHASSIS 0x4D
0162 #define W83795_REG_BEEP(index) (0x50 + (index))
0163
0164 #define W83795_REG_OVT_CFG 0x58
0165 #define OVT_CFG_SEL (1 << 7)
0166
0167
0168 #define W83795_REG_FCMS1 0x201
0169 #define W83795_REG_FCMS2 0x208
0170 #define W83795_REG_TFMR(index) (0x202 + (index))
0171 #define W83795_REG_FOMC 0x20F
0172
0173 #define W83795_REG_TSS(index) (0x209 + (index))
0174
0175 #define TSS_MAP_RESERVED 0xff
0176 static const u8 tss_map[4][6] = {
0177 { 0, 1, 2, 3, 4, 5},
0178 { 6, 7, 8, 9, 0, 1},
0179 {10, 11, 12, 13, 2, 3},
0180 { 4, 5, 4, 5, TSS_MAP_RESERVED, TSS_MAP_RESERVED},
0181 };
0182
0183 #define PWM_OUTPUT 0
0184 #define PWM_FREQ 1
0185 #define PWM_START 2
0186 #define PWM_NONSTOP 3
0187 #define PWM_STOP_TIME 4
0188 #define W83795_REG_PWM(index, nr) (0x210 + (nr) * 8 + (index))
0189
0190 #define W83795_REG_FTSH(index) (0x240 + (index) * 2)
0191 #define W83795_REG_FTSL(index) (0x241 + (index) * 2)
0192 #define W83795_REG_TFTS 0x250
0193
0194 #define TEMP_PWM_TTTI 0
0195 #define TEMP_PWM_CTFS 1
0196 #define TEMP_PWM_HCT 2
0197 #define TEMP_PWM_HOT 3
0198 #define W83795_REG_TTTI(index) (0x260 + (index))
0199 #define W83795_REG_CTFS(index) (0x268 + (index))
0200 #define W83795_REG_HT(index) (0x270 + (index))
0201
0202 #define SF4_TEMP 0
0203 #define SF4_PWM 1
0204 #define W83795_REG_SF4_TEMP(temp_num, index) \
0205 (0x280 + 0x10 * (temp_num) + (index))
0206 #define W83795_REG_SF4_PWM(temp_num, index) \
0207 (0x288 + 0x10 * (temp_num) + (index))
0208
0209 #define W83795_REG_DTSC 0x301
0210 #define W83795_REG_DTSE 0x302
0211 #define W83795_REG_DTS(index) (0x26 + (index))
0212 #define W83795_REG_PECI_TBASE(index) (0x320 + (index))
0213
0214 #define DTS_CRIT 0
0215 #define DTS_CRIT_HYST 1
0216 #define DTS_WARN 2
0217 #define DTS_WARN_HYST 3
0218 #define W83795_REG_DTS_EXT(index) (0xB2 + (index))
0219
0220 #define SETUP_PWM_DEFAULT 0
0221 #define SETUP_PWM_UPTIME 1
0222 #define SETUP_PWM_DOWNTIME 2
0223 #define W83795_REG_SETUP_PWM(index) (0x20C + (index))
0224
0225 static inline u16 in_from_reg(u8 index, u16 val)
0226 {
0227
0228 if (index >= 12 && index <= 14)
0229 return val * 6;
0230 else
0231 return val * 2;
0232 }
0233
0234 static inline u16 in_to_reg(u8 index, u16 val)
0235 {
0236 if (index >= 12 && index <= 14)
0237 return val / 6;
0238 else
0239 return val / 2;
0240 }
0241
0242 static inline unsigned long fan_from_reg(u16 val)
0243 {
0244 if ((val == 0xfff) || (val == 0))
0245 return 0;
0246 return 1350000UL / val;
0247 }
0248
0249 static inline u16 fan_to_reg(long rpm)
0250 {
0251 if (rpm <= 0)
0252 return 0x0fff;
0253 return clamp_val((1350000 + (rpm >> 1)) / rpm, 1, 0xffe);
0254 }
0255
0256 static inline unsigned long time_from_reg(u8 reg)
0257 {
0258 return reg * 100;
0259 }
0260
0261 static inline u8 time_to_reg(unsigned long val)
0262 {
0263 return clamp_val((val + 50) / 100, 0, 0xff);
0264 }
0265
0266 static inline long temp_from_reg(s8 reg)
0267 {
0268 return reg * 1000;
0269 }
0270
0271 static inline s8 temp_to_reg(long val, s8 min, s8 max)
0272 {
0273 return clamp_val(val / 1000, min, max);
0274 }
0275
0276 static const u16 pwm_freq_cksel0[16] = {
0277 1024, 512, 341, 256, 205, 171, 146, 128,
0278 85, 64, 32, 16, 8, 4, 2, 1
0279 };
0280
0281 static unsigned int pwm_freq_from_reg(u8 reg, u16 clkin)
0282 {
0283 unsigned long base_clock;
0284
0285 if (reg & 0x80) {
0286 base_clock = clkin * 1000 / ((clkin == 48000) ? 384 : 256);
0287 return base_clock / ((reg & 0x7f) + 1);
0288 } else
0289 return pwm_freq_cksel0[reg & 0x0f];
0290 }
0291
0292 static u8 pwm_freq_to_reg(unsigned long val, u16 clkin)
0293 {
0294 unsigned long base_clock;
0295 u8 reg0, reg1;
0296 unsigned long best0, best1;
0297
0298
0299 reg0 = find_closest_descending(val, pwm_freq_cksel0,
0300 ARRAY_SIZE(pwm_freq_cksel0));
0301 if (val < 375)
0302 return reg0;
0303 best0 = pwm_freq_cksel0[reg0];
0304
0305
0306 base_clock = clkin * 1000 / ((clkin == 48000) ? 384 : 256);
0307 reg1 = clamp_val(DIV_ROUND_CLOSEST(base_clock, val), 1, 128);
0308 best1 = base_clock / reg1;
0309 reg1 = 0x80 | (reg1 - 1);
0310
0311
0312 if (abs(val - best0) > abs(val - best1))
0313 return reg1;
0314 else
0315 return reg0;
0316 }
0317
0318 enum chip_types {w83795g, w83795adg};
0319
0320 struct w83795_data {
0321 struct device *hwmon_dev;
0322 struct mutex update_lock;
0323 unsigned long last_updated;
0324 enum chip_types chip_type;
0325
0326 u8 bank;
0327
0328 u32 has_in;
0329 u8 has_dyn_in;
0330 u16 in[21][3];
0331 u8 in_lsb[10][3];
0332 u8 has_gain;
0333
0334 u16 has_fan;
0335 u16 fan[14];
0336 u16 fan_min[14];
0337
0338 u8 has_temp;
0339 s8 temp[6][5];
0340 u8 temp_read_vrlsb[6];
0341 u8 temp_mode;
0342 u8 temp_src[3];
0343
0344 u8 enable_dts;
0345
0346
0347
0348
0349 u8 has_dts;
0350 s8 dts[8];
0351 u8 dts_read_vrlsb[8];
0352 s8 dts_ext[4];
0353
0354 u8 has_pwm;
0355
0356
0357
0358
0359 u8 pwm[8][5];
0360
0361
0362
0363 u16 clkin;
0364 u8 pwm_fcms[2];
0365 u8 pwm_tfmr[6];
0366 u8 pwm_fomc;
0367
0368 u16 target_speed[8];
0369
0370
0371
0372 u8 tol_speed;
0373 u8 pwm_temp[6][4];
0374 u8 sf4_reg[6][2][7];
0375
0376 u8 setup_pwm[3];
0377
0378 u8 alarms[6];
0379 u8 enable_beep;
0380 u8 beeps[6];
0381
0382 bool valid;
0383 char valid_limits;
0384 char valid_pwm_config;
0385 };
0386
0387
0388
0389
0390
0391
0392
0393 static int w83795_set_bank(struct i2c_client *client, u8 bank)
0394 {
0395 struct w83795_data *data = i2c_get_clientdata(client);
0396 int err;
0397
0398
0399 if ((data->bank & 0x07) == bank)
0400 return 0;
0401
0402
0403 bank |= data->bank & ~0x07;
0404 err = i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL, bank);
0405 if (err < 0) {
0406 dev_err(&client->dev,
0407 "Failed to set bank to %d, err %d\n",
0408 (int)bank, err);
0409 return err;
0410 }
0411 data->bank = bank;
0412
0413 return 0;
0414 }
0415
0416
0417 static u8 w83795_read(struct i2c_client *client, u16 reg)
0418 {
0419 int err;
0420
0421 err = w83795_set_bank(client, reg >> 8);
0422 if (err < 0)
0423 return 0x00;
0424
0425 err = i2c_smbus_read_byte_data(client, reg & 0xff);
0426 if (err < 0) {
0427 dev_err(&client->dev,
0428 "Failed to read from register 0x%03x, err %d\n",
0429 (int)reg, err);
0430 return 0x00;
0431 }
0432 return err;
0433 }
0434
0435
0436 static int w83795_write(struct i2c_client *client, u16 reg, u8 value)
0437 {
0438 int err;
0439
0440 err = w83795_set_bank(client, reg >> 8);
0441 if (err < 0)
0442 return err;
0443
0444 err = i2c_smbus_write_byte_data(client, reg & 0xff, value);
0445 if (err < 0)
0446 dev_err(&client->dev,
0447 "Failed to write to register 0x%03x, err %d\n",
0448 (int)reg, err);
0449 return err;
0450 }
0451
0452 static void w83795_update_limits(struct i2c_client *client)
0453 {
0454 struct w83795_data *data = i2c_get_clientdata(client);
0455 int i, limit;
0456 u8 lsb;
0457
0458
0459 for (i = 0; i < ARRAY_SIZE(data->in); i++) {
0460 if (!(data->has_in & (1 << i)))
0461 continue;
0462 data->in[i][IN_MAX] =
0463 w83795_read(client, W83795_REG_IN[i][IN_MAX]);
0464 data->in[i][IN_LOW] =
0465 w83795_read(client, W83795_REG_IN[i][IN_LOW]);
0466 }
0467 for (i = 0; i < ARRAY_SIZE(data->in_lsb); i++) {
0468 if ((i == 2 && data->chip_type == w83795adg) ||
0469 (i >= 4 && !(data->has_in & (1 << (i + 11)))))
0470 continue;
0471 data->in_lsb[i][IN_MAX] =
0472 w83795_read(client, IN_LSB_REG(i, IN_MAX));
0473 data->in_lsb[i][IN_LOW] =
0474 w83795_read(client, IN_LSB_REG(i, IN_LOW));
0475 }
0476
0477
0478 lsb = 0;
0479 for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
0480
0481
0482
0483
0484 if ((i & 1) == 0 && (data->has_fan & (3 << i)))
0485 lsb = w83795_read(client, W83795_REG_FAN_MIN_LSB(i));
0486
0487 if (!(data->has_fan & (1 << i)))
0488 continue;
0489 data->fan_min[i] =
0490 w83795_read(client, W83795_REG_FAN_MIN_HL(i)) << 4;
0491 data->fan_min[i] |=
0492 (lsb >> W83795_REG_FAN_MIN_LSB_SHIFT(i)) & 0x0F;
0493 }
0494
0495
0496 for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
0497 if (!(data->has_temp & (1 << i)))
0498 continue;
0499 for (limit = TEMP_CRIT; limit <= TEMP_WARN_HYST; limit++)
0500 data->temp[i][limit] =
0501 w83795_read(client, W83795_REG_TEMP[i][limit]);
0502 }
0503
0504
0505 if (data->enable_dts) {
0506 for (limit = DTS_CRIT; limit <= DTS_WARN_HYST; limit++)
0507 data->dts_ext[limit] =
0508 w83795_read(client, W83795_REG_DTS_EXT(limit));
0509 }
0510
0511
0512 if (data->enable_beep) {
0513 for (i = 0; i < ARRAY_SIZE(data->beeps); i++)
0514 data->beeps[i] =
0515 w83795_read(client, W83795_REG_BEEP(i));
0516 }
0517
0518 data->valid_limits = 1;
0519 }
0520
0521 static struct w83795_data *w83795_update_pwm_config(struct device *dev)
0522 {
0523 struct i2c_client *client = to_i2c_client(dev);
0524 struct w83795_data *data = i2c_get_clientdata(client);
0525 int i, tmp;
0526
0527 mutex_lock(&data->update_lock);
0528
0529 if (data->valid_pwm_config)
0530 goto END;
0531
0532
0533 for (i = 0; i < ARRAY_SIZE(data->temp_src); i++)
0534 data->temp_src[i] = w83795_read(client, W83795_REG_TSS(i));
0535
0536
0537 data->pwm_fcms[0] = w83795_read(client, W83795_REG_FCMS1);
0538 data->pwm_fcms[1] = w83795_read(client, W83795_REG_FCMS2);
0539 for (i = 0; i < ARRAY_SIZE(data->pwm_tfmr); i++)
0540 data->pwm_tfmr[i] = w83795_read(client, W83795_REG_TFMR(i));
0541 data->pwm_fomc = w83795_read(client, W83795_REG_FOMC);
0542 for (i = 0; i < data->has_pwm; i++) {
0543 for (tmp = PWM_FREQ; tmp <= PWM_STOP_TIME; tmp++)
0544 data->pwm[i][tmp] =
0545 w83795_read(client, W83795_REG_PWM(i, tmp));
0546 }
0547 for (i = 0; i < ARRAY_SIZE(data->target_speed); i++) {
0548 data->target_speed[i] =
0549 w83795_read(client, W83795_REG_FTSH(i)) << 4;
0550 data->target_speed[i] |=
0551 w83795_read(client, W83795_REG_FTSL(i)) >> 4;
0552 }
0553 data->tol_speed = w83795_read(client, W83795_REG_TFTS) & 0x3f;
0554
0555 for (i = 0; i < ARRAY_SIZE(data->pwm_temp); i++) {
0556 data->pwm_temp[i][TEMP_PWM_TTTI] =
0557 w83795_read(client, W83795_REG_TTTI(i)) & 0x7f;
0558 data->pwm_temp[i][TEMP_PWM_CTFS] =
0559 w83795_read(client, W83795_REG_CTFS(i));
0560 tmp = w83795_read(client, W83795_REG_HT(i));
0561 data->pwm_temp[i][TEMP_PWM_HCT] = tmp >> 4;
0562 data->pwm_temp[i][TEMP_PWM_HOT] = tmp & 0x0f;
0563 }
0564
0565
0566 for (i = 0; i < ARRAY_SIZE(data->sf4_reg); i++) {
0567 for (tmp = 0; tmp < 7; tmp++) {
0568 data->sf4_reg[i][SF4_TEMP][tmp] =
0569 w83795_read(client,
0570 W83795_REG_SF4_TEMP(i, tmp));
0571 data->sf4_reg[i][SF4_PWM][tmp] =
0572 w83795_read(client, W83795_REG_SF4_PWM(i, tmp));
0573 }
0574 }
0575
0576
0577 for (i = 0; i < ARRAY_SIZE(data->setup_pwm); i++)
0578 data->setup_pwm[i] =
0579 w83795_read(client, W83795_REG_SETUP_PWM(i));
0580
0581 data->valid_pwm_config = 1;
0582
0583 END:
0584 mutex_unlock(&data->update_lock);
0585 return data;
0586 }
0587
0588 static struct w83795_data *w83795_update_device(struct device *dev)
0589 {
0590 struct i2c_client *client = to_i2c_client(dev);
0591 struct w83795_data *data = i2c_get_clientdata(client);
0592 u16 tmp;
0593 u8 intrusion;
0594 int i;
0595
0596 mutex_lock(&data->update_lock);
0597
0598 if (!data->valid_limits)
0599 w83795_update_limits(client);
0600
0601 if (!(time_after(jiffies, data->last_updated + HZ * 2)
0602 || !data->valid))
0603 goto END;
0604
0605
0606 for (i = 0; i < ARRAY_SIZE(data->in); i++) {
0607 if (!(data->has_in & (1 << i)))
0608 continue;
0609 tmp = w83795_read(client, W83795_REG_IN[i][IN_READ]) << 2;
0610 tmp |= w83795_read(client, W83795_REG_VRLSB) >> 6;
0611 data->in[i][IN_READ] = tmp;
0612 }
0613
0614
0615 if (data->has_dyn_in) {
0616 u8 lsb_max = w83795_read(client, IN_LSB_REG(0, IN_MAX));
0617 u8 lsb_low = w83795_read(client, IN_LSB_REG(0, IN_LOW));
0618
0619 for (i = 0; i < 3; i++) {
0620 if (!(data->has_dyn_in & (1 << i)))
0621 continue;
0622 data->in[i][IN_MAX] =
0623 w83795_read(client, W83795_REG_IN[i][IN_MAX]);
0624 data->in[i][IN_LOW] =
0625 w83795_read(client, W83795_REG_IN[i][IN_LOW]);
0626 data->in_lsb[i][IN_MAX] = (lsb_max >> (2 * i)) & 0x03;
0627 data->in_lsb[i][IN_LOW] = (lsb_low >> (2 * i)) & 0x03;
0628 }
0629 }
0630
0631
0632 for (i = 0; i < ARRAY_SIZE(data->fan); i++) {
0633 if (!(data->has_fan & (1 << i)))
0634 continue;
0635 data->fan[i] = w83795_read(client, W83795_REG_FAN(i)) << 4;
0636 data->fan[i] |= w83795_read(client, W83795_REG_VRLSB) >> 4;
0637 }
0638
0639
0640 for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
0641 data->temp[i][TEMP_READ] =
0642 w83795_read(client, W83795_REG_TEMP[i][TEMP_READ]);
0643 data->temp_read_vrlsb[i] =
0644 w83795_read(client, W83795_REG_VRLSB);
0645 }
0646
0647
0648 if (data->enable_dts) {
0649 for (i = 0; i < ARRAY_SIZE(data->dts); i++) {
0650 if (!(data->has_dts & (1 << i)))
0651 continue;
0652 data->dts[i] =
0653 w83795_read(client, W83795_REG_DTS(i));
0654 data->dts_read_vrlsb[i] =
0655 w83795_read(client, W83795_REG_VRLSB);
0656 }
0657 }
0658
0659
0660 for (i = 0; i < data->has_pwm; i++) {
0661 data->pwm[i][PWM_OUTPUT] =
0662 w83795_read(client, W83795_REG_PWM(i, PWM_OUTPUT));
0663 }
0664
0665
0666
0667
0668
0669
0670 tmp = w83795_read(client, W83795_REG_ALARM_CTRL);
0671
0672 if (tmp & ALARM_CTRL_RTSACS)
0673 w83795_write(client, W83795_REG_ALARM_CTRL,
0674 tmp & ~ALARM_CTRL_RTSACS);
0675 intrusion = w83795_read(client, W83795_REG_ALARM(5)) & (1 << 6);
0676
0677 w83795_write(client, W83795_REG_ALARM_CTRL, tmp | ALARM_CTRL_RTSACS);
0678 for (i = 0; i < ARRAY_SIZE(data->alarms); i++)
0679 data->alarms[i] = w83795_read(client, W83795_REG_ALARM(i));
0680 data->alarms[5] |= intrusion;
0681
0682 if (!(tmp & ALARM_CTRL_RTSACS))
0683 w83795_write(client, W83795_REG_ALARM_CTRL,
0684 tmp & ~ALARM_CTRL_RTSACS);
0685
0686 data->last_updated = jiffies;
0687 data->valid = true;
0688
0689 END:
0690 mutex_unlock(&data->update_lock);
0691 return data;
0692 }
0693
0694
0695
0696
0697
0698 #define ALARM_STATUS 0
0699 #define BEEP_ENABLE 1
0700 static ssize_t
0701 show_alarm_beep(struct device *dev, struct device_attribute *attr, char *buf)
0702 {
0703 struct w83795_data *data = w83795_update_device(dev);
0704 struct sensor_device_attribute_2 *sensor_attr =
0705 to_sensor_dev_attr_2(attr);
0706 int nr = sensor_attr->nr;
0707 int index = sensor_attr->index >> 3;
0708 int bit = sensor_attr->index & 0x07;
0709 u8 val;
0710
0711 if (nr == ALARM_STATUS)
0712 val = (data->alarms[index] >> bit) & 1;
0713 else
0714 val = (data->beeps[index] >> bit) & 1;
0715
0716 return sprintf(buf, "%u\n", val);
0717 }
0718
0719 static ssize_t
0720 store_beep(struct device *dev, struct device_attribute *attr,
0721 const char *buf, size_t count)
0722 {
0723 struct i2c_client *client = to_i2c_client(dev);
0724 struct w83795_data *data = i2c_get_clientdata(client);
0725 struct sensor_device_attribute_2 *sensor_attr =
0726 to_sensor_dev_attr_2(attr);
0727 int index = sensor_attr->index >> 3;
0728 int shift = sensor_attr->index & 0x07;
0729 u8 beep_bit = 1 << shift;
0730 unsigned long val;
0731
0732 if (kstrtoul(buf, 10, &val) < 0)
0733 return -EINVAL;
0734 if (val != 0 && val != 1)
0735 return -EINVAL;
0736
0737 mutex_lock(&data->update_lock);
0738 data->beeps[index] = w83795_read(client, W83795_REG_BEEP(index));
0739 data->beeps[index] &= ~beep_bit;
0740 data->beeps[index] |= val << shift;
0741 w83795_write(client, W83795_REG_BEEP(index), data->beeps[index]);
0742 mutex_unlock(&data->update_lock);
0743
0744 return count;
0745 }
0746
0747
0748 static ssize_t
0749 store_chassis_clear(struct device *dev,
0750 struct device_attribute *attr, const char *buf,
0751 size_t count)
0752 {
0753 struct i2c_client *client = to_i2c_client(dev);
0754 struct w83795_data *data = i2c_get_clientdata(client);
0755 unsigned long val;
0756
0757 if (kstrtoul(buf, 10, &val) < 0 || val != 0)
0758 return -EINVAL;
0759
0760 mutex_lock(&data->update_lock);
0761 val = w83795_read(client, W83795_REG_CLR_CHASSIS);
0762 val |= 0x80;
0763 w83795_write(client, W83795_REG_CLR_CHASSIS, val);
0764
0765
0766 w83795_read(client, W83795_REG_ALARM(5));
0767 data->valid = false;
0768 mutex_unlock(&data->update_lock);
0769 return count;
0770 }
0771
0772 #define FAN_INPUT 0
0773 #define FAN_MIN 1
0774 static ssize_t
0775 show_fan(struct device *dev, struct device_attribute *attr, char *buf)
0776 {
0777 struct sensor_device_attribute_2 *sensor_attr =
0778 to_sensor_dev_attr_2(attr);
0779 int nr = sensor_attr->nr;
0780 int index = sensor_attr->index;
0781 struct w83795_data *data = w83795_update_device(dev);
0782 u16 val;
0783
0784 if (nr == FAN_INPUT)
0785 val = data->fan[index] & 0x0fff;
0786 else
0787 val = data->fan_min[index] & 0x0fff;
0788
0789 return sprintf(buf, "%lu\n", fan_from_reg(val));
0790 }
0791
0792 static ssize_t
0793 store_fan_min(struct device *dev, struct device_attribute *attr,
0794 const char *buf, size_t count)
0795 {
0796 struct sensor_device_attribute_2 *sensor_attr =
0797 to_sensor_dev_attr_2(attr);
0798 int index = sensor_attr->index;
0799 struct i2c_client *client = to_i2c_client(dev);
0800 struct w83795_data *data = i2c_get_clientdata(client);
0801 unsigned long val;
0802
0803 if (kstrtoul(buf, 10, &val))
0804 return -EINVAL;
0805 val = fan_to_reg(val);
0806
0807 mutex_lock(&data->update_lock);
0808 data->fan_min[index] = val;
0809 w83795_write(client, W83795_REG_FAN_MIN_HL(index), (val >> 4) & 0xff);
0810 val &= 0x0f;
0811 if (index & 1) {
0812 val <<= 4;
0813 val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
0814 & 0x0f;
0815 } else {
0816 val |= w83795_read(client, W83795_REG_FAN_MIN_LSB(index))
0817 & 0xf0;
0818 }
0819 w83795_write(client, W83795_REG_FAN_MIN_LSB(index), val & 0xff);
0820 mutex_unlock(&data->update_lock);
0821
0822 return count;
0823 }
0824
0825 static ssize_t
0826 show_pwm(struct device *dev, struct device_attribute *attr, char *buf)
0827 {
0828 struct w83795_data *data;
0829 struct sensor_device_attribute_2 *sensor_attr =
0830 to_sensor_dev_attr_2(attr);
0831 int nr = sensor_attr->nr;
0832 int index = sensor_attr->index;
0833 unsigned int val;
0834
0835 data = nr == PWM_OUTPUT ? w83795_update_device(dev)
0836 : w83795_update_pwm_config(dev);
0837
0838 switch (nr) {
0839 case PWM_STOP_TIME:
0840 val = time_from_reg(data->pwm[index][nr]);
0841 break;
0842 case PWM_FREQ:
0843 val = pwm_freq_from_reg(data->pwm[index][nr], data->clkin);
0844 break;
0845 default:
0846 val = data->pwm[index][nr];
0847 break;
0848 }
0849
0850 return sprintf(buf, "%u\n", val);
0851 }
0852
0853 static ssize_t
0854 store_pwm(struct device *dev, struct device_attribute *attr,
0855 const char *buf, size_t count)
0856 {
0857 struct i2c_client *client = to_i2c_client(dev);
0858 struct w83795_data *data = i2c_get_clientdata(client);
0859 struct sensor_device_attribute_2 *sensor_attr =
0860 to_sensor_dev_attr_2(attr);
0861 int nr = sensor_attr->nr;
0862 int index = sensor_attr->index;
0863 unsigned long val;
0864
0865 if (kstrtoul(buf, 10, &val) < 0)
0866 return -EINVAL;
0867
0868 mutex_lock(&data->update_lock);
0869 switch (nr) {
0870 case PWM_STOP_TIME:
0871 val = time_to_reg(val);
0872 break;
0873 case PWM_FREQ:
0874 val = pwm_freq_to_reg(val, data->clkin);
0875 break;
0876 default:
0877 val = clamp_val(val, 0, 0xff);
0878 break;
0879 }
0880 w83795_write(client, W83795_REG_PWM(index, nr), val);
0881 data->pwm[index][nr] = val;
0882 mutex_unlock(&data->update_lock);
0883 return count;
0884 }
0885
0886 static ssize_t
0887 show_pwm_enable(struct device *dev, struct device_attribute *attr, char *buf)
0888 {
0889 struct sensor_device_attribute_2 *sensor_attr =
0890 to_sensor_dev_attr_2(attr);
0891 struct w83795_data *data = w83795_update_pwm_config(dev);
0892 int index = sensor_attr->index;
0893 u8 tmp;
0894
0895
0896 if (data->pwm_fcms[0] & (1 << index)) {
0897 tmp = 2;
0898 goto out;
0899 }
0900
0901 for (tmp = 0; tmp < 6; tmp++) {
0902 if (data->pwm_tfmr[tmp] & (1 << index)) {
0903 tmp = 3;
0904 goto out;
0905 }
0906 }
0907
0908 tmp = 1;
0909
0910 out:
0911 return sprintf(buf, "%u\n", tmp);
0912 }
0913
0914 static ssize_t
0915 store_pwm_enable(struct device *dev, struct device_attribute *attr,
0916 const char *buf, size_t count)
0917 {
0918 struct i2c_client *client = to_i2c_client(dev);
0919 struct w83795_data *data = w83795_update_pwm_config(dev);
0920 struct sensor_device_attribute_2 *sensor_attr =
0921 to_sensor_dev_attr_2(attr);
0922 int index = sensor_attr->index;
0923 unsigned long val;
0924 int i;
0925
0926 if (kstrtoul(buf, 10, &val) < 0)
0927 return -EINVAL;
0928 if (val < 1 || val > 2)
0929 return -EINVAL;
0930
0931 #ifndef CONFIG_SENSORS_W83795_FANCTRL
0932 if (val > 1) {
0933 dev_warn(dev, "Automatic fan speed control support disabled\n");
0934 dev_warn(dev, "Build with CONFIG_SENSORS_W83795_FANCTRL=y if you want it\n");
0935 return -EOPNOTSUPP;
0936 }
0937 #endif
0938
0939 mutex_lock(&data->update_lock);
0940 switch (val) {
0941 case 1:
0942
0943 data->pwm_fcms[0] &= ~(1 << index);
0944 w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
0945
0946 for (i = 0; i < 6; i++) {
0947 data->pwm_tfmr[i] &= ~(1 << index);
0948 w83795_write(client, W83795_REG_TFMR(i),
0949 data->pwm_tfmr[i]);
0950 }
0951 break;
0952 case 2:
0953 data->pwm_fcms[0] |= (1 << index);
0954 w83795_write(client, W83795_REG_FCMS1, data->pwm_fcms[0]);
0955 break;
0956 }
0957 mutex_unlock(&data->update_lock);
0958 return count;
0959 }
0960
0961 static ssize_t
0962 show_pwm_mode(struct device *dev, struct device_attribute *attr, char *buf)
0963 {
0964 struct w83795_data *data = w83795_update_pwm_config(dev);
0965 int index = to_sensor_dev_attr_2(attr)->index;
0966 unsigned int mode;
0967
0968 if (data->pwm_fomc & (1 << index))
0969 mode = 0;
0970 else
0971 mode = 1;
0972
0973 return sprintf(buf, "%u\n", mode);
0974 }
0975
0976
0977
0978
0979
0980
0981 static int w83795_tss_useful(const struct w83795_data *data, int tsrc)
0982 {
0983 int useful = 0, i;
0984
0985 for (i = 0; i < 4; i++) {
0986 if (tss_map[i][tsrc] == TSS_MAP_RESERVED)
0987 continue;
0988 if (tss_map[i][tsrc] < 6)
0989 useful += (data->has_temp >> tss_map[i][tsrc]) & 1;
0990 else
0991 useful += (data->has_dts >> (tss_map[i][tsrc] - 6)) & 1;
0992 }
0993
0994 return useful;
0995 }
0996
0997 static ssize_t
0998 show_temp_src(struct device *dev, struct device_attribute *attr, char *buf)
0999 {
1000 struct sensor_device_attribute_2 *sensor_attr =
1001 to_sensor_dev_attr_2(attr);
1002 struct w83795_data *data = w83795_update_pwm_config(dev);
1003 int index = sensor_attr->index;
1004 u8 tmp = data->temp_src[index / 2];
1005
1006 if (index & 1)
1007 tmp >>= 4;
1008 else
1009 tmp &= 0x0f;
1010
1011
1012 if (tmp >= 4 || tss_map[tmp][index] == TSS_MAP_RESERVED)
1013 return -EINVAL;
1014
1015 return sprintf(buf, "%u\n", (unsigned int)tss_map[tmp][index] + 1);
1016 }
1017
1018 static ssize_t
1019 store_temp_src(struct device *dev, struct device_attribute *attr,
1020 const char *buf, size_t count)
1021 {
1022 struct i2c_client *client = to_i2c_client(dev);
1023 struct w83795_data *data = w83795_update_pwm_config(dev);
1024 struct sensor_device_attribute_2 *sensor_attr =
1025 to_sensor_dev_attr_2(attr);
1026 int index = sensor_attr->index;
1027 int tmp;
1028 unsigned long channel;
1029 u8 val = index / 2;
1030
1031 if (kstrtoul(buf, 10, &channel) < 0 ||
1032 channel < 1 || channel > 14)
1033 return -EINVAL;
1034
1035
1036 for (tmp = 0; tmp < 4; tmp++) {
1037 if (tss_map[tmp][index] == channel - 1)
1038 break;
1039 }
1040 if (tmp == 4)
1041 return -EINVAL;
1042
1043 mutex_lock(&data->update_lock);
1044 if (index & 1) {
1045 tmp <<= 4;
1046 data->temp_src[val] &= 0x0f;
1047 } else {
1048 data->temp_src[val] &= 0xf0;
1049 }
1050 data->temp_src[val] |= tmp;
1051 w83795_write(client, W83795_REG_TSS(val), data->temp_src[val]);
1052 mutex_unlock(&data->update_lock);
1053
1054 return count;
1055 }
1056
1057 #define TEMP_PWM_ENABLE 0
1058 #define TEMP_PWM_FAN_MAP 1
1059 static ssize_t
1060 show_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
1061 char *buf)
1062 {
1063 struct w83795_data *data = w83795_update_pwm_config(dev);
1064 struct sensor_device_attribute_2 *sensor_attr =
1065 to_sensor_dev_attr_2(attr);
1066 int nr = sensor_attr->nr;
1067 int index = sensor_attr->index;
1068 u8 tmp = 0xff;
1069
1070 switch (nr) {
1071 case TEMP_PWM_ENABLE:
1072 tmp = (data->pwm_fcms[1] >> index) & 1;
1073 if (tmp)
1074 tmp = 4;
1075 else
1076 tmp = 3;
1077 break;
1078 case TEMP_PWM_FAN_MAP:
1079 tmp = data->pwm_tfmr[index];
1080 break;
1081 }
1082
1083 return sprintf(buf, "%u\n", tmp);
1084 }
1085
1086 static ssize_t
1087 store_temp_pwm_enable(struct device *dev, struct device_attribute *attr,
1088 const char *buf, size_t count)
1089 {
1090 struct i2c_client *client = to_i2c_client(dev);
1091 struct w83795_data *data = w83795_update_pwm_config(dev);
1092 struct sensor_device_attribute_2 *sensor_attr =
1093 to_sensor_dev_attr_2(attr);
1094 int nr = sensor_attr->nr;
1095 int index = sensor_attr->index;
1096 unsigned long tmp;
1097
1098 if (kstrtoul(buf, 10, &tmp) < 0)
1099 return -EINVAL;
1100
1101 switch (nr) {
1102 case TEMP_PWM_ENABLE:
1103 if (tmp != 3 && tmp != 4)
1104 return -EINVAL;
1105 tmp -= 3;
1106 mutex_lock(&data->update_lock);
1107 data->pwm_fcms[1] &= ~(1 << index);
1108 data->pwm_fcms[1] |= tmp << index;
1109 w83795_write(client, W83795_REG_FCMS2, data->pwm_fcms[1]);
1110 mutex_unlock(&data->update_lock);
1111 break;
1112 case TEMP_PWM_FAN_MAP:
1113 mutex_lock(&data->update_lock);
1114 tmp = clamp_val(tmp, 0, 0xff);
1115 w83795_write(client, W83795_REG_TFMR(index), tmp);
1116 data->pwm_tfmr[index] = tmp;
1117 mutex_unlock(&data->update_lock);
1118 break;
1119 }
1120 return count;
1121 }
1122
1123 #define FANIN_TARGET 0
1124 #define FANIN_TOL 1
1125 static ssize_t
1126 show_fanin(struct device *dev, struct device_attribute *attr, char *buf)
1127 {
1128 struct w83795_data *data = w83795_update_pwm_config(dev);
1129 struct sensor_device_attribute_2 *sensor_attr =
1130 to_sensor_dev_attr_2(attr);
1131 int nr = sensor_attr->nr;
1132 int index = sensor_attr->index;
1133 u16 tmp = 0;
1134
1135 switch (nr) {
1136 case FANIN_TARGET:
1137 tmp = fan_from_reg(data->target_speed[index]);
1138 break;
1139 case FANIN_TOL:
1140 tmp = data->tol_speed;
1141 break;
1142 }
1143
1144 return sprintf(buf, "%u\n", tmp);
1145 }
1146
1147 static ssize_t
1148 store_fanin(struct device *dev, struct device_attribute *attr,
1149 const char *buf, size_t count)
1150 {
1151 struct i2c_client *client = to_i2c_client(dev);
1152 struct w83795_data *data = i2c_get_clientdata(client);
1153 struct sensor_device_attribute_2 *sensor_attr =
1154 to_sensor_dev_attr_2(attr);
1155 int nr = sensor_attr->nr;
1156 int index = sensor_attr->index;
1157 unsigned long val;
1158
1159 if (kstrtoul(buf, 10, &val) < 0)
1160 return -EINVAL;
1161
1162 mutex_lock(&data->update_lock);
1163 switch (nr) {
1164 case FANIN_TARGET:
1165 val = fan_to_reg(clamp_val(val, 0, 0xfff));
1166 w83795_write(client, W83795_REG_FTSH(index), val >> 4);
1167 w83795_write(client, W83795_REG_FTSL(index), (val << 4) & 0xf0);
1168 data->target_speed[index] = val;
1169 break;
1170 case FANIN_TOL:
1171 val = clamp_val(val, 0, 0x3f);
1172 w83795_write(client, W83795_REG_TFTS, val);
1173 data->tol_speed = val;
1174 break;
1175 }
1176 mutex_unlock(&data->update_lock);
1177
1178 return count;
1179 }
1180
1181
1182 static ssize_t
1183 show_temp_pwm(struct device *dev, struct device_attribute *attr, char *buf)
1184 {
1185 struct w83795_data *data = w83795_update_pwm_config(dev);
1186 struct sensor_device_attribute_2 *sensor_attr =
1187 to_sensor_dev_attr_2(attr);
1188 int nr = sensor_attr->nr;
1189 int index = sensor_attr->index;
1190 long tmp = temp_from_reg(data->pwm_temp[index][nr]);
1191
1192 return sprintf(buf, "%ld\n", tmp);
1193 }
1194
1195 static ssize_t
1196 store_temp_pwm(struct device *dev, struct device_attribute *attr,
1197 const char *buf, size_t count)
1198 {
1199 struct i2c_client *client = to_i2c_client(dev);
1200 struct w83795_data *data = i2c_get_clientdata(client);
1201 struct sensor_device_attribute_2 *sensor_attr =
1202 to_sensor_dev_attr_2(attr);
1203 int nr = sensor_attr->nr;
1204 int index = sensor_attr->index;
1205 unsigned long val;
1206 u8 tmp;
1207
1208 if (kstrtoul(buf, 10, &val) < 0)
1209 return -EINVAL;
1210 val /= 1000;
1211
1212 mutex_lock(&data->update_lock);
1213 switch (nr) {
1214 case TEMP_PWM_TTTI:
1215 val = clamp_val(val, 0, 0x7f);
1216 w83795_write(client, W83795_REG_TTTI(index), val);
1217 break;
1218 case TEMP_PWM_CTFS:
1219 val = clamp_val(val, 0, 0x7f);
1220 w83795_write(client, W83795_REG_CTFS(index), val);
1221 break;
1222 case TEMP_PWM_HCT:
1223 val = clamp_val(val, 0, 0x0f);
1224 tmp = w83795_read(client, W83795_REG_HT(index));
1225 tmp &= 0x0f;
1226 tmp |= (val << 4) & 0xf0;
1227 w83795_write(client, W83795_REG_HT(index), tmp);
1228 break;
1229 case TEMP_PWM_HOT:
1230 val = clamp_val(val, 0, 0x0f);
1231 tmp = w83795_read(client, W83795_REG_HT(index));
1232 tmp &= 0xf0;
1233 tmp |= val & 0x0f;
1234 w83795_write(client, W83795_REG_HT(index), tmp);
1235 break;
1236 }
1237 data->pwm_temp[index][nr] = val;
1238 mutex_unlock(&data->update_lock);
1239
1240 return count;
1241 }
1242
1243 static ssize_t
1244 show_sf4_pwm(struct device *dev, struct device_attribute *attr, char *buf)
1245 {
1246 struct w83795_data *data = w83795_update_pwm_config(dev);
1247 struct sensor_device_attribute_2 *sensor_attr =
1248 to_sensor_dev_attr_2(attr);
1249 int nr = sensor_attr->nr;
1250 int index = sensor_attr->index;
1251
1252 return sprintf(buf, "%u\n", data->sf4_reg[index][SF4_PWM][nr]);
1253 }
1254
1255 static ssize_t
1256 store_sf4_pwm(struct device *dev, struct device_attribute *attr,
1257 const char *buf, size_t count)
1258 {
1259 struct i2c_client *client = to_i2c_client(dev);
1260 struct w83795_data *data = i2c_get_clientdata(client);
1261 struct sensor_device_attribute_2 *sensor_attr =
1262 to_sensor_dev_attr_2(attr);
1263 int nr = sensor_attr->nr;
1264 int index = sensor_attr->index;
1265 unsigned long val;
1266
1267 if (kstrtoul(buf, 10, &val) < 0)
1268 return -EINVAL;
1269
1270 mutex_lock(&data->update_lock);
1271 w83795_write(client, W83795_REG_SF4_PWM(index, nr), val);
1272 data->sf4_reg[index][SF4_PWM][nr] = val;
1273 mutex_unlock(&data->update_lock);
1274
1275 return count;
1276 }
1277
1278 static ssize_t
1279 show_sf4_temp(struct device *dev, struct device_attribute *attr, char *buf)
1280 {
1281 struct w83795_data *data = w83795_update_pwm_config(dev);
1282 struct sensor_device_attribute_2 *sensor_attr =
1283 to_sensor_dev_attr_2(attr);
1284 int nr = sensor_attr->nr;
1285 int index = sensor_attr->index;
1286
1287 return sprintf(buf, "%u\n",
1288 (data->sf4_reg[index][SF4_TEMP][nr]) * 1000);
1289 }
1290
1291 static ssize_t
1292 store_sf4_temp(struct device *dev, struct device_attribute *attr,
1293 const char *buf, size_t count)
1294 {
1295 struct i2c_client *client = to_i2c_client(dev);
1296 struct w83795_data *data = i2c_get_clientdata(client);
1297 struct sensor_device_attribute_2 *sensor_attr =
1298 to_sensor_dev_attr_2(attr);
1299 int nr = sensor_attr->nr;
1300 int index = sensor_attr->index;
1301 unsigned long val;
1302
1303 if (kstrtoul(buf, 10, &val) < 0)
1304 return -EINVAL;
1305 val /= 1000;
1306
1307 mutex_lock(&data->update_lock);
1308 w83795_write(client, W83795_REG_SF4_TEMP(index, nr), val);
1309 data->sf4_reg[index][SF4_TEMP][nr] = val;
1310 mutex_unlock(&data->update_lock);
1311
1312 return count;
1313 }
1314
1315
1316 static ssize_t
1317 show_temp(struct device *dev, struct device_attribute *attr, char *buf)
1318 {
1319 struct sensor_device_attribute_2 *sensor_attr =
1320 to_sensor_dev_attr_2(attr);
1321 int nr = sensor_attr->nr;
1322 int index = sensor_attr->index;
1323 struct w83795_data *data = w83795_update_device(dev);
1324 long temp = temp_from_reg(data->temp[index][nr]);
1325
1326 if (nr == TEMP_READ)
1327 temp += (data->temp_read_vrlsb[index] >> 6) * 250;
1328 return sprintf(buf, "%ld\n", temp);
1329 }
1330
1331 static ssize_t
1332 store_temp(struct device *dev, struct device_attribute *attr,
1333 const char *buf, size_t count)
1334 {
1335 struct sensor_device_attribute_2 *sensor_attr =
1336 to_sensor_dev_attr_2(attr);
1337 int nr = sensor_attr->nr;
1338 int index = sensor_attr->index;
1339 struct i2c_client *client = to_i2c_client(dev);
1340 struct w83795_data *data = i2c_get_clientdata(client);
1341 long tmp;
1342
1343 if (kstrtol(buf, 10, &tmp) < 0)
1344 return -EINVAL;
1345
1346 mutex_lock(&data->update_lock);
1347 data->temp[index][nr] = temp_to_reg(tmp, -128, 127);
1348 w83795_write(client, W83795_REG_TEMP[index][nr], data->temp[index][nr]);
1349 mutex_unlock(&data->update_lock);
1350 return count;
1351 }
1352
1353
1354 static ssize_t
1355 show_dts_mode(struct device *dev, struct device_attribute *attr, char *buf)
1356 {
1357 struct w83795_data *data = dev_get_drvdata(dev);
1358 int tmp;
1359
1360 if (data->enable_dts & 2)
1361 tmp = 5;
1362 else
1363 tmp = 6;
1364
1365 return sprintf(buf, "%d\n", tmp);
1366 }
1367
1368 static ssize_t
1369 show_dts(struct device *dev, struct device_attribute *attr, char *buf)
1370 {
1371 struct sensor_device_attribute_2 *sensor_attr =
1372 to_sensor_dev_attr_2(attr);
1373 int index = sensor_attr->index;
1374 struct w83795_data *data = w83795_update_device(dev);
1375 long temp = temp_from_reg(data->dts[index]);
1376
1377 temp += (data->dts_read_vrlsb[index] >> 6) * 250;
1378 return sprintf(buf, "%ld\n", temp);
1379 }
1380
1381 static ssize_t
1382 show_dts_ext(struct device *dev, struct device_attribute *attr, char *buf)
1383 {
1384 struct sensor_device_attribute_2 *sensor_attr =
1385 to_sensor_dev_attr_2(attr);
1386 int nr = sensor_attr->nr;
1387 struct w83795_data *data = dev_get_drvdata(dev);
1388 long temp = temp_from_reg(data->dts_ext[nr]);
1389
1390 return sprintf(buf, "%ld\n", temp);
1391 }
1392
1393 static ssize_t
1394 store_dts_ext(struct device *dev, struct device_attribute *attr,
1395 const char *buf, size_t count)
1396 {
1397 struct sensor_device_attribute_2 *sensor_attr =
1398 to_sensor_dev_attr_2(attr);
1399 int nr = sensor_attr->nr;
1400 struct i2c_client *client = to_i2c_client(dev);
1401 struct w83795_data *data = i2c_get_clientdata(client);
1402 long tmp;
1403
1404 if (kstrtol(buf, 10, &tmp) < 0)
1405 return -EINVAL;
1406
1407 mutex_lock(&data->update_lock);
1408 data->dts_ext[nr] = temp_to_reg(tmp, -128, 127);
1409 w83795_write(client, W83795_REG_DTS_EXT(nr), data->dts_ext[nr]);
1410 mutex_unlock(&data->update_lock);
1411 return count;
1412 }
1413
1414
1415 static ssize_t
1416 show_temp_mode(struct device *dev, struct device_attribute *attr, char *buf)
1417 {
1418 struct w83795_data *data = dev_get_drvdata(dev);
1419 struct sensor_device_attribute_2 *sensor_attr =
1420 to_sensor_dev_attr_2(attr);
1421 int index = sensor_attr->index;
1422 int tmp;
1423
1424 if (data->temp_mode & (1 << index))
1425 tmp = 3;
1426 else
1427 tmp = 4;
1428
1429 return sprintf(buf, "%d\n", tmp);
1430 }
1431
1432
1433 static ssize_t
1434 store_temp_mode(struct device *dev, struct device_attribute *attr,
1435 const char *buf, size_t count)
1436 {
1437 struct i2c_client *client = to_i2c_client(dev);
1438 struct w83795_data *data = i2c_get_clientdata(client);
1439 struct sensor_device_attribute_2 *sensor_attr =
1440 to_sensor_dev_attr_2(attr);
1441 int index = sensor_attr->index;
1442 int reg_shift;
1443 unsigned long val;
1444 u8 tmp;
1445
1446 if (kstrtoul(buf, 10, &val) < 0)
1447 return -EINVAL;
1448 if ((val != 4) && (val != 3))
1449 return -EINVAL;
1450
1451 mutex_lock(&data->update_lock);
1452 if (val == 3) {
1453
1454 val = 0x01;
1455 data->temp_mode |= 1 << index;
1456 } else if (val == 4) {
1457
1458 val = 0x03;
1459 data->temp_mode &= ~(1 << index);
1460 }
1461
1462 reg_shift = 2 * index;
1463 tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
1464 tmp &= ~(0x03 << reg_shift);
1465 tmp |= val << reg_shift;
1466 w83795_write(client, W83795_REG_TEMP_CTRL2, tmp);
1467
1468 mutex_unlock(&data->update_lock);
1469 return count;
1470 }
1471
1472
1473
1474 static ssize_t
1475 show_in(struct device *dev, struct device_attribute *attr, char *buf)
1476 {
1477 struct sensor_device_attribute_2 *sensor_attr =
1478 to_sensor_dev_attr_2(attr);
1479 int nr = sensor_attr->nr;
1480 int index = sensor_attr->index;
1481 struct w83795_data *data = w83795_update_device(dev);
1482 u16 val = data->in[index][nr];
1483 u8 lsb_idx;
1484
1485 switch (nr) {
1486 case IN_READ:
1487
1488 if ((index >= 17) &&
1489 !((data->has_gain >> (index - 17)) & 1))
1490 val *= 8;
1491 break;
1492 case IN_MAX:
1493 case IN_LOW:
1494 lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1495 val <<= 2;
1496 val |= (data->in_lsb[lsb_idx][nr] >>
1497 IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT]) & 0x03;
1498 if ((index >= 17) &&
1499 !((data->has_gain >> (index - 17)) & 1))
1500 val *= 8;
1501 break;
1502 }
1503 val = in_from_reg(index, val);
1504
1505 return sprintf(buf, "%d\n", val);
1506 }
1507
1508 static ssize_t
1509 store_in(struct device *dev, struct device_attribute *attr,
1510 const char *buf, size_t count)
1511 {
1512 struct sensor_device_attribute_2 *sensor_attr =
1513 to_sensor_dev_attr_2(attr);
1514 int nr = sensor_attr->nr;
1515 int index = sensor_attr->index;
1516 struct i2c_client *client = to_i2c_client(dev);
1517 struct w83795_data *data = i2c_get_clientdata(client);
1518 unsigned long val;
1519 u8 tmp;
1520 u8 lsb_idx;
1521
1522 if (kstrtoul(buf, 10, &val) < 0)
1523 return -EINVAL;
1524 val = in_to_reg(index, val);
1525
1526 if ((index >= 17) &&
1527 !((data->has_gain >> (index - 17)) & 1))
1528 val /= 8;
1529 val = clamp_val(val, 0, 0x3FF);
1530 mutex_lock(&data->update_lock);
1531
1532 lsb_idx = IN_LSB_SHIFT_IDX[index][IN_LSB_IDX];
1533 tmp = w83795_read(client, IN_LSB_REG(lsb_idx, nr));
1534 tmp &= ~(0x03 << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT]);
1535 tmp |= (val & 0x03) << IN_LSB_SHIFT_IDX[index][IN_LSB_SHIFT];
1536 w83795_write(client, IN_LSB_REG(lsb_idx, nr), tmp);
1537 data->in_lsb[lsb_idx][nr] = tmp;
1538
1539 tmp = (val >> 2) & 0xff;
1540 w83795_write(client, W83795_REG_IN[index][nr], tmp);
1541 data->in[index][nr] = tmp;
1542
1543 mutex_unlock(&data->update_lock);
1544 return count;
1545 }
1546
1547
1548 #ifdef CONFIG_SENSORS_W83795_FANCTRL
1549 static ssize_t
1550 show_sf_setup(struct device *dev, struct device_attribute *attr, char *buf)
1551 {
1552 struct sensor_device_attribute_2 *sensor_attr =
1553 to_sensor_dev_attr_2(attr);
1554 int nr = sensor_attr->nr;
1555 struct w83795_data *data = w83795_update_pwm_config(dev);
1556 u16 val = data->setup_pwm[nr];
1557
1558 switch (nr) {
1559 case SETUP_PWM_UPTIME:
1560 case SETUP_PWM_DOWNTIME:
1561 val = time_from_reg(val);
1562 break;
1563 }
1564
1565 return sprintf(buf, "%d\n", val);
1566 }
1567
1568 static ssize_t
1569 store_sf_setup(struct device *dev, struct device_attribute *attr,
1570 const char *buf, size_t count)
1571 {
1572 struct sensor_device_attribute_2 *sensor_attr =
1573 to_sensor_dev_attr_2(attr);
1574 int nr = sensor_attr->nr;
1575 struct i2c_client *client = to_i2c_client(dev);
1576 struct w83795_data *data = i2c_get_clientdata(client);
1577 unsigned long val;
1578
1579 if (kstrtoul(buf, 10, &val) < 0)
1580 return -EINVAL;
1581
1582 switch (nr) {
1583 case SETUP_PWM_DEFAULT:
1584 val = clamp_val(val, 0, 0xff);
1585 break;
1586 case SETUP_PWM_UPTIME:
1587 case SETUP_PWM_DOWNTIME:
1588 val = time_to_reg(val);
1589 if (val == 0)
1590 return -EINVAL;
1591 break;
1592 }
1593
1594 mutex_lock(&data->update_lock);
1595 data->setup_pwm[nr] = val;
1596 w83795_write(client, W83795_REG_SETUP_PWM(nr), val);
1597 mutex_unlock(&data->update_lock);
1598 return count;
1599 }
1600 #endif
1601
1602
1603 #define NOT_USED -1
1604
1605
1606
1607
1608
1609 #define SENSOR_ATTR_IN(index) { \
1610 SENSOR_ATTR_2(in##index##_input, S_IRUGO, show_in, NULL, \
1611 IN_READ, index), \
1612 SENSOR_ATTR_2(in##index##_max, S_IRUGO | S_IWUSR, show_in, \
1613 store_in, IN_MAX, index), \
1614 SENSOR_ATTR_2(in##index##_min, S_IRUGO | S_IWUSR, show_in, \
1615 store_in, IN_LOW, index), \
1616 SENSOR_ATTR_2(in##index##_alarm, S_IRUGO, show_alarm_beep, \
1617 NULL, ALARM_STATUS, index + ((index > 14) ? 1 : 0)), \
1618 SENSOR_ATTR_2(in##index##_beep, S_IWUSR | S_IRUGO, \
1619 show_alarm_beep, store_beep, BEEP_ENABLE, \
1620 index + ((index > 14) ? 1 : 0)) }
1621
1622
1623
1624
1625
1626 #define SENSOR_ATTR_FAN(index) { \
1627 SENSOR_ATTR_2(fan##index##_input, S_IRUGO, show_fan, \
1628 NULL, FAN_INPUT, index - 1), \
1629 SENSOR_ATTR_2(fan##index##_min, S_IWUSR | S_IRUGO, \
1630 show_fan, store_fan_min, FAN_MIN, index - 1), \
1631 SENSOR_ATTR_2(fan##index##_alarm, S_IRUGO, show_alarm_beep, \
1632 NULL, ALARM_STATUS, index + 31), \
1633 SENSOR_ATTR_2(fan##index##_beep, S_IWUSR | S_IRUGO, \
1634 show_alarm_beep, store_beep, BEEP_ENABLE, index + 31) }
1635
1636 #define SENSOR_ATTR_PWM(index) { \
1637 SENSOR_ATTR_2(pwm##index, S_IWUSR | S_IRUGO, show_pwm, \
1638 store_pwm, PWM_OUTPUT, index - 1), \
1639 SENSOR_ATTR_2(pwm##index##_enable, S_IWUSR | S_IRUGO, \
1640 show_pwm_enable, store_pwm_enable, NOT_USED, index - 1), \
1641 SENSOR_ATTR_2(pwm##index##_mode, S_IRUGO, \
1642 show_pwm_mode, NULL, NOT_USED, index - 1), \
1643 SENSOR_ATTR_2(pwm##index##_freq, S_IWUSR | S_IRUGO, \
1644 show_pwm, store_pwm, PWM_FREQ, index - 1), \
1645 SENSOR_ATTR_2(pwm##index##_nonstop, S_IWUSR | S_IRUGO, \
1646 show_pwm, store_pwm, PWM_NONSTOP, index - 1), \
1647 SENSOR_ATTR_2(pwm##index##_start, S_IWUSR | S_IRUGO, \
1648 show_pwm, store_pwm, PWM_START, index - 1), \
1649 SENSOR_ATTR_2(pwm##index##_stop_time, S_IWUSR | S_IRUGO, \
1650 show_pwm, store_pwm, PWM_STOP_TIME, index - 1), \
1651 SENSOR_ATTR_2(fan##index##_target, S_IWUSR | S_IRUGO, \
1652 show_fanin, store_fanin, FANIN_TARGET, index - 1) }
1653
1654
1655
1656
1657
1658 #define SENSOR_ATTR_DTS(index) { \
1659 SENSOR_ATTR_2(temp##index##_type, S_IRUGO , \
1660 show_dts_mode, NULL, NOT_USED, index - 7), \
1661 SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_dts, \
1662 NULL, NOT_USED, index - 7), \
1663 SENSOR_ATTR_2(temp##index##_crit, S_IRUGO | S_IWUSR, show_dts_ext, \
1664 store_dts_ext, DTS_CRIT, NOT_USED), \
1665 SENSOR_ATTR_2(temp##index##_crit_hyst, S_IRUGO | S_IWUSR, \
1666 show_dts_ext, store_dts_ext, DTS_CRIT_HYST, NOT_USED), \
1667 SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_dts_ext, \
1668 store_dts_ext, DTS_WARN, NOT_USED), \
1669 SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR, \
1670 show_dts_ext, store_dts_ext, DTS_WARN_HYST, NOT_USED), \
1671 SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO, \
1672 show_alarm_beep, NULL, ALARM_STATUS, index + 17), \
1673 SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO, \
1674 show_alarm_beep, store_beep, BEEP_ENABLE, index + 17) }
1675
1676
1677
1678
1679
1680 #define SENSOR_ATTR_TEMP(index) { \
1681 SENSOR_ATTR_2(temp##index##_type, S_IRUGO | (index < 5 ? S_IWUSR : 0), \
1682 show_temp_mode, store_temp_mode, NOT_USED, index - 1), \
1683 SENSOR_ATTR_2(temp##index##_input, S_IRUGO, show_temp, \
1684 NULL, TEMP_READ, index - 1), \
1685 SENSOR_ATTR_2(temp##index##_crit, S_IRUGO | S_IWUSR, show_temp, \
1686 store_temp, TEMP_CRIT, index - 1), \
1687 SENSOR_ATTR_2(temp##index##_crit_hyst, S_IRUGO | S_IWUSR, \
1688 show_temp, store_temp, TEMP_CRIT_HYST, index - 1), \
1689 SENSOR_ATTR_2(temp##index##_max, S_IRUGO | S_IWUSR, show_temp, \
1690 store_temp, TEMP_WARN, index - 1), \
1691 SENSOR_ATTR_2(temp##index##_max_hyst, S_IRUGO | S_IWUSR, \
1692 show_temp, store_temp, TEMP_WARN_HYST, index - 1), \
1693 SENSOR_ATTR_2(temp##index##_alarm, S_IRUGO, \
1694 show_alarm_beep, NULL, ALARM_STATUS, \
1695 index + (index > 4 ? 11 : 17)), \
1696 SENSOR_ATTR_2(temp##index##_beep, S_IWUSR | S_IRUGO, \
1697 show_alarm_beep, store_beep, BEEP_ENABLE, \
1698 index + (index > 4 ? 11 : 17)), \
1699 SENSOR_ATTR_2(temp##index##_pwm_enable, S_IWUSR | S_IRUGO, \
1700 show_temp_pwm_enable, store_temp_pwm_enable, \
1701 TEMP_PWM_ENABLE, index - 1), \
1702 SENSOR_ATTR_2(temp##index##_auto_channels_pwm, S_IWUSR | S_IRUGO, \
1703 show_temp_pwm_enable, store_temp_pwm_enable, \
1704 TEMP_PWM_FAN_MAP, index - 1), \
1705 SENSOR_ATTR_2(thermal_cruise##index, S_IWUSR | S_IRUGO, \
1706 show_temp_pwm, store_temp_pwm, TEMP_PWM_TTTI, index - 1), \
1707 SENSOR_ATTR_2(temp##index##_warn, S_IWUSR | S_IRUGO, \
1708 show_temp_pwm, store_temp_pwm, TEMP_PWM_CTFS, index - 1), \
1709 SENSOR_ATTR_2(temp##index##_warn_hyst, S_IWUSR | S_IRUGO, \
1710 show_temp_pwm, store_temp_pwm, TEMP_PWM_HCT, index - 1), \
1711 SENSOR_ATTR_2(temp##index##_operation_hyst, S_IWUSR | S_IRUGO, \
1712 show_temp_pwm, store_temp_pwm, TEMP_PWM_HOT, index - 1), \
1713 SENSOR_ATTR_2(temp##index##_auto_point1_pwm, S_IRUGO | S_IWUSR, \
1714 show_sf4_pwm, store_sf4_pwm, 0, index - 1), \
1715 SENSOR_ATTR_2(temp##index##_auto_point2_pwm, S_IRUGO | S_IWUSR, \
1716 show_sf4_pwm, store_sf4_pwm, 1, index - 1), \
1717 SENSOR_ATTR_2(temp##index##_auto_point3_pwm, S_IRUGO | S_IWUSR, \
1718 show_sf4_pwm, store_sf4_pwm, 2, index - 1), \
1719 SENSOR_ATTR_2(temp##index##_auto_point4_pwm, S_IRUGO | S_IWUSR, \
1720 show_sf4_pwm, store_sf4_pwm, 3, index - 1), \
1721 SENSOR_ATTR_2(temp##index##_auto_point5_pwm, S_IRUGO | S_IWUSR, \
1722 show_sf4_pwm, store_sf4_pwm, 4, index - 1), \
1723 SENSOR_ATTR_2(temp##index##_auto_point6_pwm, S_IRUGO | S_IWUSR, \
1724 show_sf4_pwm, store_sf4_pwm, 5, index - 1), \
1725 SENSOR_ATTR_2(temp##index##_auto_point7_pwm, S_IRUGO | S_IWUSR, \
1726 show_sf4_pwm, store_sf4_pwm, 6, index - 1), \
1727 SENSOR_ATTR_2(temp##index##_auto_point1_temp, S_IRUGO | S_IWUSR,\
1728 show_sf4_temp, store_sf4_temp, 0, index - 1), \
1729 SENSOR_ATTR_2(temp##index##_auto_point2_temp, S_IRUGO | S_IWUSR,\
1730 show_sf4_temp, store_sf4_temp, 1, index - 1), \
1731 SENSOR_ATTR_2(temp##index##_auto_point3_temp, S_IRUGO | S_IWUSR,\
1732 show_sf4_temp, store_sf4_temp, 2, index - 1), \
1733 SENSOR_ATTR_2(temp##index##_auto_point4_temp, S_IRUGO | S_IWUSR,\
1734 show_sf4_temp, store_sf4_temp, 3, index - 1), \
1735 SENSOR_ATTR_2(temp##index##_auto_point5_temp, S_IRUGO | S_IWUSR,\
1736 show_sf4_temp, store_sf4_temp, 4, index - 1), \
1737 SENSOR_ATTR_2(temp##index##_auto_point6_temp, S_IRUGO | S_IWUSR,\
1738 show_sf4_temp, store_sf4_temp, 5, index - 1), \
1739 SENSOR_ATTR_2(temp##index##_auto_point7_temp, S_IRUGO | S_IWUSR,\
1740 show_sf4_temp, store_sf4_temp, 6, index - 1) }
1741
1742
1743 static struct sensor_device_attribute_2 w83795_in[][5] = {
1744 SENSOR_ATTR_IN(0),
1745 SENSOR_ATTR_IN(1),
1746 SENSOR_ATTR_IN(2),
1747 SENSOR_ATTR_IN(3),
1748 SENSOR_ATTR_IN(4),
1749 SENSOR_ATTR_IN(5),
1750 SENSOR_ATTR_IN(6),
1751 SENSOR_ATTR_IN(7),
1752 SENSOR_ATTR_IN(8),
1753 SENSOR_ATTR_IN(9),
1754 SENSOR_ATTR_IN(10),
1755 SENSOR_ATTR_IN(11),
1756 SENSOR_ATTR_IN(12),
1757 SENSOR_ATTR_IN(13),
1758 SENSOR_ATTR_IN(14),
1759 SENSOR_ATTR_IN(15),
1760 SENSOR_ATTR_IN(16),
1761 SENSOR_ATTR_IN(17),
1762 SENSOR_ATTR_IN(18),
1763 SENSOR_ATTR_IN(19),
1764 SENSOR_ATTR_IN(20),
1765 };
1766
1767 static const struct sensor_device_attribute_2 w83795_fan[][4] = {
1768 SENSOR_ATTR_FAN(1),
1769 SENSOR_ATTR_FAN(2),
1770 SENSOR_ATTR_FAN(3),
1771 SENSOR_ATTR_FAN(4),
1772 SENSOR_ATTR_FAN(5),
1773 SENSOR_ATTR_FAN(6),
1774 SENSOR_ATTR_FAN(7),
1775 SENSOR_ATTR_FAN(8),
1776 SENSOR_ATTR_FAN(9),
1777 SENSOR_ATTR_FAN(10),
1778 SENSOR_ATTR_FAN(11),
1779 SENSOR_ATTR_FAN(12),
1780 SENSOR_ATTR_FAN(13),
1781 SENSOR_ATTR_FAN(14),
1782 };
1783
1784 static const struct sensor_device_attribute_2 w83795_temp[][28] = {
1785 SENSOR_ATTR_TEMP(1),
1786 SENSOR_ATTR_TEMP(2),
1787 SENSOR_ATTR_TEMP(3),
1788 SENSOR_ATTR_TEMP(4),
1789 SENSOR_ATTR_TEMP(5),
1790 SENSOR_ATTR_TEMP(6),
1791 };
1792
1793 static const struct sensor_device_attribute_2 w83795_dts[][8] = {
1794 SENSOR_ATTR_DTS(7),
1795 SENSOR_ATTR_DTS(8),
1796 SENSOR_ATTR_DTS(9),
1797 SENSOR_ATTR_DTS(10),
1798 SENSOR_ATTR_DTS(11),
1799 SENSOR_ATTR_DTS(12),
1800 SENSOR_ATTR_DTS(13),
1801 SENSOR_ATTR_DTS(14),
1802 };
1803
1804 static const struct sensor_device_attribute_2 w83795_pwm[][8] = {
1805 SENSOR_ATTR_PWM(1),
1806 SENSOR_ATTR_PWM(2),
1807 SENSOR_ATTR_PWM(3),
1808 SENSOR_ATTR_PWM(4),
1809 SENSOR_ATTR_PWM(5),
1810 SENSOR_ATTR_PWM(6),
1811 SENSOR_ATTR_PWM(7),
1812 SENSOR_ATTR_PWM(8),
1813 };
1814
1815 static const struct sensor_device_attribute_2 w83795_tss[6] = {
1816 SENSOR_ATTR_2(temp1_source_sel, S_IWUSR | S_IRUGO,
1817 show_temp_src, store_temp_src, NOT_USED, 0),
1818 SENSOR_ATTR_2(temp2_source_sel, S_IWUSR | S_IRUGO,
1819 show_temp_src, store_temp_src, NOT_USED, 1),
1820 SENSOR_ATTR_2(temp3_source_sel, S_IWUSR | S_IRUGO,
1821 show_temp_src, store_temp_src, NOT_USED, 2),
1822 SENSOR_ATTR_2(temp4_source_sel, S_IWUSR | S_IRUGO,
1823 show_temp_src, store_temp_src, NOT_USED, 3),
1824 SENSOR_ATTR_2(temp5_source_sel, S_IWUSR | S_IRUGO,
1825 show_temp_src, store_temp_src, NOT_USED, 4),
1826 SENSOR_ATTR_2(temp6_source_sel, S_IWUSR | S_IRUGO,
1827 show_temp_src, store_temp_src, NOT_USED, 5),
1828 };
1829
1830 static const struct sensor_device_attribute_2 sda_single_files[] = {
1831 SENSOR_ATTR_2(intrusion0_alarm, S_IWUSR | S_IRUGO, show_alarm_beep,
1832 store_chassis_clear, ALARM_STATUS, 46),
1833 #ifdef CONFIG_SENSORS_W83795_FANCTRL
1834 SENSOR_ATTR_2(speed_cruise_tolerance, S_IWUSR | S_IRUGO, show_fanin,
1835 store_fanin, FANIN_TOL, NOT_USED),
1836 SENSOR_ATTR_2(pwm_default, S_IWUSR | S_IRUGO, show_sf_setup,
1837 store_sf_setup, SETUP_PWM_DEFAULT, NOT_USED),
1838 SENSOR_ATTR_2(pwm_uptime, S_IWUSR | S_IRUGO, show_sf_setup,
1839 store_sf_setup, SETUP_PWM_UPTIME, NOT_USED),
1840 SENSOR_ATTR_2(pwm_downtime, S_IWUSR | S_IRUGO, show_sf_setup,
1841 store_sf_setup, SETUP_PWM_DOWNTIME, NOT_USED),
1842 #endif
1843 };
1844
1845 static const struct sensor_device_attribute_2 sda_beep_files[] = {
1846 SENSOR_ATTR_2(intrusion0_beep, S_IWUSR | S_IRUGO, show_alarm_beep,
1847 store_beep, BEEP_ENABLE, 46),
1848 SENSOR_ATTR_2(beep_enable, S_IWUSR | S_IRUGO, show_alarm_beep,
1849 store_beep, BEEP_ENABLE, 47),
1850 };
1851
1852
1853
1854
1855
1856 static void w83795_init_client(struct i2c_client *client)
1857 {
1858 struct w83795_data *data = i2c_get_clientdata(client);
1859 static const u16 clkin[4] = {
1860 14318, 24000, 33333, 48000
1861 };
1862 u8 config;
1863
1864 if (reset)
1865 w83795_write(client, W83795_REG_CONFIG, 0x80);
1866
1867
1868 config = w83795_read(client, W83795_REG_CONFIG);
1869 if (!(config & W83795_REG_CONFIG_START)) {
1870 dev_info(&client->dev, "Enabling monitoring operations\n");
1871 w83795_write(client, W83795_REG_CONFIG,
1872 config | W83795_REG_CONFIG_START);
1873 }
1874
1875 data->clkin = clkin[(config >> 3) & 0x3];
1876 dev_dbg(&client->dev, "clkin = %u kHz\n", data->clkin);
1877 }
1878
1879 static int w83795_get_device_id(struct i2c_client *client)
1880 {
1881 int device_id;
1882
1883 device_id = i2c_smbus_read_byte_data(client, W83795_REG_DEVICEID);
1884
1885
1886
1887
1888
1889 if (device_id < 0 || (device_id & 0xf0) != 0x50) {
1890 int alt_id;
1891
1892 alt_id = i2c_smbus_read_byte_data(client,
1893 W83795_REG_DEVICEID_A);
1894 if (alt_id == 0x50)
1895 device_id = alt_id;
1896 }
1897
1898 return device_id;
1899 }
1900
1901
1902 static int w83795_detect(struct i2c_client *client,
1903 struct i2c_board_info *info)
1904 {
1905 int bank, vendor_id, device_id, expected, i2c_addr, config;
1906 struct i2c_adapter *adapter = client->adapter;
1907 unsigned short address = client->addr;
1908 const char *chip_name;
1909
1910 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1911 return -ENODEV;
1912 bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
1913 if (bank < 0 || (bank & 0x7c)) {
1914 dev_dbg(&adapter->dev,
1915 "w83795: Detection failed at addr 0x%02hx, check %s\n",
1916 address, "bank");
1917 return -ENODEV;
1918 }
1919
1920
1921 vendor_id = i2c_smbus_read_byte_data(client, W83795_REG_VENDORID);
1922 expected = bank & 0x80 ? 0x5c : 0xa3;
1923 if (vendor_id != expected) {
1924 dev_dbg(&adapter->dev,
1925 "w83795: Detection failed at addr 0x%02hx, check %s\n",
1926 address, "vendor id");
1927 return -ENODEV;
1928 }
1929
1930
1931 device_id = w83795_get_device_id(client) |
1932 (i2c_smbus_read_byte_data(client, W83795_REG_CHIPID) << 8);
1933 if ((device_id >> 4) != 0x795) {
1934 dev_dbg(&adapter->dev,
1935 "w83795: Detection failed at addr 0x%02hx, check %s\n",
1936 address, "device id\n");
1937 return -ENODEV;
1938 }
1939
1940
1941
1942
1943
1944 if ((bank & 0x07) == 0) {
1945 i2c_addr = i2c_smbus_read_byte_data(client,
1946 W83795_REG_I2C_ADDR);
1947 if ((i2c_addr & 0x7f) != address) {
1948 dev_dbg(&adapter->dev,
1949 "w83795: Detection failed at addr 0x%02hx, "
1950 "check %s\n", address, "i2c addr");
1951 return -ENODEV;
1952 }
1953 }
1954
1955
1956
1957
1958
1959
1960
1961 if ((bank & 0x07) != 0)
1962 i2c_smbus_write_byte_data(client, W83795_REG_BANKSEL,
1963 bank & ~0x07);
1964 config = i2c_smbus_read_byte_data(client, W83795_REG_CONFIG);
1965 if (config & W83795_REG_CONFIG_CONFIG48)
1966 chip_name = "w83795adg";
1967 else
1968 chip_name = "w83795g";
1969
1970 strlcpy(info->type, chip_name, I2C_NAME_SIZE);
1971 dev_info(&adapter->dev, "Found %s rev. %c at 0x%02hx\n", chip_name,
1972 'A' + (device_id & 0xf), address);
1973
1974 return 0;
1975 }
1976
1977 #ifdef CONFIG_SENSORS_W83795_FANCTRL
1978 #define NUM_PWM_ATTRIBUTES ARRAY_SIZE(w83795_pwm[0])
1979 #define NUM_TEMP_ATTRIBUTES ARRAY_SIZE(w83795_temp[0])
1980 #else
1981 #define NUM_PWM_ATTRIBUTES 4
1982 #define NUM_TEMP_ATTRIBUTES 8
1983 #endif
1984
1985 static int w83795_handle_files(struct device *dev, int (*fn)(struct device *,
1986 const struct device_attribute *))
1987 {
1988 struct w83795_data *data = dev_get_drvdata(dev);
1989 int err, i, j;
1990
1991 for (i = 0; i < ARRAY_SIZE(w83795_in); i++) {
1992 if (!(data->has_in & (1 << i)))
1993 continue;
1994 for (j = 0; j < ARRAY_SIZE(w83795_in[0]); j++) {
1995 if (j == 4 && !data->enable_beep)
1996 continue;
1997 err = fn(dev, &w83795_in[i][j].dev_attr);
1998 if (err)
1999 return err;
2000 }
2001 }
2002
2003 for (i = 0; i < ARRAY_SIZE(w83795_fan); i++) {
2004 if (!(data->has_fan & (1 << i)))
2005 continue;
2006 for (j = 0; j < ARRAY_SIZE(w83795_fan[0]); j++) {
2007 if (j == 3 && !data->enable_beep)
2008 continue;
2009 err = fn(dev, &w83795_fan[i][j].dev_attr);
2010 if (err)
2011 return err;
2012 }
2013 }
2014
2015 for (i = 0; i < ARRAY_SIZE(w83795_tss); i++) {
2016 j = w83795_tss_useful(data, i);
2017 if (!j)
2018 continue;
2019 err = fn(dev, &w83795_tss[i].dev_attr);
2020 if (err)
2021 return err;
2022 }
2023
2024 for (i = 0; i < ARRAY_SIZE(sda_single_files); i++) {
2025 err = fn(dev, &sda_single_files[i].dev_attr);
2026 if (err)
2027 return err;
2028 }
2029
2030 if (data->enable_beep) {
2031 for (i = 0; i < ARRAY_SIZE(sda_beep_files); i++) {
2032 err = fn(dev, &sda_beep_files[i].dev_attr);
2033 if (err)
2034 return err;
2035 }
2036 }
2037
2038 for (i = 0; i < data->has_pwm; i++) {
2039 for (j = 0; j < NUM_PWM_ATTRIBUTES; j++) {
2040 err = fn(dev, &w83795_pwm[i][j].dev_attr);
2041 if (err)
2042 return err;
2043 }
2044 }
2045
2046 for (i = 0; i < ARRAY_SIZE(w83795_temp); i++) {
2047 if (!(data->has_temp & (1 << i)))
2048 continue;
2049 for (j = 0; j < NUM_TEMP_ATTRIBUTES; j++) {
2050 if (j == 7 && !data->enable_beep)
2051 continue;
2052 err = fn(dev, &w83795_temp[i][j].dev_attr);
2053 if (err)
2054 return err;
2055 }
2056 }
2057
2058 if (data->enable_dts) {
2059 for (i = 0; i < ARRAY_SIZE(w83795_dts); i++) {
2060 if (!(data->has_dts & (1 << i)))
2061 continue;
2062 for (j = 0; j < ARRAY_SIZE(w83795_dts[0]); j++) {
2063 if (j == 7 && !data->enable_beep)
2064 continue;
2065 err = fn(dev, &w83795_dts[i][j].dev_attr);
2066 if (err)
2067 return err;
2068 }
2069 }
2070 }
2071
2072 return 0;
2073 }
2074
2075
2076 static int device_remove_file_wrapper(struct device *dev,
2077 const struct device_attribute *attr)
2078 {
2079 device_remove_file(dev, attr);
2080 return 0;
2081 }
2082
2083 static void w83795_check_dynamic_in_limits(struct i2c_client *client)
2084 {
2085 struct w83795_data *data = i2c_get_clientdata(client);
2086 u8 vid_ctl;
2087 int i, err_max, err_min;
2088
2089 vid_ctl = w83795_read(client, W83795_REG_VID_CTRL);
2090
2091
2092 if ((vid_ctl & 0x07) == 0x00 || (vid_ctl & 0x07) == 0x07)
2093 return;
2094
2095 data->has_dyn_in = (vid_ctl >> 3) & 0x07;
2096 for (i = 0; i < 2; i++) {
2097 if (!(data->has_dyn_in & (1 << i)))
2098 continue;
2099
2100
2101 err_max = sysfs_chmod_file(&client->dev.kobj,
2102 &w83795_in[i][2].dev_attr.attr,
2103 S_IRUGO);
2104 err_min = sysfs_chmod_file(&client->dev.kobj,
2105 &w83795_in[i][3].dev_attr.attr,
2106 S_IRUGO);
2107 if (err_max || err_min)
2108 dev_warn(&client->dev,
2109 "Failed to set in%d limits read-only (%d, %d)\n",
2110 i, err_max, err_min);
2111 else
2112 dev_info(&client->dev,
2113 "in%d limits set dynamically from VID\n", i);
2114 }
2115 }
2116
2117
2118 static void w83795_apply_temp_config(struct w83795_data *data, u8 config,
2119 int temp_chan, int in_chan)
2120 {
2121
2122 switch (config) {
2123 case 0x2:
2124 data->has_in |= 1 << in_chan;
2125 break;
2126 case 0x1:
2127 if (temp_chan >= 4)
2128 break;
2129 data->temp_mode |= 1 << temp_chan;
2130 fallthrough;
2131 case 0x3:
2132 data->has_temp |= 1 << temp_chan;
2133 break;
2134 }
2135 }
2136
2137 static const struct i2c_device_id w83795_id[];
2138
2139 static int w83795_probe(struct i2c_client *client)
2140 {
2141 int i;
2142 u8 tmp;
2143 struct device *dev = &client->dev;
2144 struct w83795_data *data;
2145 int err;
2146
2147 data = devm_kzalloc(dev, sizeof(struct w83795_data), GFP_KERNEL);
2148 if (!data)
2149 return -ENOMEM;
2150
2151 i2c_set_clientdata(client, data);
2152 data->chip_type = i2c_match_id(w83795_id, client)->driver_data;
2153 data->bank = i2c_smbus_read_byte_data(client, W83795_REG_BANKSEL);
2154 mutex_init(&data->update_lock);
2155
2156
2157 w83795_init_client(client);
2158
2159
2160 data->has_in = w83795_read(client, W83795_REG_VOLT_CTRL1)
2161 | (w83795_read(client, W83795_REG_VOLT_CTRL2) << 8);
2162 data->has_fan = w83795_read(client, W83795_REG_FANIN_CTRL1)
2163 | (w83795_read(client, W83795_REG_FANIN_CTRL2) << 8);
2164
2165
2166 tmp = w83795_read(client, W83795_REG_TEMP_CTRL1);
2167 if (tmp & 0x20)
2168 data->enable_dts = 1;
2169 w83795_apply_temp_config(data, (tmp >> 2) & 0x3, 5, 16);
2170 w83795_apply_temp_config(data, tmp & 0x3, 4, 15);
2171 tmp = w83795_read(client, W83795_REG_TEMP_CTRL2);
2172 w83795_apply_temp_config(data, tmp >> 6, 3, 20);
2173 w83795_apply_temp_config(data, (tmp >> 4) & 0x3, 2, 19);
2174 w83795_apply_temp_config(data, (tmp >> 2) & 0x3, 1, 18);
2175 w83795_apply_temp_config(data, tmp & 0x3, 0, 17);
2176
2177
2178 if (data->enable_dts) {
2179 if (1 & w83795_read(client, W83795_REG_DTSC))
2180 data->enable_dts |= 2;
2181 data->has_dts = w83795_read(client, W83795_REG_DTSE);
2182 }
2183
2184
2185 if (data->enable_dts == 1) {
2186 for (i = 0; i < 8; i++) {
2187 if (!(data->has_dts & (1 << i)))
2188 continue;
2189 tmp = w83795_read(client, W83795_REG_PECI_TBASE(i));
2190 dev_info(&client->dev,
2191 "PECI agent %d Tbase temperature: %u\n",
2192 i + 1, (unsigned int)tmp & 0x7f);
2193 }
2194 }
2195
2196 data->has_gain = w83795_read(client, W83795_REG_VMIGB_CTRL) & 0x0f;
2197
2198
2199 if (data->chip_type == w83795g)
2200 data->has_pwm = 8;
2201 else
2202 data->has_pwm = 2;
2203
2204
2205 if (data->chip_type == w83795g) {
2206
2207 data->enable_beep = 1;
2208 } else {
2209
2210
2211
2212
2213 tmp = w83795_read(client, W83795_REG_OVT_CFG);
2214 if ((tmp & OVT_CFG_SEL) == 0)
2215 data->enable_beep = 1;
2216 }
2217
2218 err = w83795_handle_files(dev, device_create_file);
2219 if (err)
2220 goto exit_remove;
2221
2222 if (data->chip_type == w83795g)
2223 w83795_check_dynamic_in_limits(client);
2224
2225 data->hwmon_dev = hwmon_device_register(dev);
2226 if (IS_ERR(data->hwmon_dev)) {
2227 err = PTR_ERR(data->hwmon_dev);
2228 goto exit_remove;
2229 }
2230
2231 return 0;
2232
2233 exit_remove:
2234 w83795_handle_files(dev, device_remove_file_wrapper);
2235 return err;
2236 }
2237
2238 static int w83795_remove(struct i2c_client *client)
2239 {
2240 struct w83795_data *data = i2c_get_clientdata(client);
2241
2242 hwmon_device_unregister(data->hwmon_dev);
2243 w83795_handle_files(&client->dev, device_remove_file_wrapper);
2244
2245 return 0;
2246 }
2247
2248
2249 static const struct i2c_device_id w83795_id[] = {
2250 { "w83795g", w83795g },
2251 { "w83795adg", w83795adg },
2252 { }
2253 };
2254 MODULE_DEVICE_TABLE(i2c, w83795_id);
2255
2256 static struct i2c_driver w83795_driver = {
2257 .driver = {
2258 .name = "w83795",
2259 },
2260 .probe_new = w83795_probe,
2261 .remove = w83795_remove,
2262 .id_table = w83795_id,
2263
2264 .class = I2C_CLASS_HWMON,
2265 .detect = w83795_detect,
2266 .address_list = normal_i2c,
2267 };
2268
2269 module_i2c_driver(w83795_driver);
2270
2271 MODULE_AUTHOR("Wei Song, Jean Delvare <jdelvare@suse.de>");
2272 MODULE_DESCRIPTION("W83795G/ADG hardware monitoring driver");
2273 MODULE_LICENSE("GPL");