18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * w83627ehf - Driver for the hardware monitoring functionality of 48c2ecf20Sopenharmony_ci * the Winbond W83627EHF Super-I/O chip 58c2ecf20Sopenharmony_ci * Copyright (C) 2005-2012 Jean Delvare <jdelvare@suse.de> 68c2ecf20Sopenharmony_ci * Copyright (C) 2006 Yuan Mu (Winbond), 78c2ecf20Sopenharmony_ci * Rudolf Marek <r.marek@assembler.cz> 88c2ecf20Sopenharmony_ci * David Hubbard <david.c.hubbard@gmail.com> 98c2ecf20Sopenharmony_ci * Daniel J Blueman <daniel.blueman@gmail.com> 108c2ecf20Sopenharmony_ci * Copyright (C) 2010 Sheng-Yuan Huang (Nuvoton) (PS00) 118c2ecf20Sopenharmony_ci * 128c2ecf20Sopenharmony_ci * Shamelessly ripped from the w83627hf driver 138c2ecf20Sopenharmony_ci * Copyright (C) 2003 Mark Studebaker 148c2ecf20Sopenharmony_ci * 158c2ecf20Sopenharmony_ci * Thanks to Leon Moonen, Steve Cliffe and Grant Coady for their help 168c2ecf20Sopenharmony_ci * in testing and debugging this driver. 178c2ecf20Sopenharmony_ci * 188c2ecf20Sopenharmony_ci * This driver also supports the W83627EHG, which is the lead-free 198c2ecf20Sopenharmony_ci * version of the W83627EHF. 208c2ecf20Sopenharmony_ci * 218c2ecf20Sopenharmony_ci * Supports the following chips: 228c2ecf20Sopenharmony_ci * 238c2ecf20Sopenharmony_ci * Chip #vin #fan #pwm #temp chip IDs man ID 248c2ecf20Sopenharmony_ci * w83627ehf 10 5 4 3 0x8850 0x88 0x5ca3 258c2ecf20Sopenharmony_ci * 0x8860 0xa1 268c2ecf20Sopenharmony_ci * w83627dhg 9 5 4 3 0xa020 0xc1 0x5ca3 278c2ecf20Sopenharmony_ci * w83627dhg-p 9 5 4 3 0xb070 0xc1 0x5ca3 288c2ecf20Sopenharmony_ci * w83627uhg 8 2 2 3 0xa230 0xc1 0x5ca3 298c2ecf20Sopenharmony_ci * w83667hg 9 5 3 3 0xa510 0xc1 0x5ca3 308c2ecf20Sopenharmony_ci * w83667hg-b 9 5 3 4 0xb350 0xc1 0x5ca3 318c2ecf20Sopenharmony_ci */ 328c2ecf20Sopenharmony_ci 338c2ecf20Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci#include <linux/module.h> 368c2ecf20Sopenharmony_ci#include <linux/init.h> 378c2ecf20Sopenharmony_ci#include <linux/slab.h> 388c2ecf20Sopenharmony_ci#include <linux/jiffies.h> 398c2ecf20Sopenharmony_ci#include <linux/platform_device.h> 408c2ecf20Sopenharmony_ci#include <linux/hwmon.h> 418c2ecf20Sopenharmony_ci#include <linux/hwmon-sysfs.h> 428c2ecf20Sopenharmony_ci#include <linux/hwmon-vid.h> 438c2ecf20Sopenharmony_ci#include <linux/err.h> 448c2ecf20Sopenharmony_ci#include <linux/mutex.h> 458c2ecf20Sopenharmony_ci#include <linux/acpi.h> 468c2ecf20Sopenharmony_ci#include <linux/io.h> 478c2ecf20Sopenharmony_ci#include "lm75.h" 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_cienum kinds { 508c2ecf20Sopenharmony_ci w83627ehf, w83627dhg, w83627dhg_p, w83627uhg, 518c2ecf20Sopenharmony_ci w83667hg, w83667hg_b, 528c2ecf20Sopenharmony_ci}; 538c2ecf20Sopenharmony_ci 548c2ecf20Sopenharmony_ci/* used to set data->name = w83627ehf_device_names[data->sio_kind] */ 558c2ecf20Sopenharmony_cistatic const char * const w83627ehf_device_names[] = { 568c2ecf20Sopenharmony_ci "w83627ehf", 578c2ecf20Sopenharmony_ci "w83627dhg", 588c2ecf20Sopenharmony_ci "w83627dhg", 598c2ecf20Sopenharmony_ci "w83627uhg", 608c2ecf20Sopenharmony_ci "w83667hg", 618c2ecf20Sopenharmony_ci "w83667hg", 628c2ecf20Sopenharmony_ci}; 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_cistatic unsigned short force_id; 658c2ecf20Sopenharmony_cimodule_param(force_id, ushort, 0); 668c2ecf20Sopenharmony_ciMODULE_PARM_DESC(force_id, "Override the detected device ID"); 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci#define DRVNAME "w83627ehf" 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_ci/* 718c2ecf20Sopenharmony_ci * Super-I/O constants and functions 728c2ecf20Sopenharmony_ci */ 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_ci#define W83627EHF_LD_HWM 0x0b 758c2ecf20Sopenharmony_ci#define W83667HG_LD_VID 0x0d 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_ci#define SIO_REG_LDSEL 0x07 /* Logical device select */ 788c2ecf20Sopenharmony_ci#define SIO_REG_DEVID 0x20 /* Device ID (2 bytes) */ 798c2ecf20Sopenharmony_ci#define SIO_REG_EN_VRM10 0x2C /* GPIO3, GPIO4 selection */ 808c2ecf20Sopenharmony_ci#define SIO_REG_ENABLE 0x30 /* Logical device enable */ 818c2ecf20Sopenharmony_ci#define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */ 828c2ecf20Sopenharmony_ci#define SIO_REG_VID_CTRL 0xF0 /* VID control */ 838c2ecf20Sopenharmony_ci#define SIO_REG_VID_DATA 0xF1 /* VID data */ 848c2ecf20Sopenharmony_ci 858c2ecf20Sopenharmony_ci#define SIO_W83627EHF_ID 0x8850 868c2ecf20Sopenharmony_ci#define SIO_W83627EHG_ID 0x8860 878c2ecf20Sopenharmony_ci#define SIO_W83627DHG_ID 0xa020 888c2ecf20Sopenharmony_ci#define SIO_W83627DHG_P_ID 0xb070 898c2ecf20Sopenharmony_ci#define SIO_W83627UHG_ID 0xa230 908c2ecf20Sopenharmony_ci#define SIO_W83667HG_ID 0xa510 918c2ecf20Sopenharmony_ci#define SIO_W83667HG_B_ID 0xb350 928c2ecf20Sopenharmony_ci#define SIO_ID_MASK 0xFFF0 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_cistatic inline void 958c2ecf20Sopenharmony_cisuperio_outb(int ioreg, int reg, int val) 968c2ecf20Sopenharmony_ci{ 978c2ecf20Sopenharmony_ci outb(reg, ioreg); 988c2ecf20Sopenharmony_ci outb(val, ioreg + 1); 998c2ecf20Sopenharmony_ci} 1008c2ecf20Sopenharmony_ci 1018c2ecf20Sopenharmony_cistatic inline int 1028c2ecf20Sopenharmony_cisuperio_inb(int ioreg, int reg) 1038c2ecf20Sopenharmony_ci{ 1048c2ecf20Sopenharmony_ci outb(reg, ioreg); 1058c2ecf20Sopenharmony_ci return inb(ioreg + 1); 1068c2ecf20Sopenharmony_ci} 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_cistatic inline void 1098c2ecf20Sopenharmony_cisuperio_select(int ioreg, int ld) 1108c2ecf20Sopenharmony_ci{ 1118c2ecf20Sopenharmony_ci outb(SIO_REG_LDSEL, ioreg); 1128c2ecf20Sopenharmony_ci outb(ld, ioreg + 1); 1138c2ecf20Sopenharmony_ci} 1148c2ecf20Sopenharmony_ci 1158c2ecf20Sopenharmony_cistatic inline int 1168c2ecf20Sopenharmony_cisuperio_enter(int ioreg) 1178c2ecf20Sopenharmony_ci{ 1188c2ecf20Sopenharmony_ci if (!request_muxed_region(ioreg, 2, DRVNAME)) 1198c2ecf20Sopenharmony_ci return -EBUSY; 1208c2ecf20Sopenharmony_ci 1218c2ecf20Sopenharmony_ci outb(0x87, ioreg); 1228c2ecf20Sopenharmony_ci outb(0x87, ioreg); 1238c2ecf20Sopenharmony_ci 1248c2ecf20Sopenharmony_ci return 0; 1258c2ecf20Sopenharmony_ci} 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_cistatic inline void 1288c2ecf20Sopenharmony_cisuperio_exit(int ioreg) 1298c2ecf20Sopenharmony_ci{ 1308c2ecf20Sopenharmony_ci outb(0xaa, ioreg); 1318c2ecf20Sopenharmony_ci outb(0x02, ioreg); 1328c2ecf20Sopenharmony_ci outb(0x02, ioreg + 1); 1338c2ecf20Sopenharmony_ci release_region(ioreg, 2); 1348c2ecf20Sopenharmony_ci} 1358c2ecf20Sopenharmony_ci 1368c2ecf20Sopenharmony_ci/* 1378c2ecf20Sopenharmony_ci * ISA constants 1388c2ecf20Sopenharmony_ci */ 1398c2ecf20Sopenharmony_ci 1408c2ecf20Sopenharmony_ci#define IOREGION_ALIGNMENT (~7) 1418c2ecf20Sopenharmony_ci#define IOREGION_OFFSET 5 1428c2ecf20Sopenharmony_ci#define IOREGION_LENGTH 2 1438c2ecf20Sopenharmony_ci#define ADDR_REG_OFFSET 0 1448c2ecf20Sopenharmony_ci#define DATA_REG_OFFSET 1 1458c2ecf20Sopenharmony_ci 1468c2ecf20Sopenharmony_ci#define W83627EHF_REG_BANK 0x4E 1478c2ecf20Sopenharmony_ci#define W83627EHF_REG_CONFIG 0x40 1488c2ecf20Sopenharmony_ci 1498c2ecf20Sopenharmony_ci/* 1508c2ecf20Sopenharmony_ci * Not currently used: 1518c2ecf20Sopenharmony_ci * REG_MAN_ID has the value 0x5ca3 for all supported chips. 1528c2ecf20Sopenharmony_ci * REG_CHIP_ID == 0x88/0xa1/0xc1 depending on chip model. 1538c2ecf20Sopenharmony_ci * REG_MAN_ID is at port 0x4f 1548c2ecf20Sopenharmony_ci * REG_CHIP_ID is at port 0x58 1558c2ecf20Sopenharmony_ci */ 1568c2ecf20Sopenharmony_ci 1578c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN[] = { 0x28, 0x29, 0x2a, 0x3f, 0x553 }; 1588c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_MIN[] = { 0x3b, 0x3c, 0x3d, 0x3e, 0x55c }; 1598c2ecf20Sopenharmony_ci 1608c2ecf20Sopenharmony_ci/* The W83627EHF registers for nr=7,8,9 are in bank 5 */ 1618c2ecf20Sopenharmony_ci#define W83627EHF_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \ 1628c2ecf20Sopenharmony_ci (0x554 + (((nr) - 7) * 2))) 1638c2ecf20Sopenharmony_ci#define W83627EHF_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \ 1648c2ecf20Sopenharmony_ci (0x555 + (((nr) - 7) * 2))) 1658c2ecf20Sopenharmony_ci#define W83627EHF_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \ 1668c2ecf20Sopenharmony_ci (0x550 + (nr) - 7)) 1678c2ecf20Sopenharmony_ci 1688c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_TEMP[] = { 0x27, 0x150, 0x250, 0x7e }; 1698c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_TEMP_HYST[] = { 0x3a, 0x153, 0x253, 0 }; 1708c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_TEMP_OVER[] = { 0x39, 0x155, 0x255, 0 }; 1718c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_TEMP_CONFIG[] = { 0, 0x152, 0x252, 0 }; 1728c2ecf20Sopenharmony_ci 1738c2ecf20Sopenharmony_ci/* Fan clock dividers are spread over the following five registers */ 1748c2ecf20Sopenharmony_ci#define W83627EHF_REG_FANDIV1 0x47 1758c2ecf20Sopenharmony_ci#define W83627EHF_REG_FANDIV2 0x4B 1768c2ecf20Sopenharmony_ci#define W83627EHF_REG_VBAT 0x5D 1778c2ecf20Sopenharmony_ci#define W83627EHF_REG_DIODE 0x59 1788c2ecf20Sopenharmony_ci#define W83627EHF_REG_SMI_OVT 0x4C 1798c2ecf20Sopenharmony_ci 1808c2ecf20Sopenharmony_ci#define W83627EHF_REG_ALARM1 0x459 1818c2ecf20Sopenharmony_ci#define W83627EHF_REG_ALARM2 0x45A 1828c2ecf20Sopenharmony_ci#define W83627EHF_REG_ALARM3 0x45B 1838c2ecf20Sopenharmony_ci 1848c2ecf20Sopenharmony_ci#define W83627EHF_REG_CASEOPEN_DET 0x42 /* SMI STATUS #2 */ 1858c2ecf20Sopenharmony_ci#define W83627EHF_REG_CASEOPEN_CLR 0x46 /* SMI MASK #3 */ 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_ci/* SmartFan registers */ 1888c2ecf20Sopenharmony_ci#define W83627EHF_REG_FAN_STEPUP_TIME 0x0f 1898c2ecf20Sopenharmony_ci#define W83627EHF_REG_FAN_STEPDOWN_TIME 0x0e 1908c2ecf20Sopenharmony_ci 1918c2ecf20Sopenharmony_ci/* DC or PWM output fan configuration */ 1928c2ecf20Sopenharmony_cistatic const u8 W83627EHF_REG_PWM_ENABLE[] = { 1938c2ecf20Sopenharmony_ci 0x04, /* SYS FAN0 output mode and PWM mode */ 1948c2ecf20Sopenharmony_ci 0x04, /* CPU FAN0 output mode and PWM mode */ 1958c2ecf20Sopenharmony_ci 0x12, /* AUX FAN mode */ 1968c2ecf20Sopenharmony_ci 0x62, /* CPU FAN1 mode */ 1978c2ecf20Sopenharmony_ci}; 1988c2ecf20Sopenharmony_ci 1998c2ecf20Sopenharmony_cistatic const u8 W83627EHF_PWM_MODE_SHIFT[] = { 0, 1, 0, 6 }; 2008c2ecf20Sopenharmony_cistatic const u8 W83627EHF_PWM_ENABLE_SHIFT[] = { 2, 4, 1, 4 }; 2018c2ecf20Sopenharmony_ci 2028c2ecf20Sopenharmony_ci/* FAN Duty Cycle, be used to control */ 2038c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_PWM[] = { 0x01, 0x03, 0x11, 0x61 }; 2048c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_TARGET[] = { 0x05, 0x06, 0x13, 0x63 }; 2058c2ecf20Sopenharmony_cistatic const u8 W83627EHF_REG_TOLERANCE[] = { 0x07, 0x07, 0x14, 0x62 }; 2068c2ecf20Sopenharmony_ci 2078c2ecf20Sopenharmony_ci/* Advanced Fan control, some values are common for all fans */ 2088c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_START_OUTPUT[] = { 0x0a, 0x0b, 0x16, 0x65 }; 2098c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_STOP_OUTPUT[] = { 0x08, 0x09, 0x15, 0x64 }; 2108c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_STOP_TIME[] = { 0x0c, 0x0d, 0x17, 0x66 }; 2118c2ecf20Sopenharmony_ci 2128c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_MAX_OUTPUT_COMMON[] 2138c2ecf20Sopenharmony_ci = { 0xff, 0x67, 0xff, 0x69 }; 2148c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_STEP_OUTPUT_COMMON[] 2158c2ecf20Sopenharmony_ci = { 0xff, 0x68, 0xff, 0x6a }; 2168c2ecf20Sopenharmony_ci 2178c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B[] = { 0x67, 0x69, 0x6b }; 2188c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B[] 2198c2ecf20Sopenharmony_ci = { 0x68, 0x6a, 0x6c }; 2208c2ecf20Sopenharmony_ci 2218c2ecf20Sopenharmony_cistatic const u16 W83627EHF_REG_TEMP_OFFSET[] = { 0x454, 0x455, 0x456 }; 2228c2ecf20Sopenharmony_ci 2238c2ecf20Sopenharmony_cistatic const char *const w83667hg_b_temp_label[] = { 2248c2ecf20Sopenharmony_ci "SYSTIN", 2258c2ecf20Sopenharmony_ci "CPUTIN", 2268c2ecf20Sopenharmony_ci "AUXTIN", 2278c2ecf20Sopenharmony_ci "AMDTSI", 2288c2ecf20Sopenharmony_ci "PECI Agent 1", 2298c2ecf20Sopenharmony_ci "PECI Agent 2", 2308c2ecf20Sopenharmony_ci "PECI Agent 3", 2318c2ecf20Sopenharmony_ci "PECI Agent 4" 2328c2ecf20Sopenharmony_ci}; 2338c2ecf20Sopenharmony_ci 2348c2ecf20Sopenharmony_ci#define NUM_REG_TEMP ARRAY_SIZE(W83627EHF_REG_TEMP) 2358c2ecf20Sopenharmony_ci 2368c2ecf20Sopenharmony_cistatic int is_word_sized(u16 reg) 2378c2ecf20Sopenharmony_ci{ 2388c2ecf20Sopenharmony_ci return ((((reg & 0xff00) == 0x100 2398c2ecf20Sopenharmony_ci || (reg & 0xff00) == 0x200) 2408c2ecf20Sopenharmony_ci && ((reg & 0x00ff) == 0x50 2418c2ecf20Sopenharmony_ci || (reg & 0x00ff) == 0x53 2428c2ecf20Sopenharmony_ci || (reg & 0x00ff) == 0x55)) 2438c2ecf20Sopenharmony_ci || (reg & 0xfff0) == 0x630 2448c2ecf20Sopenharmony_ci || reg == 0x640 || reg == 0x642 2458c2ecf20Sopenharmony_ci || ((reg & 0xfff0) == 0x650 2468c2ecf20Sopenharmony_ci && (reg & 0x000f) >= 0x06) 2478c2ecf20Sopenharmony_ci || reg == 0x73 || reg == 0x75 || reg == 0x77 2488c2ecf20Sopenharmony_ci ); 2498c2ecf20Sopenharmony_ci} 2508c2ecf20Sopenharmony_ci 2518c2ecf20Sopenharmony_ci/* 2528c2ecf20Sopenharmony_ci * Conversions 2538c2ecf20Sopenharmony_ci */ 2548c2ecf20Sopenharmony_ci 2558c2ecf20Sopenharmony_ci/* 1 is PWM mode, output in ms */ 2568c2ecf20Sopenharmony_cistatic inline unsigned int step_time_from_reg(u8 reg, u8 mode) 2578c2ecf20Sopenharmony_ci{ 2588c2ecf20Sopenharmony_ci return mode ? 100 * reg : 400 * reg; 2598c2ecf20Sopenharmony_ci} 2608c2ecf20Sopenharmony_ci 2618c2ecf20Sopenharmony_cistatic inline u8 step_time_to_reg(unsigned int msec, u8 mode) 2628c2ecf20Sopenharmony_ci{ 2638c2ecf20Sopenharmony_ci return clamp_val((mode ? (msec + 50) / 100 : (msec + 200) / 400), 2648c2ecf20Sopenharmony_ci 1, 255); 2658c2ecf20Sopenharmony_ci} 2668c2ecf20Sopenharmony_ci 2678c2ecf20Sopenharmony_cistatic unsigned int fan_from_reg8(u16 reg, unsigned int divreg) 2688c2ecf20Sopenharmony_ci{ 2698c2ecf20Sopenharmony_ci if (reg == 0 || reg == 255) 2708c2ecf20Sopenharmony_ci return 0; 2718c2ecf20Sopenharmony_ci return 1350000U / (reg << divreg); 2728c2ecf20Sopenharmony_ci} 2738c2ecf20Sopenharmony_ci 2748c2ecf20Sopenharmony_cistatic inline unsigned int 2758c2ecf20Sopenharmony_cidiv_from_reg(u8 reg) 2768c2ecf20Sopenharmony_ci{ 2778c2ecf20Sopenharmony_ci return 1 << reg; 2788c2ecf20Sopenharmony_ci} 2798c2ecf20Sopenharmony_ci 2808c2ecf20Sopenharmony_ci/* 2818c2ecf20Sopenharmony_ci * Some of the voltage inputs have internal scaling, the tables below 2828c2ecf20Sopenharmony_ci * contain 8 (the ADC LSB in mV) * scaling factor * 100 2838c2ecf20Sopenharmony_ci */ 2848c2ecf20Sopenharmony_cistatic const u16 scale_in_common[10] = { 2858c2ecf20Sopenharmony_ci 800, 800, 1600, 1600, 800, 800, 800, 1600, 1600, 800 2868c2ecf20Sopenharmony_ci}; 2878c2ecf20Sopenharmony_cistatic const u16 scale_in_w83627uhg[9] = { 2888c2ecf20Sopenharmony_ci 800, 800, 3328, 3424, 800, 800, 0, 3328, 3400 2898c2ecf20Sopenharmony_ci}; 2908c2ecf20Sopenharmony_ci 2918c2ecf20Sopenharmony_cistatic inline long in_from_reg(u8 reg, u8 nr, const u16 *scale_in) 2928c2ecf20Sopenharmony_ci{ 2938c2ecf20Sopenharmony_ci return DIV_ROUND_CLOSEST(reg * scale_in[nr], 100); 2948c2ecf20Sopenharmony_ci} 2958c2ecf20Sopenharmony_ci 2968c2ecf20Sopenharmony_cistatic inline u8 in_to_reg(u32 val, u8 nr, const u16 *scale_in) 2978c2ecf20Sopenharmony_ci{ 2988c2ecf20Sopenharmony_ci return clamp_val(DIV_ROUND_CLOSEST(val * 100, scale_in[nr]), 0, 255); 2998c2ecf20Sopenharmony_ci} 3008c2ecf20Sopenharmony_ci 3018c2ecf20Sopenharmony_ci/* 3028c2ecf20Sopenharmony_ci * Data structures and manipulation thereof 3038c2ecf20Sopenharmony_ci */ 3048c2ecf20Sopenharmony_ci 3058c2ecf20Sopenharmony_cistruct w83627ehf_data { 3068c2ecf20Sopenharmony_ci int addr; /* IO base of hw monitor block */ 3078c2ecf20Sopenharmony_ci const char *name; 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_ci struct mutex lock; 3108c2ecf20Sopenharmony_ci 3118c2ecf20Sopenharmony_ci u16 reg_temp[NUM_REG_TEMP]; 3128c2ecf20Sopenharmony_ci u16 reg_temp_over[NUM_REG_TEMP]; 3138c2ecf20Sopenharmony_ci u16 reg_temp_hyst[NUM_REG_TEMP]; 3148c2ecf20Sopenharmony_ci u16 reg_temp_config[NUM_REG_TEMP]; 3158c2ecf20Sopenharmony_ci u8 temp_src[NUM_REG_TEMP]; 3168c2ecf20Sopenharmony_ci const char * const *temp_label; 3178c2ecf20Sopenharmony_ci 3188c2ecf20Sopenharmony_ci const u16 *REG_FAN_MAX_OUTPUT; 3198c2ecf20Sopenharmony_ci const u16 *REG_FAN_STEP_OUTPUT; 3208c2ecf20Sopenharmony_ci const u16 *scale_in; 3218c2ecf20Sopenharmony_ci 3228c2ecf20Sopenharmony_ci struct mutex update_lock; 3238c2ecf20Sopenharmony_ci char valid; /* !=0 if following fields are valid */ 3248c2ecf20Sopenharmony_ci unsigned long last_updated; /* In jiffies */ 3258c2ecf20Sopenharmony_ci 3268c2ecf20Sopenharmony_ci /* Register values */ 3278c2ecf20Sopenharmony_ci u8 bank; /* current register bank */ 3288c2ecf20Sopenharmony_ci u8 in_num; /* number of in inputs we have */ 3298c2ecf20Sopenharmony_ci u8 in[10]; /* Register value */ 3308c2ecf20Sopenharmony_ci u8 in_max[10]; /* Register value */ 3318c2ecf20Sopenharmony_ci u8 in_min[10]; /* Register value */ 3328c2ecf20Sopenharmony_ci unsigned int rpm[5]; 3338c2ecf20Sopenharmony_ci u16 fan_min[5]; 3348c2ecf20Sopenharmony_ci u8 fan_div[5]; 3358c2ecf20Sopenharmony_ci u8 has_fan; /* some fan inputs can be disabled */ 3368c2ecf20Sopenharmony_ci u8 has_fan_min; /* some fans don't have min register */ 3378c2ecf20Sopenharmony_ci u8 temp_type[3]; 3388c2ecf20Sopenharmony_ci s8 temp_offset[3]; 3398c2ecf20Sopenharmony_ci s16 temp[9]; 3408c2ecf20Sopenharmony_ci s16 temp_max[9]; 3418c2ecf20Sopenharmony_ci s16 temp_max_hyst[9]; 3428c2ecf20Sopenharmony_ci u32 alarms; 3438c2ecf20Sopenharmony_ci u8 caseopen; 3448c2ecf20Sopenharmony_ci 3458c2ecf20Sopenharmony_ci u8 pwm_mode[4]; /* 0->DC variable voltage, 1->PWM variable duty cycle */ 3468c2ecf20Sopenharmony_ci u8 pwm_enable[4]; /* 1->manual 3478c2ecf20Sopenharmony_ci * 2->thermal cruise mode (also called SmartFan I) 3488c2ecf20Sopenharmony_ci * 3->fan speed cruise mode 3498c2ecf20Sopenharmony_ci * 4->variable thermal cruise (also called 3508c2ecf20Sopenharmony_ci * SmartFan III) 3518c2ecf20Sopenharmony_ci * 5->enhanced variable thermal cruise (also called 3528c2ecf20Sopenharmony_ci * SmartFan IV) 3538c2ecf20Sopenharmony_ci */ 3548c2ecf20Sopenharmony_ci u8 pwm_enable_orig[4]; /* original value of pwm_enable */ 3558c2ecf20Sopenharmony_ci u8 pwm_num; /* number of pwm */ 3568c2ecf20Sopenharmony_ci u8 pwm[4]; 3578c2ecf20Sopenharmony_ci u8 target_temp[4]; 3588c2ecf20Sopenharmony_ci u8 tolerance[4]; 3598c2ecf20Sopenharmony_ci 3608c2ecf20Sopenharmony_ci u8 fan_start_output[4]; /* minimum fan speed when spinning up */ 3618c2ecf20Sopenharmony_ci u8 fan_stop_output[4]; /* minimum fan speed when spinning down */ 3628c2ecf20Sopenharmony_ci u8 fan_stop_time[4]; /* time at minimum before disabling fan */ 3638c2ecf20Sopenharmony_ci u8 fan_max_output[4]; /* maximum fan speed */ 3648c2ecf20Sopenharmony_ci u8 fan_step_output[4]; /* rate of change output value */ 3658c2ecf20Sopenharmony_ci 3668c2ecf20Sopenharmony_ci u8 vid; 3678c2ecf20Sopenharmony_ci u8 vrm; 3688c2ecf20Sopenharmony_ci 3698c2ecf20Sopenharmony_ci u16 have_temp; 3708c2ecf20Sopenharmony_ci u16 have_temp_offset; 3718c2ecf20Sopenharmony_ci u8 in6_skip:1; 3728c2ecf20Sopenharmony_ci u8 temp3_val_only:1; 3738c2ecf20Sopenharmony_ci u8 have_vid:1; 3748c2ecf20Sopenharmony_ci 3758c2ecf20Sopenharmony_ci#ifdef CONFIG_PM 3768c2ecf20Sopenharmony_ci /* Remember extra register values over suspend/resume */ 3778c2ecf20Sopenharmony_ci u8 vbat; 3788c2ecf20Sopenharmony_ci u8 fandiv1; 3798c2ecf20Sopenharmony_ci u8 fandiv2; 3808c2ecf20Sopenharmony_ci#endif 3818c2ecf20Sopenharmony_ci}; 3828c2ecf20Sopenharmony_ci 3838c2ecf20Sopenharmony_cistruct w83627ehf_sio_data { 3848c2ecf20Sopenharmony_ci int sioreg; 3858c2ecf20Sopenharmony_ci enum kinds kind; 3868c2ecf20Sopenharmony_ci}; 3878c2ecf20Sopenharmony_ci 3888c2ecf20Sopenharmony_ci/* 3898c2ecf20Sopenharmony_ci * On older chips, only registers 0x50-0x5f are banked. 3908c2ecf20Sopenharmony_ci * On more recent chips, all registers are banked. 3918c2ecf20Sopenharmony_ci * Assume that is the case and set the bank number for each access. 3928c2ecf20Sopenharmony_ci * Cache the bank number so it only needs to be set if it changes. 3938c2ecf20Sopenharmony_ci */ 3948c2ecf20Sopenharmony_cistatic inline void w83627ehf_set_bank(struct w83627ehf_data *data, u16 reg) 3958c2ecf20Sopenharmony_ci{ 3968c2ecf20Sopenharmony_ci u8 bank = reg >> 8; 3978c2ecf20Sopenharmony_ci if (data->bank != bank) { 3988c2ecf20Sopenharmony_ci outb_p(W83627EHF_REG_BANK, data->addr + ADDR_REG_OFFSET); 3998c2ecf20Sopenharmony_ci outb_p(bank, data->addr + DATA_REG_OFFSET); 4008c2ecf20Sopenharmony_ci data->bank = bank; 4018c2ecf20Sopenharmony_ci } 4028c2ecf20Sopenharmony_ci} 4038c2ecf20Sopenharmony_ci 4048c2ecf20Sopenharmony_cistatic u16 w83627ehf_read_value(struct w83627ehf_data *data, u16 reg) 4058c2ecf20Sopenharmony_ci{ 4068c2ecf20Sopenharmony_ci int res, word_sized = is_word_sized(reg); 4078c2ecf20Sopenharmony_ci 4088c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 4098c2ecf20Sopenharmony_ci 4108c2ecf20Sopenharmony_ci w83627ehf_set_bank(data, reg); 4118c2ecf20Sopenharmony_ci outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET); 4128c2ecf20Sopenharmony_ci res = inb_p(data->addr + DATA_REG_OFFSET); 4138c2ecf20Sopenharmony_ci if (word_sized) { 4148c2ecf20Sopenharmony_ci outb_p((reg & 0xff) + 1, 4158c2ecf20Sopenharmony_ci data->addr + ADDR_REG_OFFSET); 4168c2ecf20Sopenharmony_ci res = (res << 8) + inb_p(data->addr + DATA_REG_OFFSET); 4178c2ecf20Sopenharmony_ci } 4188c2ecf20Sopenharmony_ci 4198c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 4208c2ecf20Sopenharmony_ci return res; 4218c2ecf20Sopenharmony_ci} 4228c2ecf20Sopenharmony_ci 4238c2ecf20Sopenharmony_cistatic int w83627ehf_write_value(struct w83627ehf_data *data, u16 reg, 4248c2ecf20Sopenharmony_ci u16 value) 4258c2ecf20Sopenharmony_ci{ 4268c2ecf20Sopenharmony_ci int word_sized = is_word_sized(reg); 4278c2ecf20Sopenharmony_ci 4288c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 4298c2ecf20Sopenharmony_ci 4308c2ecf20Sopenharmony_ci w83627ehf_set_bank(data, reg); 4318c2ecf20Sopenharmony_ci outb_p(reg & 0xff, data->addr + ADDR_REG_OFFSET); 4328c2ecf20Sopenharmony_ci if (word_sized) { 4338c2ecf20Sopenharmony_ci outb_p(value >> 8, data->addr + DATA_REG_OFFSET); 4348c2ecf20Sopenharmony_ci outb_p((reg & 0xff) + 1, 4358c2ecf20Sopenharmony_ci data->addr + ADDR_REG_OFFSET); 4368c2ecf20Sopenharmony_ci } 4378c2ecf20Sopenharmony_ci outb_p(value & 0xff, data->addr + DATA_REG_OFFSET); 4388c2ecf20Sopenharmony_ci 4398c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 4408c2ecf20Sopenharmony_ci return 0; 4418c2ecf20Sopenharmony_ci} 4428c2ecf20Sopenharmony_ci 4438c2ecf20Sopenharmony_ci/* We left-align 8-bit temperature values to make the code simpler */ 4448c2ecf20Sopenharmony_cistatic u16 w83627ehf_read_temp(struct w83627ehf_data *data, u16 reg) 4458c2ecf20Sopenharmony_ci{ 4468c2ecf20Sopenharmony_ci u16 res; 4478c2ecf20Sopenharmony_ci 4488c2ecf20Sopenharmony_ci res = w83627ehf_read_value(data, reg); 4498c2ecf20Sopenharmony_ci if (!is_word_sized(reg)) 4508c2ecf20Sopenharmony_ci res <<= 8; 4518c2ecf20Sopenharmony_ci 4528c2ecf20Sopenharmony_ci return res; 4538c2ecf20Sopenharmony_ci} 4548c2ecf20Sopenharmony_ci 4558c2ecf20Sopenharmony_cistatic int w83627ehf_write_temp(struct w83627ehf_data *data, u16 reg, 4568c2ecf20Sopenharmony_ci u16 value) 4578c2ecf20Sopenharmony_ci{ 4588c2ecf20Sopenharmony_ci if (!is_word_sized(reg)) 4598c2ecf20Sopenharmony_ci value >>= 8; 4608c2ecf20Sopenharmony_ci return w83627ehf_write_value(data, reg, value); 4618c2ecf20Sopenharmony_ci} 4628c2ecf20Sopenharmony_ci 4638c2ecf20Sopenharmony_ci/* This function assumes that the caller holds data->update_lock */ 4648c2ecf20Sopenharmony_cistatic void w83627ehf_write_fan_div(struct w83627ehf_data *data, int nr) 4658c2ecf20Sopenharmony_ci{ 4668c2ecf20Sopenharmony_ci u8 reg; 4678c2ecf20Sopenharmony_ci 4688c2ecf20Sopenharmony_ci switch (nr) { 4698c2ecf20Sopenharmony_ci case 0: 4708c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0xcf) 4718c2ecf20Sopenharmony_ci | ((data->fan_div[0] & 0x03) << 4); 4728c2ecf20Sopenharmony_ci /* fan5 input control bit is write only, compute the value */ 4738c2ecf20Sopenharmony_ci reg |= (data->has_fan & (1 << 4)) ? 1 : 0; 4748c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg); 4758c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xdf) 4768c2ecf20Sopenharmony_ci | ((data->fan_div[0] & 0x04) << 3); 4778c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg); 4788c2ecf20Sopenharmony_ci break; 4798c2ecf20Sopenharmony_ci case 1: 4808c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV1) & 0x3f) 4818c2ecf20Sopenharmony_ci | ((data->fan_div[1] & 0x03) << 6); 4828c2ecf20Sopenharmony_ci /* fan5 input control bit is write only, compute the value */ 4838c2ecf20Sopenharmony_ci reg |= (data->has_fan & (1 << 4)) ? 1 : 0; 4848c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_FANDIV1, reg); 4858c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0xbf) 4868c2ecf20Sopenharmony_ci | ((data->fan_div[1] & 0x04) << 4); 4878c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg); 4888c2ecf20Sopenharmony_ci break; 4898c2ecf20Sopenharmony_ci case 2: 4908c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_FANDIV2) & 0x3f) 4918c2ecf20Sopenharmony_ci | ((data->fan_div[2] & 0x03) << 6); 4928c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_FANDIV2, reg); 4938c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_VBAT) & 0x7f) 4948c2ecf20Sopenharmony_ci | ((data->fan_div[2] & 0x04) << 5); 4958c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_VBAT, reg); 4968c2ecf20Sopenharmony_ci break; 4978c2ecf20Sopenharmony_ci case 3: 4988c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0xfc) 4998c2ecf20Sopenharmony_ci | (data->fan_div[3] & 0x03); 5008c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg); 5018c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT) & 0x7f) 5028c2ecf20Sopenharmony_ci | ((data->fan_div[3] & 0x04) << 5); 5038c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_SMI_OVT, reg); 5048c2ecf20Sopenharmony_ci break; 5058c2ecf20Sopenharmony_ci case 4: 5068c2ecf20Sopenharmony_ci reg = (w83627ehf_read_value(data, W83627EHF_REG_DIODE) & 0x73) 5078c2ecf20Sopenharmony_ci | ((data->fan_div[4] & 0x03) << 2) 5088c2ecf20Sopenharmony_ci | ((data->fan_div[4] & 0x04) << 5); 5098c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_DIODE, reg); 5108c2ecf20Sopenharmony_ci break; 5118c2ecf20Sopenharmony_ci } 5128c2ecf20Sopenharmony_ci} 5138c2ecf20Sopenharmony_ci 5148c2ecf20Sopenharmony_cistatic void w83627ehf_update_fan_div(struct w83627ehf_data *data) 5158c2ecf20Sopenharmony_ci{ 5168c2ecf20Sopenharmony_ci int i; 5178c2ecf20Sopenharmony_ci 5188c2ecf20Sopenharmony_ci i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1); 5198c2ecf20Sopenharmony_ci data->fan_div[0] = (i >> 4) & 0x03; 5208c2ecf20Sopenharmony_ci data->fan_div[1] = (i >> 6) & 0x03; 5218c2ecf20Sopenharmony_ci i = w83627ehf_read_value(data, W83627EHF_REG_FANDIV2); 5228c2ecf20Sopenharmony_ci data->fan_div[2] = (i >> 6) & 0x03; 5238c2ecf20Sopenharmony_ci i = w83627ehf_read_value(data, W83627EHF_REG_VBAT); 5248c2ecf20Sopenharmony_ci data->fan_div[0] |= (i >> 3) & 0x04; 5258c2ecf20Sopenharmony_ci data->fan_div[1] |= (i >> 4) & 0x04; 5268c2ecf20Sopenharmony_ci data->fan_div[2] |= (i >> 5) & 0x04; 5278c2ecf20Sopenharmony_ci if (data->has_fan & ((1 << 3) | (1 << 4))) { 5288c2ecf20Sopenharmony_ci i = w83627ehf_read_value(data, W83627EHF_REG_DIODE); 5298c2ecf20Sopenharmony_ci data->fan_div[3] = i & 0x03; 5308c2ecf20Sopenharmony_ci data->fan_div[4] = ((i >> 2) & 0x03) 5318c2ecf20Sopenharmony_ci | ((i >> 5) & 0x04); 5328c2ecf20Sopenharmony_ci } 5338c2ecf20Sopenharmony_ci if (data->has_fan & (1 << 3)) { 5348c2ecf20Sopenharmony_ci i = w83627ehf_read_value(data, W83627EHF_REG_SMI_OVT); 5358c2ecf20Sopenharmony_ci data->fan_div[3] |= (i >> 5) & 0x04; 5368c2ecf20Sopenharmony_ci } 5378c2ecf20Sopenharmony_ci} 5388c2ecf20Sopenharmony_ci 5398c2ecf20Sopenharmony_cistatic void w83627ehf_update_pwm(struct w83627ehf_data *data) 5408c2ecf20Sopenharmony_ci{ 5418c2ecf20Sopenharmony_ci int i; 5428c2ecf20Sopenharmony_ci int pwmcfg = 0, tolerance = 0; /* shut up the compiler */ 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci for (i = 0; i < data->pwm_num; i++) { 5458c2ecf20Sopenharmony_ci if (!(data->has_fan & (1 << i))) 5468c2ecf20Sopenharmony_ci continue; 5478c2ecf20Sopenharmony_ci 5488c2ecf20Sopenharmony_ci /* pwmcfg, tolerance mapped for i=0, i=1 to same reg */ 5498c2ecf20Sopenharmony_ci if (i != 1) { 5508c2ecf20Sopenharmony_ci pwmcfg = w83627ehf_read_value(data, 5518c2ecf20Sopenharmony_ci W83627EHF_REG_PWM_ENABLE[i]); 5528c2ecf20Sopenharmony_ci tolerance = w83627ehf_read_value(data, 5538c2ecf20Sopenharmony_ci W83627EHF_REG_TOLERANCE[i]); 5548c2ecf20Sopenharmony_ci } 5558c2ecf20Sopenharmony_ci data->pwm_mode[i] = 5568c2ecf20Sopenharmony_ci ((pwmcfg >> W83627EHF_PWM_MODE_SHIFT[i]) & 1) ? 0 : 1; 5578c2ecf20Sopenharmony_ci data->pwm_enable[i] = ((pwmcfg >> W83627EHF_PWM_ENABLE_SHIFT[i]) 5588c2ecf20Sopenharmony_ci & 3) + 1; 5598c2ecf20Sopenharmony_ci data->pwm[i] = w83627ehf_read_value(data, W83627EHF_REG_PWM[i]); 5608c2ecf20Sopenharmony_ci 5618c2ecf20Sopenharmony_ci data->tolerance[i] = (tolerance >> (i == 1 ? 4 : 0)) & 0x0f; 5628c2ecf20Sopenharmony_ci } 5638c2ecf20Sopenharmony_ci} 5648c2ecf20Sopenharmony_ci 5658c2ecf20Sopenharmony_cistatic struct w83627ehf_data *w83627ehf_update_device(struct device *dev) 5668c2ecf20Sopenharmony_ci{ 5678c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 5688c2ecf20Sopenharmony_ci int i; 5698c2ecf20Sopenharmony_ci 5708c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 5718c2ecf20Sopenharmony_ci 5728c2ecf20Sopenharmony_ci if (time_after(jiffies, data->last_updated + HZ + HZ/2) 5738c2ecf20Sopenharmony_ci || !data->valid) { 5748c2ecf20Sopenharmony_ci /* Fan clock dividers */ 5758c2ecf20Sopenharmony_ci w83627ehf_update_fan_div(data); 5768c2ecf20Sopenharmony_ci 5778c2ecf20Sopenharmony_ci /* Measured voltages and limits */ 5788c2ecf20Sopenharmony_ci for (i = 0; i < data->in_num; i++) { 5798c2ecf20Sopenharmony_ci if ((i == 6) && data->in6_skip) 5808c2ecf20Sopenharmony_ci continue; 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_ci data->in[i] = w83627ehf_read_value(data, 5838c2ecf20Sopenharmony_ci W83627EHF_REG_IN(i)); 5848c2ecf20Sopenharmony_ci data->in_min[i] = w83627ehf_read_value(data, 5858c2ecf20Sopenharmony_ci W83627EHF_REG_IN_MIN(i)); 5868c2ecf20Sopenharmony_ci data->in_max[i] = w83627ehf_read_value(data, 5878c2ecf20Sopenharmony_ci W83627EHF_REG_IN_MAX(i)); 5888c2ecf20Sopenharmony_ci } 5898c2ecf20Sopenharmony_ci 5908c2ecf20Sopenharmony_ci /* Measured fan speeds and limits */ 5918c2ecf20Sopenharmony_ci for (i = 0; i < 5; i++) { 5928c2ecf20Sopenharmony_ci u16 reg; 5938c2ecf20Sopenharmony_ci 5948c2ecf20Sopenharmony_ci if (!(data->has_fan & (1 << i))) 5958c2ecf20Sopenharmony_ci continue; 5968c2ecf20Sopenharmony_ci 5978c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, W83627EHF_REG_FAN[i]); 5988c2ecf20Sopenharmony_ci data->rpm[i] = fan_from_reg8(reg, data->fan_div[i]); 5998c2ecf20Sopenharmony_ci 6008c2ecf20Sopenharmony_ci if (data->has_fan_min & (1 << i)) 6018c2ecf20Sopenharmony_ci data->fan_min[i] = w83627ehf_read_value(data, 6028c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_MIN[i]); 6038c2ecf20Sopenharmony_ci 6048c2ecf20Sopenharmony_ci /* 6058c2ecf20Sopenharmony_ci * If we failed to measure the fan speed and clock 6068c2ecf20Sopenharmony_ci * divider can be increased, let's try that for next 6078c2ecf20Sopenharmony_ci * time 6088c2ecf20Sopenharmony_ci */ 6098c2ecf20Sopenharmony_ci if (reg >= 0xff && data->fan_div[i] < 0x07) { 6108c2ecf20Sopenharmony_ci dev_dbg(dev, 6118c2ecf20Sopenharmony_ci "Increasing fan%d clock divider from %u to %u\n", 6128c2ecf20Sopenharmony_ci i + 1, div_from_reg(data->fan_div[i]), 6138c2ecf20Sopenharmony_ci div_from_reg(data->fan_div[i] + 1)); 6148c2ecf20Sopenharmony_ci data->fan_div[i]++; 6158c2ecf20Sopenharmony_ci w83627ehf_write_fan_div(data, i); 6168c2ecf20Sopenharmony_ci /* Preserve min limit if possible */ 6178c2ecf20Sopenharmony_ci if ((data->has_fan_min & (1 << i)) 6188c2ecf20Sopenharmony_ci && data->fan_min[i] >= 2 6198c2ecf20Sopenharmony_ci && data->fan_min[i] != 255) 6208c2ecf20Sopenharmony_ci w83627ehf_write_value(data, 6218c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_MIN[i], 6228c2ecf20Sopenharmony_ci (data->fan_min[i] /= 2)); 6238c2ecf20Sopenharmony_ci } 6248c2ecf20Sopenharmony_ci } 6258c2ecf20Sopenharmony_ci 6268c2ecf20Sopenharmony_ci w83627ehf_update_pwm(data); 6278c2ecf20Sopenharmony_ci 6288c2ecf20Sopenharmony_ci for (i = 0; i < data->pwm_num; i++) { 6298c2ecf20Sopenharmony_ci if (!(data->has_fan & (1 << i))) 6308c2ecf20Sopenharmony_ci continue; 6318c2ecf20Sopenharmony_ci 6328c2ecf20Sopenharmony_ci data->fan_start_output[i] = 6338c2ecf20Sopenharmony_ci w83627ehf_read_value(data, 6348c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_START_OUTPUT[i]); 6358c2ecf20Sopenharmony_ci data->fan_stop_output[i] = 6368c2ecf20Sopenharmony_ci w83627ehf_read_value(data, 6378c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_STOP_OUTPUT[i]); 6388c2ecf20Sopenharmony_ci data->fan_stop_time[i] = 6398c2ecf20Sopenharmony_ci w83627ehf_read_value(data, 6408c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_STOP_TIME[i]); 6418c2ecf20Sopenharmony_ci 6428c2ecf20Sopenharmony_ci if (data->REG_FAN_MAX_OUTPUT && 6438c2ecf20Sopenharmony_ci data->REG_FAN_MAX_OUTPUT[i] != 0xff) 6448c2ecf20Sopenharmony_ci data->fan_max_output[i] = 6458c2ecf20Sopenharmony_ci w83627ehf_read_value(data, 6468c2ecf20Sopenharmony_ci data->REG_FAN_MAX_OUTPUT[i]); 6478c2ecf20Sopenharmony_ci 6488c2ecf20Sopenharmony_ci if (data->REG_FAN_STEP_OUTPUT && 6498c2ecf20Sopenharmony_ci data->REG_FAN_STEP_OUTPUT[i] != 0xff) 6508c2ecf20Sopenharmony_ci data->fan_step_output[i] = 6518c2ecf20Sopenharmony_ci w83627ehf_read_value(data, 6528c2ecf20Sopenharmony_ci data->REG_FAN_STEP_OUTPUT[i]); 6538c2ecf20Sopenharmony_ci 6548c2ecf20Sopenharmony_ci data->target_temp[i] = 6558c2ecf20Sopenharmony_ci w83627ehf_read_value(data, 6568c2ecf20Sopenharmony_ci W83627EHF_REG_TARGET[i]) & 6578c2ecf20Sopenharmony_ci (data->pwm_mode[i] == 1 ? 0x7f : 0xff); 6588c2ecf20Sopenharmony_ci } 6598c2ecf20Sopenharmony_ci 6608c2ecf20Sopenharmony_ci /* Measured temperatures and limits */ 6618c2ecf20Sopenharmony_ci for (i = 0; i < NUM_REG_TEMP; i++) { 6628c2ecf20Sopenharmony_ci if (!(data->have_temp & (1 << i))) 6638c2ecf20Sopenharmony_ci continue; 6648c2ecf20Sopenharmony_ci data->temp[i] = w83627ehf_read_temp(data, 6658c2ecf20Sopenharmony_ci data->reg_temp[i]); 6668c2ecf20Sopenharmony_ci if (data->reg_temp_over[i]) 6678c2ecf20Sopenharmony_ci data->temp_max[i] 6688c2ecf20Sopenharmony_ci = w83627ehf_read_temp(data, 6698c2ecf20Sopenharmony_ci data->reg_temp_over[i]); 6708c2ecf20Sopenharmony_ci if (data->reg_temp_hyst[i]) 6718c2ecf20Sopenharmony_ci data->temp_max_hyst[i] 6728c2ecf20Sopenharmony_ci = w83627ehf_read_temp(data, 6738c2ecf20Sopenharmony_ci data->reg_temp_hyst[i]); 6748c2ecf20Sopenharmony_ci if (i > 2) 6758c2ecf20Sopenharmony_ci continue; 6768c2ecf20Sopenharmony_ci if (data->have_temp_offset & (1 << i)) 6778c2ecf20Sopenharmony_ci data->temp_offset[i] 6788c2ecf20Sopenharmony_ci = w83627ehf_read_value(data, 6798c2ecf20Sopenharmony_ci W83627EHF_REG_TEMP_OFFSET[i]); 6808c2ecf20Sopenharmony_ci } 6818c2ecf20Sopenharmony_ci 6828c2ecf20Sopenharmony_ci data->alarms = w83627ehf_read_value(data, 6838c2ecf20Sopenharmony_ci W83627EHF_REG_ALARM1) | 6848c2ecf20Sopenharmony_ci (w83627ehf_read_value(data, 6858c2ecf20Sopenharmony_ci W83627EHF_REG_ALARM2) << 8) | 6868c2ecf20Sopenharmony_ci (w83627ehf_read_value(data, 6878c2ecf20Sopenharmony_ci W83627EHF_REG_ALARM3) << 16); 6888c2ecf20Sopenharmony_ci 6898c2ecf20Sopenharmony_ci data->caseopen = w83627ehf_read_value(data, 6908c2ecf20Sopenharmony_ci W83627EHF_REG_CASEOPEN_DET); 6918c2ecf20Sopenharmony_ci 6928c2ecf20Sopenharmony_ci data->last_updated = jiffies; 6938c2ecf20Sopenharmony_ci data->valid = 1; 6948c2ecf20Sopenharmony_ci } 6958c2ecf20Sopenharmony_ci 6968c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 6978c2ecf20Sopenharmony_ci return data; 6988c2ecf20Sopenharmony_ci} 6998c2ecf20Sopenharmony_ci 7008c2ecf20Sopenharmony_ci#define store_in_reg(REG, reg) \ 7018c2ecf20Sopenharmony_cistatic int \ 7028c2ecf20Sopenharmony_cistore_in_##reg(struct device *dev, struct w83627ehf_data *data, int channel, \ 7038c2ecf20Sopenharmony_ci long val) \ 7048c2ecf20Sopenharmony_ci{ \ 7058c2ecf20Sopenharmony_ci if (val < 0) \ 7068c2ecf20Sopenharmony_ci return -EINVAL; \ 7078c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); \ 7088c2ecf20Sopenharmony_ci data->in_##reg[channel] = in_to_reg(val, channel, data->scale_in); \ 7098c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_IN_##REG(channel), \ 7108c2ecf20Sopenharmony_ci data->in_##reg[channel]); \ 7118c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); \ 7128c2ecf20Sopenharmony_ci return 0; \ 7138c2ecf20Sopenharmony_ci} 7148c2ecf20Sopenharmony_ci 7158c2ecf20Sopenharmony_cistore_in_reg(MIN, min) 7168c2ecf20Sopenharmony_cistore_in_reg(MAX, max) 7178c2ecf20Sopenharmony_ci 7188c2ecf20Sopenharmony_cistatic int 7198c2ecf20Sopenharmony_cistore_fan_min(struct device *dev, struct w83627ehf_data *data, int channel, 7208c2ecf20Sopenharmony_ci long val) 7218c2ecf20Sopenharmony_ci{ 7228c2ecf20Sopenharmony_ci unsigned int reg; 7238c2ecf20Sopenharmony_ci u8 new_div; 7248c2ecf20Sopenharmony_ci 7258c2ecf20Sopenharmony_ci if (val < 0) 7268c2ecf20Sopenharmony_ci return -EINVAL; 7278c2ecf20Sopenharmony_ci 7288c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 7298c2ecf20Sopenharmony_ci if (!val) { 7308c2ecf20Sopenharmony_ci /* No min limit, alarm disabled */ 7318c2ecf20Sopenharmony_ci data->fan_min[channel] = 255; 7328c2ecf20Sopenharmony_ci new_div = data->fan_div[channel]; /* No change */ 7338c2ecf20Sopenharmony_ci dev_info(dev, "fan%u low limit and alarm disabled\n", 7348c2ecf20Sopenharmony_ci channel + 1); 7358c2ecf20Sopenharmony_ci } else if ((reg = 1350000U / val) >= 128 * 255) { 7368c2ecf20Sopenharmony_ci /* 7378c2ecf20Sopenharmony_ci * Speed below this value cannot possibly be represented, 7388c2ecf20Sopenharmony_ci * even with the highest divider (128) 7398c2ecf20Sopenharmony_ci */ 7408c2ecf20Sopenharmony_ci data->fan_min[channel] = 254; 7418c2ecf20Sopenharmony_ci new_div = 7; /* 128 == (1 << 7) */ 7428c2ecf20Sopenharmony_ci dev_warn(dev, 7438c2ecf20Sopenharmony_ci "fan%u low limit %lu below minimum %u, set to minimum\n", 7448c2ecf20Sopenharmony_ci channel + 1, val, fan_from_reg8(254, 7)); 7458c2ecf20Sopenharmony_ci } else if (!reg) { 7468c2ecf20Sopenharmony_ci /* 7478c2ecf20Sopenharmony_ci * Speed above this value cannot possibly be represented, 7488c2ecf20Sopenharmony_ci * even with the lowest divider (1) 7498c2ecf20Sopenharmony_ci */ 7508c2ecf20Sopenharmony_ci data->fan_min[channel] = 1; 7518c2ecf20Sopenharmony_ci new_div = 0; /* 1 == (1 << 0) */ 7528c2ecf20Sopenharmony_ci dev_warn(dev, 7538c2ecf20Sopenharmony_ci "fan%u low limit %lu above maximum %u, set to maximum\n", 7548c2ecf20Sopenharmony_ci channel + 1, val, fan_from_reg8(1, 0)); 7558c2ecf20Sopenharmony_ci } else { 7568c2ecf20Sopenharmony_ci /* 7578c2ecf20Sopenharmony_ci * Automatically pick the best divider, i.e. the one such 7588c2ecf20Sopenharmony_ci * that the min limit will correspond to a register value 7598c2ecf20Sopenharmony_ci * in the 96..192 range 7608c2ecf20Sopenharmony_ci */ 7618c2ecf20Sopenharmony_ci new_div = 0; 7628c2ecf20Sopenharmony_ci while (reg > 192 && new_div < 7) { 7638c2ecf20Sopenharmony_ci reg >>= 1; 7648c2ecf20Sopenharmony_ci new_div++; 7658c2ecf20Sopenharmony_ci } 7668c2ecf20Sopenharmony_ci data->fan_min[channel] = reg; 7678c2ecf20Sopenharmony_ci } 7688c2ecf20Sopenharmony_ci 7698c2ecf20Sopenharmony_ci /* 7708c2ecf20Sopenharmony_ci * Write both the fan clock divider (if it changed) and the new 7718c2ecf20Sopenharmony_ci * fan min (unconditionally) 7728c2ecf20Sopenharmony_ci */ 7738c2ecf20Sopenharmony_ci if (new_div != data->fan_div[channel]) { 7748c2ecf20Sopenharmony_ci dev_dbg(dev, "fan%u clock divider changed from %u to %u\n", 7758c2ecf20Sopenharmony_ci channel + 1, div_from_reg(data->fan_div[channel]), 7768c2ecf20Sopenharmony_ci div_from_reg(new_div)); 7778c2ecf20Sopenharmony_ci data->fan_div[channel] = new_div; 7788c2ecf20Sopenharmony_ci w83627ehf_write_fan_div(data, channel); 7798c2ecf20Sopenharmony_ci /* Give the chip time to sample a new speed value */ 7808c2ecf20Sopenharmony_ci data->last_updated = jiffies; 7818c2ecf20Sopenharmony_ci } 7828c2ecf20Sopenharmony_ci 7838c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_FAN_MIN[channel], 7848c2ecf20Sopenharmony_ci data->fan_min[channel]); 7858c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 7868c2ecf20Sopenharmony_ci 7878c2ecf20Sopenharmony_ci return 0; 7888c2ecf20Sopenharmony_ci} 7898c2ecf20Sopenharmony_ci 7908c2ecf20Sopenharmony_ci#define store_temp_reg(addr, reg) \ 7918c2ecf20Sopenharmony_cistatic int \ 7928c2ecf20Sopenharmony_cistore_##reg(struct device *dev, struct w83627ehf_data *data, int channel, \ 7938c2ecf20Sopenharmony_ci long val) \ 7948c2ecf20Sopenharmony_ci{ \ 7958c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); \ 7968c2ecf20Sopenharmony_ci data->reg[channel] = LM75_TEMP_TO_REG(val); \ 7978c2ecf20Sopenharmony_ci w83627ehf_write_temp(data, data->addr[channel], data->reg[channel]); \ 7988c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); \ 7998c2ecf20Sopenharmony_ci return 0; \ 8008c2ecf20Sopenharmony_ci} 8018c2ecf20Sopenharmony_cistore_temp_reg(reg_temp_over, temp_max); 8028c2ecf20Sopenharmony_cistore_temp_reg(reg_temp_hyst, temp_max_hyst); 8038c2ecf20Sopenharmony_ci 8048c2ecf20Sopenharmony_cistatic int 8058c2ecf20Sopenharmony_cistore_temp_offset(struct device *dev, struct w83627ehf_data *data, int channel, 8068c2ecf20Sopenharmony_ci long val) 8078c2ecf20Sopenharmony_ci{ 8088c2ecf20Sopenharmony_ci val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), -128, 127); 8098c2ecf20Sopenharmony_ci 8108c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 8118c2ecf20Sopenharmony_ci data->temp_offset[channel] = val; 8128c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_TEMP_OFFSET[channel], val); 8138c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 8148c2ecf20Sopenharmony_ci return 0; 8158c2ecf20Sopenharmony_ci} 8168c2ecf20Sopenharmony_ci 8178c2ecf20Sopenharmony_cistatic int 8188c2ecf20Sopenharmony_cistore_pwm_mode(struct device *dev, struct w83627ehf_data *data, int channel, 8198c2ecf20Sopenharmony_ci long val) 8208c2ecf20Sopenharmony_ci{ 8218c2ecf20Sopenharmony_ci u16 reg; 8228c2ecf20Sopenharmony_ci 8238c2ecf20Sopenharmony_ci if (val < 0 || val > 1) 8248c2ecf20Sopenharmony_ci return -EINVAL; 8258c2ecf20Sopenharmony_ci 8268c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 8278c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, W83627EHF_REG_PWM_ENABLE[channel]); 8288c2ecf20Sopenharmony_ci data->pwm_mode[channel] = val; 8298c2ecf20Sopenharmony_ci reg &= ~(1 << W83627EHF_PWM_MODE_SHIFT[channel]); 8308c2ecf20Sopenharmony_ci if (!val) 8318c2ecf20Sopenharmony_ci reg |= 1 << W83627EHF_PWM_MODE_SHIFT[channel]; 8328c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[channel], reg); 8338c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 8348c2ecf20Sopenharmony_ci return 0; 8358c2ecf20Sopenharmony_ci} 8368c2ecf20Sopenharmony_ci 8378c2ecf20Sopenharmony_cistatic int 8388c2ecf20Sopenharmony_cistore_pwm(struct device *dev, struct w83627ehf_data *data, int channel, 8398c2ecf20Sopenharmony_ci long val) 8408c2ecf20Sopenharmony_ci{ 8418c2ecf20Sopenharmony_ci val = clamp_val(val, 0, 255); 8428c2ecf20Sopenharmony_ci 8438c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 8448c2ecf20Sopenharmony_ci data->pwm[channel] = val; 8458c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_PWM[channel], val); 8468c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 8478c2ecf20Sopenharmony_ci return 0; 8488c2ecf20Sopenharmony_ci} 8498c2ecf20Sopenharmony_ci 8508c2ecf20Sopenharmony_cistatic int 8518c2ecf20Sopenharmony_cistore_pwm_enable(struct device *dev, struct w83627ehf_data *data, int channel, 8528c2ecf20Sopenharmony_ci long val) 8538c2ecf20Sopenharmony_ci{ 8548c2ecf20Sopenharmony_ci u16 reg; 8558c2ecf20Sopenharmony_ci 8568c2ecf20Sopenharmony_ci if (!val || val < 0 || 8578c2ecf20Sopenharmony_ci (val > 4 && val != data->pwm_enable_orig[channel])) 8588c2ecf20Sopenharmony_ci return -EINVAL; 8598c2ecf20Sopenharmony_ci 8608c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 8618c2ecf20Sopenharmony_ci data->pwm_enable[channel] = val; 8628c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, 8638c2ecf20Sopenharmony_ci W83627EHF_REG_PWM_ENABLE[channel]); 8648c2ecf20Sopenharmony_ci reg &= ~(0x03 << W83627EHF_PWM_ENABLE_SHIFT[channel]); 8658c2ecf20Sopenharmony_ci reg |= (val - 1) << W83627EHF_PWM_ENABLE_SHIFT[channel]; 8668c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_PWM_ENABLE[channel], 8678c2ecf20Sopenharmony_ci reg); 8688c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 8698c2ecf20Sopenharmony_ci return 0; 8708c2ecf20Sopenharmony_ci} 8718c2ecf20Sopenharmony_ci 8728c2ecf20Sopenharmony_ci#define show_tol_temp(reg) \ 8738c2ecf20Sopenharmony_cistatic ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \ 8748c2ecf20Sopenharmony_ci char *buf) \ 8758c2ecf20Sopenharmony_ci{ \ 8768c2ecf20Sopenharmony_ci struct w83627ehf_data *data = w83627ehf_update_device(dev->parent); \ 8778c2ecf20Sopenharmony_ci struct sensor_device_attribute *sensor_attr = \ 8788c2ecf20Sopenharmony_ci to_sensor_dev_attr(attr); \ 8798c2ecf20Sopenharmony_ci int nr = sensor_attr->index; \ 8808c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", data->reg[nr] * 1000); \ 8818c2ecf20Sopenharmony_ci} 8828c2ecf20Sopenharmony_ci 8838c2ecf20Sopenharmony_cishow_tol_temp(tolerance) 8848c2ecf20Sopenharmony_cishow_tol_temp(target_temp) 8858c2ecf20Sopenharmony_ci 8868c2ecf20Sopenharmony_cistatic ssize_t 8878c2ecf20Sopenharmony_cistore_target_temp(struct device *dev, struct device_attribute *attr, 8888c2ecf20Sopenharmony_ci const char *buf, size_t count) 8898c2ecf20Sopenharmony_ci{ 8908c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 8918c2ecf20Sopenharmony_ci struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 8928c2ecf20Sopenharmony_ci int nr = sensor_attr->index; 8938c2ecf20Sopenharmony_ci long val; 8948c2ecf20Sopenharmony_ci int err; 8958c2ecf20Sopenharmony_ci 8968c2ecf20Sopenharmony_ci err = kstrtol(buf, 10, &val); 8978c2ecf20Sopenharmony_ci if (err < 0) 8988c2ecf20Sopenharmony_ci return err; 8998c2ecf20Sopenharmony_ci 9008c2ecf20Sopenharmony_ci val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, 127); 9018c2ecf20Sopenharmony_ci 9028c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 9038c2ecf20Sopenharmony_ci data->target_temp[nr] = val; 9048c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_TARGET[nr], val); 9058c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 9068c2ecf20Sopenharmony_ci return count; 9078c2ecf20Sopenharmony_ci} 9088c2ecf20Sopenharmony_ci 9098c2ecf20Sopenharmony_cistatic ssize_t 9108c2ecf20Sopenharmony_cistore_tolerance(struct device *dev, struct device_attribute *attr, 9118c2ecf20Sopenharmony_ci const char *buf, size_t count) 9128c2ecf20Sopenharmony_ci{ 9138c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 9148c2ecf20Sopenharmony_ci struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr); 9158c2ecf20Sopenharmony_ci int nr = sensor_attr->index; 9168c2ecf20Sopenharmony_ci u16 reg; 9178c2ecf20Sopenharmony_ci long val; 9188c2ecf20Sopenharmony_ci int err; 9198c2ecf20Sopenharmony_ci 9208c2ecf20Sopenharmony_ci err = kstrtol(buf, 10, &val); 9218c2ecf20Sopenharmony_ci if (err < 0) 9228c2ecf20Sopenharmony_ci return err; 9238c2ecf20Sopenharmony_ci 9248c2ecf20Sopenharmony_ci /* Limit the temp to 0C - 15C */ 9258c2ecf20Sopenharmony_ci val = clamp_val(DIV_ROUND_CLOSEST(val, 1000), 0, 15); 9268c2ecf20Sopenharmony_ci 9278c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 9288c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, W83627EHF_REG_TOLERANCE[nr]); 9298c2ecf20Sopenharmony_ci if (nr == 1) 9308c2ecf20Sopenharmony_ci reg = (reg & 0x0f) | (val << 4); 9318c2ecf20Sopenharmony_ci else 9328c2ecf20Sopenharmony_ci reg = (reg & 0xf0) | val; 9338c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_TOLERANCE[nr], reg); 9348c2ecf20Sopenharmony_ci data->tolerance[nr] = val; 9358c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 9368c2ecf20Sopenharmony_ci return count; 9378c2ecf20Sopenharmony_ci} 9388c2ecf20Sopenharmony_ci 9398c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm1_target, 0644, show_target_temp, 9408c2ecf20Sopenharmony_ci store_target_temp, 0); 9418c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm2_target, 0644, show_target_temp, 9428c2ecf20Sopenharmony_ci store_target_temp, 1); 9438c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm3_target, 0644, show_target_temp, 9448c2ecf20Sopenharmony_ci store_target_temp, 2); 9458c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm4_target, 0644, show_target_temp, 9468c2ecf20Sopenharmony_ci store_target_temp, 3); 9478c2ecf20Sopenharmony_ci 9488c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm1_tolerance, 0644, show_tolerance, 9498c2ecf20Sopenharmony_ci store_tolerance, 0); 9508c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm2_tolerance, 0644, show_tolerance, 9518c2ecf20Sopenharmony_ci store_tolerance, 1); 9528c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm3_tolerance, 0644, show_tolerance, 9538c2ecf20Sopenharmony_ci store_tolerance, 2); 9548c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm4_tolerance, 0644, show_tolerance, 9558c2ecf20Sopenharmony_ci store_tolerance, 3); 9568c2ecf20Sopenharmony_ci 9578c2ecf20Sopenharmony_ci/* Smart Fan registers */ 9588c2ecf20Sopenharmony_ci 9598c2ecf20Sopenharmony_ci#define fan_functions(reg, REG) \ 9608c2ecf20Sopenharmony_cistatic ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \ 9618c2ecf20Sopenharmony_ci char *buf) \ 9628c2ecf20Sopenharmony_ci{ \ 9638c2ecf20Sopenharmony_ci struct w83627ehf_data *data = w83627ehf_update_device(dev->parent); \ 9648c2ecf20Sopenharmony_ci struct sensor_device_attribute *sensor_attr = \ 9658c2ecf20Sopenharmony_ci to_sensor_dev_attr(attr); \ 9668c2ecf20Sopenharmony_ci int nr = sensor_attr->index; \ 9678c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", data->reg[nr]); \ 9688c2ecf20Sopenharmony_ci} \ 9698c2ecf20Sopenharmony_cistatic ssize_t \ 9708c2ecf20Sopenharmony_cistore_##reg(struct device *dev, struct device_attribute *attr, \ 9718c2ecf20Sopenharmony_ci const char *buf, size_t count) \ 9728c2ecf20Sopenharmony_ci{ \ 9738c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); \ 9748c2ecf20Sopenharmony_ci struct sensor_device_attribute *sensor_attr = \ 9758c2ecf20Sopenharmony_ci to_sensor_dev_attr(attr); \ 9768c2ecf20Sopenharmony_ci int nr = sensor_attr->index; \ 9778c2ecf20Sopenharmony_ci unsigned long val; \ 9788c2ecf20Sopenharmony_ci int err; \ 9798c2ecf20Sopenharmony_ci err = kstrtoul(buf, 10, &val); \ 9808c2ecf20Sopenharmony_ci if (err < 0) \ 9818c2ecf20Sopenharmony_ci return err; \ 9828c2ecf20Sopenharmony_ci val = clamp_val(val, 1, 255); \ 9838c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); \ 9848c2ecf20Sopenharmony_ci data->reg[nr] = val; \ 9858c2ecf20Sopenharmony_ci w83627ehf_write_value(data, REG[nr], val); \ 9868c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); \ 9878c2ecf20Sopenharmony_ci return count; \ 9888c2ecf20Sopenharmony_ci} 9898c2ecf20Sopenharmony_ci 9908c2ecf20Sopenharmony_cifan_functions(fan_start_output, W83627EHF_REG_FAN_START_OUTPUT) 9918c2ecf20Sopenharmony_cifan_functions(fan_stop_output, W83627EHF_REG_FAN_STOP_OUTPUT) 9928c2ecf20Sopenharmony_cifan_functions(fan_max_output, data->REG_FAN_MAX_OUTPUT) 9938c2ecf20Sopenharmony_cifan_functions(fan_step_output, data->REG_FAN_STEP_OUTPUT) 9948c2ecf20Sopenharmony_ci 9958c2ecf20Sopenharmony_ci#define fan_time_functions(reg, REG) \ 9968c2ecf20Sopenharmony_cistatic ssize_t show_##reg(struct device *dev, struct device_attribute *attr, \ 9978c2ecf20Sopenharmony_ci char *buf) \ 9988c2ecf20Sopenharmony_ci{ \ 9998c2ecf20Sopenharmony_ci struct w83627ehf_data *data = w83627ehf_update_device(dev->parent); \ 10008c2ecf20Sopenharmony_ci struct sensor_device_attribute *sensor_attr = \ 10018c2ecf20Sopenharmony_ci to_sensor_dev_attr(attr); \ 10028c2ecf20Sopenharmony_ci int nr = sensor_attr->index; \ 10038c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", \ 10048c2ecf20Sopenharmony_ci step_time_from_reg(data->reg[nr], \ 10058c2ecf20Sopenharmony_ci data->pwm_mode[nr])); \ 10068c2ecf20Sopenharmony_ci} \ 10078c2ecf20Sopenharmony_ci\ 10088c2ecf20Sopenharmony_cistatic ssize_t \ 10098c2ecf20Sopenharmony_cistore_##reg(struct device *dev, struct device_attribute *attr, \ 10108c2ecf20Sopenharmony_ci const char *buf, size_t count) \ 10118c2ecf20Sopenharmony_ci{ \ 10128c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); \ 10138c2ecf20Sopenharmony_ci struct sensor_device_attribute *sensor_attr = \ 10148c2ecf20Sopenharmony_ci to_sensor_dev_attr(attr); \ 10158c2ecf20Sopenharmony_ci int nr = sensor_attr->index; \ 10168c2ecf20Sopenharmony_ci unsigned long val; \ 10178c2ecf20Sopenharmony_ci int err; \ 10188c2ecf20Sopenharmony_ci err = kstrtoul(buf, 10, &val); \ 10198c2ecf20Sopenharmony_ci if (err < 0) \ 10208c2ecf20Sopenharmony_ci return err; \ 10218c2ecf20Sopenharmony_ci val = step_time_to_reg(val, data->pwm_mode[nr]); \ 10228c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); \ 10238c2ecf20Sopenharmony_ci data->reg[nr] = val; \ 10248c2ecf20Sopenharmony_ci w83627ehf_write_value(data, REG[nr], val); \ 10258c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); \ 10268c2ecf20Sopenharmony_ci return count; \ 10278c2ecf20Sopenharmony_ci} \ 10288c2ecf20Sopenharmony_ci 10298c2ecf20Sopenharmony_cifan_time_functions(fan_stop_time, W83627EHF_REG_FAN_STOP_TIME) 10308c2ecf20Sopenharmony_ci 10318c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm4_stop_time, 0644, show_fan_stop_time, 10328c2ecf20Sopenharmony_ci store_fan_stop_time, 3); 10338c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm4_start_output, 0644, show_fan_start_output, 10348c2ecf20Sopenharmony_ci store_fan_start_output, 3); 10358c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm4_stop_output, 0644, show_fan_stop_output, 10368c2ecf20Sopenharmony_ci store_fan_stop_output, 3); 10378c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm4_max_output, 0644, show_fan_max_output, 10388c2ecf20Sopenharmony_ci store_fan_max_output, 3); 10398c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm4_step_output, 0644, show_fan_step_output, 10408c2ecf20Sopenharmony_ci store_fan_step_output, 3); 10418c2ecf20Sopenharmony_ci 10428c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm3_stop_time, 0644, show_fan_stop_time, 10438c2ecf20Sopenharmony_ci store_fan_stop_time, 2); 10448c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm3_start_output, 0644, show_fan_start_output, 10458c2ecf20Sopenharmony_ci store_fan_start_output, 2); 10468c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm3_stop_output, 0644, show_fan_stop_output, 10478c2ecf20Sopenharmony_ci store_fan_stop_output, 2); 10488c2ecf20Sopenharmony_ci 10498c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm1_stop_time, 0644, show_fan_stop_time, 10508c2ecf20Sopenharmony_ci store_fan_stop_time, 0); 10518c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm2_stop_time, 0644, show_fan_stop_time, 10528c2ecf20Sopenharmony_ci store_fan_stop_time, 1); 10538c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm1_start_output, 0644, show_fan_start_output, 10548c2ecf20Sopenharmony_ci store_fan_start_output, 0); 10558c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm2_start_output, 0644, show_fan_start_output, 10568c2ecf20Sopenharmony_ci store_fan_start_output, 1); 10578c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm1_stop_output, 0644, show_fan_stop_output, 10588c2ecf20Sopenharmony_ci store_fan_stop_output, 0); 10598c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm2_stop_output, 0644, show_fan_stop_output, 10608c2ecf20Sopenharmony_ci store_fan_stop_output, 1); 10618c2ecf20Sopenharmony_ci 10628c2ecf20Sopenharmony_ci 10638c2ecf20Sopenharmony_ci/* 10648c2ecf20Sopenharmony_ci * pwm1 and pwm3 don't support max and step settings on all chips. 10658c2ecf20Sopenharmony_ci * Need to check support while generating/removing attribute files. 10668c2ecf20Sopenharmony_ci */ 10678c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm1_max_output, 0644, show_fan_max_output, 10688c2ecf20Sopenharmony_ci store_fan_max_output, 0); 10698c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm1_step_output, 0644, show_fan_step_output, 10708c2ecf20Sopenharmony_ci store_fan_step_output, 0); 10718c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm2_max_output, 0644, show_fan_max_output, 10728c2ecf20Sopenharmony_ci store_fan_max_output, 1); 10738c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm2_step_output, 0644, show_fan_step_output, 10748c2ecf20Sopenharmony_ci store_fan_step_output, 1); 10758c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm3_max_output, 0644, show_fan_max_output, 10768c2ecf20Sopenharmony_ci store_fan_max_output, 2); 10778c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR(pwm3_step_output, 0644, show_fan_step_output, 10788c2ecf20Sopenharmony_ci store_fan_step_output, 2); 10798c2ecf20Sopenharmony_ci 10808c2ecf20Sopenharmony_cistatic ssize_t 10818c2ecf20Sopenharmony_cicpu0_vid_show(struct device *dev, struct device_attribute *attr, char *buf) 10828c2ecf20Sopenharmony_ci{ 10838c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 10848c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm)); 10858c2ecf20Sopenharmony_ci} 10868c2ecf20Sopenharmony_ciDEVICE_ATTR_RO(cpu0_vid); 10878c2ecf20Sopenharmony_ci 10888c2ecf20Sopenharmony_ci 10898c2ecf20Sopenharmony_ci/* Case open detection */ 10908c2ecf20Sopenharmony_cistatic int 10918c2ecf20Sopenharmony_ciclear_caseopen(struct device *dev, struct w83627ehf_data *data, int channel, 10928c2ecf20Sopenharmony_ci long val) 10938c2ecf20Sopenharmony_ci{ 10948c2ecf20Sopenharmony_ci const u16 mask = 0x80; 10958c2ecf20Sopenharmony_ci u16 reg; 10968c2ecf20Sopenharmony_ci 10978c2ecf20Sopenharmony_ci if (val != 0 || channel != 0) 10988c2ecf20Sopenharmony_ci return -EINVAL; 10998c2ecf20Sopenharmony_ci 11008c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 11018c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, W83627EHF_REG_CASEOPEN_CLR); 11028c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg | mask); 11038c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_CASEOPEN_CLR, reg & ~mask); 11048c2ecf20Sopenharmony_ci data->valid = 0; /* Force cache refresh */ 11058c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 11068c2ecf20Sopenharmony_ci 11078c2ecf20Sopenharmony_ci return 0; 11088c2ecf20Sopenharmony_ci} 11098c2ecf20Sopenharmony_ci 11108c2ecf20Sopenharmony_cistatic umode_t w83627ehf_attrs_visible(struct kobject *kobj, 11118c2ecf20Sopenharmony_ci struct attribute *a, int n) 11128c2ecf20Sopenharmony_ci{ 11138c2ecf20Sopenharmony_ci struct device *dev = container_of(kobj, struct device, kobj); 11148c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 11158c2ecf20Sopenharmony_ci struct device_attribute *devattr; 11168c2ecf20Sopenharmony_ci struct sensor_device_attribute *sda; 11178c2ecf20Sopenharmony_ci 11188c2ecf20Sopenharmony_ci devattr = container_of(a, struct device_attribute, attr); 11198c2ecf20Sopenharmony_ci 11208c2ecf20Sopenharmony_ci /* Not sensor */ 11218c2ecf20Sopenharmony_ci if (devattr->show == cpu0_vid_show && data->have_vid) 11228c2ecf20Sopenharmony_ci return a->mode; 11238c2ecf20Sopenharmony_ci 11248c2ecf20Sopenharmony_ci sda = (struct sensor_device_attribute *)devattr; 11258c2ecf20Sopenharmony_ci 11268c2ecf20Sopenharmony_ci if (sda->index < 2 && 11278c2ecf20Sopenharmony_ci (devattr->show == show_fan_stop_time || 11288c2ecf20Sopenharmony_ci devattr->show == show_fan_start_output || 11298c2ecf20Sopenharmony_ci devattr->show == show_fan_stop_output)) 11308c2ecf20Sopenharmony_ci return a->mode; 11318c2ecf20Sopenharmony_ci 11328c2ecf20Sopenharmony_ci if (sda->index < 3 && 11338c2ecf20Sopenharmony_ci (devattr->show == show_fan_max_output || 11348c2ecf20Sopenharmony_ci devattr->show == show_fan_step_output) && 11358c2ecf20Sopenharmony_ci data->REG_FAN_STEP_OUTPUT && 11368c2ecf20Sopenharmony_ci data->REG_FAN_STEP_OUTPUT[sda->index] != 0xff) 11378c2ecf20Sopenharmony_ci return a->mode; 11388c2ecf20Sopenharmony_ci 11398c2ecf20Sopenharmony_ci /* if fan3 and fan4 are enabled create the files for them */ 11408c2ecf20Sopenharmony_ci if (sda->index == 2 && 11418c2ecf20Sopenharmony_ci (data->has_fan & (1 << 2)) && data->pwm_num >= 3 && 11428c2ecf20Sopenharmony_ci (devattr->show == show_fan_stop_time || 11438c2ecf20Sopenharmony_ci devattr->show == show_fan_start_output || 11448c2ecf20Sopenharmony_ci devattr->show == show_fan_stop_output)) 11458c2ecf20Sopenharmony_ci return a->mode; 11468c2ecf20Sopenharmony_ci 11478c2ecf20Sopenharmony_ci if (sda->index == 3 && 11488c2ecf20Sopenharmony_ci (data->has_fan & (1 << 3)) && data->pwm_num >= 4 && 11498c2ecf20Sopenharmony_ci (devattr->show == show_fan_stop_time || 11508c2ecf20Sopenharmony_ci devattr->show == show_fan_start_output || 11518c2ecf20Sopenharmony_ci devattr->show == show_fan_stop_output || 11528c2ecf20Sopenharmony_ci devattr->show == show_fan_max_output || 11538c2ecf20Sopenharmony_ci devattr->show == show_fan_step_output)) 11548c2ecf20Sopenharmony_ci return a->mode; 11558c2ecf20Sopenharmony_ci 11568c2ecf20Sopenharmony_ci if ((devattr->show == show_target_temp || 11578c2ecf20Sopenharmony_ci devattr->show == show_tolerance) && 11588c2ecf20Sopenharmony_ci (data->has_fan & (1 << sda->index)) && 11598c2ecf20Sopenharmony_ci sda->index < data->pwm_num) 11608c2ecf20Sopenharmony_ci return a->mode; 11618c2ecf20Sopenharmony_ci 11628c2ecf20Sopenharmony_ci return 0; 11638c2ecf20Sopenharmony_ci} 11648c2ecf20Sopenharmony_ci 11658c2ecf20Sopenharmony_ci/* These groups handle non-standard attributes used in this device */ 11668c2ecf20Sopenharmony_cistatic struct attribute *w83627ehf_attrs[] = { 11678c2ecf20Sopenharmony_ci 11688c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm1_stop_time.dev_attr.attr, 11698c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm1_start_output.dev_attr.attr, 11708c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm1_stop_output.dev_attr.attr, 11718c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm1_max_output.dev_attr.attr, 11728c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm1_step_output.dev_attr.attr, 11738c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm1_target.dev_attr.attr, 11748c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm1_tolerance.dev_attr.attr, 11758c2ecf20Sopenharmony_ci 11768c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm2_stop_time.dev_attr.attr, 11778c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm2_start_output.dev_attr.attr, 11788c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm2_stop_output.dev_attr.attr, 11798c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm2_max_output.dev_attr.attr, 11808c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm2_step_output.dev_attr.attr, 11818c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm2_target.dev_attr.attr, 11828c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm2_tolerance.dev_attr.attr, 11838c2ecf20Sopenharmony_ci 11848c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm3_stop_time.dev_attr.attr, 11858c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm3_start_output.dev_attr.attr, 11868c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm3_stop_output.dev_attr.attr, 11878c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm3_max_output.dev_attr.attr, 11888c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm3_step_output.dev_attr.attr, 11898c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm3_target.dev_attr.attr, 11908c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm3_tolerance.dev_attr.attr, 11918c2ecf20Sopenharmony_ci 11928c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm4_stop_time.dev_attr.attr, 11938c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm4_start_output.dev_attr.attr, 11948c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm4_stop_output.dev_attr.attr, 11958c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm4_max_output.dev_attr.attr, 11968c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm4_step_output.dev_attr.attr, 11978c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm4_target.dev_attr.attr, 11988c2ecf20Sopenharmony_ci &sensor_dev_attr_pwm4_tolerance.dev_attr.attr, 11998c2ecf20Sopenharmony_ci 12008c2ecf20Sopenharmony_ci &dev_attr_cpu0_vid.attr, 12018c2ecf20Sopenharmony_ci NULL 12028c2ecf20Sopenharmony_ci}; 12038c2ecf20Sopenharmony_ci 12048c2ecf20Sopenharmony_cistatic const struct attribute_group w83627ehf_group = { 12058c2ecf20Sopenharmony_ci .attrs = w83627ehf_attrs, 12068c2ecf20Sopenharmony_ci .is_visible = w83627ehf_attrs_visible, 12078c2ecf20Sopenharmony_ci}; 12088c2ecf20Sopenharmony_ci 12098c2ecf20Sopenharmony_cistatic const struct attribute_group *w83627ehf_groups[] = { 12108c2ecf20Sopenharmony_ci &w83627ehf_group, 12118c2ecf20Sopenharmony_ci NULL 12128c2ecf20Sopenharmony_ci}; 12138c2ecf20Sopenharmony_ci 12148c2ecf20Sopenharmony_ci/* 12158c2ecf20Sopenharmony_ci * Driver and device management 12168c2ecf20Sopenharmony_ci */ 12178c2ecf20Sopenharmony_ci 12188c2ecf20Sopenharmony_ci/* Get the monitoring functions started */ 12198c2ecf20Sopenharmony_cistatic inline void w83627ehf_init_device(struct w83627ehf_data *data, 12208c2ecf20Sopenharmony_ci enum kinds kind) 12218c2ecf20Sopenharmony_ci{ 12228c2ecf20Sopenharmony_ci int i; 12238c2ecf20Sopenharmony_ci u8 tmp, diode; 12248c2ecf20Sopenharmony_ci 12258c2ecf20Sopenharmony_ci /* Start monitoring is needed */ 12268c2ecf20Sopenharmony_ci tmp = w83627ehf_read_value(data, W83627EHF_REG_CONFIG); 12278c2ecf20Sopenharmony_ci if (!(tmp & 0x01)) 12288c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_CONFIG, 12298c2ecf20Sopenharmony_ci tmp | 0x01); 12308c2ecf20Sopenharmony_ci 12318c2ecf20Sopenharmony_ci /* Enable temperature sensors if needed */ 12328c2ecf20Sopenharmony_ci for (i = 0; i < NUM_REG_TEMP; i++) { 12338c2ecf20Sopenharmony_ci if (!(data->have_temp & (1 << i))) 12348c2ecf20Sopenharmony_ci continue; 12358c2ecf20Sopenharmony_ci if (!data->reg_temp_config[i]) 12368c2ecf20Sopenharmony_ci continue; 12378c2ecf20Sopenharmony_ci tmp = w83627ehf_read_value(data, 12388c2ecf20Sopenharmony_ci data->reg_temp_config[i]); 12398c2ecf20Sopenharmony_ci if (tmp & 0x01) 12408c2ecf20Sopenharmony_ci w83627ehf_write_value(data, 12418c2ecf20Sopenharmony_ci data->reg_temp_config[i], 12428c2ecf20Sopenharmony_ci tmp & 0xfe); 12438c2ecf20Sopenharmony_ci } 12448c2ecf20Sopenharmony_ci 12458c2ecf20Sopenharmony_ci /* Enable VBAT monitoring if needed */ 12468c2ecf20Sopenharmony_ci tmp = w83627ehf_read_value(data, W83627EHF_REG_VBAT); 12478c2ecf20Sopenharmony_ci if (!(tmp & 0x01)) 12488c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_VBAT, tmp | 0x01); 12498c2ecf20Sopenharmony_ci 12508c2ecf20Sopenharmony_ci /* Get thermal sensor types */ 12518c2ecf20Sopenharmony_ci switch (kind) { 12528c2ecf20Sopenharmony_ci case w83627ehf: 12538c2ecf20Sopenharmony_ci diode = w83627ehf_read_value(data, W83627EHF_REG_DIODE); 12548c2ecf20Sopenharmony_ci break; 12558c2ecf20Sopenharmony_ci case w83627uhg: 12568c2ecf20Sopenharmony_ci diode = 0x00; 12578c2ecf20Sopenharmony_ci break; 12588c2ecf20Sopenharmony_ci default: 12598c2ecf20Sopenharmony_ci diode = 0x70; 12608c2ecf20Sopenharmony_ci } 12618c2ecf20Sopenharmony_ci for (i = 0; i < 3; i++) { 12628c2ecf20Sopenharmony_ci const char *label = NULL; 12638c2ecf20Sopenharmony_ci 12648c2ecf20Sopenharmony_ci if (data->temp_label) 12658c2ecf20Sopenharmony_ci label = data->temp_label[data->temp_src[i]]; 12668c2ecf20Sopenharmony_ci 12678c2ecf20Sopenharmony_ci /* Digital source overrides analog type */ 12688c2ecf20Sopenharmony_ci if (label && strncmp(label, "PECI", 4) == 0) 12698c2ecf20Sopenharmony_ci data->temp_type[i] = 6; 12708c2ecf20Sopenharmony_ci else if (label && strncmp(label, "AMD", 3) == 0) 12718c2ecf20Sopenharmony_ci data->temp_type[i] = 5; 12728c2ecf20Sopenharmony_ci else if ((tmp & (0x02 << i))) 12738c2ecf20Sopenharmony_ci data->temp_type[i] = (diode & (0x10 << i)) ? 1 : 3; 12748c2ecf20Sopenharmony_ci else 12758c2ecf20Sopenharmony_ci data->temp_type[i] = 4; /* thermistor */ 12768c2ecf20Sopenharmony_ci } 12778c2ecf20Sopenharmony_ci} 12788c2ecf20Sopenharmony_ci 12798c2ecf20Sopenharmony_cistatic void 12808c2ecf20Sopenharmony_ciw83627ehf_set_temp_reg_ehf(struct w83627ehf_data *data, int n_temp) 12818c2ecf20Sopenharmony_ci{ 12828c2ecf20Sopenharmony_ci int i; 12838c2ecf20Sopenharmony_ci 12848c2ecf20Sopenharmony_ci for (i = 0; i < n_temp; i++) { 12858c2ecf20Sopenharmony_ci data->reg_temp[i] = W83627EHF_REG_TEMP[i]; 12868c2ecf20Sopenharmony_ci data->reg_temp_over[i] = W83627EHF_REG_TEMP_OVER[i]; 12878c2ecf20Sopenharmony_ci data->reg_temp_hyst[i] = W83627EHF_REG_TEMP_HYST[i]; 12888c2ecf20Sopenharmony_ci data->reg_temp_config[i] = W83627EHF_REG_TEMP_CONFIG[i]; 12898c2ecf20Sopenharmony_ci } 12908c2ecf20Sopenharmony_ci} 12918c2ecf20Sopenharmony_ci 12928c2ecf20Sopenharmony_cistatic void 12938c2ecf20Sopenharmony_ciw83627ehf_check_fan_inputs(const struct w83627ehf_sio_data *sio_data, 12948c2ecf20Sopenharmony_ci struct w83627ehf_data *data) 12958c2ecf20Sopenharmony_ci{ 12968c2ecf20Sopenharmony_ci int fan3pin, fan4pin, fan5pin, regval; 12978c2ecf20Sopenharmony_ci 12988c2ecf20Sopenharmony_ci /* The W83627UHG is simple, only two fan inputs, no config */ 12998c2ecf20Sopenharmony_ci if (sio_data->kind == w83627uhg) { 13008c2ecf20Sopenharmony_ci data->has_fan = 0x03; /* fan1 and fan2 */ 13018c2ecf20Sopenharmony_ci data->has_fan_min = 0x03; 13028c2ecf20Sopenharmony_ci return; 13038c2ecf20Sopenharmony_ci } 13048c2ecf20Sopenharmony_ci 13058c2ecf20Sopenharmony_ci /* fan4 and fan5 share some pins with the GPIO and serial flash */ 13068c2ecf20Sopenharmony_ci if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b) { 13078c2ecf20Sopenharmony_ci fan3pin = 1; 13088c2ecf20Sopenharmony_ci fan4pin = superio_inb(sio_data->sioreg, 0x27) & 0x40; 13098c2ecf20Sopenharmony_ci fan5pin = superio_inb(sio_data->sioreg, 0x27) & 0x20; 13108c2ecf20Sopenharmony_ci } else { 13118c2ecf20Sopenharmony_ci fan3pin = 1; 13128c2ecf20Sopenharmony_ci fan4pin = !(superio_inb(sio_data->sioreg, 0x29) & 0x06); 13138c2ecf20Sopenharmony_ci fan5pin = !(superio_inb(sio_data->sioreg, 0x24) & 0x02); 13148c2ecf20Sopenharmony_ci } 13158c2ecf20Sopenharmony_ci 13168c2ecf20Sopenharmony_ci data->has_fan = data->has_fan_min = 0x03; /* fan1 and fan2 */ 13178c2ecf20Sopenharmony_ci data->has_fan |= (fan3pin << 2); 13188c2ecf20Sopenharmony_ci data->has_fan_min |= (fan3pin << 2); 13198c2ecf20Sopenharmony_ci 13208c2ecf20Sopenharmony_ci /* 13218c2ecf20Sopenharmony_ci * It looks like fan4 and fan5 pins can be alternatively used 13228c2ecf20Sopenharmony_ci * as fan on/off switches, but fan5 control is write only :/ 13238c2ecf20Sopenharmony_ci * We assume that if the serial interface is disabled, designers 13248c2ecf20Sopenharmony_ci * connected fan5 as input unless they are emitting log 1, which 13258c2ecf20Sopenharmony_ci * is not the default. 13268c2ecf20Sopenharmony_ci */ 13278c2ecf20Sopenharmony_ci regval = w83627ehf_read_value(data, W83627EHF_REG_FANDIV1); 13288c2ecf20Sopenharmony_ci if ((regval & (1 << 2)) && fan4pin) { 13298c2ecf20Sopenharmony_ci data->has_fan |= (1 << 3); 13308c2ecf20Sopenharmony_ci data->has_fan_min |= (1 << 3); 13318c2ecf20Sopenharmony_ci } 13328c2ecf20Sopenharmony_ci if (!(regval & (1 << 1)) && fan5pin) { 13338c2ecf20Sopenharmony_ci data->has_fan |= (1 << 4); 13348c2ecf20Sopenharmony_ci data->has_fan_min |= (1 << 4); 13358c2ecf20Sopenharmony_ci } 13368c2ecf20Sopenharmony_ci} 13378c2ecf20Sopenharmony_ci 13388c2ecf20Sopenharmony_cistatic umode_t 13398c2ecf20Sopenharmony_ciw83627ehf_is_visible(const void *drvdata, enum hwmon_sensor_types type, 13408c2ecf20Sopenharmony_ci u32 attr, int channel) 13418c2ecf20Sopenharmony_ci{ 13428c2ecf20Sopenharmony_ci const struct w83627ehf_data *data = drvdata; 13438c2ecf20Sopenharmony_ci 13448c2ecf20Sopenharmony_ci switch (type) { 13458c2ecf20Sopenharmony_ci case hwmon_temp: 13468c2ecf20Sopenharmony_ci /* channel 0.., name 1.. */ 13478c2ecf20Sopenharmony_ci if (!(data->have_temp & (1 << channel))) 13488c2ecf20Sopenharmony_ci return 0; 13498c2ecf20Sopenharmony_ci if (attr == hwmon_temp_input) 13508c2ecf20Sopenharmony_ci return 0444; 13518c2ecf20Sopenharmony_ci if (attr == hwmon_temp_label) { 13528c2ecf20Sopenharmony_ci if (data->temp_label) 13538c2ecf20Sopenharmony_ci return 0444; 13548c2ecf20Sopenharmony_ci return 0; 13558c2ecf20Sopenharmony_ci } 13568c2ecf20Sopenharmony_ci if (channel == 2 && data->temp3_val_only) 13578c2ecf20Sopenharmony_ci return 0; 13588c2ecf20Sopenharmony_ci if (attr == hwmon_temp_max) { 13598c2ecf20Sopenharmony_ci if (data->reg_temp_over[channel]) 13608c2ecf20Sopenharmony_ci return 0644; 13618c2ecf20Sopenharmony_ci else 13628c2ecf20Sopenharmony_ci return 0; 13638c2ecf20Sopenharmony_ci } 13648c2ecf20Sopenharmony_ci if (attr == hwmon_temp_max_hyst) { 13658c2ecf20Sopenharmony_ci if (data->reg_temp_hyst[channel]) 13668c2ecf20Sopenharmony_ci return 0644; 13678c2ecf20Sopenharmony_ci else 13688c2ecf20Sopenharmony_ci return 0; 13698c2ecf20Sopenharmony_ci } 13708c2ecf20Sopenharmony_ci if (channel > 2) 13718c2ecf20Sopenharmony_ci return 0; 13728c2ecf20Sopenharmony_ci if (attr == hwmon_temp_alarm || attr == hwmon_temp_type) 13738c2ecf20Sopenharmony_ci return 0444; 13748c2ecf20Sopenharmony_ci if (attr == hwmon_temp_offset) { 13758c2ecf20Sopenharmony_ci if (data->have_temp_offset & (1 << channel)) 13768c2ecf20Sopenharmony_ci return 0644; 13778c2ecf20Sopenharmony_ci else 13788c2ecf20Sopenharmony_ci return 0; 13798c2ecf20Sopenharmony_ci } 13808c2ecf20Sopenharmony_ci break; 13818c2ecf20Sopenharmony_ci 13828c2ecf20Sopenharmony_ci case hwmon_fan: 13838c2ecf20Sopenharmony_ci /* channel 0.., name 1.. */ 13848c2ecf20Sopenharmony_ci if (!(data->has_fan & (1 << channel))) 13858c2ecf20Sopenharmony_ci return 0; 13868c2ecf20Sopenharmony_ci if (attr == hwmon_fan_input || attr == hwmon_fan_alarm) 13878c2ecf20Sopenharmony_ci return 0444; 13888c2ecf20Sopenharmony_ci if (attr == hwmon_fan_div) { 13898c2ecf20Sopenharmony_ci return 0444; 13908c2ecf20Sopenharmony_ci } 13918c2ecf20Sopenharmony_ci if (attr == hwmon_fan_min) { 13928c2ecf20Sopenharmony_ci if (data->has_fan_min & (1 << channel)) 13938c2ecf20Sopenharmony_ci return 0644; 13948c2ecf20Sopenharmony_ci else 13958c2ecf20Sopenharmony_ci return 0; 13968c2ecf20Sopenharmony_ci } 13978c2ecf20Sopenharmony_ci break; 13988c2ecf20Sopenharmony_ci 13998c2ecf20Sopenharmony_ci case hwmon_in: 14008c2ecf20Sopenharmony_ci /* channel 0.., name 0.. */ 14018c2ecf20Sopenharmony_ci if (channel >= data->in_num) 14028c2ecf20Sopenharmony_ci return 0; 14038c2ecf20Sopenharmony_ci if (channel == 6 && data->in6_skip) 14048c2ecf20Sopenharmony_ci return 0; 14058c2ecf20Sopenharmony_ci if (attr == hwmon_in_alarm || attr == hwmon_in_input) 14068c2ecf20Sopenharmony_ci return 0444; 14078c2ecf20Sopenharmony_ci if (attr == hwmon_in_min || attr == hwmon_in_max) 14088c2ecf20Sopenharmony_ci return 0644; 14098c2ecf20Sopenharmony_ci break; 14108c2ecf20Sopenharmony_ci 14118c2ecf20Sopenharmony_ci case hwmon_pwm: 14128c2ecf20Sopenharmony_ci /* channel 0.., name 1.. */ 14138c2ecf20Sopenharmony_ci if (!(data->has_fan & (1 << channel)) || 14148c2ecf20Sopenharmony_ci channel >= data->pwm_num) 14158c2ecf20Sopenharmony_ci return 0; 14168c2ecf20Sopenharmony_ci if (attr == hwmon_pwm_mode || attr == hwmon_pwm_enable || 14178c2ecf20Sopenharmony_ci attr == hwmon_pwm_input) 14188c2ecf20Sopenharmony_ci return 0644; 14198c2ecf20Sopenharmony_ci break; 14208c2ecf20Sopenharmony_ci 14218c2ecf20Sopenharmony_ci case hwmon_intrusion: 14228c2ecf20Sopenharmony_ci return 0644; 14238c2ecf20Sopenharmony_ci 14248c2ecf20Sopenharmony_ci default: /* Shouldn't happen */ 14258c2ecf20Sopenharmony_ci return 0; 14268c2ecf20Sopenharmony_ci } 14278c2ecf20Sopenharmony_ci 14288c2ecf20Sopenharmony_ci return 0; /* Shouldn't happen */ 14298c2ecf20Sopenharmony_ci} 14308c2ecf20Sopenharmony_ci 14318c2ecf20Sopenharmony_cistatic int 14328c2ecf20Sopenharmony_ciw83627ehf_do_read_temp(struct w83627ehf_data *data, u32 attr, 14338c2ecf20Sopenharmony_ci int channel, long *val) 14348c2ecf20Sopenharmony_ci{ 14358c2ecf20Sopenharmony_ci switch (attr) { 14368c2ecf20Sopenharmony_ci case hwmon_temp_input: 14378c2ecf20Sopenharmony_ci *val = LM75_TEMP_FROM_REG(data->temp[channel]); 14388c2ecf20Sopenharmony_ci return 0; 14398c2ecf20Sopenharmony_ci case hwmon_temp_max: 14408c2ecf20Sopenharmony_ci *val = LM75_TEMP_FROM_REG(data->temp_max[channel]); 14418c2ecf20Sopenharmony_ci return 0; 14428c2ecf20Sopenharmony_ci case hwmon_temp_max_hyst: 14438c2ecf20Sopenharmony_ci *val = LM75_TEMP_FROM_REG(data->temp_max_hyst[channel]); 14448c2ecf20Sopenharmony_ci return 0; 14458c2ecf20Sopenharmony_ci case hwmon_temp_offset: 14468c2ecf20Sopenharmony_ci *val = data->temp_offset[channel] * 1000; 14478c2ecf20Sopenharmony_ci return 0; 14488c2ecf20Sopenharmony_ci case hwmon_temp_type: 14498c2ecf20Sopenharmony_ci *val = (int)data->temp_type[channel]; 14508c2ecf20Sopenharmony_ci return 0; 14518c2ecf20Sopenharmony_ci case hwmon_temp_alarm: 14528c2ecf20Sopenharmony_ci if (channel < 3) { 14538c2ecf20Sopenharmony_ci int bit[] = { 4, 5, 13 }; 14548c2ecf20Sopenharmony_ci *val = (data->alarms >> bit[channel]) & 1; 14558c2ecf20Sopenharmony_ci return 0; 14568c2ecf20Sopenharmony_ci } 14578c2ecf20Sopenharmony_ci break; 14588c2ecf20Sopenharmony_ci 14598c2ecf20Sopenharmony_ci default: 14608c2ecf20Sopenharmony_ci break; 14618c2ecf20Sopenharmony_ci } 14628c2ecf20Sopenharmony_ci 14638c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 14648c2ecf20Sopenharmony_ci} 14658c2ecf20Sopenharmony_ci 14668c2ecf20Sopenharmony_cistatic int 14678c2ecf20Sopenharmony_ciw83627ehf_do_read_in(struct w83627ehf_data *data, u32 attr, 14688c2ecf20Sopenharmony_ci int channel, long *val) 14698c2ecf20Sopenharmony_ci{ 14708c2ecf20Sopenharmony_ci switch (attr) { 14718c2ecf20Sopenharmony_ci case hwmon_in_input: 14728c2ecf20Sopenharmony_ci *val = in_from_reg(data->in[channel], channel, data->scale_in); 14738c2ecf20Sopenharmony_ci return 0; 14748c2ecf20Sopenharmony_ci case hwmon_in_min: 14758c2ecf20Sopenharmony_ci *val = in_from_reg(data->in_min[channel], channel, 14768c2ecf20Sopenharmony_ci data->scale_in); 14778c2ecf20Sopenharmony_ci return 0; 14788c2ecf20Sopenharmony_ci case hwmon_in_max: 14798c2ecf20Sopenharmony_ci *val = in_from_reg(data->in_max[channel], channel, 14808c2ecf20Sopenharmony_ci data->scale_in); 14818c2ecf20Sopenharmony_ci return 0; 14828c2ecf20Sopenharmony_ci case hwmon_in_alarm: 14838c2ecf20Sopenharmony_ci if (channel < 10) { 14848c2ecf20Sopenharmony_ci int bit[] = { 0, 1, 2, 3, 8, 21, 20, 16, 17, 19 }; 14858c2ecf20Sopenharmony_ci *val = (data->alarms >> bit[channel]) & 1; 14868c2ecf20Sopenharmony_ci return 0; 14878c2ecf20Sopenharmony_ci } 14888c2ecf20Sopenharmony_ci break; 14898c2ecf20Sopenharmony_ci default: 14908c2ecf20Sopenharmony_ci break; 14918c2ecf20Sopenharmony_ci } 14928c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 14938c2ecf20Sopenharmony_ci} 14948c2ecf20Sopenharmony_ci 14958c2ecf20Sopenharmony_cistatic int 14968c2ecf20Sopenharmony_ciw83627ehf_do_read_fan(struct w83627ehf_data *data, u32 attr, 14978c2ecf20Sopenharmony_ci int channel, long *val) 14988c2ecf20Sopenharmony_ci{ 14998c2ecf20Sopenharmony_ci switch (attr) { 15008c2ecf20Sopenharmony_ci case hwmon_fan_input: 15018c2ecf20Sopenharmony_ci *val = data->rpm[channel]; 15028c2ecf20Sopenharmony_ci return 0; 15038c2ecf20Sopenharmony_ci case hwmon_fan_min: 15048c2ecf20Sopenharmony_ci *val = fan_from_reg8(data->fan_min[channel], 15058c2ecf20Sopenharmony_ci data->fan_div[channel]); 15068c2ecf20Sopenharmony_ci return 0; 15078c2ecf20Sopenharmony_ci case hwmon_fan_div: 15088c2ecf20Sopenharmony_ci *val = div_from_reg(data->fan_div[channel]); 15098c2ecf20Sopenharmony_ci return 0; 15108c2ecf20Sopenharmony_ci case hwmon_fan_alarm: 15118c2ecf20Sopenharmony_ci if (channel < 5) { 15128c2ecf20Sopenharmony_ci int bit[] = { 6, 7, 11, 10, 23 }; 15138c2ecf20Sopenharmony_ci *val = (data->alarms >> bit[channel]) & 1; 15148c2ecf20Sopenharmony_ci return 0; 15158c2ecf20Sopenharmony_ci } 15168c2ecf20Sopenharmony_ci break; 15178c2ecf20Sopenharmony_ci default: 15188c2ecf20Sopenharmony_ci break; 15198c2ecf20Sopenharmony_ci } 15208c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 15218c2ecf20Sopenharmony_ci} 15228c2ecf20Sopenharmony_ci 15238c2ecf20Sopenharmony_cistatic int 15248c2ecf20Sopenharmony_ciw83627ehf_do_read_pwm(struct w83627ehf_data *data, u32 attr, 15258c2ecf20Sopenharmony_ci int channel, long *val) 15268c2ecf20Sopenharmony_ci{ 15278c2ecf20Sopenharmony_ci switch (attr) { 15288c2ecf20Sopenharmony_ci case hwmon_pwm_input: 15298c2ecf20Sopenharmony_ci *val = data->pwm[channel]; 15308c2ecf20Sopenharmony_ci return 0; 15318c2ecf20Sopenharmony_ci case hwmon_pwm_enable: 15328c2ecf20Sopenharmony_ci *val = data->pwm_enable[channel]; 15338c2ecf20Sopenharmony_ci return 0; 15348c2ecf20Sopenharmony_ci case hwmon_pwm_mode: 15358c2ecf20Sopenharmony_ci *val = data->pwm_enable[channel]; 15368c2ecf20Sopenharmony_ci return 0; 15378c2ecf20Sopenharmony_ci default: 15388c2ecf20Sopenharmony_ci break; 15398c2ecf20Sopenharmony_ci } 15408c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 15418c2ecf20Sopenharmony_ci} 15428c2ecf20Sopenharmony_ci 15438c2ecf20Sopenharmony_cistatic int 15448c2ecf20Sopenharmony_ciw83627ehf_do_read_intrusion(struct w83627ehf_data *data, u32 attr, 15458c2ecf20Sopenharmony_ci int channel, long *val) 15468c2ecf20Sopenharmony_ci{ 15478c2ecf20Sopenharmony_ci if (attr != hwmon_intrusion_alarm || channel != 0) 15488c2ecf20Sopenharmony_ci return -EOPNOTSUPP; /* shouldn't happen */ 15498c2ecf20Sopenharmony_ci 15508c2ecf20Sopenharmony_ci *val = !!(data->caseopen & 0x10); 15518c2ecf20Sopenharmony_ci return 0; 15528c2ecf20Sopenharmony_ci} 15538c2ecf20Sopenharmony_ci 15548c2ecf20Sopenharmony_cistatic int 15558c2ecf20Sopenharmony_ciw83627ehf_read(struct device *dev, enum hwmon_sensor_types type, 15568c2ecf20Sopenharmony_ci u32 attr, int channel, long *val) 15578c2ecf20Sopenharmony_ci{ 15588c2ecf20Sopenharmony_ci struct w83627ehf_data *data = w83627ehf_update_device(dev->parent); 15598c2ecf20Sopenharmony_ci 15608c2ecf20Sopenharmony_ci switch (type) { 15618c2ecf20Sopenharmony_ci case hwmon_fan: 15628c2ecf20Sopenharmony_ci return w83627ehf_do_read_fan(data, attr, channel, val); 15638c2ecf20Sopenharmony_ci 15648c2ecf20Sopenharmony_ci case hwmon_in: 15658c2ecf20Sopenharmony_ci return w83627ehf_do_read_in(data, attr, channel, val); 15668c2ecf20Sopenharmony_ci 15678c2ecf20Sopenharmony_ci case hwmon_pwm: 15688c2ecf20Sopenharmony_ci return w83627ehf_do_read_pwm(data, attr, channel, val); 15698c2ecf20Sopenharmony_ci 15708c2ecf20Sopenharmony_ci case hwmon_temp: 15718c2ecf20Sopenharmony_ci return w83627ehf_do_read_temp(data, attr, channel, val); 15728c2ecf20Sopenharmony_ci 15738c2ecf20Sopenharmony_ci case hwmon_intrusion: 15748c2ecf20Sopenharmony_ci return w83627ehf_do_read_intrusion(data, attr, channel, val); 15758c2ecf20Sopenharmony_ci 15768c2ecf20Sopenharmony_ci default: 15778c2ecf20Sopenharmony_ci break; 15788c2ecf20Sopenharmony_ci } 15798c2ecf20Sopenharmony_ci 15808c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 15818c2ecf20Sopenharmony_ci} 15828c2ecf20Sopenharmony_ci 15838c2ecf20Sopenharmony_cistatic int 15848c2ecf20Sopenharmony_ciw83627ehf_read_string(struct device *dev, enum hwmon_sensor_types type, 15858c2ecf20Sopenharmony_ci u32 attr, int channel, const char **str) 15868c2ecf20Sopenharmony_ci{ 15878c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 15888c2ecf20Sopenharmony_ci 15898c2ecf20Sopenharmony_ci switch (type) { 15908c2ecf20Sopenharmony_ci case hwmon_temp: 15918c2ecf20Sopenharmony_ci if (attr == hwmon_temp_label) { 15928c2ecf20Sopenharmony_ci *str = data->temp_label[data->temp_src[channel]]; 15938c2ecf20Sopenharmony_ci return 0; 15948c2ecf20Sopenharmony_ci } 15958c2ecf20Sopenharmony_ci break; 15968c2ecf20Sopenharmony_ci 15978c2ecf20Sopenharmony_ci default: 15988c2ecf20Sopenharmony_ci break; 15998c2ecf20Sopenharmony_ci } 16008c2ecf20Sopenharmony_ci /* Nothing else should be read as a string */ 16018c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 16028c2ecf20Sopenharmony_ci} 16038c2ecf20Sopenharmony_ci 16048c2ecf20Sopenharmony_cistatic int 16058c2ecf20Sopenharmony_ciw83627ehf_write(struct device *dev, enum hwmon_sensor_types type, 16068c2ecf20Sopenharmony_ci u32 attr, int channel, long val) 16078c2ecf20Sopenharmony_ci{ 16088c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 16098c2ecf20Sopenharmony_ci 16108c2ecf20Sopenharmony_ci if (type == hwmon_in && attr == hwmon_in_min) 16118c2ecf20Sopenharmony_ci return store_in_min(dev, data, channel, val); 16128c2ecf20Sopenharmony_ci if (type == hwmon_in && attr == hwmon_in_max) 16138c2ecf20Sopenharmony_ci return store_in_max(dev, data, channel, val); 16148c2ecf20Sopenharmony_ci 16158c2ecf20Sopenharmony_ci if (type == hwmon_fan && attr == hwmon_fan_min) 16168c2ecf20Sopenharmony_ci return store_fan_min(dev, data, channel, val); 16178c2ecf20Sopenharmony_ci 16188c2ecf20Sopenharmony_ci if (type == hwmon_temp && attr == hwmon_temp_max) 16198c2ecf20Sopenharmony_ci return store_temp_max(dev, data, channel, val); 16208c2ecf20Sopenharmony_ci if (type == hwmon_temp && attr == hwmon_temp_max_hyst) 16218c2ecf20Sopenharmony_ci return store_temp_max_hyst(dev, data, channel, val); 16228c2ecf20Sopenharmony_ci if (type == hwmon_temp && attr == hwmon_temp_offset) 16238c2ecf20Sopenharmony_ci return store_temp_offset(dev, data, channel, val); 16248c2ecf20Sopenharmony_ci 16258c2ecf20Sopenharmony_ci if (type == hwmon_pwm && attr == hwmon_pwm_mode) 16268c2ecf20Sopenharmony_ci return store_pwm_mode(dev, data, channel, val); 16278c2ecf20Sopenharmony_ci if (type == hwmon_pwm && attr == hwmon_pwm_enable) 16288c2ecf20Sopenharmony_ci return store_pwm_enable(dev, data, channel, val); 16298c2ecf20Sopenharmony_ci if (type == hwmon_pwm && attr == hwmon_pwm_input) 16308c2ecf20Sopenharmony_ci return store_pwm(dev, data, channel, val); 16318c2ecf20Sopenharmony_ci 16328c2ecf20Sopenharmony_ci if (type == hwmon_intrusion && attr == hwmon_intrusion_alarm) 16338c2ecf20Sopenharmony_ci return clear_caseopen(dev, data, channel, val); 16348c2ecf20Sopenharmony_ci 16358c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 16368c2ecf20Sopenharmony_ci} 16378c2ecf20Sopenharmony_ci 16388c2ecf20Sopenharmony_cistatic const struct hwmon_ops w83627ehf_ops = { 16398c2ecf20Sopenharmony_ci .is_visible = w83627ehf_is_visible, 16408c2ecf20Sopenharmony_ci .read = w83627ehf_read, 16418c2ecf20Sopenharmony_ci .read_string = w83627ehf_read_string, 16428c2ecf20Sopenharmony_ci .write = w83627ehf_write, 16438c2ecf20Sopenharmony_ci}; 16448c2ecf20Sopenharmony_ci 16458c2ecf20Sopenharmony_cistatic const struct hwmon_channel_info *w83627ehf_info[] = { 16468c2ecf20Sopenharmony_ci HWMON_CHANNEL_INFO(fan, 16478c2ecf20Sopenharmony_ci HWMON_F_ALARM | HWMON_F_DIV | HWMON_F_INPUT | HWMON_F_MIN, 16488c2ecf20Sopenharmony_ci HWMON_F_ALARM | HWMON_F_DIV | HWMON_F_INPUT | HWMON_F_MIN, 16498c2ecf20Sopenharmony_ci HWMON_F_ALARM | HWMON_F_DIV | HWMON_F_INPUT | HWMON_F_MIN, 16508c2ecf20Sopenharmony_ci HWMON_F_ALARM | HWMON_F_DIV | HWMON_F_INPUT | HWMON_F_MIN, 16518c2ecf20Sopenharmony_ci HWMON_F_ALARM | HWMON_F_DIV | HWMON_F_INPUT | HWMON_F_MIN), 16528c2ecf20Sopenharmony_ci HWMON_CHANNEL_INFO(in, 16538c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16548c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16558c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16568c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16578c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16588c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16598c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16608c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16618c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN, 16628c2ecf20Sopenharmony_ci HWMON_I_ALARM | HWMON_I_INPUT | HWMON_I_MAX | HWMON_I_MIN), 16638c2ecf20Sopenharmony_ci HWMON_CHANNEL_INFO(pwm, 16648c2ecf20Sopenharmony_ci HWMON_PWM_ENABLE | HWMON_PWM_INPUT | HWMON_PWM_MODE, 16658c2ecf20Sopenharmony_ci HWMON_PWM_ENABLE | HWMON_PWM_INPUT | HWMON_PWM_MODE, 16668c2ecf20Sopenharmony_ci HWMON_PWM_ENABLE | HWMON_PWM_INPUT | HWMON_PWM_MODE, 16678c2ecf20Sopenharmony_ci HWMON_PWM_ENABLE | HWMON_PWM_INPUT | HWMON_PWM_MODE), 16688c2ecf20Sopenharmony_ci HWMON_CHANNEL_INFO(temp, 16698c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16708c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16718c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16728c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16738c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16748c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16758c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16768c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16778c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16788c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16798c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16808c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16818c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16828c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16838c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16848c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE, 16858c2ecf20Sopenharmony_ci HWMON_T_ALARM | HWMON_T_INPUT | HWMON_T_LABEL | HWMON_T_MAX | 16868c2ecf20Sopenharmony_ci HWMON_T_MAX_HYST | HWMON_T_OFFSET | HWMON_T_TYPE), 16878c2ecf20Sopenharmony_ci HWMON_CHANNEL_INFO(intrusion, 16888c2ecf20Sopenharmony_ci HWMON_INTRUSION_ALARM), 16898c2ecf20Sopenharmony_ci NULL 16908c2ecf20Sopenharmony_ci}; 16918c2ecf20Sopenharmony_ci 16928c2ecf20Sopenharmony_cistatic const struct hwmon_chip_info w83627ehf_chip_info = { 16938c2ecf20Sopenharmony_ci .ops = &w83627ehf_ops, 16948c2ecf20Sopenharmony_ci .info = w83627ehf_info, 16958c2ecf20Sopenharmony_ci}; 16968c2ecf20Sopenharmony_ci 16978c2ecf20Sopenharmony_cistatic int w83627ehf_probe(struct platform_device *pdev) 16988c2ecf20Sopenharmony_ci{ 16998c2ecf20Sopenharmony_ci struct device *dev = &pdev->dev; 17008c2ecf20Sopenharmony_ci struct w83627ehf_sio_data *sio_data = dev_get_platdata(dev); 17018c2ecf20Sopenharmony_ci struct w83627ehf_data *data; 17028c2ecf20Sopenharmony_ci struct resource *res; 17038c2ecf20Sopenharmony_ci u8 en_vrm10; 17048c2ecf20Sopenharmony_ci int i, err = 0; 17058c2ecf20Sopenharmony_ci struct device *hwmon_dev; 17068c2ecf20Sopenharmony_ci 17078c2ecf20Sopenharmony_ci res = platform_get_resource(pdev, IORESOURCE_IO, 0); 17088c2ecf20Sopenharmony_ci if (!request_region(res->start, IOREGION_LENGTH, DRVNAME)) { 17098c2ecf20Sopenharmony_ci err = -EBUSY; 17108c2ecf20Sopenharmony_ci dev_err(dev, "Failed to request region 0x%lx-0x%lx\n", 17118c2ecf20Sopenharmony_ci (unsigned long)res->start, 17128c2ecf20Sopenharmony_ci (unsigned long)res->start + IOREGION_LENGTH - 1); 17138c2ecf20Sopenharmony_ci goto exit; 17148c2ecf20Sopenharmony_ci } 17158c2ecf20Sopenharmony_ci 17168c2ecf20Sopenharmony_ci data = devm_kzalloc(&pdev->dev, sizeof(struct w83627ehf_data), 17178c2ecf20Sopenharmony_ci GFP_KERNEL); 17188c2ecf20Sopenharmony_ci if (!data) { 17198c2ecf20Sopenharmony_ci err = -ENOMEM; 17208c2ecf20Sopenharmony_ci goto exit_release; 17218c2ecf20Sopenharmony_ci } 17228c2ecf20Sopenharmony_ci 17238c2ecf20Sopenharmony_ci data->addr = res->start; 17248c2ecf20Sopenharmony_ci mutex_init(&data->lock); 17258c2ecf20Sopenharmony_ci mutex_init(&data->update_lock); 17268c2ecf20Sopenharmony_ci data->name = w83627ehf_device_names[sio_data->kind]; 17278c2ecf20Sopenharmony_ci data->bank = 0xff; /* Force initial bank selection */ 17288c2ecf20Sopenharmony_ci platform_set_drvdata(pdev, data); 17298c2ecf20Sopenharmony_ci 17308c2ecf20Sopenharmony_ci /* 627EHG and 627EHF have 10 voltage inputs; 627DHG and 667HG have 9 */ 17318c2ecf20Sopenharmony_ci data->in_num = (sio_data->kind == w83627ehf) ? 10 : 9; 17328c2ecf20Sopenharmony_ci /* 667HG has 3 pwms, and 627UHG has only 2 */ 17338c2ecf20Sopenharmony_ci switch (sio_data->kind) { 17348c2ecf20Sopenharmony_ci default: 17358c2ecf20Sopenharmony_ci data->pwm_num = 4; 17368c2ecf20Sopenharmony_ci break; 17378c2ecf20Sopenharmony_ci case w83667hg: 17388c2ecf20Sopenharmony_ci case w83667hg_b: 17398c2ecf20Sopenharmony_ci data->pwm_num = 3; 17408c2ecf20Sopenharmony_ci break; 17418c2ecf20Sopenharmony_ci case w83627uhg: 17428c2ecf20Sopenharmony_ci data->pwm_num = 2; 17438c2ecf20Sopenharmony_ci break; 17448c2ecf20Sopenharmony_ci } 17458c2ecf20Sopenharmony_ci 17468c2ecf20Sopenharmony_ci /* Default to 3 temperature inputs, code below will adjust as needed */ 17478c2ecf20Sopenharmony_ci data->have_temp = 0x07; 17488c2ecf20Sopenharmony_ci 17498c2ecf20Sopenharmony_ci /* Deal with temperature register setup first. */ 17508c2ecf20Sopenharmony_ci if (sio_data->kind == w83667hg_b) { 17518c2ecf20Sopenharmony_ci u8 reg; 17528c2ecf20Sopenharmony_ci 17538c2ecf20Sopenharmony_ci w83627ehf_set_temp_reg_ehf(data, 4); 17548c2ecf20Sopenharmony_ci 17558c2ecf20Sopenharmony_ci /* 17568c2ecf20Sopenharmony_ci * Temperature sources are selected with bank 0, registers 0x49 17578c2ecf20Sopenharmony_ci * and 0x4a. 17588c2ecf20Sopenharmony_ci */ 17598c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, 0x4a); 17608c2ecf20Sopenharmony_ci data->temp_src[0] = reg >> 5; 17618c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, 0x49); 17628c2ecf20Sopenharmony_ci data->temp_src[1] = reg & 0x07; 17638c2ecf20Sopenharmony_ci data->temp_src[2] = (reg >> 4) & 0x07; 17648c2ecf20Sopenharmony_ci 17658c2ecf20Sopenharmony_ci /* 17668c2ecf20Sopenharmony_ci * W83667HG-B has another temperature register at 0x7e. 17678c2ecf20Sopenharmony_ci * The temperature source is selected with register 0x7d. 17688c2ecf20Sopenharmony_ci * Support it if the source differs from already reported 17698c2ecf20Sopenharmony_ci * sources. 17708c2ecf20Sopenharmony_ci */ 17718c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, 0x7d); 17728c2ecf20Sopenharmony_ci reg &= 0x07; 17738c2ecf20Sopenharmony_ci if (reg != data->temp_src[0] && reg != data->temp_src[1] 17748c2ecf20Sopenharmony_ci && reg != data->temp_src[2]) { 17758c2ecf20Sopenharmony_ci data->temp_src[3] = reg; 17768c2ecf20Sopenharmony_ci data->have_temp |= 1 << 3; 17778c2ecf20Sopenharmony_ci } 17788c2ecf20Sopenharmony_ci 17798c2ecf20Sopenharmony_ci /* 17808c2ecf20Sopenharmony_ci * Chip supports either AUXTIN or VIN3. Try to find out which 17818c2ecf20Sopenharmony_ci * one. 17828c2ecf20Sopenharmony_ci */ 17838c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, W83627EHF_REG_TEMP_CONFIG[2]); 17848c2ecf20Sopenharmony_ci if (data->temp_src[2] == 2 && (reg & 0x01)) 17858c2ecf20Sopenharmony_ci data->have_temp &= ~(1 << 2); 17868c2ecf20Sopenharmony_ci 17878c2ecf20Sopenharmony_ci if ((data->temp_src[2] == 2 && (data->have_temp & (1 << 2))) 17888c2ecf20Sopenharmony_ci || (data->temp_src[3] == 2 && (data->have_temp & (1 << 3)))) 17898c2ecf20Sopenharmony_ci data->in6_skip = 1; 17908c2ecf20Sopenharmony_ci 17918c2ecf20Sopenharmony_ci data->temp_label = w83667hg_b_temp_label; 17928c2ecf20Sopenharmony_ci data->have_temp_offset = data->have_temp & 0x07; 17938c2ecf20Sopenharmony_ci for (i = 0; i < 3; i++) { 17948c2ecf20Sopenharmony_ci if (data->temp_src[i] > 2) 17958c2ecf20Sopenharmony_ci data->have_temp_offset &= ~(1 << i); 17968c2ecf20Sopenharmony_ci } 17978c2ecf20Sopenharmony_ci } else if (sio_data->kind == w83627uhg) { 17988c2ecf20Sopenharmony_ci u8 reg; 17998c2ecf20Sopenharmony_ci 18008c2ecf20Sopenharmony_ci w83627ehf_set_temp_reg_ehf(data, 3); 18018c2ecf20Sopenharmony_ci 18028c2ecf20Sopenharmony_ci /* 18038c2ecf20Sopenharmony_ci * Temperature sources for temp2 and temp3 are selected with 18048c2ecf20Sopenharmony_ci * bank 0, registers 0x49 and 0x4a. 18058c2ecf20Sopenharmony_ci */ 18068c2ecf20Sopenharmony_ci data->temp_src[0] = 0; /* SYSTIN */ 18078c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, 0x49) & 0x07; 18088c2ecf20Sopenharmony_ci /* Adjust to have the same mapping as other source registers */ 18098c2ecf20Sopenharmony_ci if (reg == 0) 18108c2ecf20Sopenharmony_ci data->temp_src[1] = 1; 18118c2ecf20Sopenharmony_ci else if (reg >= 2 && reg <= 5) 18128c2ecf20Sopenharmony_ci data->temp_src[1] = reg + 2; 18138c2ecf20Sopenharmony_ci else /* should never happen */ 18148c2ecf20Sopenharmony_ci data->have_temp &= ~(1 << 1); 18158c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, 0x4a); 18168c2ecf20Sopenharmony_ci data->temp_src[2] = reg >> 5; 18178c2ecf20Sopenharmony_ci 18188c2ecf20Sopenharmony_ci /* 18198c2ecf20Sopenharmony_ci * Skip temp3 if source is invalid or the same as temp1 18208c2ecf20Sopenharmony_ci * or temp2. 18218c2ecf20Sopenharmony_ci */ 18228c2ecf20Sopenharmony_ci if (data->temp_src[2] == 2 || data->temp_src[2] == 3 || 18238c2ecf20Sopenharmony_ci data->temp_src[2] == data->temp_src[0] || 18248c2ecf20Sopenharmony_ci ((data->have_temp & (1 << 1)) && 18258c2ecf20Sopenharmony_ci data->temp_src[2] == data->temp_src[1])) 18268c2ecf20Sopenharmony_ci data->have_temp &= ~(1 << 2); 18278c2ecf20Sopenharmony_ci else 18288c2ecf20Sopenharmony_ci data->temp3_val_only = 1; /* No limit regs */ 18298c2ecf20Sopenharmony_ci 18308c2ecf20Sopenharmony_ci data->in6_skip = 1; /* No VIN3 */ 18318c2ecf20Sopenharmony_ci 18328c2ecf20Sopenharmony_ci data->temp_label = w83667hg_b_temp_label; 18338c2ecf20Sopenharmony_ci data->have_temp_offset = data->have_temp & 0x03; 18348c2ecf20Sopenharmony_ci for (i = 0; i < 3; i++) { 18358c2ecf20Sopenharmony_ci if (data->temp_src[i] > 1) 18368c2ecf20Sopenharmony_ci data->have_temp_offset &= ~(1 << i); 18378c2ecf20Sopenharmony_ci } 18388c2ecf20Sopenharmony_ci } else { 18398c2ecf20Sopenharmony_ci w83627ehf_set_temp_reg_ehf(data, 3); 18408c2ecf20Sopenharmony_ci 18418c2ecf20Sopenharmony_ci /* Temperature sources are fixed */ 18428c2ecf20Sopenharmony_ci 18438c2ecf20Sopenharmony_ci if (sio_data->kind == w83667hg) { 18448c2ecf20Sopenharmony_ci u8 reg; 18458c2ecf20Sopenharmony_ci 18468c2ecf20Sopenharmony_ci /* 18478c2ecf20Sopenharmony_ci * Chip supports either AUXTIN or VIN3. Try to find 18488c2ecf20Sopenharmony_ci * out which one. 18498c2ecf20Sopenharmony_ci */ 18508c2ecf20Sopenharmony_ci reg = w83627ehf_read_value(data, 18518c2ecf20Sopenharmony_ci W83627EHF_REG_TEMP_CONFIG[2]); 18528c2ecf20Sopenharmony_ci if (reg & 0x01) 18538c2ecf20Sopenharmony_ci data->have_temp &= ~(1 << 2); 18548c2ecf20Sopenharmony_ci else 18558c2ecf20Sopenharmony_ci data->in6_skip = 1; 18568c2ecf20Sopenharmony_ci } 18578c2ecf20Sopenharmony_ci data->have_temp_offset = data->have_temp & 0x07; 18588c2ecf20Sopenharmony_ci } 18598c2ecf20Sopenharmony_ci 18608c2ecf20Sopenharmony_ci if (sio_data->kind == w83667hg_b) { 18618c2ecf20Sopenharmony_ci data->REG_FAN_MAX_OUTPUT = 18628c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_MAX_OUTPUT_W83667_B; 18638c2ecf20Sopenharmony_ci data->REG_FAN_STEP_OUTPUT = 18648c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_STEP_OUTPUT_W83667_B; 18658c2ecf20Sopenharmony_ci } else { 18668c2ecf20Sopenharmony_ci data->REG_FAN_MAX_OUTPUT = 18678c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_MAX_OUTPUT_COMMON; 18688c2ecf20Sopenharmony_ci data->REG_FAN_STEP_OUTPUT = 18698c2ecf20Sopenharmony_ci W83627EHF_REG_FAN_STEP_OUTPUT_COMMON; 18708c2ecf20Sopenharmony_ci } 18718c2ecf20Sopenharmony_ci 18728c2ecf20Sopenharmony_ci /* Setup input voltage scaling factors */ 18738c2ecf20Sopenharmony_ci if (sio_data->kind == w83627uhg) 18748c2ecf20Sopenharmony_ci data->scale_in = scale_in_w83627uhg; 18758c2ecf20Sopenharmony_ci else 18768c2ecf20Sopenharmony_ci data->scale_in = scale_in_common; 18778c2ecf20Sopenharmony_ci 18788c2ecf20Sopenharmony_ci /* Initialize the chip */ 18798c2ecf20Sopenharmony_ci w83627ehf_init_device(data, sio_data->kind); 18808c2ecf20Sopenharmony_ci 18818c2ecf20Sopenharmony_ci data->vrm = vid_which_vrm(); 18828c2ecf20Sopenharmony_ci 18838c2ecf20Sopenharmony_ci err = superio_enter(sio_data->sioreg); 18848c2ecf20Sopenharmony_ci if (err) 18858c2ecf20Sopenharmony_ci goto exit_release; 18868c2ecf20Sopenharmony_ci 18878c2ecf20Sopenharmony_ci /* Read VID value */ 18888c2ecf20Sopenharmony_ci if (sio_data->kind == w83667hg || sio_data->kind == w83667hg_b) { 18898c2ecf20Sopenharmony_ci /* 18908c2ecf20Sopenharmony_ci * W83667HG has different pins for VID input and output, so 18918c2ecf20Sopenharmony_ci * we can get the VID input values directly at logical device D 18928c2ecf20Sopenharmony_ci * 0xe3. 18938c2ecf20Sopenharmony_ci */ 18948c2ecf20Sopenharmony_ci superio_select(sio_data->sioreg, W83667HG_LD_VID); 18958c2ecf20Sopenharmony_ci data->vid = superio_inb(sio_data->sioreg, 0xe3); 18968c2ecf20Sopenharmony_ci data->have_vid = true; 18978c2ecf20Sopenharmony_ci } else if (sio_data->kind != w83627uhg) { 18988c2ecf20Sopenharmony_ci superio_select(sio_data->sioreg, W83627EHF_LD_HWM); 18998c2ecf20Sopenharmony_ci if (superio_inb(sio_data->sioreg, SIO_REG_VID_CTRL) & 0x80) { 19008c2ecf20Sopenharmony_ci /* 19018c2ecf20Sopenharmony_ci * Set VID input sensibility if needed. In theory the 19028c2ecf20Sopenharmony_ci * BIOS should have set it, but in practice it's not 19038c2ecf20Sopenharmony_ci * always the case. We only do it for the W83627EHF/EHG 19048c2ecf20Sopenharmony_ci * because the W83627DHG is more complex in this 19058c2ecf20Sopenharmony_ci * respect. 19068c2ecf20Sopenharmony_ci */ 19078c2ecf20Sopenharmony_ci if (sio_data->kind == w83627ehf) { 19088c2ecf20Sopenharmony_ci en_vrm10 = superio_inb(sio_data->sioreg, 19098c2ecf20Sopenharmony_ci SIO_REG_EN_VRM10); 19108c2ecf20Sopenharmony_ci if ((en_vrm10 & 0x08) && data->vrm == 90) { 19118c2ecf20Sopenharmony_ci dev_warn(dev, 19128c2ecf20Sopenharmony_ci "Setting VID input voltage to TTL\n"); 19138c2ecf20Sopenharmony_ci superio_outb(sio_data->sioreg, 19148c2ecf20Sopenharmony_ci SIO_REG_EN_VRM10, 19158c2ecf20Sopenharmony_ci en_vrm10 & ~0x08); 19168c2ecf20Sopenharmony_ci } else if (!(en_vrm10 & 0x08) 19178c2ecf20Sopenharmony_ci && data->vrm == 100) { 19188c2ecf20Sopenharmony_ci dev_warn(dev, 19198c2ecf20Sopenharmony_ci "Setting VID input voltage to VRM10\n"); 19208c2ecf20Sopenharmony_ci superio_outb(sio_data->sioreg, 19218c2ecf20Sopenharmony_ci SIO_REG_EN_VRM10, 19228c2ecf20Sopenharmony_ci en_vrm10 | 0x08); 19238c2ecf20Sopenharmony_ci } 19248c2ecf20Sopenharmony_ci } 19258c2ecf20Sopenharmony_ci 19268c2ecf20Sopenharmony_ci data->vid = superio_inb(sio_data->sioreg, 19278c2ecf20Sopenharmony_ci SIO_REG_VID_DATA); 19288c2ecf20Sopenharmony_ci if (sio_data->kind == w83627ehf) /* 6 VID pins only */ 19298c2ecf20Sopenharmony_ci data->vid &= 0x3f; 19308c2ecf20Sopenharmony_ci data->have_vid = true; 19318c2ecf20Sopenharmony_ci } else { 19328c2ecf20Sopenharmony_ci dev_info(dev, 19338c2ecf20Sopenharmony_ci "VID pins in output mode, CPU VID not available\n"); 19348c2ecf20Sopenharmony_ci } 19358c2ecf20Sopenharmony_ci } 19368c2ecf20Sopenharmony_ci 19378c2ecf20Sopenharmony_ci w83627ehf_check_fan_inputs(sio_data, data); 19388c2ecf20Sopenharmony_ci 19398c2ecf20Sopenharmony_ci superio_exit(sio_data->sioreg); 19408c2ecf20Sopenharmony_ci 19418c2ecf20Sopenharmony_ci /* Read fan clock dividers immediately */ 19428c2ecf20Sopenharmony_ci w83627ehf_update_fan_div(data); 19438c2ecf20Sopenharmony_ci 19448c2ecf20Sopenharmony_ci /* Read pwm data to save original values */ 19458c2ecf20Sopenharmony_ci w83627ehf_update_pwm(data); 19468c2ecf20Sopenharmony_ci for (i = 0; i < data->pwm_num; i++) 19478c2ecf20Sopenharmony_ci data->pwm_enable_orig[i] = data->pwm_enable[i]; 19488c2ecf20Sopenharmony_ci 19498c2ecf20Sopenharmony_ci hwmon_dev = devm_hwmon_device_register_with_info(&pdev->dev, 19508c2ecf20Sopenharmony_ci data->name, 19518c2ecf20Sopenharmony_ci data, 19528c2ecf20Sopenharmony_ci &w83627ehf_chip_info, 19538c2ecf20Sopenharmony_ci w83627ehf_groups); 19548c2ecf20Sopenharmony_ci if (IS_ERR(hwmon_dev)) { 19558c2ecf20Sopenharmony_ci err = PTR_ERR(hwmon_dev); 19568c2ecf20Sopenharmony_ci goto exit_release; 19578c2ecf20Sopenharmony_ci } 19588c2ecf20Sopenharmony_ci 19598c2ecf20Sopenharmony_ci return 0; 19608c2ecf20Sopenharmony_ci 19618c2ecf20Sopenharmony_ciexit_release: 19628c2ecf20Sopenharmony_ci release_region(res->start, IOREGION_LENGTH); 19638c2ecf20Sopenharmony_ciexit: 19648c2ecf20Sopenharmony_ci return err; 19658c2ecf20Sopenharmony_ci} 19668c2ecf20Sopenharmony_ci 19678c2ecf20Sopenharmony_cistatic int w83627ehf_remove(struct platform_device *pdev) 19688c2ecf20Sopenharmony_ci{ 19698c2ecf20Sopenharmony_ci struct w83627ehf_data *data = platform_get_drvdata(pdev); 19708c2ecf20Sopenharmony_ci 19718c2ecf20Sopenharmony_ci release_region(data->addr, IOREGION_LENGTH); 19728c2ecf20Sopenharmony_ci 19738c2ecf20Sopenharmony_ci return 0; 19748c2ecf20Sopenharmony_ci} 19758c2ecf20Sopenharmony_ci 19768c2ecf20Sopenharmony_ci#ifdef CONFIG_PM 19778c2ecf20Sopenharmony_cistatic int w83627ehf_suspend(struct device *dev) 19788c2ecf20Sopenharmony_ci{ 19798c2ecf20Sopenharmony_ci struct w83627ehf_data *data = w83627ehf_update_device(dev); 19808c2ecf20Sopenharmony_ci 19818c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 19828c2ecf20Sopenharmony_ci data->vbat = w83627ehf_read_value(data, W83627EHF_REG_VBAT); 19838c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 19848c2ecf20Sopenharmony_ci 19858c2ecf20Sopenharmony_ci return 0; 19868c2ecf20Sopenharmony_ci} 19878c2ecf20Sopenharmony_ci 19888c2ecf20Sopenharmony_cistatic int w83627ehf_resume(struct device *dev) 19898c2ecf20Sopenharmony_ci{ 19908c2ecf20Sopenharmony_ci struct w83627ehf_data *data = dev_get_drvdata(dev); 19918c2ecf20Sopenharmony_ci int i; 19928c2ecf20Sopenharmony_ci 19938c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 19948c2ecf20Sopenharmony_ci data->bank = 0xff; /* Force initial bank selection */ 19958c2ecf20Sopenharmony_ci 19968c2ecf20Sopenharmony_ci /* Restore limits */ 19978c2ecf20Sopenharmony_ci for (i = 0; i < data->in_num; i++) { 19988c2ecf20Sopenharmony_ci if ((i == 6) && data->in6_skip) 19998c2ecf20Sopenharmony_ci continue; 20008c2ecf20Sopenharmony_ci 20018c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_IN_MIN(i), 20028c2ecf20Sopenharmony_ci data->in_min[i]); 20038c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_IN_MAX(i), 20048c2ecf20Sopenharmony_ci data->in_max[i]); 20058c2ecf20Sopenharmony_ci } 20068c2ecf20Sopenharmony_ci 20078c2ecf20Sopenharmony_ci for (i = 0; i < 5; i++) { 20088c2ecf20Sopenharmony_ci if (!(data->has_fan_min & (1 << i))) 20098c2ecf20Sopenharmony_ci continue; 20108c2ecf20Sopenharmony_ci 20118c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_FAN_MIN[i], 20128c2ecf20Sopenharmony_ci data->fan_min[i]); 20138c2ecf20Sopenharmony_ci } 20148c2ecf20Sopenharmony_ci 20158c2ecf20Sopenharmony_ci for (i = 0; i < NUM_REG_TEMP; i++) { 20168c2ecf20Sopenharmony_ci if (!(data->have_temp & (1 << i))) 20178c2ecf20Sopenharmony_ci continue; 20188c2ecf20Sopenharmony_ci 20198c2ecf20Sopenharmony_ci if (data->reg_temp_over[i]) 20208c2ecf20Sopenharmony_ci w83627ehf_write_temp(data, data->reg_temp_over[i], 20218c2ecf20Sopenharmony_ci data->temp_max[i]); 20228c2ecf20Sopenharmony_ci if (data->reg_temp_hyst[i]) 20238c2ecf20Sopenharmony_ci w83627ehf_write_temp(data, data->reg_temp_hyst[i], 20248c2ecf20Sopenharmony_ci data->temp_max_hyst[i]); 20258c2ecf20Sopenharmony_ci if (i > 2) 20268c2ecf20Sopenharmony_ci continue; 20278c2ecf20Sopenharmony_ci if (data->have_temp_offset & (1 << i)) 20288c2ecf20Sopenharmony_ci w83627ehf_write_value(data, 20298c2ecf20Sopenharmony_ci W83627EHF_REG_TEMP_OFFSET[i], 20308c2ecf20Sopenharmony_ci data->temp_offset[i]); 20318c2ecf20Sopenharmony_ci } 20328c2ecf20Sopenharmony_ci 20338c2ecf20Sopenharmony_ci /* Restore other settings */ 20348c2ecf20Sopenharmony_ci w83627ehf_write_value(data, W83627EHF_REG_VBAT, data->vbat); 20358c2ecf20Sopenharmony_ci 20368c2ecf20Sopenharmony_ci /* Force re-reading all values */ 20378c2ecf20Sopenharmony_ci data->valid = 0; 20388c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 20398c2ecf20Sopenharmony_ci 20408c2ecf20Sopenharmony_ci return 0; 20418c2ecf20Sopenharmony_ci} 20428c2ecf20Sopenharmony_ci 20438c2ecf20Sopenharmony_cistatic const struct dev_pm_ops w83627ehf_dev_pm_ops = { 20448c2ecf20Sopenharmony_ci .suspend = w83627ehf_suspend, 20458c2ecf20Sopenharmony_ci .resume = w83627ehf_resume, 20468c2ecf20Sopenharmony_ci .freeze = w83627ehf_suspend, 20478c2ecf20Sopenharmony_ci .restore = w83627ehf_resume, 20488c2ecf20Sopenharmony_ci}; 20498c2ecf20Sopenharmony_ci 20508c2ecf20Sopenharmony_ci#define W83627EHF_DEV_PM_OPS (&w83627ehf_dev_pm_ops) 20518c2ecf20Sopenharmony_ci#else 20528c2ecf20Sopenharmony_ci#define W83627EHF_DEV_PM_OPS NULL 20538c2ecf20Sopenharmony_ci#endif /* CONFIG_PM */ 20548c2ecf20Sopenharmony_ci 20558c2ecf20Sopenharmony_cistatic struct platform_driver w83627ehf_driver = { 20568c2ecf20Sopenharmony_ci .driver = { 20578c2ecf20Sopenharmony_ci .name = DRVNAME, 20588c2ecf20Sopenharmony_ci .pm = W83627EHF_DEV_PM_OPS, 20598c2ecf20Sopenharmony_ci }, 20608c2ecf20Sopenharmony_ci .probe = w83627ehf_probe, 20618c2ecf20Sopenharmony_ci .remove = w83627ehf_remove, 20628c2ecf20Sopenharmony_ci}; 20638c2ecf20Sopenharmony_ci 20648c2ecf20Sopenharmony_ci/* w83627ehf_find() looks for a '627 in the Super-I/O config space */ 20658c2ecf20Sopenharmony_cistatic int __init w83627ehf_find(int sioaddr, unsigned short *addr, 20668c2ecf20Sopenharmony_ci struct w83627ehf_sio_data *sio_data) 20678c2ecf20Sopenharmony_ci{ 20688c2ecf20Sopenharmony_ci static const char sio_name_W83627EHF[] __initconst = "W83627EHF"; 20698c2ecf20Sopenharmony_ci static const char sio_name_W83627EHG[] __initconst = "W83627EHG"; 20708c2ecf20Sopenharmony_ci static const char sio_name_W83627DHG[] __initconst = "W83627DHG"; 20718c2ecf20Sopenharmony_ci static const char sio_name_W83627DHG_P[] __initconst = "W83627DHG-P"; 20728c2ecf20Sopenharmony_ci static const char sio_name_W83627UHG[] __initconst = "W83627UHG"; 20738c2ecf20Sopenharmony_ci static const char sio_name_W83667HG[] __initconst = "W83667HG"; 20748c2ecf20Sopenharmony_ci static const char sio_name_W83667HG_B[] __initconst = "W83667HG-B"; 20758c2ecf20Sopenharmony_ci 20768c2ecf20Sopenharmony_ci u16 val; 20778c2ecf20Sopenharmony_ci const char *sio_name; 20788c2ecf20Sopenharmony_ci int err; 20798c2ecf20Sopenharmony_ci 20808c2ecf20Sopenharmony_ci err = superio_enter(sioaddr); 20818c2ecf20Sopenharmony_ci if (err) 20828c2ecf20Sopenharmony_ci return err; 20838c2ecf20Sopenharmony_ci 20848c2ecf20Sopenharmony_ci if (force_id) 20858c2ecf20Sopenharmony_ci val = force_id; 20868c2ecf20Sopenharmony_ci else 20878c2ecf20Sopenharmony_ci val = (superio_inb(sioaddr, SIO_REG_DEVID) << 8) 20888c2ecf20Sopenharmony_ci | superio_inb(sioaddr, SIO_REG_DEVID + 1); 20898c2ecf20Sopenharmony_ci switch (val & SIO_ID_MASK) { 20908c2ecf20Sopenharmony_ci case SIO_W83627EHF_ID: 20918c2ecf20Sopenharmony_ci sio_data->kind = w83627ehf; 20928c2ecf20Sopenharmony_ci sio_name = sio_name_W83627EHF; 20938c2ecf20Sopenharmony_ci break; 20948c2ecf20Sopenharmony_ci case SIO_W83627EHG_ID: 20958c2ecf20Sopenharmony_ci sio_data->kind = w83627ehf; 20968c2ecf20Sopenharmony_ci sio_name = sio_name_W83627EHG; 20978c2ecf20Sopenharmony_ci break; 20988c2ecf20Sopenharmony_ci case SIO_W83627DHG_ID: 20998c2ecf20Sopenharmony_ci sio_data->kind = w83627dhg; 21008c2ecf20Sopenharmony_ci sio_name = sio_name_W83627DHG; 21018c2ecf20Sopenharmony_ci break; 21028c2ecf20Sopenharmony_ci case SIO_W83627DHG_P_ID: 21038c2ecf20Sopenharmony_ci sio_data->kind = w83627dhg_p; 21048c2ecf20Sopenharmony_ci sio_name = sio_name_W83627DHG_P; 21058c2ecf20Sopenharmony_ci break; 21068c2ecf20Sopenharmony_ci case SIO_W83627UHG_ID: 21078c2ecf20Sopenharmony_ci sio_data->kind = w83627uhg; 21088c2ecf20Sopenharmony_ci sio_name = sio_name_W83627UHG; 21098c2ecf20Sopenharmony_ci break; 21108c2ecf20Sopenharmony_ci case SIO_W83667HG_ID: 21118c2ecf20Sopenharmony_ci sio_data->kind = w83667hg; 21128c2ecf20Sopenharmony_ci sio_name = sio_name_W83667HG; 21138c2ecf20Sopenharmony_ci break; 21148c2ecf20Sopenharmony_ci case SIO_W83667HG_B_ID: 21158c2ecf20Sopenharmony_ci sio_data->kind = w83667hg_b; 21168c2ecf20Sopenharmony_ci sio_name = sio_name_W83667HG_B; 21178c2ecf20Sopenharmony_ci break; 21188c2ecf20Sopenharmony_ci default: 21198c2ecf20Sopenharmony_ci if (val != 0xffff) 21208c2ecf20Sopenharmony_ci pr_debug("unsupported chip ID: 0x%04x\n", val); 21218c2ecf20Sopenharmony_ci superio_exit(sioaddr); 21228c2ecf20Sopenharmony_ci return -ENODEV; 21238c2ecf20Sopenharmony_ci } 21248c2ecf20Sopenharmony_ci 21258c2ecf20Sopenharmony_ci /* We have a known chip, find the HWM I/O address */ 21268c2ecf20Sopenharmony_ci superio_select(sioaddr, W83627EHF_LD_HWM); 21278c2ecf20Sopenharmony_ci val = (superio_inb(sioaddr, SIO_REG_ADDR) << 8) 21288c2ecf20Sopenharmony_ci | superio_inb(sioaddr, SIO_REG_ADDR + 1); 21298c2ecf20Sopenharmony_ci *addr = val & IOREGION_ALIGNMENT; 21308c2ecf20Sopenharmony_ci if (*addr == 0) { 21318c2ecf20Sopenharmony_ci pr_err("Refusing to enable a Super-I/O device with a base I/O port 0\n"); 21328c2ecf20Sopenharmony_ci superio_exit(sioaddr); 21338c2ecf20Sopenharmony_ci return -ENODEV; 21348c2ecf20Sopenharmony_ci } 21358c2ecf20Sopenharmony_ci 21368c2ecf20Sopenharmony_ci /* Activate logical device if needed */ 21378c2ecf20Sopenharmony_ci val = superio_inb(sioaddr, SIO_REG_ENABLE); 21388c2ecf20Sopenharmony_ci if (!(val & 0x01)) { 21398c2ecf20Sopenharmony_ci pr_warn("Forcibly enabling Super-I/O. Sensor is probably unusable.\n"); 21408c2ecf20Sopenharmony_ci superio_outb(sioaddr, SIO_REG_ENABLE, val | 0x01); 21418c2ecf20Sopenharmony_ci } 21428c2ecf20Sopenharmony_ci 21438c2ecf20Sopenharmony_ci superio_exit(sioaddr); 21448c2ecf20Sopenharmony_ci pr_info("Found %s chip at %#x\n", sio_name, *addr); 21458c2ecf20Sopenharmony_ci sio_data->sioreg = sioaddr; 21468c2ecf20Sopenharmony_ci 21478c2ecf20Sopenharmony_ci return 0; 21488c2ecf20Sopenharmony_ci} 21498c2ecf20Sopenharmony_ci 21508c2ecf20Sopenharmony_ci/* 21518c2ecf20Sopenharmony_ci * when Super-I/O functions move to a separate file, the Super-I/O 21528c2ecf20Sopenharmony_ci * bus will manage the lifetime of the device and this module will only keep 21538c2ecf20Sopenharmony_ci * track of the w83627ehf driver. But since we platform_device_alloc(), we 21548c2ecf20Sopenharmony_ci * must keep track of the device 21558c2ecf20Sopenharmony_ci */ 21568c2ecf20Sopenharmony_cistatic struct platform_device *pdev; 21578c2ecf20Sopenharmony_ci 21588c2ecf20Sopenharmony_cistatic int __init sensors_w83627ehf_init(void) 21598c2ecf20Sopenharmony_ci{ 21608c2ecf20Sopenharmony_ci int err; 21618c2ecf20Sopenharmony_ci unsigned short address; 21628c2ecf20Sopenharmony_ci struct resource res; 21638c2ecf20Sopenharmony_ci struct w83627ehf_sio_data sio_data; 21648c2ecf20Sopenharmony_ci 21658c2ecf20Sopenharmony_ci /* 21668c2ecf20Sopenharmony_ci * initialize sio_data->kind and sio_data->sioreg. 21678c2ecf20Sopenharmony_ci * 21688c2ecf20Sopenharmony_ci * when Super-I/O functions move to a separate file, the Super-I/O 21698c2ecf20Sopenharmony_ci * driver will probe 0x2e and 0x4e and auto-detect the presence of a 21708c2ecf20Sopenharmony_ci * w83627ehf hardware monitor, and call probe() 21718c2ecf20Sopenharmony_ci */ 21728c2ecf20Sopenharmony_ci if (w83627ehf_find(0x2e, &address, &sio_data) && 21738c2ecf20Sopenharmony_ci w83627ehf_find(0x4e, &address, &sio_data)) 21748c2ecf20Sopenharmony_ci return -ENODEV; 21758c2ecf20Sopenharmony_ci 21768c2ecf20Sopenharmony_ci err = platform_driver_register(&w83627ehf_driver); 21778c2ecf20Sopenharmony_ci if (err) 21788c2ecf20Sopenharmony_ci goto exit; 21798c2ecf20Sopenharmony_ci 21808c2ecf20Sopenharmony_ci pdev = platform_device_alloc(DRVNAME, address); 21818c2ecf20Sopenharmony_ci if (!pdev) { 21828c2ecf20Sopenharmony_ci err = -ENOMEM; 21838c2ecf20Sopenharmony_ci pr_err("Device allocation failed\n"); 21848c2ecf20Sopenharmony_ci goto exit_unregister; 21858c2ecf20Sopenharmony_ci } 21868c2ecf20Sopenharmony_ci 21878c2ecf20Sopenharmony_ci err = platform_device_add_data(pdev, &sio_data, 21888c2ecf20Sopenharmony_ci sizeof(struct w83627ehf_sio_data)); 21898c2ecf20Sopenharmony_ci if (err) { 21908c2ecf20Sopenharmony_ci pr_err("Platform data allocation failed\n"); 21918c2ecf20Sopenharmony_ci goto exit_device_put; 21928c2ecf20Sopenharmony_ci } 21938c2ecf20Sopenharmony_ci 21948c2ecf20Sopenharmony_ci memset(&res, 0, sizeof(res)); 21958c2ecf20Sopenharmony_ci res.name = DRVNAME; 21968c2ecf20Sopenharmony_ci res.start = address + IOREGION_OFFSET; 21978c2ecf20Sopenharmony_ci res.end = address + IOREGION_OFFSET + IOREGION_LENGTH - 1; 21988c2ecf20Sopenharmony_ci res.flags = IORESOURCE_IO; 21998c2ecf20Sopenharmony_ci 22008c2ecf20Sopenharmony_ci err = acpi_check_resource_conflict(&res); 22018c2ecf20Sopenharmony_ci if (err) 22028c2ecf20Sopenharmony_ci goto exit_device_put; 22038c2ecf20Sopenharmony_ci 22048c2ecf20Sopenharmony_ci err = platform_device_add_resources(pdev, &res, 1); 22058c2ecf20Sopenharmony_ci if (err) { 22068c2ecf20Sopenharmony_ci pr_err("Device resource addition failed (%d)\n", err); 22078c2ecf20Sopenharmony_ci goto exit_device_put; 22088c2ecf20Sopenharmony_ci } 22098c2ecf20Sopenharmony_ci 22108c2ecf20Sopenharmony_ci /* platform_device_add calls probe() */ 22118c2ecf20Sopenharmony_ci err = platform_device_add(pdev); 22128c2ecf20Sopenharmony_ci if (err) { 22138c2ecf20Sopenharmony_ci pr_err("Device addition failed (%d)\n", err); 22148c2ecf20Sopenharmony_ci goto exit_device_put; 22158c2ecf20Sopenharmony_ci } 22168c2ecf20Sopenharmony_ci 22178c2ecf20Sopenharmony_ci return 0; 22188c2ecf20Sopenharmony_ci 22198c2ecf20Sopenharmony_ciexit_device_put: 22208c2ecf20Sopenharmony_ci platform_device_put(pdev); 22218c2ecf20Sopenharmony_ciexit_unregister: 22228c2ecf20Sopenharmony_ci platform_driver_unregister(&w83627ehf_driver); 22238c2ecf20Sopenharmony_ciexit: 22248c2ecf20Sopenharmony_ci return err; 22258c2ecf20Sopenharmony_ci} 22268c2ecf20Sopenharmony_ci 22278c2ecf20Sopenharmony_cistatic void __exit sensors_w83627ehf_exit(void) 22288c2ecf20Sopenharmony_ci{ 22298c2ecf20Sopenharmony_ci platform_device_unregister(pdev); 22308c2ecf20Sopenharmony_ci platform_driver_unregister(&w83627ehf_driver); 22318c2ecf20Sopenharmony_ci} 22328c2ecf20Sopenharmony_ci 22338c2ecf20Sopenharmony_ciMODULE_AUTHOR("Jean Delvare <jdelvare@suse.de>"); 22348c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("W83627EHF driver"); 22358c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 22368c2ecf20Sopenharmony_ci 22378c2ecf20Sopenharmony_cimodule_init(sensors_w83627ehf_init); 22388c2ecf20Sopenharmony_cimodule_exit(sensors_w83627ehf_exit); 2239