Lines Matching +full:reg +full:- +full:data
2 * w83627ehf - Driver for the hardware monitoring functionality of
3 * the Winbond W83627EHF Super-I/O chip
4 * Copyright (C) 2005-2012 Jean Delvare <jdelvare@suse.de>
9 * Copyright (C) 2010 Sheng-Yuan Huang (Nuvoton) (PS00)
17 * This driver also supports the W83627EHG, which is the lead-free
40 * w83627dhg-p 9 5 4 3 0xb070 0xc1 0x5ca3
43 * w83667hg-b 9 5 3 4 0xb350 0xc1 0x5ca3
56 #include <linux/hwmon-sysfs.h>
57 #include <linux/hwmon-vid.h>
69 /* used to set data->name = w83627ehf_device_names[data->sio_kind] */
92 * Super-I/O constants and functions
104 #define SIO_REG_VID_DATA 0xF1 /* VID data */
118 superio_outb(int ioreg, int reg, int val) in superio_outb() argument
120 outb(reg, ioreg); in superio_outb()
125 superio_inb(int ioreg, int reg) in superio_inb() argument
127 outb(reg, ioreg); in superio_inb()
142 return -EBUSY; in superio_enter()
185 (0x554 + (((nr) - 7) * 2)))
187 (0x555 + (((nr) - 7) * 2)))
189 (0x550 + (nr) - 7))
289 "AMD SB-TSI",
336 static int is_word_sized(u16 reg) in is_word_sized() argument
338 return ((((reg & 0xff00) == 0x100 in is_word_sized()
339 || (reg & 0xff00) == 0x200) in is_word_sized()
340 && ((reg & 0x00ff) == 0x50 in is_word_sized()
341 || (reg & 0x00ff) == 0x53 in is_word_sized()
342 || (reg & 0x00ff) == 0x55)) in is_word_sized()
343 || (reg & 0xfff0) == 0x630 in is_word_sized()
344 || reg == 0x640 || reg == 0x642 in is_word_sized()
345 || ((reg & 0xfff0) == 0x650 in is_word_sized()
346 && (reg & 0x000f) >= 0x06) in is_word_sized()
347 || reg == 0x73 || reg == 0x75 || reg == 0x77 in is_word_sized()
356 static inline unsigned int step_time_from_reg(u8 reg, u8 mode) in step_time_from_reg() argument
358 return mode ? 100 * reg : 400 * reg; in step_time_from_reg()
367 static unsigned int fan_from_reg8(u16 reg, unsigned int divreg) in fan_from_reg8() argument
369 if (reg == 0 || reg == 255) in fan_from_reg8()
371 return 1350000U / (reg << divreg); in fan_from_reg8()
374 static unsigned int fan_from_reg13(u16 reg, unsigned int divreg) in fan_from_reg13() argument
376 if ((reg & 0xff1f) == 0xff1f) in fan_from_reg13()
379 reg = (reg & 0x1f) | ((reg & 0xff00) >> 3); in fan_from_reg13()
381 if (reg == 0) in fan_from_reg13()
384 return 1350000U / reg; in fan_from_reg13()
387 static unsigned int fan_from_reg16(u16 reg, unsigned int divreg) in fan_from_reg16() argument
389 if (reg == 0 || reg == 0xffff) in fan_from_reg16()
396 return 1350000U / (reg << divreg); in fan_from_reg16()
400 div_from_reg(u8 reg) in div_from_reg() argument
402 return 1 << reg; in div_from_reg()
416 static inline long in_from_reg(u8 reg, u8 nr, const u16 *scale_in) in in_from_reg() argument
418 return DIV_ROUND_CLOSEST(reg * scale_in[nr], 100); in in_from_reg()
427 * Data structures and manipulation thereof
455 unsigned int (*fan_from_reg)(u16 reg, unsigned int divreg);
456 unsigned int (*fan_from_reg_min)(u16 reg, unsigned int divreg);
482 u8 pwm_mode[4]; /* 0->DC variable voltage, 1->PWM variable duty cycle */
483 u8 pwm_enable[4]; /* 1->manual
484 * 2->thermal cruise mode (also called SmartFan I)
485 * 3->fan speed cruise mode
486 * 4->variable thermal cruise (also called
488 * 5->enhanced variable thermal cruise (also called
525 * On older chips, only registers 0x50-0x5f are banked.
530 static inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg) in w83627ehf_set_bank() argument
532 u8 bank = reg >> 8; in w83627ehf_set_bank()
533 if (data->bank != bank) { in w83627ehf_set_bank()
534 outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET); in w83627ehf_set_bank()
535 outb_p(bank, data->addr + DATA_REG_OFFSET); in w83627ehf_set_bank()
536 data->bank = bank; in w83627ehf_set_bank()
540 static u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg) in w83627ehf_read_value() argument
542 int res, word_sized = is_word_sized(reg); in w83627ehf_read_value()
544 mutex_lock(&data->lock); in w83627ehf_read_value()
546 w83627ehf_set_bank(data, reg); in w83627ehf_read_value()
547 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET); in w83627ehf_read_value()
548 res = inb_p(data->addr + DATA_REG_OFFSET); in w83627ehf_read_value()
550 outb_p((reg & 0xff) + 1, in w83627ehf_read_value()
551 data->addr + ADDR_REG_OFFSET); in w83627ehf_read_value()
552 res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET); in w83627ehf_read_value()
555 mutex_unlock(&data->lock); in w83627ehf_read_value()
559 static int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg, in w83627ehf_write_value() argument
562 int word_sized = is_word_sized(reg); in w83627ehf_write_value()
564 mutex_lock(&data->lock); in w83627ehf_write_value()
566 w83627ehf_set_bank(data, reg); in w83627ehf_write_value()
567 outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET); in w83627ehf_write_value()
569 outb_p(value >> 8, data->addr + DATA_REG_OFFSET); in w83627ehf_write_value()
570 outb_p((reg & 0xff) + 1, in w83627ehf_write_value()
571 data->addr + ADDR_REG_OFFSET); in w83627ehf_write_value()
573 outb_p(value & 0xff, data->addr + DATA_REG_OFFSET); in w83627ehf_write_value()
575 mutex_unlock(&data->lock); in w83627ehf_write_value()
579 /* We left-align 8-bit temperature values to make the code simpler */
580 static u16 w83627ehf_read_temp(struct w83627ehf_data *data, u16 reg) in w83627ehf_read_temp() argument
584 res = w83627ehf_read_value(data, reg); in w83627ehf_read_temp()
585 if (!is_word_sized(reg)) in w83627ehf_read_temp()
591 static int w83627ehf_write_temp(struct w83627ehf_data *data, u16 reg, in w83627ehf_write_temp() argument
594 if (!is_word_sized(reg)) in w83627ehf_write_temp()
596 return w83627ehf_write_value(data, reg, value); in w83627ehf_write_temp()
599 /* This function assumes that the caller holds data->update_lock */
600 static void nct6775_write_fan_div(struct w83627ehf_data *data, int nr) in nct6775_write_fan_div() argument
602 u8 reg; in nct6775_write_fan_div() local
606 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV1) & 0x70) in nct6775_write_fan_div()
607 | (data->fan_div[0] & 0x7); in nct6775_write_fan_div()
608 w83627ehf_write_value(data, NCT6775_REG_FANDIV1, reg); in nct6775_write_fan_div()
611 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV1) & 0x7) in nct6775_write_fan_div()
612 | ((data->fan_div[1] << 4) & 0x70); in nct6775_write_fan_div()
613 w83627ehf_write_value(data, NCT6775_REG_FANDIV1, reg); in nct6775_write_fan_div()
616 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV2) & 0x70) in nct6775_write_fan_div()
617 | (data->fan_div[2] & 0x7); in nct6775_write_fan_div()
618 w83627ehf_write_value(data, NCT6775_REG_FANDIV2, reg); in nct6775_write_fan_div()
621 reg = (w83627ehf_read_value(data, NCT6775_REG_FANDIV2) & 0x7) in nct6775_write_fan_div()
622 | ((data->fan_div[3] << 4) & 0x70); in nct6775_write_fan_div()
623 w83627ehf_write_value(data, NCT6775_REG_FANDIV2, reg); in nct6775_write_fan_div()
628 /* This function assumes that the caller holds data->update_lock */
629 static void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr) in w83627ehf_write_fan_div() argument
631 u8 reg; in w83627ehf_write_fan_div() local
635 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf) in w83627ehf_write_fan_div()
636 | ((data->fan_div[0] & 0x03) << 4); in w83627ehf_write_fan_div()
638 reg |= (data->has_fan & (1 << 4)) ? 1 : 0; in w83627ehf_write_fan_div()
639 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg); in w83627ehf_write_fan_div()
640 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf) in w83627ehf_write_fan_div()
641 | ((data->fan_div[0] & 0x04) << 3); in w83627ehf_write_fan_div()
642 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg); in w83627ehf_write_fan_div()
645 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f) in w83627ehf_write_fan_div()
646 | ((data->fan_div[1] & 0x03) << 6); in w83627ehf_write_fan_div()
648 reg |= (data->has_fan & (1 << 4)) ? 1 : 0; in w83627ehf_write_fan_div()
649 w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg); in w83627ehf_write_fan_div()
650 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf) in w83627ehf_write_fan_div()
651 | ((data->fan_div[1] & 0x04) << 4); in w83627ehf_write_fan_div()
652 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg); in w83627ehf_write_fan_div()
655 reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f) in w83627ehf_write_fan_div()
656 | ((data->fan_div[2] & 0x03) << 6); in w83627ehf_write_fan_div()
657 w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg); in w83627ehf_write_fan_div()
658 reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f) in w83627ehf_write_fan_div()
659 | ((data->fan_div[2] & 0x04) << 5); in w83627ehf_write_fan_div()
660 w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg); in w83627ehf_write_fan_div()
663 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc) in w83627ehf_write_fan_div()
664 | (data->fan_div[3] & 0x03); in w83627ehf_write_fan_div()
665 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg); in w83627ehf_write_fan_div()
666 reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f) in w83627ehf_write_fan_div()
667 | ((data->fan_div[3] & 0x04) << 5); in w83627ehf_write_fan_div()
668 w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg); in w83627ehf_write_fan_div()
671 reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73) in w83627ehf_write_fan_div()
672 | ((data->fan_div[4] & 0x03) << 2) in w83627ehf_write_fan_div()
673 | ((data->fan_div[4] & 0x04) << 5); in w83627ehf_write_fan_div()
674 w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg); in w83627ehf_write_fan_div()
680 struct w83627ehf_data *data, int nr) in w83627ehf_write_fan_div_common() argument
684 if (sio_data->kind == nct6776) in w83627ehf_write_fan_div_common()
686 else if (sio_data->kind == nct6775) in w83627ehf_write_fan_div_common()
687 nct6775_write_fan_div(data, nr); in w83627ehf_write_fan_div_common()
689 w83627ehf_write_fan_div(data, nr); in w83627ehf_write_fan_div_common()
692 static void nct6775_update_fan_div(struct w83627ehf_data *data) in nct6775_update_fan_div() argument
696 i = w83627ehf_read_value(data, NCT6775_REG_FANDIV1); in nct6775_update_fan_div()
697 data->fan_div[0] = i & 0x7; in nct6775_update_fan_div()
698 data->fan_div[1] = (i & 0x70) >> 4; in nct6775_update_fan_div()
699 i = w83627ehf_read_value(data, NCT6775_REG_FANDIV2); in nct6775_update_fan_div()
700 data->fan_div[2] = i & 0x7; in nct6775_update_fan_div()
701 if (data->has_fan & (1<<3)) in nct6775_update_fan_div()
702 data->fan_div[3] = (i & 0x70) >> 4; in nct6775_update_fan_div()
705 static void w83627ehf_update_fan_div(struct w83627ehf_data *data) in w83627ehf_update_fan_div() argument
709 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1); in w83627ehf_update_fan_div()
710 data->fan_div[0] = (i >> 4) & 0x03; in w83627ehf_update_fan_div()
711 data->fan_div[1] = (i >> 6) & 0x03; in w83627ehf_update_fan_div()
712 i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV2); in w83627ehf_update_fan_div()
713 data->fan_div[2] = (i >> 6) & 0x03; in w83627ehf_update_fan_div()
714 i = w83627ehf_read_value(data, W83627EHF_REG_VBAT); in w83627ehf_update_fan_div()
715 data->fan_div[0] |= (i >> 3) & 0x04; in w83627ehf_update_fan_div()
716 data->fan_div[1] |= (i >> 4) & 0x04; in w83627ehf_update_fan_div()
717 data->fan_div[2] |= (i >> 5) & 0x04; in w83627ehf_update_fan_div()
718 if (data->has_fan & ((1 << 3) | (1 << 4))) { in w83627ehf_update_fan_div()
719 i = w83627ehf_read_value(data, W83627EHF_REG_DIODE); in w83627ehf_update_fan_div()
720 data->fan_div[3] = i & 0x03; in w83627ehf_update_fan_div()
721 data->fan_div[4] = ((i >> 2) & 0x03) in w83627ehf_update_fan_div()
724 if (data->has_fan & (1 << 3)) { in w83627ehf_update_fan_div()
725 i = w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT); in w83627ehf_update_fan_div()
726 data->fan_div[3] |= (i >> 5) & 0x04; in w83627ehf_update_fan_div()
731 struct w83627ehf_data *data) in w83627ehf_update_fan_div_common() argument
735 if (sio_data->kind == nct6776) in w83627ehf_update_fan_div_common()
737 else if (sio_data->kind == nct6775) in w83627ehf_update_fan_div_common()
738 nct6775_update_fan_div(data); in w83627ehf_update_fan_div_common()
740 w83627ehf_update_fan_div(data); in w83627ehf_update_fan_div_common()
743 static void nct6775_update_pwm(struct w83627ehf_data *data) in nct6775_update_pwm() argument
748 for (i = 0; i < data->pwm_num; i++) { in nct6775_update_pwm()
749 pwmcfg = w83627ehf_read_value(data, in nct6775_update_pwm()
751 fanmodecfg = w83627ehf_read_value(data, in nct6775_update_pwm()
753 data->pwm_mode[i] = in nct6775_update_pwm()
755 data->pwm_enable[i] = ((fanmodecfg >> 4) & 7) + 1; in nct6775_update_pwm()
756 data->tolerance[i] = fanmodecfg & 0x0f; in nct6775_update_pwm()
757 data->pwm[i] = w83627ehf_read_value(data, data->REG_PWM[i]); in nct6775_update_pwm()
761 static void w83627ehf_update_pwm(struct w83627ehf_data *data) in w83627ehf_update_pwm() argument
766 for (i = 0; i < data->pwm_num; i++) { in w83627ehf_update_pwm()
767 if (!(data->has_fan & (1 << i))) in w83627ehf_update_pwm()
770 /* pwmcfg, tolerance mapped for i=0, i=1 to same reg */ in w83627ehf_update_pwm()
772 pwmcfg = w83627ehf_read_value(data, in w83627ehf_update_pwm()
774 tolerance = w83627ehf_read_value(data, in w83627ehf_update_pwm()
777 data->pwm_mode[i] = in w83627ehf_update_pwm()
779 data->pwm_enable[i] = ((pwmcfg >> W83627EHF_PWM_ENABLE_SHIFT[i]) in w83627ehf_update_pwm()
781 data->pwm[i] = w83627ehf_read_value(data, data->REG_PWM[i]); in w83627ehf_update_pwm()
783 data->tolerance[i] = (tolerance >> (i == 1 ? 4 : 0)) & 0x0f; in w83627ehf_update_pwm()
788 struct w83627ehf_data *data) in w83627ehf_update_pwm_common() argument
792 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) in w83627ehf_update_pwm_common()
793 nct6775_update_pwm(data); in w83627ehf_update_pwm_common()
795 w83627ehf_update_pwm(data); in w83627ehf_update_pwm_common()
800 struct w83627ehf_data *data = dev_get_drvdata(dev); in w83627ehf_update_device() local
805 mutex_lock(&data->update_lock); in w83627ehf_update_device()
807 if (time_after(jiffies, data->last_updated + HZ + HZ/2) in w83627ehf_update_device()
808 || !data->valid) { in w83627ehf_update_device()
810 w83627ehf_update_fan_div_common(dev, data); in w83627ehf_update_device()
813 for (i = 0; i < data->in_num; i++) { in w83627ehf_update_device()
814 if ((i == 6) && data->in6_skip) in w83627ehf_update_device()
817 data->in[i] = w83627ehf_read_value(data, in w83627ehf_update_device()
819 data->in_min[i] = w83627ehf_read_value(data, in w83627ehf_update_device()
821 data->in_max[i] = w83627ehf_read_value(data, in w83627ehf_update_device()
827 u16 reg; in w83627ehf_update_device() local
829 if (!(data->has_fan & (1 << i))) in w83627ehf_update_device()
832 reg = w83627ehf_read_value(data, data->REG_FAN[i]); in w83627ehf_update_device()
833 data->rpm[i] = data->fan_from_reg(reg, in w83627ehf_update_device()
834 data->fan_div[i]); in w83627ehf_update_device()
836 if (data->has_fan_min & (1 << i)) in w83627ehf_update_device()
837 data->fan_min[i] = w83627ehf_read_value(data, in w83627ehf_update_device()
838 data->REG_FAN_MIN[i]); in w83627ehf_update_device()
845 if (data->has_fan_div in w83627ehf_update_device()
846 && (reg >= 0xff || (sio_data->kind == nct6775 in w83627ehf_update_device()
847 && reg == 0x00)) in w83627ehf_update_device()
848 && data->fan_div[i] < 0x07) { in w83627ehf_update_device()
851 i + 1, div_from_reg(data->fan_div[i]), in w83627ehf_update_device()
852 div_from_reg(data->fan_div[i] + 1)); in w83627ehf_update_device()
853 data->fan_div[i]++; in w83627ehf_update_device()
854 w83627ehf_write_fan_div_common(dev, data, i); in w83627ehf_update_device()
856 if ((data->has_fan_min & (1 << i)) in w83627ehf_update_device()
857 && data->fan_min[i] >= 2 in w83627ehf_update_device()
858 && data->fan_min[i] != 255) in w83627ehf_update_device()
859 w83627ehf_write_value(data, in w83627ehf_update_device()
860 data->REG_FAN_MIN[i], in w83627ehf_update_device()
861 (data->fan_min[i] /= 2)); in w83627ehf_update_device()
865 w83627ehf_update_pwm_common(dev, data); in w83627ehf_update_device()
867 for (i = 0; i < data->pwm_num; i++) { in w83627ehf_update_device()
868 if (!(data->has_fan & (1 << i))) in w83627ehf_update_device()
871 data->fan_start_output[i] = in w83627ehf_update_device()
872 w83627ehf_read_value(data, in w83627ehf_update_device()
873 data->REG_FAN_START_OUTPUT[i]); in w83627ehf_update_device()
874 data->fan_stop_output[i] = in w83627ehf_update_device()
875 w83627ehf_read_value(data, in w83627ehf_update_device()
876 data->REG_FAN_STOP_OUTPUT[i]); in w83627ehf_update_device()
877 data->fan_stop_time[i] = in w83627ehf_update_device()
878 w83627ehf_read_value(data, in w83627ehf_update_device()
879 data->REG_FAN_STOP_TIME[i]); in w83627ehf_update_device()
881 if (data->REG_FAN_MAX_OUTPUT && in w83627ehf_update_device()
882 data->REG_FAN_MAX_OUTPUT[i] != 0xff) in w83627ehf_update_device()
883 data->fan_max_output[i] = in w83627ehf_update_device()
884 w83627ehf_read_value(data, in w83627ehf_update_device()
885 data->REG_FAN_MAX_OUTPUT[i]); in w83627ehf_update_device()
887 if (data->REG_FAN_STEP_OUTPUT && in w83627ehf_update_device()
888 data->REG_FAN_STEP_OUTPUT[i] != 0xff) in w83627ehf_update_device()
889 data->fan_step_output[i] = in w83627ehf_update_device()
890 w83627ehf_read_value(data, in w83627ehf_update_device()
891 data->REG_FAN_STEP_OUTPUT[i]); in w83627ehf_update_device()
893 data->target_temp[i] = in w83627ehf_update_device()
894 w83627ehf_read_value(data, in w83627ehf_update_device()
895 data->REG_TARGET[i]) & in w83627ehf_update_device()
896 (data->pwm_mode[i] == 1 ? 0x7f : 0xff); in w83627ehf_update_device()
901 if (!(data->have_temp & (1 << i))) in w83627ehf_update_device()
903 data->temp[i] = w83627ehf_read_temp(data, in w83627ehf_update_device()
904 data->reg_temp[i]); in w83627ehf_update_device()
905 if (data->reg_temp_over[i]) in w83627ehf_update_device()
906 data->temp_max[i] in w83627ehf_update_device()
907 = w83627ehf_read_temp(data, in w83627ehf_update_device()
908 data->reg_temp_over[i]); in w83627ehf_update_device()
909 if (data->reg_temp_hyst[i]) in w83627ehf_update_device()
910 data->temp_max_hyst[i] in w83627ehf_update_device()
911 = w83627ehf_read_temp(data, in w83627ehf_update_device()
912 data->reg_temp_hyst[i]); in w83627ehf_update_device()
915 if (data->have_temp_offset & (1 << i)) in w83627ehf_update_device()
916 data->temp_offset[i] in w83627ehf_update_device()
917 = w83627ehf_read_value(data, in w83627ehf_update_device()
921 data->alarms = w83627ehf_read_value(data, in w83627ehf_update_device()
923 (w83627ehf_read_value(data, in w83627ehf_update_device()
925 (w83627ehf_read_value(data, in w83627ehf_update_device()
928 data->caseopen = w83627ehf_read_value(data, in w83627ehf_update_device()
931 data->last_updated = jiffies; in w83627ehf_update_device()
932 data->valid = 1; in w83627ehf_update_device()
935 mutex_unlock(&data->update_lock); in w83627ehf_update_device()
936 return data; in w83627ehf_update_device()
942 #define show_in_reg(reg) \ argument
944 show_##reg(struct device *dev, struct device_attribute *attr, \
947 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
950 int nr = sensor_attr->index; \
951 return sprintf(buf, "%ld\n", in_from_reg(data->reg[nr], nr, \
952 data->scale_in)); \
958 #define store_in_reg(REG, reg) \ in show_in_reg() argument
960 store_in_##reg(struct device *dev, struct device_attribute *attr, \ in show_in_reg()
963 struct w83627ehf_data *data = dev_get_drvdata(dev); \ in show_in_reg()
966 int nr = sensor_attr->index; \ in show_in_reg()
972 mutex_lock(&data->update_lock); \ in show_in_reg()
973 data->in_##reg[nr] = in_to_reg(val, nr, data->scale_in); \ in show_in_reg()
974 w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(nr), \ in show_in_reg()
975 data->in_##reg[nr]); \ in show_in_reg()
976 mutex_unlock(&data->update_lock); \ in show_in_reg()
986 struct w83627ehf_data *data = w83627ehf_update_device(dev); local
988 int nr = sensor_attr->index;
989 return sprintf(buf, "%u\n", (data->alarms >> nr) & 0x01);
1047 struct w83627ehf_data *data = w83627ehf_update_device(dev); in show_fan() local
1049 int nr = sensor_attr->index; in show_fan()
1050 return sprintf(buf, "%d\n", data->rpm[nr]); in show_fan()
1056 struct w83627ehf_data *data = w83627ehf_update_device(dev); in show_fan_min() local
1058 int nr = sensor_attr->index; in show_fan_min()
1060 data->fan_from_reg_min(data->fan_min[nr], in show_fan_min()
1061 data->fan_div[nr])); in show_fan_min()
1068 struct w83627ehf_data *data = w83627ehf_update_device(dev); in show_fan_div() local
1070 int nr = sensor_attr->index; in show_fan_div()
1071 return sprintf(buf, "%u\n", div_from_reg(data->fan_div[nr])); in show_fan_div()
1078 struct w83627ehf_data *data = dev_get_drvdata(dev); in store_fan_min() local
1080 int nr = sensor_attr->index; in store_fan_min()
1083 unsigned int reg; in store_fan_min() local
1090 mutex_lock(&data->update_lock); in store_fan_min()
1091 if (!data->has_fan_div) { in store_fan_min()
1104 data->fan_min[nr] = val; in store_fan_min()
1109 data->fan_min[nr] = 255; in store_fan_min()
1110 new_div = data->fan_div[nr]; /* No change */ in store_fan_min()
1112 } else if ((reg = 1350000U / val) >= 128 * 255) { in store_fan_min()
1117 data->fan_min[nr] = 254; in store_fan_min()
1121 nr + 1, val, data->fan_from_reg_min(254, 7)); in store_fan_min()
1122 } else if (!reg) { in store_fan_min()
1127 data->fan_min[nr] = 1; in store_fan_min()
1131 nr + 1, val, data->fan_from_reg_min(1, 0)); in store_fan_min()
1139 while (reg > 192 && new_div < 7) { in store_fan_min()
1140 reg >>= 1; in store_fan_min()
1143 data->fan_min[nr] = reg; in store_fan_min()
1150 if (new_div != data->fan_div[nr]) { in store_fan_min()
1152 nr + 1, div_from_reg(data->fan_div[nr]), in store_fan_min()
1154 data->fan_div[nr] = new_div; in store_fan_min()
1155 w83627ehf_write_fan_div_common(dev, data, nr); in store_fan_min()
1157 data->last_updated = jiffies; in store_fan_min()
1160 w83627ehf_write_value(data, data->REG_FAN_MIN[nr], in store_fan_min()
1161 data->fan_min[nr]); in store_fan_min()
1162 mutex_unlock(&data->update_lock); in store_fan_min()
1207 struct w83627ehf_data *data = w83627ehf_update_device(dev); in show_temp_label() local
1209 int nr = sensor_attr->index; in show_temp_label()
1210 return sprintf(buf, "%s\n", data->temp_label[data->temp_src[nr]]); in show_temp_label()
1213 #define show_temp_reg(addr, reg) \ argument
1215 show_##reg(struct device *dev, struct device_attribute *attr, \
1218 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1221 int nr = sensor_attr->index; \
1222 return sprintf(buf, "%d\n", LM75_TEMP_FROM_REG(data->reg[nr])); \
1228 #define store_temp_reg(addr, reg) \ argument
1230 store_##reg(struct device *dev, struct device_attribute *attr, \
1233 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1236 int nr = sensor_attr->index; \
1242 mutex_lock(&data->update_lock); \
1243 data->reg[nr] = LM75_TEMP_TO_REG(val); \
1244 w83627ehf_write_temp(data, data->addr[nr], data->reg[nr]); \
1245 mutex_unlock(&data->update_lock); \
1254 struct w83627ehf_data *data = w83627ehf_update_device(dev); in show_temp_offset() local
1258 data->temp_offset[sensor_attr->index] * 1000); in show_temp_offset()
1265 struct w83627ehf_data *data = dev_get_drvdata(dev); in store_temp_offset() local
1267 int nr = sensor_attr->index; in store_temp_offset()
1275 val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), -128, 127); in store_temp_offset()
1277 mutex_lock(&data->update_lock); in store_temp_offset()
1278 data->temp_offset[nr] = val; in store_temp_offset()
1279 w83627ehf_write_value(data, W83627EHF_REG_TEMP_OFFSET[nr], val); in store_temp_offset()
1280 mutex_unlock(&data->update_lock); in store_temp_offset()
1287 struct w83627ehf_data *data = w83627ehf_update_device(dev); in show_temp_type() local
1289 int nr = sensor_attr->index; in show_temp_type()
1290 return sprintf(buf, "%d\n", (int)data->temp_type[nr]); in show_temp_type()
1380 #define show_pwm_reg(reg) \ argument
1381 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1384 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1387 int nr = sensor_attr->index; \
1388 return sprintf(buf, "%d\n", data->reg[nr]); \
1399 struct w83627ehf_data *data = dev_get_drvdata(dev); in show_pwm_reg() local
1402 int nr = sensor_attr->index; in show_pwm_reg()
1405 u16 reg; in show_pwm_reg() local
1412 return -EINVAL; in show_pwm_reg()
1415 if (sio_data->kind == nct6776 && nr && val != 1) in show_pwm_reg()
1416 return -EINVAL; in show_pwm_reg()
1418 mutex_lock(&data->update_lock); in show_pwm_reg()
1419 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]); in show_pwm_reg()
1420 data->pwm_mode[nr] = val; in show_pwm_reg()
1421 reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[nr]); in show_pwm_reg()
1423 reg |= 1 << W83627EHF_PWM_MODE_SHIFT[nr]; in show_pwm_reg()
1424 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg); in show_pwm_reg()
1425 mutex_unlock(&data->update_lock); in show_pwm_reg()
1433 struct w83627ehf_data *data = dev_get_drvdata(dev); in store_pwm() local
1435 int nr = sensor_attr->index; in store_pwm()
1445 mutex_lock(&data->update_lock); in store_pwm()
1446 data->pwm[nr] = val; in store_pwm()
1447 w83627ehf_write_value(data, data->REG_PWM[nr], val); in store_pwm()
1448 mutex_unlock(&data->update_lock); in store_pwm()
1456 struct w83627ehf_data *data = dev_get_drvdata(dev); in store_pwm_enable() local
1459 int nr = sensor_attr->index; in store_pwm_enable()
1462 u16 reg; in store_pwm_enable() local
1468 if (!val || (val > 4 && val != data->pwm_enable_orig[nr])) in store_pwm_enable()
1469 return -EINVAL; in store_pwm_enable()
1471 if (sio_data->kind == nct6776 && val == 4) in store_pwm_enable()
1472 return -EINVAL; in store_pwm_enable()
1474 mutex_lock(&data->update_lock); in store_pwm_enable()
1475 data->pwm_enable[nr] = val; in store_pwm_enable()
1476 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) { in store_pwm_enable()
1477 reg = w83627ehf_read_value(data, in store_pwm_enable()
1479 reg &= 0x0f; in store_pwm_enable()
1480 reg |= (val - 1) << 4; in store_pwm_enable()
1481 w83627ehf_write_value(data, in store_pwm_enable()
1482 NCT6775_REG_FAN_MODE[nr], reg); in store_pwm_enable()
1484 reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[nr]); in store_pwm_enable()
1485 reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[nr]); in store_pwm_enable()
1486 reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[nr]; in store_pwm_enable()
1487 w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[nr], reg); in store_pwm_enable()
1489 mutex_unlock(&data->update_lock); in store_pwm_enable()
1494 #define show_tol_temp(reg) \ argument
1495 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1498 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1501 int nr = sensor_attr->index; \
1502 return sprintf(buf, "%d\n", data->reg[nr] * 1000); \
1512 struct w83627ehf_data *data = dev_get_drvdata(dev); in show_tol_temp() local
1514 int nr = sensor_attr->index; in show_tol_temp()
1524 mutex_lock(&data->update_lock); in show_tol_temp()
1525 data->target_temp[nr] = val; in show_tol_temp()
1526 w83627ehf_write_value(data, data->REG_TARGET[nr], val); in show_tol_temp()
1527 mutex_unlock(&data->update_lock); in show_tol_temp()
1535 struct w83627ehf_data *data = dev_get_drvdata(dev); in store_tolerance() local
1538 int nr = sensor_attr->index; in store_tolerance()
1539 u16 reg; in store_tolerance() local
1547 /* Limit the temp to 0C - 15C */ in store_tolerance()
1550 mutex_lock(&data->update_lock); in store_tolerance()
1551 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) { in store_tolerance()
1553 if (sio_data->kind == nct6776 && val > 7) in store_tolerance()
1555 reg = w83627ehf_read_value(data, NCT6775_REG_FAN_MODE[nr]); in store_tolerance()
1556 reg = (reg & 0xf0) | val; in store_tolerance()
1557 w83627ehf_write_value(data, NCT6775_REG_FAN_MODE[nr], reg); in store_tolerance()
1559 reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]); in store_tolerance()
1561 reg = (reg & 0x0f) | (val << 4); in store_tolerance()
1563 reg = (reg & 0xf0) | val; in store_tolerance()
1564 w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg); in store_tolerance()
1566 data->tolerance[nr] = val; in store_tolerance()
1567 mutex_unlock(&data->update_lock); in store_tolerance()
1624 #define fan_functions(reg, REG) \ argument
1625 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \
1628 struct w83627ehf_data *data = w83627ehf_update_device(dev); \
1631 int nr = sensor_attr->index; \
1632 return sprintf(buf, "%d\n", data->reg[nr]); \
1635 store_##reg(struct device *dev, struct device_attribute *attr, \
1638 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1641 int nr = sensor_attr->index; \
1648 mutex_lock(&data->update_lock); \
1649 data->reg[nr] = val; \
1650 w83627ehf_write_value(data, data->REG_##REG[nr], val); \
1651 mutex_unlock(&data->update_lock); \
1660 #define fan_time_functions(reg, REG) \ in fan_functions() argument
1661 static ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \ in fan_functions()
1664 struct w83627ehf_data *data = w83627ehf_update_device(dev); \ in fan_functions()
1667 int nr = sensor_attr->index; \ in fan_functions()
1669 step_time_from_reg(data->reg[nr], \ in fan_functions()
1670 data->pwm_mode[nr])); \ in fan_functions()
1674 store_##reg(struct device *dev, struct device_attribute *attr, \
1677 struct w83627ehf_data *data = dev_get_drvdata(dev); \
1680 int nr = sensor_attr->index; \
1686 val = step_time_to_reg(val, data->pwm_mode[nr]); \
1687 mutex_lock(&data->update_lock); \
1688 data->reg[nr] = val; \
1689 w83627ehf_write_value(data, data->REG_##REG[nr], val); \
1690 mutex_unlock(&data->update_lock); \
1699 struct w83627ehf_data *data = dev_get_drvdata(dev); local
1701 return sprintf(buf, "%s\n", data->name);
1765 struct w83627ehf_data *data = dev_get_drvdata(dev); in cpu0_vid_show() local
1766 return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm)); in cpu0_vid_show()
1776 struct w83627ehf_data *data = w83627ehf_update_device(dev); in show_caseopen() local
1779 !!(data->caseopen & to_sensor_dev_attr_2(attr)->index)); in show_caseopen()
1786 struct w83627ehf_data *data = dev_get_drvdata(dev); in clear_caseopen() local
1788 u16 reg, mask; in clear_caseopen() local
1791 return -EINVAL; in clear_caseopen()
1793 mask = to_sensor_dev_attr_2(attr)->nr; in clear_caseopen()
1795 mutex_lock(&data->update_lock); in clear_caseopen()
1796 reg = w83627ehf_read_value(data, W83627EHF_REG_CASEOPEN_CLR); in clear_caseopen()
1797 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg | mask); in clear_caseopen()
1798 w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg & ~mask); in clear_caseopen()
1799 data->valid = 0; /* Force cache refresh */ in clear_caseopen()
1800 mutex_unlock(&data->update_lock); in clear_caseopen()
1823 struct w83627ehf_data *data = dev_get_drvdata(dev); in w83627ehf_device_remove_files() local
1830 if (data->REG_FAN_STEP_OUTPUT && in w83627ehf_device_remove_files()
1831 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff) in w83627ehf_device_remove_files()
1832 device_remove_file(dev, &attr->dev_attr); in w83627ehf_device_remove_files()
1838 for (i = 0; i < data->in_num; i++) { in w83627ehf_device_remove_files()
1839 if ((i == 6) && data->in6_skip) in w83627ehf_device_remove_files()
1852 for (i = 0; i < data->pwm_num; i++) { in w83627ehf_device_remove_files()
1860 if (!(data->have_temp & (1 << i))) in w83627ehf_device_remove_files()
1864 if (i == 2 && data->temp3_val_only) in w83627ehf_device_remove_files()
1883 static inline void w83627ehf_init_device(struct w83627ehf_data *data, in w83627ehf_init_device() argument
1890 tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG); in w83627ehf_init_device()
1892 w83627ehf_write_value(data, W83627EHF_REG_CONFIG, in w83627ehf_init_device()
1897 if (!(data->have_temp & (1 << i))) in w83627ehf_init_device()
1899 if (!data->reg_temp_config[i]) in w83627ehf_init_device()
1901 tmp = w83627ehf_read_value(data, in w83627ehf_init_device()
1902 data->reg_temp_config[i]); in w83627ehf_init_device()
1904 w83627ehf_write_value(data, in w83627ehf_init_device()
1905 data->reg_temp_config[i], in w83627ehf_init_device()
1910 tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT); in w83627ehf_init_device()
1912 w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01); in w83627ehf_init_device()
1917 diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE); in w83627ehf_init_device()
1928 if (data->temp_label) in w83627ehf_init_device()
1929 label = data->temp_label[data->temp_src[i]]; in w83627ehf_init_device()
1933 data->temp_type[i] = 6; in w83627ehf_init_device()
1935 data->temp_type[i] = 5; in w83627ehf_init_device()
1937 data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 3; in w83627ehf_init_device()
1939 data->temp_type[i] = 4; /* thermistor */ in w83627ehf_init_device()
1943 static void w82627ehf_swap_tempreg(struct w83627ehf_data *data, in w82627ehf_swap_tempreg() argument
1946 swap(data->temp_src[r1], data->temp_src[r2]); in w82627ehf_swap_tempreg()
1947 swap(data->reg_temp[r1], data->reg_temp[r2]); in w82627ehf_swap_tempreg()
1948 swap(data->reg_temp_over[r1], data->reg_temp_over[r2]); in w82627ehf_swap_tempreg()
1949 swap(data->reg_temp_hyst[r1], data->reg_temp_hyst[r2]); in w82627ehf_swap_tempreg()
1950 swap(data->reg_temp_config[r1], data->reg_temp_config[r2]); in w82627ehf_swap_tempreg()
1954 w83627ehf_set_temp_reg_ehf(struct w83627ehf_data *data, int n_temp) in w83627ehf_set_temp_reg_ehf() argument
1959 data->reg_temp[i] = W83627EHF_REG_TEMP[i]; in w83627ehf_set_temp_reg_ehf()
1960 data->reg_temp_over[i] = W83627EHF_REG_TEMP_OVER[i]; in w83627ehf_set_temp_reg_ehf()
1961 data->reg_temp_hyst[i] = W83627EHF_REG_TEMP_HYST[i]; in w83627ehf_set_temp_reg_ehf()
1962 data->reg_temp_config[i] = W83627EHF_REG_TEMP_CONFIG[i]; in w83627ehf_set_temp_reg_ehf()
1968 struct w83627ehf_data *data) in w83627ehf_check_fan_inputs() argument
1973 if (sio_data->kind == w83627uhg) { in w83627ehf_check_fan_inputs()
1974 data->has_fan = 0x03; /* fan1 and fan2 */ in w83627ehf_check_fan_inputs()
1975 data->has_fan_min = 0x03; in w83627ehf_check_fan_inputs()
1980 if (sio_data->kind == nct6775) { in w83627ehf_check_fan_inputs()
1983 fan4pin = !(superio_inb(sio_data->sioreg, 0x2A) & 0x80); in w83627ehf_check_fan_inputs()
1986 } else if (sio_data->kind == nct6776) { in w83627ehf_check_fan_inputs()
1987 bool gpok = superio_inb(sio_data->sioreg, 0x27) & 0x80; in w83627ehf_check_fan_inputs()
1989 superio_select(sio_data->sioreg, W83627EHF_LD_HWM); in w83627ehf_check_fan_inputs()
1990 regval = superio_inb(sio_data->sioreg, SIO_REG_ENABLE); in w83627ehf_check_fan_inputs()
1995 fan3pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x40); in w83627ehf_check_fan_inputs()
2000 fan4pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x01); in w83627ehf_check_fan_inputs()
2005 fan5pin = !!(superio_inb(sio_data->sioreg, 0x1C) & 0x02); in w83627ehf_check_fan_inputs()
2008 } else if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b) { in w83627ehf_check_fan_inputs()
2010 fan4pin = superio_inb(sio_data->sioreg, 0x27) & 0x40; in w83627ehf_check_fan_inputs()
2011 fan5pin = superio_inb(sio_data->sioreg, 0x27) & 0x20; in w83627ehf_check_fan_inputs()
2015 fan4pin = !(superio_inb(sio_data->sioreg, 0x29) & 0x06); in w83627ehf_check_fan_inputs()
2016 fan5pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x02); in w83627ehf_check_fan_inputs()
2020 data->has_fan = data->has_fan_min = 0x03; /* fan1 and fan2 */ in w83627ehf_check_fan_inputs()
2021 data->has_fan |= (fan3pin << 2); in w83627ehf_check_fan_inputs()
2022 data->has_fan_min |= (fan3pin << 2); in w83627ehf_check_fan_inputs()
2024 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) { in w83627ehf_check_fan_inputs()
2029 data->has_fan |= (fan4pin << 3) | (fan5pin << 4); in w83627ehf_check_fan_inputs()
2030 data->has_fan_min |= (fan4min << 3) | (fan5pin << 4); in w83627ehf_check_fan_inputs()
2039 regval = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1); in w83627ehf_check_fan_inputs()
2041 data->has_fan |= (1 << 3); in w83627ehf_check_fan_inputs()
2042 data->has_fan_min |= (1 << 3); in w83627ehf_check_fan_inputs()
2045 data->has_fan |= (1 << 4); in w83627ehf_check_fan_inputs()
2046 data->has_fan_min |= (1 << 4); in w83627ehf_check_fan_inputs()
2053 struct device *dev = &pdev->dev; in w83627ehf_probe()
2055 struct w83627ehf_data *data; in w83627ehf_probe() local
2061 if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) { in w83627ehf_probe()
2062 err = -EBUSY; in w83627ehf_probe()
2063 dev_err(dev, "Failed to request region 0x%lx-0x%lx\n", in w83627ehf_probe()
2064 (unsigned long)res->start, in w83627ehf_probe()
2065 (unsigned long)res->start + IOREGION_LENGTH - 1); in w83627ehf_probe()
2069 data = devm_kzalloc(&pdev->dev, sizeof(struct w83627ehf_data), in w83627ehf_probe()
2071 if (!data) { in w83627ehf_probe()
2072 err = -ENOMEM; in w83627ehf_probe()
2076 data->addr = res->start; in w83627ehf_probe()
2077 mutex_init(&data->lock); in w83627ehf_probe()
2078 mutex_init(&data->update_lock); in w83627ehf_probe()
2079 data->name = w83627ehf_device_names[sio_data->kind]; in w83627ehf_probe()
2080 data->bank = 0xff; /* Force initial bank selection */ in w83627ehf_probe()
2081 platform_set_drvdata(pdev, data); in w83627ehf_probe()
2084 data->in_num = (sio_data->kind == w83627ehf) ? 10 : 9; in w83627ehf_probe()
2086 switch (sio_data->kind) { in w83627ehf_probe()
2088 data->pwm_num = 4; in w83627ehf_probe()
2094 data->pwm_num = 3; in w83627ehf_probe()
2097 data->pwm_num = 2; in w83627ehf_probe()
2102 data->have_temp = 0x07; in w83627ehf_probe()
2105 if (sio_data->kind == nct6775 || sio_data->kind == nct6776) { in w83627ehf_probe()
2116 data->reg_temp[i] = NCT6775_REG_TEMP[i]; in w83627ehf_probe()
2117 data->reg_temp_over[i] = NCT6775_REG_TEMP_OVER[i]; in w83627ehf_probe()
2118 data->reg_temp_hyst[i] = NCT6775_REG_TEMP_HYST[i]; in w83627ehf_probe()
2119 data->reg_temp_config[i] = NCT6775_REG_TEMP_CONFIG[i]; in w83627ehf_probe()
2121 src = w83627ehf_read_value(data, in w83627ehf_probe()
2125 data->have_temp |= 1 << i; in w83627ehf_probe()
2129 data->temp_src[i] = src; in w83627ehf_probe()
2138 if (i > 0 && data->temp_src[0] != 1 in w83627ehf_probe()
2139 && data->temp_src[i] == 1) in w83627ehf_probe()
2140 w82627ehf_swap_tempreg(data, 0, i); in w83627ehf_probe()
2141 if (i > 1 && data->temp_src[1] != 2 in w83627ehf_probe()
2142 && data->temp_src[i] == 2) in w83627ehf_probe()
2143 w82627ehf_swap_tempreg(data, 1, i); in w83627ehf_probe()
2144 if (i > 2 && data->temp_src[2] != 3 in w83627ehf_probe()
2145 && data->temp_src[i] == 3) in w83627ehf_probe()
2146 w82627ehf_swap_tempreg(data, 2, i); in w83627ehf_probe()
2148 if (sio_data->kind == nct6776) { in w83627ehf_probe()
2158 if (data->temp_src[2] == 3) { in w83627ehf_probe()
2159 u8 reg; in w83627ehf_probe() local
2161 if (data->reg_temp_config[2]) in w83627ehf_probe()
2162 reg = w83627ehf_read_value(data, in w83627ehf_probe()
2163 data->reg_temp_config[2]); in w83627ehf_probe()
2165 reg = 0; /* Assume AUXTIN is used */ in w83627ehf_probe()
2167 if (reg & 0x01) in w83627ehf_probe()
2168 data->have_temp &= ~(1 << 2); in w83627ehf_probe()
2170 data->in6_skip = 1; in w83627ehf_probe()
2172 data->temp_label = nct6776_temp_label; in w83627ehf_probe()
2174 data->temp_label = nct6775_temp_label; in w83627ehf_probe()
2176 data->have_temp_offset = data->have_temp & 0x07; in w83627ehf_probe()
2178 if (data->temp_src[i] > 3) in w83627ehf_probe()
2179 data->have_temp_offset &= ~(1 << i); in w83627ehf_probe()
2181 } else if (sio_data->kind == w83667hg_b) { in w83627ehf_probe()
2182 u8 reg; in w83627ehf_probe() local
2184 w83627ehf_set_temp_reg_ehf(data, 4); in w83627ehf_probe()
2190 reg = w83627ehf_read_value(data, 0x4a); in w83627ehf_probe()
2191 data->temp_src[0] = reg >> 5; in w83627ehf_probe()
2192 reg = w83627ehf_read_value(data, 0x49); in w83627ehf_probe()
2193 data->temp_src[1] = reg & 0x07; in w83627ehf_probe()
2194 data->temp_src[2] = (reg >> 4) & 0x07; in w83627ehf_probe()
2197 * W83667HG-B has another temperature register at 0x7e. in w83627ehf_probe()
2202 reg = w83627ehf_read_value(data, 0x7d); in w83627ehf_probe()
2203 reg &= 0x07; in w83627ehf_probe()
2204 if (reg != data->temp_src[0] && reg != data->temp_src[1] in w83627ehf_probe()
2205 && reg != data->temp_src[2]) { in w83627ehf_probe()
2206 data->temp_src[3] = reg; in w83627ehf_probe()
2207 data->have_temp |= 1 << 3; in w83627ehf_probe()
2214 reg = w83627ehf_read_value(data, W83627EHF_REG_TEMP_CONFIG[2]); in w83627ehf_probe()
2215 if (data->temp_src[2] == 2 && (reg & 0x01)) in w83627ehf_probe()
2216 data->have_temp &= ~(1 << 2); in w83627ehf_probe()
2218 if ((data->temp_src[2] == 2 && (data->have_temp & (1 << 2))) in w83627ehf_probe()
2219 || (data->temp_src[3] == 2 && (data->have_temp & (1 << 3)))) in w83627ehf_probe()
2220 data->in6_skip = 1; in w83627ehf_probe()
2222 data->temp_label = w83667hg_b_temp_label; in w83627ehf_probe()
2223 data->have_temp_offset = data->have_temp & 0x07; in w83627ehf_probe()
2225 if (data->temp_src[i] > 2) in w83627ehf_probe()
2226 data->have_temp_offset &= ~(1 << i); in w83627ehf_probe()
2228 } else if (sio_data->kind == w83627uhg) { in w83627ehf_probe()
2229 u8 reg; in w83627ehf_probe() local
2231 w83627ehf_set_temp_reg_ehf(data, 3); in w83627ehf_probe()
2237 data->temp_src[0] = 0; /* SYSTIN */ in w83627ehf_probe()
2238 reg = w83627ehf_read_value(data, 0x49) & 0x07; in w83627ehf_probe()
2240 if (reg == 0) in w83627ehf_probe()
2241 data->temp_src[1] = 1; in w83627ehf_probe()
2242 else if (reg >= 2 && reg <= 5) in w83627ehf_probe()
2243 data->temp_src[1] = reg + 2; in w83627ehf_probe()
2245 data->have_temp &= ~(1 << 1); in w83627ehf_probe()
2246 reg = w83627ehf_read_value(data, 0x4a); in w83627ehf_probe()
2247 data->temp_src[2] = reg >> 5; in w83627ehf_probe()
2253 if (data->temp_src[2] == 2 || data->temp_src[2] == 3 || in w83627ehf_probe()
2254 data->temp_src[2] == data->temp_src[0] || in w83627ehf_probe()
2255 ((data->have_temp & (1 << 1)) && in w83627ehf_probe()
2256 data->temp_src[2] == data->temp_src[1])) in w83627ehf_probe()
2257 data->have_temp &= ~(1 << 2); in w83627ehf_probe()
2259 data->temp3_val_only = 1; /* No limit regs */ in w83627ehf_probe()
2261 data->in6_skip = 1; /* No VIN3 */ in w83627ehf_probe()
2263 data->temp_label = w83667hg_b_temp_label; in w83627ehf_probe()
2264 data->have_temp_offset = data->have_temp & 0x03; in w83627ehf_probe()
2266 if (data->temp_src[i] > 1) in w83627ehf_probe()
2267 data->have_temp_offset &= ~(1 << i); in w83627ehf_probe()
2270 w83627ehf_set_temp_reg_ehf(data, 3); in w83627ehf_probe()
2274 if (sio_data->kind == w83667hg) { in w83627ehf_probe()
2275 u8 reg; in w83627ehf_probe() local
2281 reg = w83627ehf_read_value(data, in w83627ehf_probe()
2283 if (reg & 0x01) in w83627ehf_probe()
2284 data->have_temp &= ~(1 << 2); in w83627ehf_probe()
2286 data->in6_skip = 1; in w83627ehf_probe()
2288 data->have_temp_offset = data->have_temp & 0x07; in w83627ehf_probe()
2291 if (sio_data->kind == nct6775) { in w83627ehf_probe()
2292 data->has_fan_div = true; in w83627ehf_probe()
2293 data->fan_from_reg = fan_from_reg16; in w83627ehf_probe()
2294 data->fan_from_reg_min = fan_from_reg8; in w83627ehf_probe()
2295 data->REG_PWM = NCT6775_REG_PWM; in w83627ehf_probe()
2296 data->REG_TARGET = NCT6775_REG_TARGET; in w83627ehf_probe()
2297 data->REG_FAN = NCT6775_REG_FAN; in w83627ehf_probe()
2298 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN; in w83627ehf_probe()
2299 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT; in w83627ehf_probe()
2300 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT; in w83627ehf_probe()
2301 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME; in w83627ehf_probe()
2302 data->REG_FAN_MAX_OUTPUT = NCT6775_REG_FAN_MAX_OUTPUT; in w83627ehf_probe()
2303 data->REG_FAN_STEP_OUTPUT = NCT6775_REG_FAN_STEP_OUTPUT; in w83627ehf_probe()
2304 } else if (sio_data->kind == nct6776) { in w83627ehf_probe()
2305 data->has_fan_div = false; in w83627ehf_probe()
2306 data->fan_from_reg = fan_from_reg13; in w83627ehf_probe()
2307 data->fan_from_reg_min = fan_from_reg13; in w83627ehf_probe()
2308 data->REG_PWM = NCT6775_REG_PWM; in w83627ehf_probe()
2309 data->REG_TARGET = NCT6775_REG_TARGET; in w83627ehf_probe()
2310 data->REG_FAN = NCT6775_REG_FAN; in w83627ehf_probe()
2311 data->REG_FAN_MIN = NCT6776_REG_FAN_MIN; in w83627ehf_probe()
2312 data->REG_FAN_START_OUTPUT = NCT6775_REG_FAN_START_OUTPUT; in w83627ehf_probe()
2313 data->REG_FAN_STOP_OUTPUT = NCT6775_REG_FAN_STOP_OUTPUT; in w83627ehf_probe()
2314 data->REG_FAN_STOP_TIME = NCT6775_REG_FAN_STOP_TIME; in w83627ehf_probe()
2315 } else if (sio_data->kind == w83667hg_b) { in w83627ehf_probe()
2316 data->has_fan_div = true; in w83627ehf_probe()
2317 data->fan_from_reg = fan_from_reg8; in w83627ehf_probe()
2318 data->fan_from_reg_min = fan_from_reg8; in w83627ehf_probe()
2319 data->REG_PWM = W83627EHF_REG_PWM; in w83627ehf_probe()
2320 data->REG_TARGET = W83627EHF_REG_TARGET; in w83627ehf_probe()
2321 data->REG_FAN = W83627EHF_REG_FAN; in w83627ehf_probe()
2322 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN; in w83627ehf_probe()
2323 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT; in w83627ehf_probe()
2324 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT; in w83627ehf_probe()
2325 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME; in w83627ehf_probe()
2326 data->REG_FAN_MAX_OUTPUT = in w83627ehf_probe()
2328 data->REG_FAN_STEP_OUTPUT = in w83627ehf_probe()
2331 data->has_fan_div = true; in w83627ehf_probe()
2332 data->fan_from_reg = fan_from_reg8; in w83627ehf_probe()
2333 data->fan_from_reg_min = fan_from_reg8; in w83627ehf_probe()
2334 data->REG_PWM = W83627EHF_REG_PWM; in w83627ehf_probe()
2335 data->REG_TARGET = W83627EHF_REG_TARGET; in w83627ehf_probe()
2336 data->REG_FAN = W83627EHF_REG_FAN; in w83627ehf_probe()
2337 data->REG_FAN_MIN = W83627EHF_REG_FAN_MIN; in w83627ehf_probe()
2338 data->REG_FAN_START_OUTPUT = W83627EHF_REG_FAN_START_OUTPUT; in w83627ehf_probe()
2339 data->REG_FAN_STOP_OUTPUT = W83627EHF_REG_FAN_STOP_OUTPUT; in w83627ehf_probe()
2340 data->REG_FAN_STOP_TIME = W83627EHF_REG_FAN_STOP_TIME; in w83627ehf_probe()
2341 data->REG_FAN_MAX_OUTPUT = in w83627ehf_probe()
2343 data->REG_FAN_STEP_OUTPUT = in w83627ehf_probe()
2348 if (sio_data->kind == w83627uhg) in w83627ehf_probe()
2349 data->scale_in = scale_in_w83627uhg; in w83627ehf_probe()
2351 data->scale_in = scale_in_common; in w83627ehf_probe()
2354 w83627ehf_init_device(data, sio_data->kind); in w83627ehf_probe()
2356 data->vrm = vid_which_vrm(); in w83627ehf_probe()
2358 err = superio_enter(sio_data->sioreg); in w83627ehf_probe()
2363 if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b || in w83627ehf_probe()
2364 sio_data->kind == nct6775 || sio_data->kind == nct6776) { in w83627ehf_probe()
2370 superio_select(sio_data->sioreg, W83667HG_LD_VID); in w83627ehf_probe()
2371 data->vid = superio_inb(sio_data->sioreg, 0xe3); in w83627ehf_probe()
2374 superio_exit(sio_data->sioreg); in w83627ehf_probe()
2377 } else if (sio_data->kind != w83627uhg) { in w83627ehf_probe()
2378 superio_select(sio_data->sioreg, W83627EHF_LD_HWM); in w83627ehf_probe()
2379 if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80) { in w83627ehf_probe()
2387 if (sio_data->kind == w83627ehf) { in w83627ehf_probe()
2388 en_vrm10 = superio_inb(sio_data->sioreg, in w83627ehf_probe()
2390 if ((en_vrm10 & 0x08) && data->vrm == 90) { in w83627ehf_probe()
2393 superio_outb(sio_data->sioreg, in w83627ehf_probe()
2397 && data->vrm == 100) { in w83627ehf_probe()
2400 superio_outb(sio_data->sioreg, in w83627ehf_probe()
2406 data->vid = superio_inb(sio_data->sioreg, in w83627ehf_probe()
2408 if (sio_data->kind == w83627ehf) /* 6 VID pins only */ in w83627ehf_probe()
2409 data->vid &= 0x3f; in w83627ehf_probe()
2413 superio_exit(sio_data->sioreg); in w83627ehf_probe()
2423 (sio_data->kind == nct6775 || sio_data->kind == nct6776)) { in w83627ehf_probe()
2426 superio_select(sio_data->sioreg, W83627EHF_LD_HWM); in w83627ehf_probe()
2427 tmp = superio_inb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE); in w83627ehf_probe()
2428 if (sio_data->kind == nct6776) in w83627ehf_probe()
2429 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE, in w83627ehf_probe()
2432 superio_outb(sio_data->sioreg, NCT6775_REG_FAN_DEBOUNCE, in w83627ehf_probe()
2434 pr_info("Enabled fan debounce for chip %s\n", data->name); in w83627ehf_probe()
2437 w83627ehf_check_fan_inputs(sio_data, data); in w83627ehf_probe()
2439 superio_exit(sio_data->sioreg); in w83627ehf_probe()
2442 w83627ehf_update_fan_div_common(dev, data); in w83627ehf_probe()
2444 /* Read pwm data to save original values */ in w83627ehf_probe()
2445 w83627ehf_update_pwm_common(dev, data); in w83627ehf_probe()
2446 for (i = 0; i < data->pwm_num; i++) in w83627ehf_probe()
2447 data->pwm_enable_orig[i] = data->pwm_enable[i]; in w83627ehf_probe()
2459 if (data->REG_FAN_STEP_OUTPUT && in w83627ehf_probe()
2460 data->REG_FAN_STEP_OUTPUT[attr->index] != 0xff) { in w83627ehf_probe()
2461 err = device_create_file(dev, &attr->dev_attr); in w83627ehf_probe()
2467 if ((data->has_fan & (1 << 2)) && data->pwm_num >= 3) in w83627ehf_probe()
2474 if ((data->has_fan & (1 << 3)) && data->pwm_num >= 4) in w83627ehf_probe()
2482 for (i = 0; i < data->in_num; i++) { in w83627ehf_probe()
2483 if ((i == 6) && data->in6_skip) in w83627ehf_probe()
2496 if (data->has_fan & (1 << i)) { in w83627ehf_probe()
2502 if (sio_data->kind != nct6776) { in w83627ehf_probe()
2508 if (data->has_fan_min & (1 << i)) { in w83627ehf_probe()
2514 if (i < data->pwm_num && in w83627ehf_probe()
2530 if (!(data->have_temp & (1 << i))) in w83627ehf_probe()
2535 if (data->temp_label) { in w83627ehf_probe()
2541 if (i == 2 && data->temp3_val_only) in w83627ehf_probe()
2543 if (data->reg_temp_over[i]) { in w83627ehf_probe()
2549 if (data->reg_temp_hyst[i]) { in w83627ehf_probe()
2562 if (data->have_temp_offset & (1 << i)) { in w83627ehf_probe()
2574 if (sio_data->kind == nct6776) { in w83627ehf_probe()
2584 data->hwmon_dev = hwmon_device_register(dev); in w83627ehf_probe()
2585 if (IS_ERR(data->hwmon_dev)) { in w83627ehf_probe()
2586 err = PTR_ERR(data->hwmon_dev); in w83627ehf_probe()
2595 release_region(res->start, IOREGION_LENGTH); in w83627ehf_probe()
2602 struct w83627ehf_data *data = platform_get_drvdata(pdev); in w83627ehf_remove() local
2604 hwmon_device_unregister(data->hwmon_dev); in w83627ehf_remove()
2605 w83627ehf_device_remove_files(&pdev->dev); in w83627ehf_remove()
2606 release_region(data->addr, IOREGION_LENGTH); in w83627ehf_remove()
2614 struct w83627ehf_data *data = w83627ehf_update_device(dev); in w83627ehf_suspend() local
2617 mutex_lock(&data->update_lock); in w83627ehf_suspend()
2618 data->vbat = w83627ehf_read_value(data, W83627EHF_REG_VBAT); in w83627ehf_suspend()
2619 if (sio_data->kind == nct6775) { in w83627ehf_suspend()
2620 data->fandiv1 = w83627ehf_read_value(data, NCT6775_REG_FANDIV1); in w83627ehf_suspend()
2621 data->fandiv2 = w83627ehf_read_value(data, NCT6775_REG_FANDIV2); in w83627ehf_suspend()
2623 mutex_unlock(&data->update_lock); in w83627ehf_suspend()
2630 struct w83627ehf_data *data = dev_get_drvdata(dev); in w83627ehf_resume() local
2634 mutex_lock(&data->update_lock); in w83627ehf_resume()
2635 data->bank = 0xff; /* Force initial bank selection */ in w83627ehf_resume()
2638 for (i = 0; i < data->in_num; i++) { in w83627ehf_resume()
2639 if ((i == 6) && data->in6_skip) in w83627ehf_resume()
2642 w83627ehf_write_value(data, W83627EHF_REG_IN_MIN(i), in w83627ehf_resume()
2643 data->in_min[i]); in w83627ehf_resume()
2644 w83627ehf_write_value(data, W83627EHF_REG_IN_MAX(i), in w83627ehf_resume()
2645 data->in_max[i]); in w83627ehf_resume()
2649 if (!(data->has_fan_min & (1 << i))) in w83627ehf_resume()
2652 w83627ehf_write_value(data, data->REG_FAN_MIN[i], in w83627ehf_resume()
2653 data->fan_min[i]); in w83627ehf_resume()
2657 if (!(data->have_temp & (1 << i))) in w83627ehf_resume()
2660 if (data->reg_temp_over[i]) in w83627ehf_resume()
2661 w83627ehf_write_temp(data, data->reg_temp_over[i], in w83627ehf_resume()
2662 data->temp_max[i]); in w83627ehf_resume()
2663 if (data->reg_temp_hyst[i]) in w83627ehf_resume()
2664 w83627ehf_write_temp(data, data->reg_temp_hyst[i], in w83627ehf_resume()
2665 data->temp_max_hyst[i]); in w83627ehf_resume()
2668 if (data->have_temp_offset & (1 << i)) in w83627ehf_resume()
2669 w83627ehf_write_value(data, in w83627ehf_resume()
2671 data->temp_offset[i]); in w83627ehf_resume()
2675 w83627ehf_write_value(data, W83627EHF_REG_VBAT, data->vbat); in w83627ehf_resume()
2676 if (sio_data->kind == nct6775) { in w83627ehf_resume()
2677 w83627ehf_write_value(data, NCT6775_REG_FANDIV1, data->fandiv1); in w83627ehf_resume()
2678 w83627ehf_write_value(data, NCT6775_REG_FANDIV2, data->fandiv2); in w83627ehf_resume()
2681 /* Force re-reading all values */ in w83627ehf_resume()
2682 data->valid = 0; in w83627ehf_resume()
2683 mutex_unlock(&data->update_lock); in w83627ehf_resume()
2709 /* w83627ehf_find() looks for a '627 in the Super-I/O config space */
2716 static const char sio_name_W83627DHG_P[] __initconst = "W83627DHG-P"; in w83627ehf_find()
2719 static const char sio_name_W83667HG_B[] __initconst = "W83667HG-B"; in w83627ehf_find()
2738 sio_data->kind = w83627ehf; in w83627ehf_find()
2742 sio_data->kind = w83627ehf; in w83627ehf_find()
2746 sio_data->kind = w83627dhg; in w83627ehf_find()
2750 sio_data->kind = w83627dhg_p; in w83627ehf_find()
2754 sio_data->kind = w83627uhg; in w83627ehf_find()
2758 sio_data->kind = w83667hg; in w83627ehf_find()
2762 sio_data->kind = w83667hg_b; in w83627ehf_find()
2766 sio_data->kind = nct6775; in w83627ehf_find()
2770 sio_data->kind = nct6776; in w83627ehf_find()
2777 return -ENODEV; in w83627ehf_find()
2786 pr_err("Refusing to enable a Super-I/O device with a base I/O port 0\n"); in w83627ehf_find()
2788 return -ENODEV; in w83627ehf_find()
2794 pr_warn("Forcibly enabling Super-I/O. Sensor is probably unusable.\n"); in w83627ehf_find()
2800 sio_data->sioreg = sioaddr; in w83627ehf_find()
2806 * when Super-I/O functions move to a separate file, the Super-I/O
2821 * initialize sio_data->kind and sio_data->sioreg. in sensors_w83627ehf_init()
2823 * when Super-I/O functions move to a separate file, the Super-I/O in sensors_w83627ehf_init()
2824 * driver will probe 0x2e and 0x4e and auto-detect the presence of a in sensors_w83627ehf_init()
2829 return -ENODEV; in sensors_w83627ehf_init()
2837 err = -ENOMEM; in sensors_w83627ehf_init()
2845 pr_err("Platform data allocation failed\n"); in sensors_w83627ehf_init()
2852 res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1; in sensors_w83627ehf_init()