?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 4.16.11
[linux/fpc-iii.git] / drivers / hwmon / nct7904.c
blob95a68ab175c7f27ab60e8a26ab0e0cf9029d6e67
1 /*
2 * nct7904.c - driver for Nuvoton NCT7904D.
3 *
4 * Copyright (c) 2015 Kontron
5 * Author: Vadim V. Vlasov <vvlasov@dev.rtsoft.ru>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 */
17
18 #include <linux/module.h>
19 #include <linux/device.h>
20 #include <linux/init.h>
21 #include <linux/i2c.h>
22 #include <linux/mutex.h>
23 #include <linux/hwmon.h>
24
25 #define VENDOR_ID_REG 0x7A /* Any bank */
26 #define NUVOTON_ID 0x50
27 #define CHIP_ID_REG 0x7B /* Any bank */
28 #define NCT7904_ID 0xC5
29 #define DEVICE_ID_REG 0x7C /* Any bank */
30
31 #define BANK_SEL_REG 0xFF
32 #define BANK_0 0x00
33 #define BANK_1 0x01
34 #define BANK_2 0x02
35 #define BANK_3 0x03
36 #define BANK_4 0x04
37 #define BANK_MAX 0x04
38
39 #define FANIN_MAX 12 /* Counted from 1 */
40 #define VSEN_MAX 21 /* VSEN1..14, 3VDD, VBAT, V3VSB,
41 LTD (not a voltage), VSEN17..19 */
42 #define FANCTL_MAX 4 /* Counted from 1 */
43 #define TCPU_MAX 8 /* Counted from 1 */
44 #define TEMP_MAX 4 /* Counted from 1 */
45
46 #define VT_ADC_CTRL0_REG 0x20 /* Bank 0 */
47 #define VT_ADC_CTRL1_REG 0x21 /* Bank 0 */
48 #define VT_ADC_CTRL2_REG 0x22 /* Bank 0 */
49 #define FANIN_CTRL0_REG 0x24
50 #define FANIN_CTRL1_REG 0x25
51 #define DTS_T_CTRL0_REG 0x26
52 #define DTS_T_CTRL1_REG 0x27
53 #define VT_ADC_MD_REG 0x2E
54
55 #define VSEN1_HV_REG 0x40 /* Bank 0; 2 regs (HV/LV) per sensor */
56 #define TEMP_CH1_HV_REG 0x42 /* Bank 0; same as VSEN2_HV */
57 #define LTD_HV_REG 0x62 /* Bank 0; 2 regs in VSEN range */
58 #define FANIN1_HV_REG 0x80 /* Bank 0; 2 regs (HV/LV) per sensor */
59 #define T_CPU1_HV_REG 0xA0 /* Bank 0; 2 regs (HV/LV) per sensor */
60
61 #define PRTS_REG 0x03 /* Bank 2 */
62 #define FANCTL1_FMR_REG 0x00 /* Bank 3; 1 reg per channel */
63 #define FANCTL1_OUT_REG 0x10 /* Bank 3; 1 reg per channel */
64
65 static const unsigned short normal_i2c[] = {
66 0x2d, 0x2e, I2C_CLIENT_END
67 };
68
69 struct nct7904_data {
70 struct i2c_client *client;
71 struct mutex bank_lock;
72 int bank_sel;
73 u32 fanin_mask;
74 u32 vsen_mask;
75 u32 tcpu_mask;
76 u8 fan_mode[FANCTL_MAX];
77 };
78
79 /* Access functions */
80 static int nct7904_bank_lock(struct nct7904_data *data, unsigned bank)
81 {
82 int ret;
83
84 mutex_lock(&data->bank_lock);
85 if (data->bank_sel == bank)
86 return 0;
87 ret = i2c_smbus_write_byte_data(data->client, BANK_SEL_REG, bank);
88 if (ret == 0)
89 data->bank_sel = bank;
90 else
91 data->bank_sel = -1;
92 return ret;
93 }
94
95 static inline void nct7904_bank_release(struct nct7904_data *data)
96 {
97 mutex_unlock(&data->bank_lock);
98 }
99
100 /* Read 1-byte register. Returns unsigned reg or -ERRNO on error. */
101 static int nct7904_read_reg(struct nct7904_data *data,
102 unsigned bank, unsigned reg)
103 {
104 struct i2c_client *client = data->client;
105 int ret;
106
107 ret = nct7904_bank_lock(data, bank);
108 if (ret == 0)
109 ret = i2c_smbus_read_byte_data(client, reg);
110
111 nct7904_bank_release(data);
112 return ret;
113 }
114
115 /*
116 * Read 2-byte register. Returns register in big-endian format or
117 * -ERRNO on error.
118 */
119 static int nct7904_read_reg16(struct nct7904_data *data,
120 unsigned bank, unsigned reg)
121 {
122 struct i2c_client *client = data->client;
123 int ret, hi;
124
125 ret = nct7904_bank_lock(data, bank);
126 if (ret == 0) {
127 ret = i2c_smbus_read_byte_data(client, reg);
128 if (ret >= 0) {
129 hi = ret;
130 ret = i2c_smbus_read_byte_data(client, reg + 1);
131 if (ret >= 0)
132 ret |= hi << 8;
133 }
134 }
135
136 nct7904_bank_release(data);
137 return ret;
138 }
139
140 /* Write 1-byte register. Returns 0 or -ERRNO on error. */
141 static int nct7904_write_reg(struct nct7904_data *data,
142 unsigned bank, unsigned reg, u8 val)
143 {
144 struct i2c_client *client = data->client;
145 int ret;
146
147 ret = nct7904_bank_lock(data, bank);
148 if (ret == 0)
149 ret = i2c_smbus_write_byte_data(client, reg, val);
150
151 nct7904_bank_release(data);
152 return ret;
153 }
154
155 static int nct7904_read_fan(struct device *dev, u32 attr, int channel,
156 long *val)
157 {
158 struct nct7904_data *data = dev_get_drvdata(dev);
159 unsigned int cnt, rpm;
160 int ret;
161
162 switch(attr) {
163 case hwmon_fan_input:
164 ret = nct7904_read_reg16(data, BANK_0,
165 FANIN1_HV_REG + channel * 2);
166 if (ret < 0)
167 return ret;
168 cnt = ((ret & 0xff00) >> 3) | (ret & 0x1f);
169 if (cnt == 0x1fff)
170 rpm = 0;
171 else
172 rpm = 1350000 / cnt;
173 *val = rpm;
174 return 0;
175 default:
176 return -EOPNOTSUPP;
177 }
178 }
179
180 static umode_t nct7904_fan_is_visible(const void *_data, u32 attr, int channel)
181 {
182 const struct nct7904_data *data = _data;
183
184 if (attr == hwmon_fan_input && data->fanin_mask & (1 << channel))
185 return S_IRUGO;
186 return 0;
187 }
188
189 static u8 nct7904_chan_to_index[] = {
190 0, /* Not used */
191 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
192 18, 19, 20, 16
193 };
194
195 static int nct7904_read_in(struct device *dev, u32 attr, int channel,
196 long *val)
197 {
198 struct nct7904_data *data = dev_get_drvdata(dev);
199 int ret, volt, index;
200
201 index = nct7904_chan_to_index[channel];
202
203 switch(attr) {
204 case hwmon_in_input:
205 ret = nct7904_read_reg16(data, BANK_0,
206 VSEN1_HV_REG + index * 2);
207 if (ret < 0)
208 return ret;
209 volt = ((ret & 0xff00) >> 5) | (ret & 0x7);
210 if (index < 14)
211 volt *= 2; /* 0.002V scale */
212 else
213 volt *= 6; /* 0.006V scale */
214 *val = volt;
215 return 0;
216 default:
217 return -EOPNOTSUPP;
218 }
219 }
220
221 static umode_t nct7904_in_is_visible(const void *_data, u32 attr, int channel)
222 {
223 const struct nct7904_data *data = _data;
224 int index = nct7904_chan_to_index[channel];
225
226 if (channel > 0 && attr == hwmon_in_input &&
227 (data->vsen_mask & BIT(index)))
228 return S_IRUGO;
229
230 return 0;
231 }
232
233 static int nct7904_read_temp(struct device *dev, u32 attr, int channel,
234 long *val)
235 {
236 struct nct7904_data *data = dev_get_drvdata(dev);
237 int ret, temp;
238
239 switch(attr) {
240 case hwmon_temp_input:
241 if (channel == 0)
242 ret = nct7904_read_reg16(data, BANK_0, LTD_HV_REG);
243 else
244 ret = nct7904_read_reg16(data, BANK_0,
245 T_CPU1_HV_REG + (channel - 1) * 2);
246 if (ret < 0)
247 return ret;
248 temp = ((ret & 0xff00) >> 5) | (ret & 0x7);
249 *val = sign_extend32(temp, 10) * 125;
250 return 0;
251 default:
252 return -EOPNOTSUPP;
253 }
254 }
255
256 static umode_t nct7904_temp_is_visible(const void *_data, u32 attr, int channel)
257 {
258 const struct nct7904_data *data = _data;
259
260 if (attr == hwmon_temp_input) {
261 if (channel == 0) {
262 if (data->vsen_mask & BIT(17))
263 return S_IRUGO;
264 } else {
265 if (data->tcpu_mask & BIT(channel - 1))
266 return S_IRUGO;
267 }
268 }
269
270 return 0;
271 }
272
273 static int nct7904_read_pwm(struct device *dev, u32 attr, int channel,
274 long *val)
275 {
276 struct nct7904_data *data = dev_get_drvdata(dev);
277 int ret;
278
279 switch(attr) {
280 case hwmon_pwm_input:
281 ret = nct7904_read_reg(data, BANK_3, FANCTL1_OUT_REG + channel);
282 if (ret < 0)
283 return ret;
284 *val = ret;
285 return 0;
286 case hwmon_pwm_enable:
287 ret = nct7904_read_reg(data, BANK_3, FANCTL1_FMR_REG + channel);
288 if (ret < 0)
289 return ret;
290
291 *val = ret ? 2 : 1;
292 return 0;
293 default:
294 return -EOPNOTSUPP;
295 }
296 }
297
298 static int nct7904_write_pwm(struct device *dev, u32 attr, int channel,
299 long val)
300 {
301 struct nct7904_data *data = dev_get_drvdata(dev);
302 int ret;
303
304 switch(attr) {
305 case hwmon_pwm_input:
306 if (val < 0 || val > 255)
307 return -EINVAL;
308 ret = nct7904_write_reg(data, BANK_3, FANCTL1_OUT_REG + channel,
309 val);
310 return ret;
311 case hwmon_pwm_enable:
312 if (val < 1 || val > 2 ||
313 (val == 2 && !data->fan_mode[channel]))
314 return -EINVAL;
315 ret = nct7904_write_reg(data, BANK_3, FANCTL1_FMR_REG + channel,
316 val == 2 ? data->fan_mode[channel] : 0);
317 return ret;
318 default:
319 return -EOPNOTSUPP;
320 }
321 }
322
323 static umode_t nct7904_pwm_is_visible(const void *_data, u32 attr, int channel)
324 {
325 switch(attr) {
326 case hwmon_pwm_input:
327 case hwmon_pwm_enable:
328 return S_IRUGO | S_IWUSR;
329 default:
330 return 0;
331 }
332 }
333
334 static int nct7904_read(struct device *dev, enum hwmon_sensor_types type,
335 u32 attr, int channel, long *val)
336 {
337 switch (type) {
338 case hwmon_in:
339 return nct7904_read_in(dev, attr, channel, val);
340 case hwmon_fan:
341 return nct7904_read_fan(dev, attr, channel, val);
342 case hwmon_pwm:
343 return nct7904_read_pwm(dev, attr, channel, val);
344 case hwmon_temp:
345 return nct7904_read_temp(dev, attr, channel, val);
346 default:
347 return -EOPNOTSUPP;
348 }
349 }
350
351 static int nct7904_write(struct device *dev, enum hwmon_sensor_types type,
352 u32 attr, int channel, long val)
353 {
354 switch (type) {
355 case hwmon_pwm:
356 return nct7904_write_pwm(dev, attr, channel, val);
357 default:
358 return -EOPNOTSUPP;
359 }
360 }
361
362 static umode_t nct7904_is_visible(const void *data,
363 enum hwmon_sensor_types type,
364 u32 attr, int channel)
365 {
366 switch (type) {
367 case hwmon_in:
368 return nct7904_in_is_visible(data, attr, channel);
369 case hwmon_fan:
370 return nct7904_fan_is_visible(data, attr, channel);
371 case hwmon_pwm:
372 return nct7904_pwm_is_visible(data, attr, channel);
373 case hwmon_temp:
374 return nct7904_temp_is_visible(data, attr, channel);
375 default:
376 return 0;
377 }
378 }
379
380 /* Return 0 if detection is successful, -ENODEV otherwise */
381 static int nct7904_detect(struct i2c_client *client,
382 struct i2c_board_info *info)
383 {
384 struct i2c_adapter *adapter = client->adapter;
385
386 if (!i2c_check_functionality(adapter,
387 I2C_FUNC_SMBUS_READ_BYTE |
388 I2C_FUNC_SMBUS_WRITE_BYTE_DATA))
389 return -ENODEV;
390
391 /* Determine the chip type. */
392 if (i2c_smbus_read_byte_data(client, VENDOR_ID_REG) != NUVOTON_ID ||
393 i2c_smbus_read_byte_data(client, CHIP_ID_REG) != NCT7904_ID ||
394 (i2c_smbus_read_byte_data(client, DEVICE_ID_REG) & 0xf0) != 0x50 ||
395 (i2c_smbus_read_byte_data(client, BANK_SEL_REG) & 0xf8) != 0x00)
396 return -ENODEV;
397
398 strlcpy(info->type, "nct7904", I2C_NAME_SIZE);
399
400 return 0;
401 }
402
403 static const u32 nct7904_in_config[] = {
404 HWMON_I_INPUT, /* dummy, skipped in is_visible */
405 HWMON_I_INPUT,
406 HWMON_I_INPUT,
407 HWMON_I_INPUT,
408 HWMON_I_INPUT,
409 HWMON_I_INPUT,
410 HWMON_I_INPUT,
411 HWMON_I_INPUT,
412 HWMON_I_INPUT,
413 HWMON_I_INPUT,
414 HWMON_I_INPUT,
415 HWMON_I_INPUT,
416 HWMON_I_INPUT,
417 HWMON_I_INPUT,
418 HWMON_I_INPUT,
419 HWMON_I_INPUT,
420 HWMON_I_INPUT,
421 HWMON_I_INPUT,
422 HWMON_I_INPUT,
423 HWMON_I_INPUT,
424 HWMON_I_INPUT,
425 0
426 };
427
428 static const struct hwmon_channel_info nct7904_in = {
429 .type = hwmon_in,
430 .config = nct7904_in_config,
431 };
432
433 static const u32 nct7904_fan_config[] = {
434 HWMON_F_INPUT,
435 HWMON_F_INPUT,
436 HWMON_F_INPUT,
437 HWMON_F_INPUT,
438 HWMON_F_INPUT,
439 HWMON_F_INPUT,
440 HWMON_F_INPUT,
441 HWMON_F_INPUT,
442 0
443 };
444
445 static const struct hwmon_channel_info nct7904_fan = {
446 .type = hwmon_fan,
447 .config = nct7904_fan_config,
448 };
449
450 static const u32 nct7904_pwm_config[] = {
451 HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
452 HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
453 HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
454 HWMON_PWM_INPUT | HWMON_PWM_ENABLE,
455 0
456 };
457
458 static const struct hwmon_channel_info nct7904_pwm = {
459 .type = hwmon_pwm,
460 .config = nct7904_pwm_config,
461 };
462
463 static const u32 nct7904_temp_config[] = {
464 HWMON_T_INPUT,
465 HWMON_T_INPUT,
466 HWMON_T_INPUT,
467 HWMON_T_INPUT,
468 HWMON_T_INPUT,
469 HWMON_T_INPUT,
470 HWMON_T_INPUT,
471 HWMON_T_INPUT,
472 HWMON_T_INPUT,
473 0
474 };
475
476 static const struct hwmon_channel_info nct7904_temp = {
477 .type = hwmon_temp,
478 .config = nct7904_temp_config,
479 };
480
481 static const struct hwmon_channel_info *nct7904_info[] = {
482 &nct7904_in,
483 &nct7904_fan,
484 &nct7904_pwm,
485 &nct7904_temp,
486 NULL
487 };
488
489 static const struct hwmon_ops nct7904_hwmon_ops = {
490 .is_visible = nct7904_is_visible,
491 .read = nct7904_read,
492 .write = nct7904_write,
493 };
494
495 static const struct hwmon_chip_info nct7904_chip_info = {
496 .ops = &nct7904_hwmon_ops,
497 .info = nct7904_info,
498 };
499
500 static int nct7904_probe(struct i2c_client *client,
501 const struct i2c_device_id *id)
502 {
503 struct nct7904_data *data;
504 struct device *hwmon_dev;
505 struct device *dev = &client->dev;
506 int ret, i;
507 u32 mask;
508
509 data = devm_kzalloc(dev, sizeof(struct nct7904_data), GFP_KERNEL);
510 if (!data)
511 return -ENOMEM;
512
513 data->client = client;
514 mutex_init(&data->bank_lock);
515 data->bank_sel = -1;
516
517 /* Setup sensor groups. */
518 /* FANIN attributes */
519 ret = nct7904_read_reg16(data, BANK_0, FANIN_CTRL0_REG);
520 if (ret < 0)
521 return ret;
522 data->fanin_mask = (ret >> 8) | ((ret & 0xff) << 8);
523
524 /*
525 * VSEN attributes
526 *
527 * Note: voltage sensors overlap with external temperature
528 * sensors. So, if we ever decide to support the latter
529 * we will have to adjust 'vsen_mask' accordingly.
530 */
531 mask = 0;
532 ret = nct7904_read_reg16(data, BANK_0, VT_ADC_CTRL0_REG);
533 if (ret >= 0)
534 mask = (ret >> 8) | ((ret & 0xff) << 8);
535 ret = nct7904_read_reg(data, BANK_0, VT_ADC_CTRL2_REG);
536 if (ret >= 0)
537 mask |= (ret << 16);
538 data->vsen_mask = mask;
539
540 /* CPU_TEMP attributes */
541 ret = nct7904_read_reg16(data, BANK_0, DTS_T_CTRL0_REG);
542 if (ret < 0)
543 return ret;
544 data->tcpu_mask = ((ret >> 8) & 0xf) | ((ret & 0xf) << 4);
545
546 for (i = 0; i < FANCTL_MAX; i++) {
547 ret = nct7904_read_reg(data, BANK_3, FANCTL1_FMR_REG + i);
548 if (ret < 0)
549 return ret;
550 data->fan_mode[i] = ret;
551 }
552
553 hwmon_dev =
554 devm_hwmon_device_register_with_info(dev, client->name, data,
555 &nct7904_chip_info, NULL);
556 return PTR_ERR_OR_ZERO(hwmon_dev);
557 }
558
559 static const struct i2c_device_id nct7904_id[] = {
560 {"nct7904", 0},
561 {}
562 };
563 MODULE_DEVICE_TABLE(i2c, nct7904_id);
564
565 static struct i2c_driver nct7904_driver = {
566 .class = I2C_CLASS_HWMON,
567 .driver = {
568 .name = "nct7904",
569 },
570 .probe = nct7904_probe,
571 .id_table = nct7904_id,
572 .detect = nct7904_detect,
573 .address_list = normal_i2c,
574 };
575
576 module_i2c_driver(nct7904_driver);
577
578 MODULE_AUTHOR("Vadim V. Vlasov <vvlasov@dev.rtsoft.ru>");
579 MODULE_DESCRIPTION("Hwmon driver for NUVOTON NCT7904");
580 MODULE_LICENSE("GPL");
Linux with added FPC-III support