0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
0016
0017 #include <linux/module.h>
0018 #include <linux/init.h>
0019 #include <linux/slab.h>
0020 #include <linux/jiffies.h>
0021 #include <linux/i2c.h>
0022 #include <linux/platform_device.h>
0023 #include <linux/hwmon.h>
0024 #include <linux/hwmon-sysfs.h>
0025 #include <linux/hwmon-vid.h>
0026 #include <linux/err.h>
0027 #include <linux/mutex.h>
0028 #include <linux/acpi.h>
0029 #include <linux/io.h>
0030
0031
0032 static struct platform_device *pdev;
0033
0034
0035 static bool force_start;
0036 module_param(force_start, bool, 0);
0037 MODULE_PARM_DESC(force_start, "Force the chip to start monitoring inputs");
0038
0039 static unsigned short force_id;
0040 module_param(force_id, ushort, 0);
0041 MODULE_PARM_DESC(force_id, "Override the detected device ID");
0042
0043 static bool probe_all_addr;
0044 module_param(probe_all_addr, bool, 0);
0045 MODULE_PARM_DESC(probe_all_addr,
0046 "Include probing of non-standard LPC addresses");
0047
0048
0049 static const unsigned short normal_i2c[] = {0x2c, 0x2d, 0x2e, I2C_CLIENT_END};
0050
0051 enum chips { dme1737, sch5027, sch311x, sch5127 };
0052
0053 #define DO_REPORT "Please report to the driver maintainer."
0054
0055
0056
0057
0058
0059
0060
0061
0062
0063
0064
0065
0066
0067
0068
0069
0070
0071
0072
0073
0074 #define DME1737_REG_IN(ix) ((ix) < 5 ? 0x20 + (ix) : \
0075 (ix) < 7 ? 0x94 + (ix) : \
0076 0x1f)
0077 #define DME1737_REG_IN_MIN(ix) ((ix) < 5 ? 0x44 + (ix) * 2 \
0078 : 0x91 + (ix) * 2)
0079 #define DME1737_REG_IN_MAX(ix) ((ix) < 5 ? 0x45 + (ix) * 2 \
0080 : 0x92 + (ix) * 2)
0081
0082
0083 #define DME1737_REG_TEMP(ix) (0x25 + (ix))
0084 #define DME1737_REG_TEMP_MIN(ix) (0x4e + (ix) * 2)
0085 #define DME1737_REG_TEMP_MAX(ix) (0x4f + (ix) * 2)
0086 #define DME1737_REG_TEMP_OFFSET(ix) ((ix) == 0 ? 0x1f \
0087 : 0x1c + (ix))
0088
0089
0090
0091
0092
0093
0094
0095
0096
0097
0098
0099 #define DME1737_REG_IN_TEMP_LSB(ix) (0x84 + (ix))
0100 static const u8 DME1737_REG_IN_LSB[] = {3, 4, 4, 3, 2, 0, 0, 5};
0101 static const u8 DME1737_REG_IN_LSB_SHL[] = {4, 4, 0, 0, 0, 0, 4, 4};
0102 static const u8 DME1737_REG_TEMP_LSB[] = {1, 2, 1};
0103 static const u8 DME1737_REG_TEMP_LSB_SHL[] = {4, 4, 0};
0104
0105
0106 #define DME1737_REG_FAN(ix) ((ix) < 4 ? 0x28 + (ix) * 2 \
0107 : 0xa1 + (ix) * 2)
0108 #define DME1737_REG_FAN_MIN(ix) ((ix) < 4 ? 0x54 + (ix) * 2 \
0109 : 0xa5 + (ix) * 2)
0110 #define DME1737_REG_FAN_OPT(ix) ((ix) < 4 ? 0x90 + (ix) \
0111 : 0xb2 + (ix))
0112 #define DME1737_REG_FAN_MAX(ix) (0xb4 + (ix))
0113
0114
0115 #define DME1737_REG_PWM(ix) ((ix) < 3 ? 0x30 + (ix) \
0116 : 0xa1 + (ix))
0117 #define DME1737_REG_PWM_CONFIG(ix) (0x5c + (ix))
0118 #define DME1737_REG_PWM_MIN(ix) (0x64 + (ix))
0119 #define DME1737_REG_PWM_FREQ(ix) ((ix) < 3 ? 0x5f + (ix) \
0120 : 0xa3 + (ix))
0121
0122
0123
0124
0125
0126
0127 #define DME1737_REG_PWM_RR(ix) (0x62 + (ix))
0128
0129
0130 #define DME1737_REG_ZONE_LOW(ix) (0x67 + (ix))
0131 #define DME1737_REG_ZONE_ABS(ix) (0x6a + (ix))
0132
0133
0134
0135
0136
0137
0138 #define DME1737_REG_ZONE_HYST(ix) (0x6d + (ix))
0139
0140
0141
0142
0143
0144
0145 #define DME1737_REG_ALARM1 0x41
0146 #define DME1737_REG_ALARM2 0x42
0147 #define DME1737_REG_ALARM3 0x83
0148 static const u8 DME1737_BIT_ALARM_IN[] = {0, 1, 2, 3, 8, 16, 17, 18};
0149 static const u8 DME1737_BIT_ALARM_TEMP[] = {4, 5, 6};
0150 static const u8 DME1737_BIT_ALARM_FAN[] = {10, 11, 12, 13, 22, 23};
0151
0152
0153 #define DME1737_REG_DEVICE 0x3d
0154 #define DME1737_REG_COMPANY 0x3e
0155 #define DME1737_REG_VERSTEP 0x3f
0156 #define DME1737_REG_CONFIG 0x40
0157 #define DME1737_REG_CONFIG2 0x7f
0158 #define DME1737_REG_VID 0x43
0159 #define DME1737_REG_TACH_PWM 0x81
0160
0161
0162
0163
0164
0165
0166 #define DME1737_COMPANY_SMSC 0x5c
0167 #define DME1737_VERSTEP 0x88
0168 #define DME1737_VERSTEP_MASK 0xf8
0169 #define SCH311X_DEVICE 0x8c
0170 #define SCH5027_VERSTEP 0x69
0171 #define SCH5127_DEVICE 0x8e
0172
0173
0174 #define DME1737_ID_1 0x77
0175 #define DME1737_ID_2 0x78
0176 #define SCH3112_ID 0x7c
0177 #define SCH3114_ID 0x7d
0178 #define SCH3116_ID 0x7f
0179 #define SCH5027_ID 0x89
0180 #define SCH5127_ID 0x86
0181
0182
0183 #define DME1737_EXTENT 2
0184
0185
0186 #define HAS_TEMP_OFFSET (1 << 0)
0187 #define HAS_VID (1 << 1)
0188 #define HAS_ZONE3 (1 << 2)
0189 #define HAS_ZONE_HYST (1 << 3)
0190 #define HAS_PWM_MIN (1 << 4)
0191 #define HAS_FAN(ix) (1 << ((ix) + 5))
0192 #define HAS_PWM(ix) (1 << ((ix) + 11))
0193 #define HAS_IN7 (1 << 17)
0194
0195
0196
0197
0198
0199 struct dme1737_data {
0200 struct i2c_client *client;
0201 struct device *hwmon_dev;
0202 const char *name;
0203 unsigned int addr;
0204
0205 struct mutex update_lock;
0206 bool valid;
0207 unsigned long last_update;
0208 unsigned long last_vbat;
0209 enum chips type;
0210 const int *in_nominal;
0211
0212 u8 vid;
0213 u8 pwm_rr_en;
0214 u32 has_features;
0215
0216
0217 u16 in[8];
0218 u8 in_min[8];
0219 u8 in_max[8];
0220 s16 temp[3];
0221 s8 temp_min[3];
0222 s8 temp_max[3];
0223 s8 temp_offset[3];
0224 u8 config;
0225 u8 config2;
0226 u8 vrm;
0227 u16 fan[6];
0228 u16 fan_min[6];
0229 u8 fan_max[2];
0230 u8 fan_opt[6];
0231 u8 pwm[6];
0232 u8 pwm_min[3];
0233 u8 pwm_config[3];
0234 u8 pwm_acz[3];
0235 u8 pwm_freq[6];
0236 u8 pwm_rr[2];
0237 s8 zone_low[3];
0238 s8 zone_abs[3];
0239 u8 zone_hyst[2];
0240 u32 alarms;
0241 };
0242
0243
0244 static const int IN_NOMINAL_DME1737[] = {5000, 2250, 3300, 5000, 12000, 3300,
0245 3300};
0246 static const int IN_NOMINAL_SCH311x[] = {2500, 1500, 3300, 5000, 12000, 3300,
0247 3300};
0248 static const int IN_NOMINAL_SCH5027[] = {5000, 2250, 3300, 1125, 1125, 3300,
0249 3300};
0250 static const int IN_NOMINAL_SCH5127[] = {2500, 2250, 3300, 1125, 1125, 3300,
0251 3300, 1500};
0252 #define IN_NOMINAL(type) ((type) == sch311x ? IN_NOMINAL_SCH311x : \
0253 (type) == sch5027 ? IN_NOMINAL_SCH5027 : \
0254 (type) == sch5127 ? IN_NOMINAL_SCH5127 : \
0255 IN_NOMINAL_DME1737)
0256
0257
0258
0259
0260
0261
0262 static inline int IN_FROM_REG(int reg, int nominal, int res)
0263 {
0264 return (reg * nominal + (3 << (res - 3))) / (3 << (res - 2));
0265 }
0266
0267 static inline int IN_TO_REG(long val, int nominal)
0268 {
0269 val = clamp_val(val, 0, 255 * nominal / 192);
0270 return DIV_ROUND_CLOSEST(val * 192, nominal);
0271 }
0272
0273
0274
0275
0276
0277
0278
0279 static inline int TEMP_FROM_REG(int reg, int res)
0280 {
0281 return (reg * 1000) >> (res - 8);
0282 }
0283
0284 static inline int TEMP_TO_REG(long val)
0285 {
0286 val = clamp_val(val, -128000, 127000);
0287 return DIV_ROUND_CLOSEST(val, 1000);
0288 }
0289
0290
0291 static const int TEMP_RANGE[] = {2000, 2500, 3333, 4000, 5000, 6666, 8000,
0292 10000, 13333, 16000, 20000, 26666, 32000,
0293 40000, 53333, 80000};
0294
0295 static inline int TEMP_RANGE_FROM_REG(int reg)
0296 {
0297 return TEMP_RANGE[(reg >> 4) & 0x0f];
0298 }
0299
0300 static int TEMP_RANGE_TO_REG(long val, int reg)
0301 {
0302 int i;
0303
0304 for (i = 15; i > 0; i--) {
0305 if (val > (TEMP_RANGE[i] + TEMP_RANGE[i - 1] + 1) / 2)
0306 break;
0307 }
0308
0309 return (reg & 0x0f) | (i << 4);
0310 }
0311
0312
0313
0314
0315
0316
0317
0318 static inline int TEMP_HYST_FROM_REG(int reg, int ix)
0319 {
0320 return (((ix == 1) ? reg : reg >> 4) & 0x0f) * 1000;
0321 }
0322
0323 static inline int TEMP_HYST_TO_REG(int temp, long hyst, int ix, int reg)
0324 {
0325 hyst = clamp_val(hyst, temp - 15000, temp);
0326 hyst = DIV_ROUND_CLOSEST(temp - hyst, 1000);
0327
0328 return (ix == 1) ? (reg & 0xf0) | hyst : (reg & 0x0f) | (hyst << 4);
0329 }
0330
0331
0332 static inline int FAN_FROM_REG(int reg, int tpc)
0333 {
0334 if (tpc)
0335 return tpc * reg;
0336 else
0337 return (reg == 0 || reg == 0xffff) ? 0 : 90000 * 60 / reg;
0338 }
0339
0340 static inline int FAN_TO_REG(long val, int tpc)
0341 {
0342 if (tpc) {
0343 return clamp_val(val / tpc, 0, 0xffff);
0344 } else {
0345 return (val <= 0) ? 0xffff :
0346 clamp_val(90000 * 60 / val, 0, 0xfffe);
0347 }
0348 }
0349
0350
0351
0352
0353
0354
0355 static inline int FAN_TPC_FROM_REG(int reg)
0356 {
0357 return (reg & 0x20) ? 0 : 60 >> (reg & 0x03);
0358 }
0359
0360
0361
0362
0363
0364
0365 static inline int FAN_TYPE_FROM_REG(int reg)
0366 {
0367 int edge = (reg >> 1) & 0x03;
0368
0369 return (edge > 0) ? 1 << (edge - 1) : 0;
0370 }
0371
0372 static inline int FAN_TYPE_TO_REG(long val, int reg)
0373 {
0374 int edge = (val == 4) ? 3 : val;
0375
0376 return (reg & 0xf9) | (edge << 1);
0377 }
0378
0379
0380 static const int FAN_MAX[] = {0x54, 0x38, 0x2a, 0x21, 0x1c, 0x18, 0x15, 0x12,
0381 0x11, 0x0f, 0x0e};
0382
0383 static int FAN_MAX_FROM_REG(int reg)
0384 {
0385 int i;
0386
0387 for (i = 10; i > 0; i--) {
0388 if (reg == FAN_MAX[i])
0389 break;
0390 }
0391
0392 return 1000 + i * 500;
0393 }
0394
0395 static int FAN_MAX_TO_REG(long val)
0396 {
0397 int i;
0398
0399 for (i = 10; i > 0; i--) {
0400 if (val > (1000 + (i - 1) * 500))
0401 break;
0402 }
0403
0404 return FAN_MAX[i];
0405 }
0406
0407
0408
0409
0410
0411
0412
0413
0414
0415
0416
0417
0418
0419 static inline int PWM_EN_FROM_REG(int reg)
0420 {
0421 static const int en[] = {2, 2, 2, 0, -1, 2, 2, 1};
0422
0423 return en[(reg >> 5) & 0x07];
0424 }
0425
0426 static inline int PWM_EN_TO_REG(int val, int reg)
0427 {
0428 int en = (val == 1) ? 7 : 3;
0429
0430 return (reg & 0x1f) | ((en & 0x07) << 5);
0431 }
0432
0433
0434
0435
0436
0437
0438
0439
0440
0441
0442
0443
0444
0445
0446 static inline int PWM_ACZ_FROM_REG(int reg)
0447 {
0448 static const int acz[] = {1, 2, 4, 0, 0, 6, 7, 0};
0449
0450 return acz[(reg >> 5) & 0x07];
0451 }
0452
0453 static inline int PWM_ACZ_TO_REG(long val, int reg)
0454 {
0455 int acz = (val == 4) ? 2 : val - 1;
0456
0457 return (reg & 0x1f) | ((acz & 0x07) << 5);
0458 }
0459
0460
0461 static const int PWM_FREQ[] = {11, 15, 22, 29, 35, 44, 59, 88,
0462 15000, 20000, 30000, 25000, 0, 0, 0, 0};
0463
0464 static inline int PWM_FREQ_FROM_REG(int reg)
0465 {
0466 return PWM_FREQ[reg & 0x0f];
0467 }
0468
0469 static int PWM_FREQ_TO_REG(long val, int reg)
0470 {
0471 int i;
0472
0473
0474 if (val > 27500) {
0475 i = 10;
0476 } else if (val > 22500) {
0477 i = 11;
0478 } else {
0479 for (i = 9; i > 0; i--) {
0480 if (val > (PWM_FREQ[i] + PWM_FREQ[i - 1] + 1) / 2)
0481 break;
0482 }
0483 }
0484
0485 return (reg & 0xf0) | i;
0486 }
0487
0488
0489
0490
0491
0492
0493
0494 static const u8 PWM_RR[] = {206, 104, 69, 41, 26, 18, 10, 5};
0495
0496 static inline int PWM_RR_FROM_REG(int reg, int ix)
0497 {
0498 int rr = (ix == 1) ? reg >> 4 : reg;
0499
0500 return (rr & 0x08) ? PWM_RR[rr & 0x07] : 0;
0501 }
0502
0503 static int PWM_RR_TO_REG(long val, int ix, int reg)
0504 {
0505 int i;
0506
0507 for (i = 0; i < 7; i++) {
0508 if (val > (PWM_RR[i] + PWM_RR[i + 1] + 1) / 2)
0509 break;
0510 }
0511
0512 return (ix == 1) ? (reg & 0x8f) | (i << 4) : (reg & 0xf8) | i;
0513 }
0514
0515
0516 static inline int PWM_RR_EN_FROM_REG(int reg, int ix)
0517 {
0518 return PWM_RR_FROM_REG(reg, ix) ? 1 : 0;
0519 }
0520
0521 static inline int PWM_RR_EN_TO_REG(long val, int ix, int reg)
0522 {
0523 int en = (ix == 1) ? 0x80 : 0x08;
0524
0525 return val ? reg | en : reg & ~en;
0526 }
0527
0528
0529
0530
0531
0532
0533 static inline int PWM_OFF_FROM_REG(int reg, int ix)
0534 {
0535 return (reg >> (ix + 5)) & 0x01;
0536 }
0537
0538 static inline int PWM_OFF_TO_REG(int val, int ix, int reg)
0539 {
0540 return (reg & ~(1 << (ix + 5))) | ((val & 0x01) << (ix + 5));
0541 }
0542
0543
0544
0545
0546
0547
0548
0549
0550
0551
0552 static u8 dme1737_read(const struct dme1737_data *data, u8 reg)
0553 {
0554 struct i2c_client *client = data->client;
0555 s32 val;
0556
0557 if (client) {
0558 val = i2c_smbus_read_byte_data(client, reg);
0559
0560 if (val < 0) {
0561 dev_warn(&client->dev,
0562 "Read from register 0x%02x failed! %s\n",
0563 reg, DO_REPORT);
0564 }
0565 } else {
0566 outb(reg, data->addr);
0567 val = inb(data->addr + 1);
0568 }
0569
0570 return val;
0571 }
0572
0573 static s32 dme1737_write(const struct dme1737_data *data, u8 reg, u8 val)
0574 {
0575 struct i2c_client *client = data->client;
0576 s32 res = 0;
0577
0578 if (client) {
0579 res = i2c_smbus_write_byte_data(client, reg, val);
0580
0581 if (res < 0) {
0582 dev_warn(&client->dev,
0583 "Write to register 0x%02x failed! %s\n",
0584 reg, DO_REPORT);
0585 }
0586 } else {
0587 outb(reg, data->addr);
0588 outb(val, data->addr + 1);
0589 }
0590
0591 return res;
0592 }
0593
0594 static struct dme1737_data *dme1737_update_device(struct device *dev)
0595 {
0596 struct dme1737_data *data = dev_get_drvdata(dev);
0597 int ix;
0598 u8 lsb[6];
0599
0600 mutex_lock(&data->update_lock);
0601
0602
0603 if (time_after(jiffies, data->last_vbat + 600 * HZ) || !data->valid) {
0604 dme1737_write(data, DME1737_REG_CONFIG, dme1737_read(data,
0605 DME1737_REG_CONFIG) | 0x10);
0606 data->last_vbat = jiffies;
0607 }
0608
0609
0610 if (time_after(jiffies, data->last_update + HZ) || !data->valid) {
0611 if (data->has_features & HAS_VID) {
0612 data->vid = dme1737_read(data, DME1737_REG_VID) &
0613 0x3f;
0614 }
0615
0616
0617 for (ix = 0; ix < ARRAY_SIZE(data->in); ix++) {
0618
0619
0620
0621
0622
0623 if (ix == 7 && !(data->has_features & HAS_IN7))
0624 continue;
0625 data->in[ix] = dme1737_read(data,
0626 DME1737_REG_IN(ix)) << 8;
0627 data->in_min[ix] = dme1737_read(data,
0628 DME1737_REG_IN_MIN(ix));
0629 data->in_max[ix] = dme1737_read(data,
0630 DME1737_REG_IN_MAX(ix));
0631 }
0632
0633
0634 for (ix = 0; ix < ARRAY_SIZE(data->temp); ix++) {
0635
0636
0637
0638
0639
0640
0641
0642 data->temp[ix] = dme1737_read(data,
0643 DME1737_REG_TEMP(ix)) << 8;
0644 data->temp_min[ix] = dme1737_read(data,
0645 DME1737_REG_TEMP_MIN(ix));
0646 data->temp_max[ix] = dme1737_read(data,
0647 DME1737_REG_TEMP_MAX(ix));
0648 if (data->has_features & HAS_TEMP_OFFSET) {
0649 data->temp_offset[ix] = dme1737_read(data,
0650 DME1737_REG_TEMP_OFFSET(ix));
0651 }
0652 }
0653
0654
0655
0656
0657
0658
0659
0660 for (ix = 0; ix < ARRAY_SIZE(lsb); ix++) {
0661 if (ix == 5 && !(data->has_features & HAS_IN7))
0662 continue;
0663 lsb[ix] = dme1737_read(data,
0664 DME1737_REG_IN_TEMP_LSB(ix));
0665 }
0666 for (ix = 0; ix < ARRAY_SIZE(data->in); ix++) {
0667 if (ix == 7 && !(data->has_features & HAS_IN7))
0668 continue;
0669 data->in[ix] |= (lsb[DME1737_REG_IN_LSB[ix]] <<
0670 DME1737_REG_IN_LSB_SHL[ix]) & 0xf0;
0671 }
0672 for (ix = 0; ix < ARRAY_SIZE(data->temp); ix++) {
0673 data->temp[ix] |= (lsb[DME1737_REG_TEMP_LSB[ix]] <<
0674 DME1737_REG_TEMP_LSB_SHL[ix]) & 0xf0;
0675 }
0676
0677
0678 for (ix = 0; ix < ARRAY_SIZE(data->fan); ix++) {
0679
0680
0681
0682
0683 if (!(data->has_features & HAS_FAN(ix)))
0684 continue;
0685 data->fan[ix] = dme1737_read(data,
0686 DME1737_REG_FAN(ix));
0687 data->fan[ix] |= dme1737_read(data,
0688 DME1737_REG_FAN(ix) + 1) << 8;
0689 data->fan_min[ix] = dme1737_read(data,
0690 DME1737_REG_FAN_MIN(ix));
0691 data->fan_min[ix] |= dme1737_read(data,
0692 DME1737_REG_FAN_MIN(ix) + 1) << 8;
0693 data->fan_opt[ix] = dme1737_read(data,
0694 DME1737_REG_FAN_OPT(ix));
0695
0696 if (ix > 3) {
0697 data->fan_max[ix - 4] = dme1737_read(data,
0698 DME1737_REG_FAN_MAX(ix));
0699 }
0700 }
0701
0702
0703 for (ix = 0; ix < ARRAY_SIZE(data->pwm); ix++) {
0704
0705
0706
0707
0708 if (!(data->has_features & HAS_PWM(ix)))
0709 continue;
0710 data->pwm[ix] = dme1737_read(data,
0711 DME1737_REG_PWM(ix));
0712 data->pwm_freq[ix] = dme1737_read(data,
0713 DME1737_REG_PWM_FREQ(ix));
0714
0715 if (ix < 3) {
0716 data->pwm_config[ix] = dme1737_read(data,
0717 DME1737_REG_PWM_CONFIG(ix));
0718 data->pwm_min[ix] = dme1737_read(data,
0719 DME1737_REG_PWM_MIN(ix));
0720 }
0721 }
0722 for (ix = 0; ix < ARRAY_SIZE(data->pwm_rr); ix++) {
0723 data->pwm_rr[ix] = dme1737_read(data,
0724 DME1737_REG_PWM_RR(ix));
0725 }
0726
0727
0728 for (ix = 0; ix < ARRAY_SIZE(data->zone_low); ix++) {
0729
0730 if ((ix == 2) && !(data->has_features & HAS_ZONE3))
0731 continue;
0732
0733 if ((ix == 1) && (data->type == sch5127)) {
0734 data->zone_low[1] = dme1737_read(data,
0735 DME1737_REG_ZONE_LOW(2));
0736 data->zone_abs[1] = dme1737_read(data,
0737 DME1737_REG_ZONE_ABS(2));
0738 } else {
0739 data->zone_low[ix] = dme1737_read(data,
0740 DME1737_REG_ZONE_LOW(ix));
0741 data->zone_abs[ix] = dme1737_read(data,
0742 DME1737_REG_ZONE_ABS(ix));
0743 }
0744 }
0745 if (data->has_features & HAS_ZONE_HYST) {
0746 for (ix = 0; ix < ARRAY_SIZE(data->zone_hyst); ix++) {
0747 data->zone_hyst[ix] = dme1737_read(data,
0748 DME1737_REG_ZONE_HYST(ix));
0749 }
0750 }
0751
0752
0753 data->alarms = dme1737_read(data,
0754 DME1737_REG_ALARM1);
0755
0756
0757
0758
0759 if (data->alarms & 0x80) {
0760 data->alarms |= dme1737_read(data,
0761 DME1737_REG_ALARM2) << 8;
0762 data->alarms |= dme1737_read(data,
0763 DME1737_REG_ALARM3) << 16;
0764 }
0765
0766
0767
0768
0769
0770
0771 if (!data->client) {
0772 if (data->alarms & 0xff0000)
0773 dme1737_write(data, DME1737_REG_ALARM3, 0xff);
0774 if (data->alarms & 0xff00)
0775 dme1737_write(data, DME1737_REG_ALARM2, 0xff);
0776 if (data->alarms & 0xff)
0777 dme1737_write(data, DME1737_REG_ALARM1, 0xff);
0778 }
0779
0780 data->last_update = jiffies;
0781 data->valid = true;
0782 }
0783
0784 mutex_unlock(&data->update_lock);
0785
0786 return data;
0787 }
0788
0789
0790
0791
0792
0793
0794 #define SYS_IN_INPUT 0
0795 #define SYS_IN_MIN 1
0796 #define SYS_IN_MAX 2
0797 #define SYS_IN_ALARM 3
0798
0799 static ssize_t show_in(struct device *dev, struct device_attribute *attr,
0800 char *buf)
0801 {
0802 struct dme1737_data *data = dme1737_update_device(dev);
0803 struct sensor_device_attribute_2
0804 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
0805 int ix = sensor_attr_2->index;
0806 int fn = sensor_attr_2->nr;
0807 int res;
0808
0809 switch (fn) {
0810 case SYS_IN_INPUT:
0811 res = IN_FROM_REG(data->in[ix], data->in_nominal[ix], 16);
0812 break;
0813 case SYS_IN_MIN:
0814 res = IN_FROM_REG(data->in_min[ix], data->in_nominal[ix], 8);
0815 break;
0816 case SYS_IN_MAX:
0817 res = IN_FROM_REG(data->in_max[ix], data->in_nominal[ix], 8);
0818 break;
0819 case SYS_IN_ALARM:
0820 res = (data->alarms >> DME1737_BIT_ALARM_IN[ix]) & 0x01;
0821 break;
0822 default:
0823 res = 0;
0824 dev_dbg(dev, "Unknown function %d.\n", fn);
0825 }
0826
0827 return sprintf(buf, "%d\n", res);
0828 }
0829
0830 static ssize_t set_in(struct device *dev, struct device_attribute *attr,
0831 const char *buf, size_t count)
0832 {
0833 struct dme1737_data *data = dev_get_drvdata(dev);
0834 struct sensor_device_attribute_2
0835 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
0836 int ix = sensor_attr_2->index;
0837 int fn = sensor_attr_2->nr;
0838 long val;
0839 int err;
0840
0841 err = kstrtol(buf, 10, &val);
0842 if (err)
0843 return err;
0844
0845 mutex_lock(&data->update_lock);
0846 switch (fn) {
0847 case SYS_IN_MIN:
0848 data->in_min[ix] = IN_TO_REG(val, data->in_nominal[ix]);
0849 dme1737_write(data, DME1737_REG_IN_MIN(ix),
0850 data->in_min[ix]);
0851 break;
0852 case SYS_IN_MAX:
0853 data->in_max[ix] = IN_TO_REG(val, data->in_nominal[ix]);
0854 dme1737_write(data, DME1737_REG_IN_MAX(ix),
0855 data->in_max[ix]);
0856 break;
0857 default:
0858 dev_dbg(dev, "Unknown function %d.\n", fn);
0859 }
0860 mutex_unlock(&data->update_lock);
0861
0862 return count;
0863 }
0864
0865
0866
0867
0868
0869
0870 #define SYS_TEMP_INPUT 0
0871 #define SYS_TEMP_MIN 1
0872 #define SYS_TEMP_MAX 2
0873 #define SYS_TEMP_OFFSET 3
0874 #define SYS_TEMP_ALARM 4
0875 #define SYS_TEMP_FAULT 5
0876
0877 static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
0878 char *buf)
0879 {
0880 struct dme1737_data *data = dme1737_update_device(dev);
0881 struct sensor_device_attribute_2
0882 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
0883 int ix = sensor_attr_2->index;
0884 int fn = sensor_attr_2->nr;
0885 int res;
0886
0887 switch (fn) {
0888 case SYS_TEMP_INPUT:
0889 res = TEMP_FROM_REG(data->temp[ix], 16);
0890 break;
0891 case SYS_TEMP_MIN:
0892 res = TEMP_FROM_REG(data->temp_min[ix], 8);
0893 break;
0894 case SYS_TEMP_MAX:
0895 res = TEMP_FROM_REG(data->temp_max[ix], 8);
0896 break;
0897 case SYS_TEMP_OFFSET:
0898 res = TEMP_FROM_REG(data->temp_offset[ix], 8);
0899 break;
0900 case SYS_TEMP_ALARM:
0901 res = (data->alarms >> DME1737_BIT_ALARM_TEMP[ix]) & 0x01;
0902 break;
0903 case SYS_TEMP_FAULT:
0904 res = (((u16)data->temp[ix] & 0xff00) == 0x8000);
0905 break;
0906 default:
0907 res = 0;
0908 dev_dbg(dev, "Unknown function %d.\n", fn);
0909 }
0910
0911 return sprintf(buf, "%d\n", res);
0912 }
0913
0914 static ssize_t set_temp(struct device *dev, struct device_attribute *attr,
0915 const char *buf, size_t count)
0916 {
0917 struct dme1737_data *data = dev_get_drvdata(dev);
0918 struct sensor_device_attribute_2
0919 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
0920 int ix = sensor_attr_2->index;
0921 int fn = sensor_attr_2->nr;
0922 long val;
0923 int err;
0924
0925 err = kstrtol(buf, 10, &val);
0926 if (err)
0927 return err;
0928
0929 mutex_lock(&data->update_lock);
0930 switch (fn) {
0931 case SYS_TEMP_MIN:
0932 data->temp_min[ix] = TEMP_TO_REG(val);
0933 dme1737_write(data, DME1737_REG_TEMP_MIN(ix),
0934 data->temp_min[ix]);
0935 break;
0936 case SYS_TEMP_MAX:
0937 data->temp_max[ix] = TEMP_TO_REG(val);
0938 dme1737_write(data, DME1737_REG_TEMP_MAX(ix),
0939 data->temp_max[ix]);
0940 break;
0941 case SYS_TEMP_OFFSET:
0942 data->temp_offset[ix] = TEMP_TO_REG(val);
0943 dme1737_write(data, DME1737_REG_TEMP_OFFSET(ix),
0944 data->temp_offset[ix]);
0945 break;
0946 default:
0947 dev_dbg(dev, "Unknown function %d.\n", fn);
0948 }
0949 mutex_unlock(&data->update_lock);
0950
0951 return count;
0952 }
0953
0954
0955
0956
0957
0958
0959 #define SYS_ZONE_AUTO_CHANNELS_TEMP 0
0960 #define SYS_ZONE_AUTO_POINT1_TEMP_HYST 1
0961 #define SYS_ZONE_AUTO_POINT1_TEMP 2
0962 #define SYS_ZONE_AUTO_POINT2_TEMP 3
0963 #define SYS_ZONE_AUTO_POINT3_TEMP 4
0964
0965 static ssize_t show_zone(struct device *dev, struct device_attribute *attr,
0966 char *buf)
0967 {
0968 struct dme1737_data *data = dme1737_update_device(dev);
0969 struct sensor_device_attribute_2
0970 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
0971 int ix = sensor_attr_2->index;
0972 int fn = sensor_attr_2->nr;
0973 int res;
0974
0975 switch (fn) {
0976 case SYS_ZONE_AUTO_CHANNELS_TEMP:
0977
0978 if ((ix == 1) && (data->config2 & 0x02))
0979 res = 4;
0980 else
0981 res = 1 << ix;
0982 break;
0983 case SYS_ZONE_AUTO_POINT1_TEMP_HYST:
0984 res = TEMP_FROM_REG(data->zone_low[ix], 8) -
0985 TEMP_HYST_FROM_REG(data->zone_hyst[ix == 2], ix);
0986 break;
0987 case SYS_ZONE_AUTO_POINT1_TEMP:
0988 res = TEMP_FROM_REG(data->zone_low[ix], 8);
0989 break;
0990 case SYS_ZONE_AUTO_POINT2_TEMP:
0991
0992 res = TEMP_FROM_REG(data->zone_low[ix], 8) +
0993 TEMP_RANGE_FROM_REG(data->pwm_freq[ix]);
0994 break;
0995 case SYS_ZONE_AUTO_POINT3_TEMP:
0996 res = TEMP_FROM_REG(data->zone_abs[ix], 8);
0997 break;
0998 default:
0999 res = 0;
1000 dev_dbg(dev, "Unknown function %d.\n", fn);
1001 }
1002
1003 return sprintf(buf, "%d\n", res);
1004 }
1005
1006 static ssize_t set_zone(struct device *dev, struct device_attribute *attr,
1007 const char *buf, size_t count)
1008 {
1009 struct dme1737_data *data = dev_get_drvdata(dev);
1010 struct sensor_device_attribute_2
1011 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
1012 int ix = sensor_attr_2->index;
1013 int fn = sensor_attr_2->nr;
1014 long val;
1015 int temp;
1016 int err;
1017 u8 reg;
1018
1019 err = kstrtol(buf, 10, &val);
1020 if (err)
1021 return err;
1022
1023 mutex_lock(&data->update_lock);
1024 switch (fn) {
1025 case SYS_ZONE_AUTO_POINT1_TEMP_HYST:
1026
1027 data->zone_low[ix] = dme1737_read(data,
1028 DME1737_REG_ZONE_LOW(ix));
1029
1030 temp = TEMP_FROM_REG(data->zone_low[ix], 8);
1031 reg = dme1737_read(data, DME1737_REG_ZONE_HYST(ix == 2));
1032 data->zone_hyst[ix == 2] = TEMP_HYST_TO_REG(temp, val, ix, reg);
1033 dme1737_write(data, DME1737_REG_ZONE_HYST(ix == 2),
1034 data->zone_hyst[ix == 2]);
1035 break;
1036 case SYS_ZONE_AUTO_POINT1_TEMP:
1037 data->zone_low[ix] = TEMP_TO_REG(val);
1038 dme1737_write(data, DME1737_REG_ZONE_LOW(ix),
1039 data->zone_low[ix]);
1040 break;
1041 case SYS_ZONE_AUTO_POINT2_TEMP:
1042
1043 data->zone_low[ix] = dme1737_read(data,
1044 DME1737_REG_ZONE_LOW(ix));
1045
1046
1047
1048
1049 temp = TEMP_FROM_REG(data->zone_low[ix], 8);
1050 val = clamp_val(val, temp, temp + 80000);
1051 reg = dme1737_read(data, DME1737_REG_PWM_FREQ(ix));
1052 data->pwm_freq[ix] = TEMP_RANGE_TO_REG(val - temp, reg);
1053 dme1737_write(data, DME1737_REG_PWM_FREQ(ix),
1054 data->pwm_freq[ix]);
1055 break;
1056 case SYS_ZONE_AUTO_POINT3_TEMP:
1057 data->zone_abs[ix] = TEMP_TO_REG(val);
1058 dme1737_write(data, DME1737_REG_ZONE_ABS(ix),
1059 data->zone_abs[ix]);
1060 break;
1061 default:
1062 dev_dbg(dev, "Unknown function %d.\n", fn);
1063 }
1064 mutex_unlock(&data->update_lock);
1065
1066 return count;
1067 }
1068
1069
1070
1071
1072
1073
1074 #define SYS_FAN_INPUT 0
1075 #define SYS_FAN_MIN 1
1076 #define SYS_FAN_MAX 2
1077 #define SYS_FAN_ALARM 3
1078 #define SYS_FAN_TYPE 4
1079
1080 static ssize_t show_fan(struct device *dev, struct device_attribute *attr,
1081 char *buf)
1082 {
1083 struct dme1737_data *data = dme1737_update_device(dev);
1084 struct sensor_device_attribute_2
1085 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
1086 int ix = sensor_attr_2->index;
1087 int fn = sensor_attr_2->nr;
1088 int res;
1089
1090 switch (fn) {
1091 case SYS_FAN_INPUT:
1092 res = FAN_FROM_REG(data->fan[ix],
1093 ix < 4 ? 0 :
1094 FAN_TPC_FROM_REG(data->fan_opt[ix]));
1095 break;
1096 case SYS_FAN_MIN:
1097 res = FAN_FROM_REG(data->fan_min[ix],
1098 ix < 4 ? 0 :
1099 FAN_TPC_FROM_REG(data->fan_opt[ix]));
1100 break;
1101 case SYS_FAN_MAX:
1102
1103 res = FAN_MAX_FROM_REG(data->fan_max[ix - 4]);
1104 break;
1105 case SYS_FAN_ALARM:
1106 res = (data->alarms >> DME1737_BIT_ALARM_FAN[ix]) & 0x01;
1107 break;
1108 case SYS_FAN_TYPE:
1109
1110 res = FAN_TYPE_FROM_REG(data->fan_opt[ix]);
1111 break;
1112 default:
1113 res = 0;
1114 dev_dbg(dev, "Unknown function %d.\n", fn);
1115 }
1116
1117 return sprintf(buf, "%d\n", res);
1118 }
1119
1120 static ssize_t set_fan(struct device *dev, struct device_attribute *attr,
1121 const char *buf, size_t count)
1122 {
1123 struct dme1737_data *data = dev_get_drvdata(dev);
1124 struct sensor_device_attribute_2
1125 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
1126 int ix = sensor_attr_2->index;
1127 int fn = sensor_attr_2->nr;
1128 long val;
1129 int err;
1130
1131 err = kstrtol(buf, 10, &val);
1132 if (err)
1133 return err;
1134
1135 mutex_lock(&data->update_lock);
1136 switch (fn) {
1137 case SYS_FAN_MIN:
1138 if (ix < 4) {
1139 data->fan_min[ix] = FAN_TO_REG(val, 0);
1140 } else {
1141
1142 data->fan_opt[ix] = dme1737_read(data,
1143 DME1737_REG_FAN_OPT(ix));
1144
1145 data->fan_min[ix] = FAN_TO_REG(val,
1146 FAN_TPC_FROM_REG(data->fan_opt[ix]));
1147 }
1148 dme1737_write(data, DME1737_REG_FAN_MIN(ix),
1149 data->fan_min[ix] & 0xff);
1150 dme1737_write(data, DME1737_REG_FAN_MIN(ix) + 1,
1151 data->fan_min[ix] >> 8);
1152 break;
1153 case SYS_FAN_MAX:
1154
1155 data->fan_max[ix - 4] = FAN_MAX_TO_REG(val);
1156 dme1737_write(data, DME1737_REG_FAN_MAX(ix),
1157 data->fan_max[ix - 4]);
1158 break;
1159 case SYS_FAN_TYPE:
1160
1161 if (!(val == 1 || val == 2 || val == 4)) {
1162 count = -EINVAL;
1163 dev_warn(dev,
1164 "Fan type value %ld not supported. Choose one of 1, 2, or 4.\n",
1165 val);
1166 goto exit;
1167 }
1168 data->fan_opt[ix] = FAN_TYPE_TO_REG(val, dme1737_read(data,
1169 DME1737_REG_FAN_OPT(ix)));
1170 dme1737_write(data, DME1737_REG_FAN_OPT(ix),
1171 data->fan_opt[ix]);
1172 break;
1173 default:
1174 dev_dbg(dev, "Unknown function %d.\n", fn);
1175 }
1176 exit:
1177 mutex_unlock(&data->update_lock);
1178
1179 return count;
1180 }
1181
1182
1183
1184
1185
1186
1187 #define SYS_PWM 0
1188 #define SYS_PWM_FREQ 1
1189 #define SYS_PWM_ENABLE 2
1190 #define SYS_PWM_RAMP_RATE 3
1191 #define SYS_PWM_AUTO_CHANNELS_ZONE 4
1192 #define SYS_PWM_AUTO_PWM_MIN 5
1193 #define SYS_PWM_AUTO_POINT1_PWM 6
1194 #define SYS_PWM_AUTO_POINT2_PWM 7
1195
1196 static ssize_t show_pwm(struct device *dev, struct device_attribute *attr,
1197 char *buf)
1198 {
1199 struct dme1737_data *data = dme1737_update_device(dev);
1200 struct sensor_device_attribute_2
1201 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
1202 int ix = sensor_attr_2->index;
1203 int fn = sensor_attr_2->nr;
1204 int res;
1205
1206 switch (fn) {
1207 case SYS_PWM:
1208 if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 0)
1209 res = 255;
1210 else
1211 res = data->pwm[ix];
1212 break;
1213 case SYS_PWM_FREQ:
1214 res = PWM_FREQ_FROM_REG(data->pwm_freq[ix]);
1215 break;
1216 case SYS_PWM_ENABLE:
1217 if (ix >= 3)
1218 res = 1;
1219 else
1220 res = PWM_EN_FROM_REG(data->pwm_config[ix]);
1221 break;
1222 case SYS_PWM_RAMP_RATE:
1223
1224 res = PWM_RR_FROM_REG(data->pwm_rr[ix > 0], ix);
1225 break;
1226 case SYS_PWM_AUTO_CHANNELS_ZONE:
1227
1228 if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2)
1229 res = PWM_ACZ_FROM_REG(data->pwm_config[ix]);
1230 else
1231 res = data->pwm_acz[ix];
1232 break;
1233 case SYS_PWM_AUTO_PWM_MIN:
1234
1235 if (PWM_OFF_FROM_REG(data->pwm_rr[0], ix))
1236 res = data->pwm_min[ix];
1237 else
1238 res = 0;
1239 break;
1240 case SYS_PWM_AUTO_POINT1_PWM:
1241
1242 res = data->pwm_min[ix];
1243 break;
1244 case SYS_PWM_AUTO_POINT2_PWM:
1245
1246 res = 255;
1247 break;
1248 default:
1249 res = 0;
1250 dev_dbg(dev, "Unknown function %d.\n", fn);
1251 }
1252
1253 return sprintf(buf, "%d\n", res);
1254 }
1255
1256 static struct attribute *dme1737_pwm_chmod_attr[];
1257 static void dme1737_chmod_file(struct device*, struct attribute*, umode_t);
1258
1259 static ssize_t set_pwm(struct device *dev, struct device_attribute *attr,
1260 const char *buf, size_t count)
1261 {
1262 struct dme1737_data *data = dev_get_drvdata(dev);
1263 struct sensor_device_attribute_2
1264 *sensor_attr_2 = to_sensor_dev_attr_2(attr);
1265 int ix = sensor_attr_2->index;
1266 int fn = sensor_attr_2->nr;
1267 long val;
1268 int err;
1269
1270 err = kstrtol(buf, 10, &val);
1271 if (err)
1272 return err;
1273
1274 mutex_lock(&data->update_lock);
1275 switch (fn) {
1276 case SYS_PWM:
1277 data->pwm[ix] = clamp_val(val, 0, 255);
1278 dme1737_write(data, DME1737_REG_PWM(ix), data->pwm[ix]);
1279 break;
1280 case SYS_PWM_FREQ:
1281 data->pwm_freq[ix] = PWM_FREQ_TO_REG(val, dme1737_read(data,
1282 DME1737_REG_PWM_FREQ(ix)));
1283 dme1737_write(data, DME1737_REG_PWM_FREQ(ix),
1284 data->pwm_freq[ix]);
1285 break;
1286 case SYS_PWM_ENABLE:
1287
1288 if (val < 0 || val > 2) {
1289 count = -EINVAL;
1290 dev_warn(dev,
1291 "PWM enable %ld not supported. Choose one of 0, 1, or 2.\n",
1292 val);
1293 goto exit;
1294 }
1295
1296 data->pwm_config[ix] = dme1737_read(data,
1297 DME1737_REG_PWM_CONFIG(ix));
1298 if (val == PWM_EN_FROM_REG(data->pwm_config[ix])) {
1299
1300 goto exit;
1301 }
1302
1303 if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
1304
1305 data->pwm_acz[ix] = PWM_ACZ_FROM_REG(
1306 data->pwm_config[ix]);
1307
1308 data->pwm_rr[ix > 0] = dme1737_read(data,
1309 DME1737_REG_PWM_RR(ix > 0));
1310 data->pwm_rr_en &= ~(1 << ix);
1311 if (PWM_RR_EN_FROM_REG(data->pwm_rr[ix > 0], ix)) {
1312 data->pwm_rr_en |= (1 << ix);
1313 data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(0, ix,
1314 data->pwm_rr[ix > 0]);
1315 dme1737_write(data,
1316 DME1737_REG_PWM_RR(ix > 0),
1317 data->pwm_rr[ix > 0]);
1318 }
1319 }
1320
1321 switch (val) {
1322 case 0:
1323
1324 dme1737_chmod_file(dev, dme1737_pwm_chmod_attr[ix],
1325 S_IRUGO);
1326
1327 data->pwm_config[ix] = PWM_EN_TO_REG(0,
1328 data->pwm_config[ix]);
1329 dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1330 data->pwm_config[ix]);
1331 break;
1332 case 1:
1333
1334 data->pwm_config[ix] = PWM_EN_TO_REG(1,
1335 data->pwm_config[ix]);
1336 dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1337 data->pwm_config[ix]);
1338
1339 dme1737_chmod_file(dev, dme1737_pwm_chmod_attr[ix],
1340 S_IRUGO | S_IWUSR);
1341 break;
1342 case 2:
1343
1344 dme1737_chmod_file(dev, dme1737_pwm_chmod_attr[ix],
1345 S_IRUGO);
1346
1347
1348
1349
1350 data->pwm_config[ix] = PWM_ACZ_TO_REG(
1351 data->pwm_acz[ix],
1352 data->pwm_config[ix]);
1353 dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1354 data->pwm_config[ix]);
1355
1356 if (data->pwm_rr_en & (1 << ix)) {
1357 data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(1, ix,
1358 dme1737_read(data,
1359 DME1737_REG_PWM_RR(ix > 0)));
1360 dme1737_write(data,
1361 DME1737_REG_PWM_RR(ix > 0),
1362 data->pwm_rr[ix > 0]);
1363 }
1364 break;
1365 }
1366 break;
1367 case SYS_PWM_RAMP_RATE:
1368
1369
1370 data->pwm_config[ix] = dme1737_read(data,
1371 DME1737_REG_PWM_CONFIG(ix));
1372 data->pwm_rr[ix > 0] = dme1737_read(data,
1373 DME1737_REG_PWM_RR(ix > 0));
1374
1375 if (val > 0) {
1376 data->pwm_rr[ix > 0] = PWM_RR_TO_REG(val, ix,
1377 data->pwm_rr[ix > 0]);
1378 }
1379
1380
1381
1382
1383 if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
1384 data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(val > 0, ix,
1385 data->pwm_rr[ix > 0]);
1386 }
1387 dme1737_write(data, DME1737_REG_PWM_RR(ix > 0),
1388 data->pwm_rr[ix > 0]);
1389 break;
1390 case SYS_PWM_AUTO_CHANNELS_ZONE:
1391
1392 if (!(val == 1 || val == 2 || val == 4 ||
1393 val == 6 || val == 7)) {
1394 count = -EINVAL;
1395 dev_warn(dev,
1396 "PWM auto channels zone %ld not supported. Choose one of 1, 2, 4, 6, "
1397 "or 7.\n", val);
1398 goto exit;
1399 }
1400
1401 data->pwm_config[ix] = dme1737_read(data,
1402 DME1737_REG_PWM_CONFIG(ix));
1403 if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
1404
1405
1406
1407
1408 data->pwm_config[ix] = PWM_ACZ_TO_REG(val,
1409 data->pwm_config[ix]);
1410 dme1737_write(data, DME1737_REG_PWM_CONFIG(ix),
1411 data->pwm_config[ix]);
1412 } else {
1413
1414
1415
1416
1417 data->pwm_acz[ix] = val;
1418 }
1419 break;
1420 case SYS_PWM_AUTO_PWM_MIN:
1421
1422
1423 data->pwm_min[ix] = dme1737_read(data,
1424 DME1737_REG_PWM_MIN(ix));
1425
1426
1427
1428
1429
1430
1431 if (val > ((data->pwm_min[ix] + 1) / 2)) {
1432 data->pwm_rr[0] = PWM_OFF_TO_REG(1, ix,
1433 dme1737_read(data,
1434 DME1737_REG_PWM_RR(0)));
1435 } else {
1436 data->pwm_rr[0] = PWM_OFF_TO_REG(0, ix,
1437 dme1737_read(data,
1438 DME1737_REG_PWM_RR(0)));
1439 }
1440 dme1737_write(data, DME1737_REG_PWM_RR(0),
1441 data->pwm_rr[0]);
1442 break;
1443 case SYS_PWM_AUTO_POINT1_PWM:
1444
1445 data->pwm_min[ix] = clamp_val(val, 0, 255);
1446 dme1737_write(data, DME1737_REG_PWM_MIN(ix),
1447 data->pwm_min[ix]);
1448 break;
1449 default:
1450 dev_dbg(dev, "Unknown function %d.\n", fn);
1451 }
1452 exit:
1453 mutex_unlock(&data->update_lock);
1454
1455 return count;
1456 }
1457
1458
1459
1460
1461
1462 static ssize_t vrm_show(struct device *dev, struct device_attribute *attr,
1463 char *buf)
1464 {
1465 struct i2c_client *client = to_i2c_client(dev);
1466 struct dme1737_data *data = i2c_get_clientdata(client);
1467
1468 return sprintf(buf, "%d\n", data->vrm);
1469 }
1470
1471 static ssize_t vrm_store(struct device *dev, struct device_attribute *attr,
1472 const char *buf, size_t count)
1473 {
1474 struct dme1737_data *data = dev_get_drvdata(dev);
1475 unsigned long val;
1476 int err;
1477
1478 err = kstrtoul(buf, 10, &val);
1479 if (err)
1480 return err;
1481
1482 if (val > 255)
1483 return -EINVAL;
1484
1485 data->vrm = val;
1486 return count;
1487 }
1488
1489 static ssize_t cpu0_vid_show(struct device *dev,
1490 struct device_attribute *attr, char *buf)
1491 {
1492 struct dme1737_data *data = dme1737_update_device(dev);
1493
1494 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
1495 }
1496
1497 static ssize_t name_show(struct device *dev, struct device_attribute *attr,
1498 char *buf)
1499 {
1500 struct dme1737_data *data = dev_get_drvdata(dev);
1501
1502 return sprintf(buf, "%s\n", data->name);
1503 }
1504
1505
1506
1507
1508
1509
1510
1511 #define SENSOR_DEVICE_ATTR_IN(ix) \
1512 static SENSOR_DEVICE_ATTR_2(in##ix##_input, S_IRUGO, \
1513 show_in, NULL, SYS_IN_INPUT, ix); \
1514 static SENSOR_DEVICE_ATTR_2(in##ix##_min, S_IRUGO | S_IWUSR, \
1515 show_in, set_in, SYS_IN_MIN, ix); \
1516 static SENSOR_DEVICE_ATTR_2(in##ix##_max, S_IRUGO | S_IWUSR, \
1517 show_in, set_in, SYS_IN_MAX, ix); \
1518 static SENSOR_DEVICE_ATTR_2(in##ix##_alarm, S_IRUGO, \
1519 show_in, NULL, SYS_IN_ALARM, ix)
1520
1521 SENSOR_DEVICE_ATTR_IN(0);
1522 SENSOR_DEVICE_ATTR_IN(1);
1523 SENSOR_DEVICE_ATTR_IN(2);
1524 SENSOR_DEVICE_ATTR_IN(3);
1525 SENSOR_DEVICE_ATTR_IN(4);
1526 SENSOR_DEVICE_ATTR_IN(5);
1527 SENSOR_DEVICE_ATTR_IN(6);
1528 SENSOR_DEVICE_ATTR_IN(7);
1529
1530
1531
1532 #define SENSOR_DEVICE_ATTR_TEMP(ix) \
1533 static SENSOR_DEVICE_ATTR_2(temp##ix##_input, S_IRUGO, \
1534 show_temp, NULL, SYS_TEMP_INPUT, ix-1); \
1535 static SENSOR_DEVICE_ATTR_2(temp##ix##_min, S_IRUGO | S_IWUSR, \
1536 show_temp, set_temp, SYS_TEMP_MIN, ix-1); \
1537 static SENSOR_DEVICE_ATTR_2(temp##ix##_max, S_IRUGO | S_IWUSR, \
1538 show_temp, set_temp, SYS_TEMP_MAX, ix-1); \
1539 static SENSOR_DEVICE_ATTR_2(temp##ix##_offset, S_IRUGO, \
1540 show_temp, set_temp, SYS_TEMP_OFFSET, ix-1); \
1541 static SENSOR_DEVICE_ATTR_2(temp##ix##_alarm, S_IRUGO, \
1542 show_temp, NULL, SYS_TEMP_ALARM, ix-1); \
1543 static SENSOR_DEVICE_ATTR_2(temp##ix##_fault, S_IRUGO, \
1544 show_temp, NULL, SYS_TEMP_FAULT, ix-1)
1545
1546 SENSOR_DEVICE_ATTR_TEMP(1);
1547 SENSOR_DEVICE_ATTR_TEMP(2);
1548 SENSOR_DEVICE_ATTR_TEMP(3);
1549
1550
1551
1552 #define SENSOR_DEVICE_ATTR_ZONE(ix) \
1553 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_channels_temp, S_IRUGO, \
1554 show_zone, NULL, SYS_ZONE_AUTO_CHANNELS_TEMP, ix-1); \
1555 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point1_temp_hyst, S_IRUGO, \
1556 show_zone, set_zone, SYS_ZONE_AUTO_POINT1_TEMP_HYST, ix-1); \
1557 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point1_temp, S_IRUGO, \
1558 show_zone, set_zone, SYS_ZONE_AUTO_POINT1_TEMP, ix-1); \
1559 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point2_temp, S_IRUGO, \
1560 show_zone, set_zone, SYS_ZONE_AUTO_POINT2_TEMP, ix-1); \
1561 static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point3_temp, S_IRUGO, \
1562 show_zone, set_zone, SYS_ZONE_AUTO_POINT3_TEMP, ix-1)
1563
1564 SENSOR_DEVICE_ATTR_ZONE(1);
1565 SENSOR_DEVICE_ATTR_ZONE(2);
1566 SENSOR_DEVICE_ATTR_ZONE(3);
1567
1568
1569
1570 #define SENSOR_DEVICE_ATTR_FAN_1TO4(ix) \
1571 static SENSOR_DEVICE_ATTR_2(fan##ix##_input, S_IRUGO, \
1572 show_fan, NULL, SYS_FAN_INPUT, ix-1); \
1573 static SENSOR_DEVICE_ATTR_2(fan##ix##_min, S_IRUGO | S_IWUSR, \
1574 show_fan, set_fan, SYS_FAN_MIN, ix-1); \
1575 static SENSOR_DEVICE_ATTR_2(fan##ix##_alarm, S_IRUGO, \
1576 show_fan, NULL, SYS_FAN_ALARM, ix-1); \
1577 static SENSOR_DEVICE_ATTR_2(fan##ix##_type, S_IRUGO | S_IWUSR, \
1578 show_fan, set_fan, SYS_FAN_TYPE, ix-1)
1579
1580 SENSOR_DEVICE_ATTR_FAN_1TO4(1);
1581 SENSOR_DEVICE_ATTR_FAN_1TO4(2);
1582 SENSOR_DEVICE_ATTR_FAN_1TO4(3);
1583 SENSOR_DEVICE_ATTR_FAN_1TO4(4);
1584
1585
1586
1587 #define SENSOR_DEVICE_ATTR_FAN_5TO6(ix) \
1588 static SENSOR_DEVICE_ATTR_2(fan##ix##_input, S_IRUGO, \
1589 show_fan, NULL, SYS_FAN_INPUT, ix-1); \
1590 static SENSOR_DEVICE_ATTR_2(fan##ix##_min, S_IRUGO | S_IWUSR, \
1591 show_fan, set_fan, SYS_FAN_MIN, ix-1); \
1592 static SENSOR_DEVICE_ATTR_2(fan##ix##_alarm, S_IRUGO, \
1593 show_fan, NULL, SYS_FAN_ALARM, ix-1); \
1594 static SENSOR_DEVICE_ATTR_2(fan##ix##_max, S_IRUGO | S_IWUSR, \
1595 show_fan, set_fan, SYS_FAN_MAX, ix-1)
1596
1597 SENSOR_DEVICE_ATTR_FAN_5TO6(5);
1598 SENSOR_DEVICE_ATTR_FAN_5TO6(6);
1599
1600
1601
1602 #define SENSOR_DEVICE_ATTR_PWM_1TO3(ix) \
1603 static SENSOR_DEVICE_ATTR_2(pwm##ix, S_IRUGO, \
1604 show_pwm, set_pwm, SYS_PWM, ix-1); \
1605 static SENSOR_DEVICE_ATTR_2(pwm##ix##_freq, S_IRUGO, \
1606 show_pwm, set_pwm, SYS_PWM_FREQ, ix-1); \
1607 static SENSOR_DEVICE_ATTR_2(pwm##ix##_enable, S_IRUGO, \
1608 show_pwm, set_pwm, SYS_PWM_ENABLE, ix-1); \
1609 static SENSOR_DEVICE_ATTR_2(pwm##ix##_ramp_rate, S_IRUGO, \
1610 show_pwm, set_pwm, SYS_PWM_RAMP_RATE, ix-1); \
1611 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_channels_zone, S_IRUGO, \
1612 show_pwm, set_pwm, SYS_PWM_AUTO_CHANNELS_ZONE, ix-1); \
1613 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_pwm_min, S_IRUGO, \
1614 show_pwm, set_pwm, SYS_PWM_AUTO_PWM_MIN, ix-1); \
1615 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_point1_pwm, S_IRUGO, \
1616 show_pwm, set_pwm, SYS_PWM_AUTO_POINT1_PWM, ix-1); \
1617 static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_point2_pwm, S_IRUGO, \
1618 show_pwm, NULL, SYS_PWM_AUTO_POINT2_PWM, ix-1)
1619
1620 SENSOR_DEVICE_ATTR_PWM_1TO3(1);
1621 SENSOR_DEVICE_ATTR_PWM_1TO3(2);
1622 SENSOR_DEVICE_ATTR_PWM_1TO3(3);
1623
1624
1625
1626 #define SENSOR_DEVICE_ATTR_PWM_5TO6(ix) \
1627 static SENSOR_DEVICE_ATTR_2(pwm##ix, S_IRUGO, \
1628 show_pwm, set_pwm, SYS_PWM, ix-1); \
1629 static SENSOR_DEVICE_ATTR_2(pwm##ix##_freq, S_IRUGO, \
1630 show_pwm, set_pwm, SYS_PWM_FREQ, ix-1); \
1631 static SENSOR_DEVICE_ATTR_2(pwm##ix##_enable, S_IRUGO, \
1632 show_pwm, NULL, SYS_PWM_ENABLE, ix-1)
1633
1634 SENSOR_DEVICE_ATTR_PWM_5TO6(5);
1635 SENSOR_DEVICE_ATTR_PWM_5TO6(6);
1636
1637
1638
1639 static DEVICE_ATTR_RW(vrm);
1640 static DEVICE_ATTR_RO(cpu0_vid);
1641 static DEVICE_ATTR_RO(name);
1642
1643
1644
1645
1646
1647
1648
1649 static struct attribute *dme1737_attr[] = {
1650
1651 &sensor_dev_attr_in0_input.dev_attr.attr,
1652 &sensor_dev_attr_in0_min.dev_attr.attr,
1653 &sensor_dev_attr_in0_max.dev_attr.attr,
1654 &sensor_dev_attr_in0_alarm.dev_attr.attr,
1655 &sensor_dev_attr_in1_input.dev_attr.attr,
1656 &sensor_dev_attr_in1_min.dev_attr.attr,
1657 &sensor_dev_attr_in1_max.dev_attr.attr,
1658 &sensor_dev_attr_in1_alarm.dev_attr.attr,
1659 &sensor_dev_attr_in2_input.dev_attr.attr,
1660 &sensor_dev_attr_in2_min.dev_attr.attr,
1661 &sensor_dev_attr_in2_max.dev_attr.attr,
1662 &sensor_dev_attr_in2_alarm.dev_attr.attr,
1663 &sensor_dev_attr_in3_input.dev_attr.attr,
1664 &sensor_dev_attr_in3_min.dev_attr.attr,
1665 &sensor_dev_attr_in3_max.dev_attr.attr,
1666 &sensor_dev_attr_in3_alarm.dev_attr.attr,
1667 &sensor_dev_attr_in4_input.dev_attr.attr,
1668 &sensor_dev_attr_in4_min.dev_attr.attr,
1669 &sensor_dev_attr_in4_max.dev_attr.attr,
1670 &sensor_dev_attr_in4_alarm.dev_attr.attr,
1671 &sensor_dev_attr_in5_input.dev_attr.attr,
1672 &sensor_dev_attr_in5_min.dev_attr.attr,
1673 &sensor_dev_attr_in5_max.dev_attr.attr,
1674 &sensor_dev_attr_in5_alarm.dev_attr.attr,
1675 &sensor_dev_attr_in6_input.dev_attr.attr,
1676 &sensor_dev_attr_in6_min.dev_attr.attr,
1677 &sensor_dev_attr_in6_max.dev_attr.attr,
1678 &sensor_dev_attr_in6_alarm.dev_attr.attr,
1679
1680 &sensor_dev_attr_temp1_input.dev_attr.attr,
1681 &sensor_dev_attr_temp1_min.dev_attr.attr,
1682 &sensor_dev_attr_temp1_max.dev_attr.attr,
1683 &sensor_dev_attr_temp1_alarm.dev_attr.attr,
1684 &sensor_dev_attr_temp1_fault.dev_attr.attr,
1685 &sensor_dev_attr_temp2_input.dev_attr.attr,
1686 &sensor_dev_attr_temp2_min.dev_attr.attr,
1687 &sensor_dev_attr_temp2_max.dev_attr.attr,
1688 &sensor_dev_attr_temp2_alarm.dev_attr.attr,
1689 &sensor_dev_attr_temp2_fault.dev_attr.attr,
1690 &sensor_dev_attr_temp3_input.dev_attr.attr,
1691 &sensor_dev_attr_temp3_min.dev_attr.attr,
1692 &sensor_dev_attr_temp3_max.dev_attr.attr,
1693 &sensor_dev_attr_temp3_alarm.dev_attr.attr,
1694 &sensor_dev_attr_temp3_fault.dev_attr.attr,
1695
1696 &sensor_dev_attr_zone1_auto_point1_temp.dev_attr.attr,
1697 &sensor_dev_attr_zone1_auto_point2_temp.dev_attr.attr,
1698 &sensor_dev_attr_zone1_auto_point3_temp.dev_attr.attr,
1699 &sensor_dev_attr_zone1_auto_channels_temp.dev_attr.attr,
1700 &sensor_dev_attr_zone2_auto_point1_temp.dev_attr.attr,
1701 &sensor_dev_attr_zone2_auto_point2_temp.dev_attr.attr,
1702 &sensor_dev_attr_zone2_auto_point3_temp.dev_attr.attr,
1703 &sensor_dev_attr_zone2_auto_channels_temp.dev_attr.attr,
1704 NULL
1705 };
1706
1707 static const struct attribute_group dme1737_group = {
1708 .attrs = dme1737_attr,
1709 };
1710
1711
1712
1713
1714
1715
1716 static struct attribute *dme1737_temp_offset_attr[] = {
1717 &sensor_dev_attr_temp1_offset.dev_attr.attr,
1718 &sensor_dev_attr_temp2_offset.dev_attr.attr,
1719 &sensor_dev_attr_temp3_offset.dev_attr.attr,
1720 NULL
1721 };
1722
1723 static const struct attribute_group dme1737_temp_offset_group = {
1724 .attrs = dme1737_temp_offset_attr,
1725 };
1726
1727
1728
1729
1730
1731
1732 static struct attribute *dme1737_vid_attr[] = {
1733 &dev_attr_vrm.attr,
1734 &dev_attr_cpu0_vid.attr,
1735 NULL
1736 };
1737
1738 static const struct attribute_group dme1737_vid_group = {
1739 .attrs = dme1737_vid_attr,
1740 };
1741
1742
1743
1744
1745
1746
1747 static struct attribute *dme1737_zone3_attr[] = {
1748 &sensor_dev_attr_zone3_auto_point1_temp.dev_attr.attr,
1749 &sensor_dev_attr_zone3_auto_point2_temp.dev_attr.attr,
1750 &sensor_dev_attr_zone3_auto_point3_temp.dev_attr.attr,
1751 &sensor_dev_attr_zone3_auto_channels_temp.dev_attr.attr,
1752 NULL
1753 };
1754
1755 static const struct attribute_group dme1737_zone3_group = {
1756 .attrs = dme1737_zone3_attr,
1757 };
1758
1759
1760
1761
1762
1763
1764
1765 static struct attribute *dme1737_zone_hyst_attr[] = {
1766 &sensor_dev_attr_zone1_auto_point1_temp_hyst.dev_attr.attr,
1767 &sensor_dev_attr_zone2_auto_point1_temp_hyst.dev_attr.attr,
1768 &sensor_dev_attr_zone3_auto_point1_temp_hyst.dev_attr.attr,
1769 NULL
1770 };
1771
1772 static const struct attribute_group dme1737_zone_hyst_group = {
1773 .attrs = dme1737_zone_hyst_attr,
1774 };
1775
1776
1777
1778
1779
1780
1781 static struct attribute *dme1737_in7_attr[] = {
1782 &sensor_dev_attr_in7_input.dev_attr.attr,
1783 &sensor_dev_attr_in7_min.dev_attr.attr,
1784 &sensor_dev_attr_in7_max.dev_attr.attr,
1785 &sensor_dev_attr_in7_alarm.dev_attr.attr,
1786 NULL
1787 };
1788
1789 static const struct attribute_group dme1737_in7_group = {
1790 .attrs = dme1737_in7_attr,
1791 };
1792
1793
1794
1795
1796
1797
1798 static struct attribute *dme1737_pwm1_attr[] = {
1799 &sensor_dev_attr_pwm1.dev_attr.attr,
1800 &sensor_dev_attr_pwm1_freq.dev_attr.attr,
1801 &sensor_dev_attr_pwm1_enable.dev_attr.attr,
1802 &sensor_dev_attr_pwm1_ramp_rate.dev_attr.attr,
1803 &sensor_dev_attr_pwm1_auto_channels_zone.dev_attr.attr,
1804 &sensor_dev_attr_pwm1_auto_point1_pwm.dev_attr.attr,
1805 &sensor_dev_attr_pwm1_auto_point2_pwm.dev_attr.attr,
1806 NULL
1807 };
1808 static struct attribute *dme1737_pwm2_attr[] = {
1809 &sensor_dev_attr_pwm2.dev_attr.attr,
1810 &sensor_dev_attr_pwm2_freq.dev_attr.attr,
1811 &sensor_dev_attr_pwm2_enable.dev_attr.attr,
1812 &sensor_dev_attr_pwm2_ramp_rate.dev_attr.attr,
1813 &sensor_dev_attr_pwm2_auto_channels_zone.dev_attr.attr,
1814 &sensor_dev_attr_pwm2_auto_point1_pwm.dev_attr.attr,
1815 &sensor_dev_attr_pwm2_auto_point2_pwm.dev_attr.attr,
1816 NULL
1817 };
1818 static struct attribute *dme1737_pwm3_attr[] = {
1819 &sensor_dev_attr_pwm3.dev_attr.attr,
1820 &sensor_dev_attr_pwm3_freq.dev_attr.attr,
1821 &sensor_dev_attr_pwm3_enable.dev_attr.attr,
1822 &sensor_dev_attr_pwm3_ramp_rate.dev_attr.attr,
1823 &sensor_dev_attr_pwm3_auto_channels_zone.dev_attr.attr,
1824 &sensor_dev_attr_pwm3_auto_point1_pwm.dev_attr.attr,
1825 &sensor_dev_attr_pwm3_auto_point2_pwm.dev_attr.attr,
1826 NULL
1827 };
1828 static struct attribute *dme1737_pwm5_attr[] = {
1829 &sensor_dev_attr_pwm5.dev_attr.attr,
1830 &sensor_dev_attr_pwm5_freq.dev_attr.attr,
1831 &sensor_dev_attr_pwm5_enable.dev_attr.attr,
1832 NULL
1833 };
1834 static struct attribute *dme1737_pwm6_attr[] = {
1835 &sensor_dev_attr_pwm6.dev_attr.attr,
1836 &sensor_dev_attr_pwm6_freq.dev_attr.attr,
1837 &sensor_dev_attr_pwm6_enable.dev_attr.attr,
1838 NULL
1839 };
1840
1841 static const struct attribute_group dme1737_pwm_group[] = {
1842 { .attrs = dme1737_pwm1_attr },
1843 { .attrs = dme1737_pwm2_attr },
1844 { .attrs = dme1737_pwm3_attr },
1845 { .attrs = NULL },
1846 { .attrs = dme1737_pwm5_attr },
1847 { .attrs = dme1737_pwm6_attr },
1848 };
1849
1850
1851
1852
1853
1854
1855 static struct attribute *dme1737_auto_pwm_min_attr[] = {
1856 &sensor_dev_attr_pwm1_auto_pwm_min.dev_attr.attr,
1857 &sensor_dev_attr_pwm2_auto_pwm_min.dev_attr.attr,
1858 &sensor_dev_attr_pwm3_auto_pwm_min.dev_attr.attr,
1859 };
1860
1861
1862
1863
1864
1865
1866 static struct attribute *dme1737_fan1_attr[] = {
1867 &sensor_dev_attr_fan1_input.dev_attr.attr,
1868 &sensor_dev_attr_fan1_min.dev_attr.attr,
1869 &sensor_dev_attr_fan1_alarm.dev_attr.attr,
1870 &sensor_dev_attr_fan1_type.dev_attr.attr,
1871 NULL
1872 };
1873 static struct attribute *dme1737_fan2_attr[] = {
1874 &sensor_dev_attr_fan2_input.dev_attr.attr,
1875 &sensor_dev_attr_fan2_min.dev_attr.attr,
1876 &sensor_dev_attr_fan2_alarm.dev_attr.attr,
1877 &sensor_dev_attr_fan2_type.dev_attr.attr,
1878 NULL
1879 };
1880 static struct attribute *dme1737_fan3_attr[] = {
1881 &sensor_dev_attr_fan3_input.dev_attr.attr,
1882 &sensor_dev_attr_fan3_min.dev_attr.attr,
1883 &sensor_dev_attr_fan3_alarm.dev_attr.attr,
1884 &sensor_dev_attr_fan3_type.dev_attr.attr,
1885 NULL
1886 };
1887 static struct attribute *dme1737_fan4_attr[] = {
1888 &sensor_dev_attr_fan4_input.dev_attr.attr,
1889 &sensor_dev_attr_fan4_min.dev_attr.attr,
1890 &sensor_dev_attr_fan4_alarm.dev_attr.attr,
1891 &sensor_dev_attr_fan4_type.dev_attr.attr,
1892 NULL
1893 };
1894 static struct attribute *dme1737_fan5_attr[] = {
1895 &sensor_dev_attr_fan5_input.dev_attr.attr,
1896 &sensor_dev_attr_fan5_min.dev_attr.attr,
1897 &sensor_dev_attr_fan5_alarm.dev_attr.attr,
1898 &sensor_dev_attr_fan5_max.dev_attr.attr,
1899 NULL
1900 };
1901 static struct attribute *dme1737_fan6_attr[] = {
1902 &sensor_dev_attr_fan6_input.dev_attr.attr,
1903 &sensor_dev_attr_fan6_min.dev_attr.attr,
1904 &sensor_dev_attr_fan6_alarm.dev_attr.attr,
1905 &sensor_dev_attr_fan6_max.dev_attr.attr,
1906 NULL
1907 };
1908
1909 static const struct attribute_group dme1737_fan_group[] = {
1910 { .attrs = dme1737_fan1_attr },
1911 { .attrs = dme1737_fan2_attr },
1912 { .attrs = dme1737_fan3_attr },
1913 { .attrs = dme1737_fan4_attr },
1914 { .attrs = dme1737_fan5_attr },
1915 { .attrs = dme1737_fan6_attr },
1916 };
1917
1918
1919
1920
1921
1922 static struct attribute *dme1737_zone_chmod_attr[] = {
1923 &sensor_dev_attr_zone1_auto_point1_temp.dev_attr.attr,
1924 &sensor_dev_attr_zone1_auto_point2_temp.dev_attr.attr,
1925 &sensor_dev_attr_zone1_auto_point3_temp.dev_attr.attr,
1926 &sensor_dev_attr_zone2_auto_point1_temp.dev_attr.attr,
1927 &sensor_dev_attr_zone2_auto_point2_temp.dev_attr.attr,
1928 &sensor_dev_attr_zone2_auto_point3_temp.dev_attr.attr,
1929 NULL
1930 };
1931
1932 static const struct attribute_group dme1737_zone_chmod_group = {
1933 .attrs = dme1737_zone_chmod_attr,
1934 };
1935
1936
1937
1938
1939
1940
1941 static struct attribute *dme1737_zone3_chmod_attr[] = {
1942 &sensor_dev_attr_zone3_auto_point1_temp.dev_attr.attr,
1943 &sensor_dev_attr_zone3_auto_point2_temp.dev_attr.attr,
1944 &sensor_dev_attr_zone3_auto_point3_temp.dev_attr.attr,
1945 NULL
1946 };
1947
1948 static const struct attribute_group dme1737_zone3_chmod_group = {
1949 .attrs = dme1737_zone3_chmod_attr,
1950 };
1951
1952
1953
1954
1955
1956
1957 static struct attribute *dme1737_pwm1_chmod_attr[] = {
1958 &sensor_dev_attr_pwm1_freq.dev_attr.attr,
1959 &sensor_dev_attr_pwm1_enable.dev_attr.attr,
1960 &sensor_dev_attr_pwm1_ramp_rate.dev_attr.attr,
1961 &sensor_dev_attr_pwm1_auto_channels_zone.dev_attr.attr,
1962 &sensor_dev_attr_pwm1_auto_point1_pwm.dev_attr.attr,
1963 NULL
1964 };
1965 static struct attribute *dme1737_pwm2_chmod_attr[] = {
1966 &sensor_dev_attr_pwm2_freq.dev_attr.attr,
1967 &sensor_dev_attr_pwm2_enable.dev_attr.attr,
1968 &sensor_dev_attr_pwm2_ramp_rate.dev_attr.attr,
1969 &sensor_dev_attr_pwm2_auto_channels_zone.dev_attr.attr,
1970 &sensor_dev_attr_pwm2_auto_point1_pwm.dev_attr.attr,
1971 NULL
1972 };
1973 static struct attribute *dme1737_pwm3_chmod_attr[] = {
1974 &sensor_dev_attr_pwm3_freq.dev_attr.attr,
1975 &sensor_dev_attr_pwm3_enable.dev_attr.attr,
1976 &sensor_dev_attr_pwm3_ramp_rate.dev_attr.attr,
1977 &sensor_dev_attr_pwm3_auto_channels_zone.dev_attr.attr,
1978 &sensor_dev_attr_pwm3_auto_point1_pwm.dev_attr.attr,
1979 NULL
1980 };
1981 static struct attribute *dme1737_pwm5_chmod_attr[] = {
1982 &sensor_dev_attr_pwm5.dev_attr.attr,
1983 &sensor_dev_attr_pwm5_freq.dev_attr.attr,
1984 NULL
1985 };
1986 static struct attribute *dme1737_pwm6_chmod_attr[] = {
1987 &sensor_dev_attr_pwm6.dev_attr.attr,
1988 &sensor_dev_attr_pwm6_freq.dev_attr.attr,
1989 NULL
1990 };
1991
1992 static const struct attribute_group dme1737_pwm_chmod_group[] = {
1993 { .attrs = dme1737_pwm1_chmod_attr },
1994 { .attrs = dme1737_pwm2_chmod_attr },
1995 { .attrs = dme1737_pwm3_chmod_attr },
1996 { .attrs = NULL },
1997 { .attrs = dme1737_pwm5_chmod_attr },
1998 { .attrs = dme1737_pwm6_chmod_attr },
1999 };
2000
2001
2002
2003
2004
2005 static struct attribute *dme1737_pwm_chmod_attr[] = {
2006 &sensor_dev_attr_pwm1.dev_attr.attr,
2007 &sensor_dev_attr_pwm2.dev_attr.attr,
2008 &sensor_dev_attr_pwm3.dev_attr.attr,
2009 };
2010
2011
2012
2013
2014
2015 static inline void dme1737_sio_enter(int sio_cip)
2016 {
2017 outb(0x55, sio_cip);
2018 }
2019
2020 static inline void dme1737_sio_exit(int sio_cip)
2021 {
2022 outb(0xaa, sio_cip);
2023 }
2024
2025 static inline int dme1737_sio_inb(int sio_cip, int reg)
2026 {
2027 outb(reg, sio_cip);
2028 return inb(sio_cip + 1);
2029 }
2030
2031 static inline void dme1737_sio_outb(int sio_cip, int reg, int val)
2032 {
2033 outb(reg, sio_cip);
2034 outb(val, sio_cip + 1);
2035 }
2036
2037
2038
2039
2040
2041 static int dme1737_i2c_get_features(int, struct dme1737_data*);
2042
2043 static void dme1737_chmod_file(struct device *dev,
2044 struct attribute *attr, umode_t mode)
2045 {
2046 if (sysfs_chmod_file(&dev->kobj, attr, mode)) {
2047 dev_warn(dev, "Failed to change permissions of %s.\n",
2048 attr->name);
2049 }
2050 }
2051
2052 static void dme1737_chmod_group(struct device *dev,
2053 const struct attribute_group *group,
2054 umode_t mode)
2055 {
2056 struct attribute **attr;
2057
2058 for (attr = group->attrs; *attr; attr++)
2059 dme1737_chmod_file(dev, *attr, mode);
2060 }
2061
2062 static void dme1737_remove_files(struct device *dev)
2063 {
2064 struct dme1737_data *data = dev_get_drvdata(dev);
2065 int ix;
2066
2067 for (ix = 0; ix < ARRAY_SIZE(dme1737_fan_group); ix++) {
2068 if (data->has_features & HAS_FAN(ix)) {
2069 sysfs_remove_group(&dev->kobj,
2070 &dme1737_fan_group[ix]);
2071 }
2072 }
2073
2074 for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_group); ix++) {
2075 if (data->has_features & HAS_PWM(ix)) {
2076 sysfs_remove_group(&dev->kobj,
2077 &dme1737_pwm_group[ix]);
2078 if ((data->has_features & HAS_PWM_MIN) && ix < 3) {
2079 sysfs_remove_file(&dev->kobj,
2080 dme1737_auto_pwm_min_attr[ix]);
2081 }
2082 }
2083 }
2084
2085 if (data->has_features & HAS_TEMP_OFFSET)
2086 sysfs_remove_group(&dev->kobj, &dme1737_temp_offset_group);
2087 if (data->has_features & HAS_VID)
2088 sysfs_remove_group(&dev->kobj, &dme1737_vid_group);
2089 if (data->has_features & HAS_ZONE3)
2090 sysfs_remove_group(&dev->kobj, &dme1737_zone3_group);
2091 if (data->has_features & HAS_ZONE_HYST)
2092 sysfs_remove_group(&dev->kobj, &dme1737_zone_hyst_group);
2093 if (data->has_features & HAS_IN7)
2094 sysfs_remove_group(&dev->kobj, &dme1737_in7_group);
2095 sysfs_remove_group(&dev->kobj, &dme1737_group);
2096
2097 if (!data->client)
2098 sysfs_remove_file(&dev->kobj, &dev_attr_name.attr);
2099 }
2100
2101 static int dme1737_create_files(struct device *dev)
2102 {
2103 struct dme1737_data *data = dev_get_drvdata(dev);
2104 int err, ix;
2105
2106
2107 if (!data->client) {
2108 err = sysfs_create_file(&dev->kobj, &dev_attr_name.attr);
2109 if (err)
2110 goto exit;
2111 }
2112
2113
2114 err = sysfs_create_group(&dev->kobj, &dme1737_group);
2115 if (err)
2116 goto exit_remove;
2117
2118
2119 if (data->has_features & HAS_TEMP_OFFSET) {
2120 err = sysfs_create_group(&dev->kobj,
2121 &dme1737_temp_offset_group);
2122 if (err)
2123 goto exit_remove;
2124 }
2125 if (data->has_features & HAS_VID) {
2126 err = sysfs_create_group(&dev->kobj, &dme1737_vid_group);
2127 if (err)
2128 goto exit_remove;
2129 }
2130 if (data->has_features & HAS_ZONE3) {
2131 err = sysfs_create_group(&dev->kobj, &dme1737_zone3_group);
2132 if (err)
2133 goto exit_remove;
2134 }
2135 if (data->has_features & HAS_ZONE_HYST) {
2136 err = sysfs_create_group(&dev->kobj, &dme1737_zone_hyst_group);
2137 if (err)
2138 goto exit_remove;
2139 }
2140 if (data->has_features & HAS_IN7) {
2141 err = sysfs_create_group(&dev->kobj, &dme1737_in7_group);
2142 if (err)
2143 goto exit_remove;
2144 }
2145
2146
2147 for (ix = 0; ix < ARRAY_SIZE(dme1737_fan_group); ix++) {
2148 if (data->has_features & HAS_FAN(ix)) {
2149 err = sysfs_create_group(&dev->kobj,
2150 &dme1737_fan_group[ix]);
2151 if (err)
2152 goto exit_remove;
2153 }
2154 }
2155
2156
2157 for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_group); ix++) {
2158 if (data->has_features & HAS_PWM(ix)) {
2159 err = sysfs_create_group(&dev->kobj,
2160 &dme1737_pwm_group[ix]);
2161 if (err)
2162 goto exit_remove;
2163 if ((data->has_features & HAS_PWM_MIN) && (ix < 3)) {
2164 err = sysfs_create_file(&dev->kobj,
2165 dme1737_auto_pwm_min_attr[ix]);
2166 if (err)
2167 goto exit_remove;
2168 }
2169 }
2170 }
2171
2172
2173
2174
2175
2176 if (data->config & 0x02) {
2177 dev_info(dev,
2178 "Device is locked. Some attributes will be read-only.\n");
2179 } else {
2180
2181 dme1737_chmod_group(dev, &dme1737_zone_chmod_group,
2182 S_IRUGO | S_IWUSR);
2183
2184
2185 if (data->has_features & HAS_TEMP_OFFSET) {
2186 dme1737_chmod_group(dev, &dme1737_temp_offset_group,
2187 S_IRUGO | S_IWUSR);
2188 }
2189 if (data->has_features & HAS_ZONE3) {
2190 dme1737_chmod_group(dev, &dme1737_zone3_chmod_group,
2191 S_IRUGO | S_IWUSR);
2192 }
2193 if (data->has_features & HAS_ZONE_HYST) {
2194 dme1737_chmod_group(dev, &dme1737_zone_hyst_group,
2195 S_IRUGO | S_IWUSR);
2196 }
2197
2198
2199 for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_chmod_group); ix++) {
2200 if (data->has_features & HAS_PWM(ix)) {
2201 dme1737_chmod_group(dev,
2202 &dme1737_pwm_chmod_group[ix],
2203 S_IRUGO | S_IWUSR);
2204 if ((data->has_features & HAS_PWM_MIN) &&
2205 ix < 3) {
2206 dme1737_chmod_file(dev,
2207 dme1737_auto_pwm_min_attr[ix],
2208 S_IRUGO | S_IWUSR);
2209 }
2210 }
2211 }
2212
2213
2214 for (ix = 0; ix < 3; ix++) {
2215 if ((data->has_features & HAS_PWM(ix)) &&
2216 (PWM_EN_FROM_REG(data->pwm_config[ix]) == 1)) {
2217 dme1737_chmod_file(dev,
2218 dme1737_pwm_chmod_attr[ix],
2219 S_IRUGO | S_IWUSR);
2220 }
2221 }
2222 }
2223
2224 return 0;
2225
2226 exit_remove:
2227 dme1737_remove_files(dev);
2228 exit:
2229 return err;
2230 }
2231
2232 static int dme1737_init_device(struct device *dev)
2233 {
2234 struct dme1737_data *data = dev_get_drvdata(dev);
2235 struct i2c_client *client = data->client;
2236 int ix;
2237 u8 reg;
2238
2239
2240 data->in_nominal = IN_NOMINAL(data->type);
2241
2242 data->config = dme1737_read(data, DME1737_REG_CONFIG);
2243
2244 if (!(data->config & 0x01)) {
2245 if (!force_start) {
2246 dev_err(dev,
2247 "Device is not monitoring. Use the force_start load parameter to override.\n");
2248 return -EFAULT;
2249 }
2250
2251
2252 data->config |= 0x01;
2253 dme1737_write(data, DME1737_REG_CONFIG, data->config);
2254 }
2255
2256 if (!(data->config & 0x04)) {
2257 dev_err(dev, "Device is not ready.\n");
2258 return -EFAULT;
2259 }
2260
2261
2262
2263
2264
2265 if (client) {
2266 data->config2 = dme1737_read(data, DME1737_REG_CONFIG2);
2267
2268 if (data->config2 & 0x04)
2269 data->has_features |= HAS_FAN(2);
2270
2271
2272
2273
2274
2275
2276 if (client->addr == 0x2e)
2277 data->has_features |= HAS_FAN(3) | HAS_PWM(2);
2278
2279
2280
2281
2282
2283
2284
2285 if (dme1737_i2c_get_features(0x2e, data) &&
2286 dme1737_i2c_get_features(0x4e, data)) {
2287 dev_warn(dev,
2288 "Failed to query Super-IO for optional features.\n");
2289 }
2290 }
2291
2292
2293 data->has_features |= HAS_FAN(0) | HAS_FAN(1) | HAS_PWM(0) | HAS_PWM(1);
2294
2295
2296 switch (data->type) {
2297 case dme1737:
2298 data->has_features |= HAS_TEMP_OFFSET | HAS_VID | HAS_ZONE3 |
2299 HAS_ZONE_HYST | HAS_PWM_MIN;
2300 break;
2301 case sch311x:
2302 data->has_features |= HAS_TEMP_OFFSET | HAS_ZONE3 |
2303 HAS_ZONE_HYST | HAS_PWM_MIN | HAS_FAN(2) | HAS_PWM(2);
2304 break;
2305 case sch5027:
2306 data->has_features |= HAS_ZONE3;
2307 break;
2308 case sch5127:
2309 data->has_features |= HAS_FAN(2) | HAS_PWM(2) | HAS_IN7;
2310 break;
2311 default:
2312 break;
2313 }
2314
2315 dev_info(dev,
2316 "Optional features: pwm3=%s, pwm5=%s, pwm6=%s, fan3=%s, fan4=%s, fan5=%s, fan6=%s.\n",
2317 (data->has_features & HAS_PWM(2)) ? "yes" : "no",
2318 (data->has_features & HAS_PWM(4)) ? "yes" : "no",
2319 (data->has_features & HAS_PWM(5)) ? "yes" : "no",
2320 (data->has_features & HAS_FAN(2)) ? "yes" : "no",
2321 (data->has_features & HAS_FAN(3)) ? "yes" : "no",
2322 (data->has_features & HAS_FAN(4)) ? "yes" : "no",
2323 (data->has_features & HAS_FAN(5)) ? "yes" : "no");
2324
2325 reg = dme1737_read(data, DME1737_REG_TACH_PWM);
2326
2327 if (client && reg != 0xa4) {
2328 dev_warn(dev,
2329 "Non-standard fan to pwm mapping: fan1->pwm%d, fan2->pwm%d, fan3->pwm%d, fan4->pwm%d. %s\n",
2330 (reg & 0x03) + 1, ((reg >> 2) & 0x03) + 1,
2331 ((reg >> 4) & 0x03) + 1, ((reg >> 6) & 0x03) + 1,
2332 DO_REPORT);
2333 } else if (!client && reg != 0x24) {
2334 dev_warn(dev,
2335 "Non-standard fan to pwm mapping: fan1->pwm%d, fan2->pwm%d, fan3->pwm%d. %s\n",
2336 (reg & 0x03) + 1, ((reg >> 2) & 0x03) + 1,
2337 ((reg >> 4) & 0x03) + 1, DO_REPORT);
2338 }
2339
2340
2341
2342
2343
2344
2345 if (!(data->config & 0x02)) {
2346 for (ix = 0; ix < 3; ix++) {
2347 data->pwm_config[ix] = dme1737_read(data,
2348 DME1737_REG_PWM_CONFIG(ix));
2349 if ((data->has_features & HAS_PWM(ix)) &&
2350 (PWM_EN_FROM_REG(data->pwm_config[ix]) == -1)) {
2351 dev_info(dev,
2352 "Switching pwm%d to manual mode.\n",
2353 ix + 1);
2354 data->pwm_config[ix] = PWM_EN_TO_REG(1,
2355 data->pwm_config[ix]);
2356 dme1737_write(data, DME1737_REG_PWM(ix), 0);
2357 dme1737_write(data,
2358 DME1737_REG_PWM_CONFIG(ix),
2359 data->pwm_config[ix]);
2360 }
2361 }
2362 }
2363
2364
2365 data->pwm_acz[0] = 1;
2366 data->pwm_acz[1] = 2;
2367 data->pwm_acz[2] = 4;
2368
2369
2370 if (data->has_features & HAS_VID)
2371 data->vrm = vid_which_vrm();
2372
2373 return 0;
2374 }
2375
2376
2377
2378
2379
2380 static struct i2c_driver dme1737_i2c_driver;
2381
2382 static int dme1737_i2c_get_features(int sio_cip, struct dme1737_data *data)
2383 {
2384 int err = 0, reg;
2385 u16 addr;
2386
2387 dme1737_sio_enter(sio_cip);
2388
2389
2390
2391
2392
2393 reg = force_id ? force_id : dme1737_sio_inb(sio_cip, 0x20);
2394 if (!(reg == DME1737_ID_1 || reg == DME1737_ID_2 ||
2395 reg == SCH5027_ID)) {
2396 err = -ENODEV;
2397 goto exit;
2398 }
2399
2400
2401 dme1737_sio_outb(sio_cip, 0x07, 0x0a);
2402
2403
2404 addr = (dme1737_sio_inb(sio_cip, 0x60) << 8) |
2405 dme1737_sio_inb(sio_cip, 0x61);
2406 if (!addr) {
2407 err = -ENODEV;
2408 goto exit;
2409 }
2410
2411
2412
2413
2414
2415
2416 if ((inb(addr + 0x43) & 0x0c) == 0x08)
2417 data->has_features |= HAS_FAN(5);
2418 if ((inb(addr + 0x44) & 0x0c) == 0x08)
2419 data->has_features |= HAS_PWM(5);
2420 if ((inb(addr + 0x45) & 0x0c) == 0x08)
2421 data->has_features |= HAS_FAN(4);
2422 if ((inb(addr + 0x46) & 0x0c) == 0x08)
2423 data->has_features |= HAS_PWM(4);
2424
2425 exit:
2426 dme1737_sio_exit(sio_cip);
2427
2428 return err;
2429 }
2430
2431
2432 static int dme1737_i2c_detect(struct i2c_client *client,
2433 struct i2c_board_info *info)
2434 {
2435 struct i2c_adapter *adapter = client->adapter;
2436 struct device *dev = &adapter->dev;
2437 u8 company, verstep = 0;
2438 const char *name;
2439
2440 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
2441 return -ENODEV;
2442
2443 company = i2c_smbus_read_byte_data(client, DME1737_REG_COMPANY);
2444 verstep = i2c_smbus_read_byte_data(client, DME1737_REG_VERSTEP);
2445
2446 if (company == DME1737_COMPANY_SMSC &&
2447 verstep == SCH5027_VERSTEP) {
2448 name = "sch5027";
2449 } else if (company == DME1737_COMPANY_SMSC &&
2450 (verstep & DME1737_VERSTEP_MASK) == DME1737_VERSTEP) {
2451 name = "dme1737";
2452 } else {
2453 return -ENODEV;
2454 }
2455
2456 dev_info(dev, "Found a %s chip at 0x%02x (rev 0x%02x).\n",
2457 verstep == SCH5027_VERSTEP ? "SCH5027" : "DME1737",
2458 client->addr, verstep);
2459 strlcpy(info->type, name, I2C_NAME_SIZE);
2460
2461 return 0;
2462 }
2463
2464 static const struct i2c_device_id dme1737_id[];
2465
2466 static int dme1737_i2c_probe(struct i2c_client *client)
2467 {
2468 struct dme1737_data *data;
2469 struct device *dev = &client->dev;
2470 int err;
2471
2472 data = devm_kzalloc(dev, sizeof(struct dme1737_data), GFP_KERNEL);
2473 if (!data)
2474 return -ENOMEM;
2475
2476 i2c_set_clientdata(client, data);
2477 data->type = i2c_match_id(dme1737_id, client)->driver_data;
2478 data->client = client;
2479 data->name = client->name;
2480 mutex_init(&data->update_lock);
2481
2482
2483 err = dme1737_init_device(dev);
2484 if (err) {
2485 dev_err(dev, "Failed to initialize device.\n");
2486 return err;
2487 }
2488
2489
2490 err = dme1737_create_files(dev);
2491 if (err) {
2492 dev_err(dev, "Failed to create sysfs files.\n");
2493 return err;
2494 }
2495
2496
2497 data->hwmon_dev = hwmon_device_register(dev);
2498 if (IS_ERR(data->hwmon_dev)) {
2499 dev_err(dev, "Failed to register device.\n");
2500 err = PTR_ERR(data->hwmon_dev);
2501 goto exit_remove;
2502 }
2503
2504 return 0;
2505
2506 exit_remove:
2507 dme1737_remove_files(dev);
2508 return err;
2509 }
2510
2511 static int dme1737_i2c_remove(struct i2c_client *client)
2512 {
2513 struct dme1737_data *data = i2c_get_clientdata(client);
2514
2515 hwmon_device_unregister(data->hwmon_dev);
2516 dme1737_remove_files(&client->dev);
2517
2518 return 0;
2519 }
2520
2521 static const struct i2c_device_id dme1737_id[] = {
2522 { "dme1737", dme1737 },
2523 { "sch5027", sch5027 },
2524 { }
2525 };
2526 MODULE_DEVICE_TABLE(i2c, dme1737_id);
2527
2528 static struct i2c_driver dme1737_i2c_driver = {
2529 .class = I2C_CLASS_HWMON,
2530 .driver = {
2531 .name = "dme1737",
2532 },
2533 .probe_new = dme1737_i2c_probe,
2534 .remove = dme1737_i2c_remove,
2535 .id_table = dme1737_id,
2536 .detect = dme1737_i2c_detect,
2537 .address_list = normal_i2c,
2538 };
2539
2540
2541
2542
2543
2544 static int __init dme1737_isa_detect(int sio_cip, unsigned short *addr)
2545 {
2546 int err = 0, reg;
2547 unsigned short base_addr;
2548
2549 dme1737_sio_enter(sio_cip);
2550
2551
2552
2553
2554
2555 reg = force_id ? force_id : dme1737_sio_inb(sio_cip, 0x20);
2556 if (!(reg == SCH3112_ID || reg == SCH3114_ID || reg == SCH3116_ID ||
2557 reg == SCH5127_ID)) {
2558 err = -ENODEV;
2559 goto exit;
2560 }
2561
2562
2563 dme1737_sio_outb(sio_cip, 0x07, 0x0a);
2564
2565
2566 base_addr = (dme1737_sio_inb(sio_cip, 0x60) << 8) |
2567 dme1737_sio_inb(sio_cip, 0x61);
2568 if (!base_addr) {
2569 pr_err("Base address not set\n");
2570 err = -ENODEV;
2571 goto exit;
2572 }
2573
2574
2575
2576
2577
2578 *addr = base_addr + 0x70;
2579
2580 exit:
2581 dme1737_sio_exit(sio_cip);
2582 return err;
2583 }
2584
2585 static int __init dme1737_isa_device_add(unsigned short addr)
2586 {
2587 struct resource res = {
2588 .start = addr,
2589 .end = addr + DME1737_EXTENT - 1,
2590 .name = "dme1737",
2591 .flags = IORESOURCE_IO,
2592 };
2593 int err;
2594
2595 err = acpi_check_resource_conflict(&res);
2596 if (err)
2597 goto exit;
2598
2599 pdev = platform_device_alloc("dme1737", addr);
2600 if (!pdev) {
2601 pr_err("Failed to allocate device\n");
2602 err = -ENOMEM;
2603 goto exit;
2604 }
2605
2606 err = platform_device_add_resources(pdev, &res, 1);
2607 if (err) {
2608 pr_err("Failed to add device resource (err = %d)\n", err);
2609 goto exit_device_put;
2610 }
2611
2612 err = platform_device_add(pdev);
2613 if (err) {
2614 pr_err("Failed to add device (err = %d)\n", err);
2615 goto exit_device_put;
2616 }
2617
2618 return 0;
2619
2620 exit_device_put:
2621 platform_device_put(pdev);
2622 pdev = NULL;
2623 exit:
2624 return err;
2625 }
2626
2627 static int dme1737_isa_probe(struct platform_device *pdev)
2628 {
2629 u8 company, device;
2630 struct resource *res;
2631 struct dme1737_data *data;
2632 struct device *dev = &pdev->dev;
2633 int err;
2634
2635 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
2636 if (!devm_request_region(dev, res->start, DME1737_EXTENT, "dme1737")) {
2637 dev_err(dev, "Failed to request region 0x%04x-0x%04x.\n",
2638 (unsigned short)res->start,
2639 (unsigned short)res->start + DME1737_EXTENT - 1);
2640 return -EBUSY;
2641 }
2642
2643 data = devm_kzalloc(dev, sizeof(struct dme1737_data), GFP_KERNEL);
2644 if (!data)
2645 return -ENOMEM;
2646
2647 data->addr = res->start;
2648 platform_set_drvdata(pdev, data);
2649
2650
2651 switch (force_id) {
2652 case SCH3112_ID:
2653 case SCH3114_ID:
2654 case SCH3116_ID:
2655 data->type = sch311x;
2656 break;
2657 case SCH5127_ID:
2658 data->type = sch5127;
2659 break;
2660 default:
2661 company = dme1737_read(data, DME1737_REG_COMPANY);
2662 device = dme1737_read(data, DME1737_REG_DEVICE);
2663
2664 if ((company == DME1737_COMPANY_SMSC) &&
2665 (device == SCH311X_DEVICE)) {
2666 data->type = sch311x;
2667 } else if ((company == DME1737_COMPANY_SMSC) &&
2668 (device == SCH5127_DEVICE)) {
2669 data->type = sch5127;
2670 } else {
2671 return -ENODEV;
2672 }
2673 }
2674
2675 if (data->type == sch5127)
2676 data->name = "sch5127";
2677 else
2678 data->name = "sch311x";
2679
2680
2681 mutex_init(&data->update_lock);
2682
2683 dev_info(dev, "Found a %s chip at 0x%04x\n",
2684 data->type == sch5127 ? "SCH5127" : "SCH311x", data->addr);
2685
2686
2687 err = dme1737_init_device(dev);
2688 if (err) {
2689 dev_err(dev, "Failed to initialize device.\n");
2690 return err;
2691 }
2692
2693
2694 err = dme1737_create_files(dev);
2695 if (err) {
2696 dev_err(dev, "Failed to create sysfs files.\n");
2697 return err;
2698 }
2699
2700
2701 data->hwmon_dev = hwmon_device_register(dev);
2702 if (IS_ERR(data->hwmon_dev)) {
2703 dev_err(dev, "Failed to register device.\n");
2704 err = PTR_ERR(data->hwmon_dev);
2705 goto exit_remove_files;
2706 }
2707
2708 return 0;
2709
2710 exit_remove_files:
2711 dme1737_remove_files(dev);
2712 return err;
2713 }
2714
2715 static int dme1737_isa_remove(struct platform_device *pdev)
2716 {
2717 struct dme1737_data *data = platform_get_drvdata(pdev);
2718
2719 hwmon_device_unregister(data->hwmon_dev);
2720 dme1737_remove_files(&pdev->dev);
2721
2722 return 0;
2723 }
2724
2725 static struct platform_driver dme1737_isa_driver = {
2726 .driver = {
2727 .name = "dme1737",
2728 },
2729 .probe = dme1737_isa_probe,
2730 .remove = dme1737_isa_remove,
2731 };
2732
2733
2734
2735
2736
2737 static int __init dme1737_init(void)
2738 {
2739 int err;
2740 unsigned short addr;
2741
2742 err = i2c_add_driver(&dme1737_i2c_driver);
2743 if (err)
2744 goto exit;
2745
2746 if (dme1737_isa_detect(0x2e, &addr) &&
2747 dme1737_isa_detect(0x4e, &addr) &&
2748 (!probe_all_addr ||
2749 (dme1737_isa_detect(0x162e, &addr) &&
2750 dme1737_isa_detect(0x164e, &addr)))) {
2751
2752 return 0;
2753 }
2754
2755 err = platform_driver_register(&dme1737_isa_driver);
2756 if (err)
2757 goto exit_del_i2c_driver;
2758
2759
2760 err = dme1737_isa_device_add(addr);
2761 if (err)
2762 goto exit_del_isa_driver;
2763
2764 return 0;
2765
2766 exit_del_isa_driver:
2767 platform_driver_unregister(&dme1737_isa_driver);
2768 exit_del_i2c_driver:
2769 i2c_del_driver(&dme1737_i2c_driver);
2770 exit:
2771 return err;
2772 }
2773
2774 static void __exit dme1737_exit(void)
2775 {
2776 if (pdev) {
2777 platform_device_unregister(pdev);
2778 platform_driver_unregister(&dme1737_isa_driver);
2779 }
2780
2781 i2c_del_driver(&dme1737_i2c_driver);
2782 }
2783
2784 MODULE_AUTHOR("Juerg Haefliger <juergh@gmail.com>");
2785 MODULE_DESCRIPTION("DME1737 sensors");
2786 MODULE_LICENSE("GPL");
2787
2788 module_init(dme1737_init);
2789 module_exit(dme1737_exit);