18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * lm78.c - Part of lm_sensors, Linux kernel modules for hardware 48c2ecf20Sopenharmony_ci * monitoring 58c2ecf20Sopenharmony_ci * Copyright (c) 1998, 1999 Frodo Looijaard <frodol@dds.nl> 68c2ecf20Sopenharmony_ci * Copyright (c) 2007, 2011 Jean Delvare <jdelvare@suse.de> 78c2ecf20Sopenharmony_ci */ 88c2ecf20Sopenharmony_ci 98c2ecf20Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 108c2ecf20Sopenharmony_ci 118c2ecf20Sopenharmony_ci#include <linux/module.h> 128c2ecf20Sopenharmony_ci#include <linux/init.h> 138c2ecf20Sopenharmony_ci#include <linux/slab.h> 148c2ecf20Sopenharmony_ci#include <linux/jiffies.h> 158c2ecf20Sopenharmony_ci#include <linux/i2c.h> 168c2ecf20Sopenharmony_ci#include <linux/hwmon.h> 178c2ecf20Sopenharmony_ci#include <linux/hwmon-vid.h> 188c2ecf20Sopenharmony_ci#include <linux/hwmon-sysfs.h> 198c2ecf20Sopenharmony_ci#include <linux/err.h> 208c2ecf20Sopenharmony_ci#include <linux/mutex.h> 218c2ecf20Sopenharmony_ci 228c2ecf20Sopenharmony_ci#ifdef CONFIG_ISA 238c2ecf20Sopenharmony_ci#include <linux/platform_device.h> 248c2ecf20Sopenharmony_ci#include <linux/ioport.h> 258c2ecf20Sopenharmony_ci#include <linux/io.h> 268c2ecf20Sopenharmony_ci#endif 278c2ecf20Sopenharmony_ci 288c2ecf20Sopenharmony_ci/* Addresses to scan */ 298c2ecf20Sopenharmony_cistatic const unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 308c2ecf20Sopenharmony_ci 0x2e, 0x2f, I2C_CLIENT_END }; 318c2ecf20Sopenharmony_cienum chips { lm78, lm79 }; 328c2ecf20Sopenharmony_ci 338c2ecf20Sopenharmony_ci/* Many LM78 constants specified below */ 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci/* Length of ISA address segment */ 368c2ecf20Sopenharmony_ci#define LM78_EXTENT 8 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci/* Where are the ISA address/data registers relative to the base address */ 398c2ecf20Sopenharmony_ci#define LM78_ADDR_REG_OFFSET 5 408c2ecf20Sopenharmony_ci#define LM78_DATA_REG_OFFSET 6 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_ci/* The LM78 registers */ 438c2ecf20Sopenharmony_ci#define LM78_REG_IN_MAX(nr) (0x2b + (nr) * 2) 448c2ecf20Sopenharmony_ci#define LM78_REG_IN_MIN(nr) (0x2c + (nr) * 2) 458c2ecf20Sopenharmony_ci#define LM78_REG_IN(nr) (0x20 + (nr)) 468c2ecf20Sopenharmony_ci 478c2ecf20Sopenharmony_ci#define LM78_REG_FAN_MIN(nr) (0x3b + (nr)) 488c2ecf20Sopenharmony_ci#define LM78_REG_FAN(nr) (0x28 + (nr)) 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_ci#define LM78_REG_TEMP 0x27 518c2ecf20Sopenharmony_ci#define LM78_REG_TEMP_OVER 0x39 528c2ecf20Sopenharmony_ci#define LM78_REG_TEMP_HYST 0x3a 538c2ecf20Sopenharmony_ci 548c2ecf20Sopenharmony_ci#define LM78_REG_ALARM1 0x41 558c2ecf20Sopenharmony_ci#define LM78_REG_ALARM2 0x42 568c2ecf20Sopenharmony_ci 578c2ecf20Sopenharmony_ci#define LM78_REG_VID_FANDIV 0x47 588c2ecf20Sopenharmony_ci 598c2ecf20Sopenharmony_ci#define LM78_REG_CONFIG 0x40 608c2ecf20Sopenharmony_ci#define LM78_REG_CHIPID 0x49 618c2ecf20Sopenharmony_ci#define LM78_REG_I2C_ADDR 0x48 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_ci/* 648c2ecf20Sopenharmony_ci * Conversions. Rounding and limit checking is only done on the TO_REG 658c2ecf20Sopenharmony_ci * variants. 668c2ecf20Sopenharmony_ci */ 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci/* 698c2ecf20Sopenharmony_ci * IN: mV (0V to 4.08V) 708c2ecf20Sopenharmony_ci * REG: 16mV/bit 718c2ecf20Sopenharmony_ci */ 728c2ecf20Sopenharmony_cistatic inline u8 IN_TO_REG(unsigned long val) 738c2ecf20Sopenharmony_ci{ 748c2ecf20Sopenharmony_ci unsigned long nval = clamp_val(val, 0, 4080); 758c2ecf20Sopenharmony_ci return (nval + 8) / 16; 768c2ecf20Sopenharmony_ci} 778c2ecf20Sopenharmony_ci#define IN_FROM_REG(val) ((val) * 16) 788c2ecf20Sopenharmony_ci 798c2ecf20Sopenharmony_cistatic inline u8 FAN_TO_REG(long rpm, int div) 808c2ecf20Sopenharmony_ci{ 818c2ecf20Sopenharmony_ci if (rpm <= 0) 828c2ecf20Sopenharmony_ci return 255; 838c2ecf20Sopenharmony_ci if (rpm > 1350000) 848c2ecf20Sopenharmony_ci return 1; 858c2ecf20Sopenharmony_ci return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254); 868c2ecf20Sopenharmony_ci} 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_cistatic inline int FAN_FROM_REG(u8 val, int div) 898c2ecf20Sopenharmony_ci{ 908c2ecf20Sopenharmony_ci return val == 0 ? -1 : val == 255 ? 0 : 1350000 / (val * div); 918c2ecf20Sopenharmony_ci} 928c2ecf20Sopenharmony_ci 938c2ecf20Sopenharmony_ci/* 948c2ecf20Sopenharmony_ci * TEMP: mC (-128C to +127C) 958c2ecf20Sopenharmony_ci * REG: 1C/bit, two's complement 968c2ecf20Sopenharmony_ci */ 978c2ecf20Sopenharmony_cistatic inline s8 TEMP_TO_REG(long val) 988c2ecf20Sopenharmony_ci{ 998c2ecf20Sopenharmony_ci int nval = clamp_val(val, -128000, 127000) ; 1008c2ecf20Sopenharmony_ci return nval < 0 ? (nval - 500) / 1000 : (nval + 500) / 1000; 1018c2ecf20Sopenharmony_ci} 1028c2ecf20Sopenharmony_ci 1038c2ecf20Sopenharmony_cistatic inline int TEMP_FROM_REG(s8 val) 1048c2ecf20Sopenharmony_ci{ 1058c2ecf20Sopenharmony_ci return val * 1000; 1068c2ecf20Sopenharmony_ci} 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_ci#define DIV_FROM_REG(val) (1 << (val)) 1098c2ecf20Sopenharmony_ci 1108c2ecf20Sopenharmony_cistruct lm78_data { 1118c2ecf20Sopenharmony_ci struct i2c_client *client; 1128c2ecf20Sopenharmony_ci struct mutex lock; 1138c2ecf20Sopenharmony_ci enum chips type; 1148c2ecf20Sopenharmony_ci 1158c2ecf20Sopenharmony_ci /* For ISA device only */ 1168c2ecf20Sopenharmony_ci const char *name; 1178c2ecf20Sopenharmony_ci int isa_addr; 1188c2ecf20Sopenharmony_ci 1198c2ecf20Sopenharmony_ci struct mutex update_lock; 1208c2ecf20Sopenharmony_ci char valid; /* !=0 if following fields are valid */ 1218c2ecf20Sopenharmony_ci unsigned long last_updated; /* In jiffies */ 1228c2ecf20Sopenharmony_ci 1238c2ecf20Sopenharmony_ci u8 in[7]; /* Register value */ 1248c2ecf20Sopenharmony_ci u8 in_max[7]; /* Register value */ 1258c2ecf20Sopenharmony_ci u8 in_min[7]; /* Register value */ 1268c2ecf20Sopenharmony_ci u8 fan[3]; /* Register value */ 1278c2ecf20Sopenharmony_ci u8 fan_min[3]; /* Register value */ 1288c2ecf20Sopenharmony_ci s8 temp; /* Register value */ 1298c2ecf20Sopenharmony_ci s8 temp_over; /* Register value */ 1308c2ecf20Sopenharmony_ci s8 temp_hyst; /* Register value */ 1318c2ecf20Sopenharmony_ci u8 fan_div[3]; /* Register encoding, shifted right */ 1328c2ecf20Sopenharmony_ci u8 vid; /* Register encoding, combined */ 1338c2ecf20Sopenharmony_ci u16 alarms; /* Register encoding, combined */ 1348c2ecf20Sopenharmony_ci}; 1358c2ecf20Sopenharmony_ci 1368c2ecf20Sopenharmony_cistatic int lm78_read_value(struct lm78_data *data, u8 reg); 1378c2ecf20Sopenharmony_cistatic int lm78_write_value(struct lm78_data *data, u8 reg, u8 value); 1388c2ecf20Sopenharmony_cistatic struct lm78_data *lm78_update_device(struct device *dev); 1398c2ecf20Sopenharmony_cistatic void lm78_init_device(struct lm78_data *data); 1408c2ecf20Sopenharmony_ci 1418c2ecf20Sopenharmony_ci/* 7 Voltages */ 1428c2ecf20Sopenharmony_cistatic ssize_t in_show(struct device *dev, struct device_attribute *da, 1438c2ecf20Sopenharmony_ci char *buf) 1448c2ecf20Sopenharmony_ci{ 1458c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 1468c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 1478c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", IN_FROM_REG(data->in[attr->index])); 1488c2ecf20Sopenharmony_ci} 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_cistatic ssize_t in_min_show(struct device *dev, struct device_attribute *da, 1518c2ecf20Sopenharmony_ci char *buf) 1528c2ecf20Sopenharmony_ci{ 1538c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 1548c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 1558c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", IN_FROM_REG(data->in_min[attr->index])); 1568c2ecf20Sopenharmony_ci} 1578c2ecf20Sopenharmony_ci 1588c2ecf20Sopenharmony_cistatic ssize_t in_max_show(struct device *dev, struct device_attribute *da, 1598c2ecf20Sopenharmony_ci char *buf) 1608c2ecf20Sopenharmony_ci{ 1618c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 1628c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 1638c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", IN_FROM_REG(data->in_max[attr->index])); 1648c2ecf20Sopenharmony_ci} 1658c2ecf20Sopenharmony_ci 1668c2ecf20Sopenharmony_cistatic ssize_t in_min_store(struct device *dev, struct device_attribute *da, 1678c2ecf20Sopenharmony_ci const char *buf, size_t count) 1688c2ecf20Sopenharmony_ci{ 1698c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 1708c2ecf20Sopenharmony_ci struct lm78_data *data = dev_get_drvdata(dev); 1718c2ecf20Sopenharmony_ci int nr = attr->index; 1728c2ecf20Sopenharmony_ci unsigned long val; 1738c2ecf20Sopenharmony_ci int err; 1748c2ecf20Sopenharmony_ci 1758c2ecf20Sopenharmony_ci err = kstrtoul(buf, 10, &val); 1768c2ecf20Sopenharmony_ci if (err) 1778c2ecf20Sopenharmony_ci return err; 1788c2ecf20Sopenharmony_ci 1798c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 1808c2ecf20Sopenharmony_ci data->in_min[nr] = IN_TO_REG(val); 1818c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_IN_MIN(nr), data->in_min[nr]); 1828c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 1838c2ecf20Sopenharmony_ci return count; 1848c2ecf20Sopenharmony_ci} 1858c2ecf20Sopenharmony_ci 1868c2ecf20Sopenharmony_cistatic ssize_t in_max_store(struct device *dev, struct device_attribute *da, 1878c2ecf20Sopenharmony_ci const char *buf, size_t count) 1888c2ecf20Sopenharmony_ci{ 1898c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 1908c2ecf20Sopenharmony_ci struct lm78_data *data = dev_get_drvdata(dev); 1918c2ecf20Sopenharmony_ci int nr = attr->index; 1928c2ecf20Sopenharmony_ci unsigned long val; 1938c2ecf20Sopenharmony_ci int err; 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci err = kstrtoul(buf, 10, &val); 1968c2ecf20Sopenharmony_ci if (err) 1978c2ecf20Sopenharmony_ci return err; 1988c2ecf20Sopenharmony_ci 1998c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 2008c2ecf20Sopenharmony_ci data->in_max[nr] = IN_TO_REG(val); 2018c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_IN_MAX(nr), data->in_max[nr]); 2028c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 2038c2ecf20Sopenharmony_ci return count; 2048c2ecf20Sopenharmony_ci} 2058c2ecf20Sopenharmony_ci 2068c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in0_input, in, 0); 2078c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in0_min, in_min, 0); 2088c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in0_max, in_max, 0); 2098c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in1_input, in, 1); 2108c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in1_min, in_min, 1); 2118c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in1_max, in_max, 1); 2128c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in2_input, in, 2); 2138c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in2_min, in_min, 2); 2148c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in2_max, in_max, 2); 2158c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in3_input, in, 3); 2168c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in3_min, in_min, 3); 2178c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in3_max, in_max, 3); 2188c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in4_input, in, 4); 2198c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in4_min, in_min, 4); 2208c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in4_max, in_max, 4); 2218c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in5_input, in, 5); 2228c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in5_min, in_min, 5); 2238c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in5_max, in_max, 5); 2248c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in6_input, in, 6); 2258c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in6_min, in_min, 6); 2268c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(in6_max, in_max, 6); 2278c2ecf20Sopenharmony_ci 2288c2ecf20Sopenharmony_ci/* Temperature */ 2298c2ecf20Sopenharmony_cistatic ssize_t temp1_input_show(struct device *dev, 2308c2ecf20Sopenharmony_ci struct device_attribute *da, char *buf) 2318c2ecf20Sopenharmony_ci{ 2328c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 2338c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp)); 2348c2ecf20Sopenharmony_ci} 2358c2ecf20Sopenharmony_ci 2368c2ecf20Sopenharmony_cistatic ssize_t temp1_max_show(struct device *dev, struct device_attribute *da, 2378c2ecf20Sopenharmony_ci char *buf) 2388c2ecf20Sopenharmony_ci{ 2398c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 2408c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_over)); 2418c2ecf20Sopenharmony_ci} 2428c2ecf20Sopenharmony_ci 2438c2ecf20Sopenharmony_cistatic ssize_t temp1_max_store(struct device *dev, 2448c2ecf20Sopenharmony_ci struct device_attribute *da, const char *buf, 2458c2ecf20Sopenharmony_ci size_t count) 2468c2ecf20Sopenharmony_ci{ 2478c2ecf20Sopenharmony_ci struct lm78_data *data = dev_get_drvdata(dev); 2488c2ecf20Sopenharmony_ci long val; 2498c2ecf20Sopenharmony_ci int err; 2508c2ecf20Sopenharmony_ci 2518c2ecf20Sopenharmony_ci err = kstrtol(buf, 10, &val); 2528c2ecf20Sopenharmony_ci if (err) 2538c2ecf20Sopenharmony_ci return err; 2548c2ecf20Sopenharmony_ci 2558c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 2568c2ecf20Sopenharmony_ci data->temp_over = TEMP_TO_REG(val); 2578c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_TEMP_OVER, data->temp_over); 2588c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 2598c2ecf20Sopenharmony_ci return count; 2608c2ecf20Sopenharmony_ci} 2618c2ecf20Sopenharmony_ci 2628c2ecf20Sopenharmony_cistatic ssize_t temp1_max_hyst_show(struct device *dev, 2638c2ecf20Sopenharmony_ci struct device_attribute *da, char *buf) 2648c2ecf20Sopenharmony_ci{ 2658c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 2668c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_hyst)); 2678c2ecf20Sopenharmony_ci} 2688c2ecf20Sopenharmony_ci 2698c2ecf20Sopenharmony_cistatic ssize_t temp1_max_hyst_store(struct device *dev, 2708c2ecf20Sopenharmony_ci struct device_attribute *da, 2718c2ecf20Sopenharmony_ci const char *buf, size_t count) 2728c2ecf20Sopenharmony_ci{ 2738c2ecf20Sopenharmony_ci struct lm78_data *data = dev_get_drvdata(dev); 2748c2ecf20Sopenharmony_ci long val; 2758c2ecf20Sopenharmony_ci int err; 2768c2ecf20Sopenharmony_ci 2778c2ecf20Sopenharmony_ci err = kstrtol(buf, 10, &val); 2788c2ecf20Sopenharmony_ci if (err) 2798c2ecf20Sopenharmony_ci return err; 2808c2ecf20Sopenharmony_ci 2818c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 2828c2ecf20Sopenharmony_ci data->temp_hyst = TEMP_TO_REG(val); 2838c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_TEMP_HYST, data->temp_hyst); 2848c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 2858c2ecf20Sopenharmony_ci return count; 2868c2ecf20Sopenharmony_ci} 2878c2ecf20Sopenharmony_ci 2888c2ecf20Sopenharmony_cistatic DEVICE_ATTR_RO(temp1_input); 2898c2ecf20Sopenharmony_cistatic DEVICE_ATTR_RW(temp1_max); 2908c2ecf20Sopenharmony_cistatic DEVICE_ATTR_RW(temp1_max_hyst); 2918c2ecf20Sopenharmony_ci 2928c2ecf20Sopenharmony_ci/* 3 Fans */ 2938c2ecf20Sopenharmony_cistatic ssize_t fan_show(struct device *dev, struct device_attribute *da, 2948c2ecf20Sopenharmony_ci char *buf) 2958c2ecf20Sopenharmony_ci{ 2968c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 2978c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 2988c2ecf20Sopenharmony_ci int nr = attr->index; 2998c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr], 3008c2ecf20Sopenharmony_ci DIV_FROM_REG(data->fan_div[nr]))); 3018c2ecf20Sopenharmony_ci} 3028c2ecf20Sopenharmony_ci 3038c2ecf20Sopenharmony_cistatic ssize_t fan_min_show(struct device *dev, struct device_attribute *da, 3048c2ecf20Sopenharmony_ci char *buf) 3058c2ecf20Sopenharmony_ci{ 3068c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 3078c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 3088c2ecf20Sopenharmony_ci int nr = attr->index; 3098c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr], 3108c2ecf20Sopenharmony_ci DIV_FROM_REG(data->fan_div[nr]))); 3118c2ecf20Sopenharmony_ci} 3128c2ecf20Sopenharmony_ci 3138c2ecf20Sopenharmony_cistatic ssize_t fan_min_store(struct device *dev, struct device_attribute *da, 3148c2ecf20Sopenharmony_ci const char *buf, size_t count) 3158c2ecf20Sopenharmony_ci{ 3168c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 3178c2ecf20Sopenharmony_ci struct lm78_data *data = dev_get_drvdata(dev); 3188c2ecf20Sopenharmony_ci int nr = attr->index; 3198c2ecf20Sopenharmony_ci unsigned long val; 3208c2ecf20Sopenharmony_ci int err; 3218c2ecf20Sopenharmony_ci 3228c2ecf20Sopenharmony_ci err = kstrtoul(buf, 10, &val); 3238c2ecf20Sopenharmony_ci if (err) 3248c2ecf20Sopenharmony_ci return err; 3258c2ecf20Sopenharmony_ci 3268c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 3278c2ecf20Sopenharmony_ci data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr])); 3288c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_FAN_MIN(nr), data->fan_min[nr]); 3298c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 3308c2ecf20Sopenharmony_ci return count; 3318c2ecf20Sopenharmony_ci} 3328c2ecf20Sopenharmony_ci 3338c2ecf20Sopenharmony_cistatic ssize_t fan_div_show(struct device *dev, struct device_attribute *da, 3348c2ecf20Sopenharmony_ci char *buf) 3358c2ecf20Sopenharmony_ci{ 3368c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 3378c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 3388c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[attr->index])); 3398c2ecf20Sopenharmony_ci} 3408c2ecf20Sopenharmony_ci 3418c2ecf20Sopenharmony_ci/* 3428c2ecf20Sopenharmony_ci * Note: we save and restore the fan minimum here, because its value is 3438c2ecf20Sopenharmony_ci * determined in part by the fan divisor. This follows the principle of 3448c2ecf20Sopenharmony_ci * least surprise; the user doesn't expect the fan minimum to change just 3458c2ecf20Sopenharmony_ci * because the divisor changed. 3468c2ecf20Sopenharmony_ci */ 3478c2ecf20Sopenharmony_cistatic ssize_t fan_div_store(struct device *dev, struct device_attribute *da, 3488c2ecf20Sopenharmony_ci const char *buf, size_t count) 3498c2ecf20Sopenharmony_ci{ 3508c2ecf20Sopenharmony_ci struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 3518c2ecf20Sopenharmony_ci struct lm78_data *data = dev_get_drvdata(dev); 3528c2ecf20Sopenharmony_ci int nr = attr->index; 3538c2ecf20Sopenharmony_ci unsigned long min; 3548c2ecf20Sopenharmony_ci u8 reg; 3558c2ecf20Sopenharmony_ci unsigned long val; 3568c2ecf20Sopenharmony_ci int err; 3578c2ecf20Sopenharmony_ci 3588c2ecf20Sopenharmony_ci err = kstrtoul(buf, 10, &val); 3598c2ecf20Sopenharmony_ci if (err) 3608c2ecf20Sopenharmony_ci return err; 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 3638c2ecf20Sopenharmony_ci min = FAN_FROM_REG(data->fan_min[nr], 3648c2ecf20Sopenharmony_ci DIV_FROM_REG(data->fan_div[nr])); 3658c2ecf20Sopenharmony_ci 3668c2ecf20Sopenharmony_ci switch (val) { 3678c2ecf20Sopenharmony_ci case 1: 3688c2ecf20Sopenharmony_ci data->fan_div[nr] = 0; 3698c2ecf20Sopenharmony_ci break; 3708c2ecf20Sopenharmony_ci case 2: 3718c2ecf20Sopenharmony_ci data->fan_div[nr] = 1; 3728c2ecf20Sopenharmony_ci break; 3738c2ecf20Sopenharmony_ci case 4: 3748c2ecf20Sopenharmony_ci data->fan_div[nr] = 2; 3758c2ecf20Sopenharmony_ci break; 3768c2ecf20Sopenharmony_ci case 8: 3778c2ecf20Sopenharmony_ci data->fan_div[nr] = 3; 3788c2ecf20Sopenharmony_ci break; 3798c2ecf20Sopenharmony_ci default: 3808c2ecf20Sopenharmony_ci dev_err(dev, 3818c2ecf20Sopenharmony_ci "fan_div value %ld not supported. Choose one of 1, 2, 4 or 8!\n", 3828c2ecf20Sopenharmony_ci val); 3838c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 3848c2ecf20Sopenharmony_ci return -EINVAL; 3858c2ecf20Sopenharmony_ci } 3868c2ecf20Sopenharmony_ci 3878c2ecf20Sopenharmony_ci reg = lm78_read_value(data, LM78_REG_VID_FANDIV); 3888c2ecf20Sopenharmony_ci switch (nr) { 3898c2ecf20Sopenharmony_ci case 0: 3908c2ecf20Sopenharmony_ci reg = (reg & 0xcf) | (data->fan_div[nr] << 4); 3918c2ecf20Sopenharmony_ci break; 3928c2ecf20Sopenharmony_ci case 1: 3938c2ecf20Sopenharmony_ci reg = (reg & 0x3f) | (data->fan_div[nr] << 6); 3948c2ecf20Sopenharmony_ci break; 3958c2ecf20Sopenharmony_ci } 3968c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_VID_FANDIV, reg); 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_ci data->fan_min[nr] = 3998c2ecf20Sopenharmony_ci FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr])); 4008c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_FAN_MIN(nr), data->fan_min[nr]); 4018c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 4028c2ecf20Sopenharmony_ci 4038c2ecf20Sopenharmony_ci return count; 4048c2ecf20Sopenharmony_ci} 4058c2ecf20Sopenharmony_ci 4068c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0); 4078c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0); 4088c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1); 4098c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1); 4108c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(fan3_input, fan, 2); 4118c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(fan3_min, fan_min, 2); 4128c2ecf20Sopenharmony_ci 4138c2ecf20Sopenharmony_ci/* Fan 3 divisor is locked in H/W */ 4148c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(fan1_div, fan_div, 0); 4158c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RW(fan2_div, fan_div, 1); 4168c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(fan3_div, fan_div, 2); 4178c2ecf20Sopenharmony_ci 4188c2ecf20Sopenharmony_ci/* VID */ 4198c2ecf20Sopenharmony_cistatic ssize_t cpu0_vid_show(struct device *dev, struct device_attribute *da, 4208c2ecf20Sopenharmony_ci char *buf) 4218c2ecf20Sopenharmony_ci{ 4228c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 4238c2ecf20Sopenharmony_ci return sprintf(buf, "%d\n", vid_from_reg(data->vid, 82)); 4248c2ecf20Sopenharmony_ci} 4258c2ecf20Sopenharmony_cistatic DEVICE_ATTR_RO(cpu0_vid); 4268c2ecf20Sopenharmony_ci 4278c2ecf20Sopenharmony_ci/* Alarms */ 4288c2ecf20Sopenharmony_cistatic ssize_t alarms_show(struct device *dev, struct device_attribute *da, 4298c2ecf20Sopenharmony_ci char *buf) 4308c2ecf20Sopenharmony_ci{ 4318c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 4328c2ecf20Sopenharmony_ci return sprintf(buf, "%u\n", data->alarms); 4338c2ecf20Sopenharmony_ci} 4348c2ecf20Sopenharmony_cistatic DEVICE_ATTR_RO(alarms); 4358c2ecf20Sopenharmony_ci 4368c2ecf20Sopenharmony_cistatic ssize_t alarm_show(struct device *dev, struct device_attribute *da, 4378c2ecf20Sopenharmony_ci char *buf) 4388c2ecf20Sopenharmony_ci{ 4398c2ecf20Sopenharmony_ci struct lm78_data *data = lm78_update_device(dev); 4408c2ecf20Sopenharmony_ci int nr = to_sensor_dev_attr(da)->index; 4418c2ecf20Sopenharmony_ci return sprintf(buf, "%u\n", (data->alarms >> nr) & 1); 4428c2ecf20Sopenharmony_ci} 4438c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in0_alarm, alarm, 0); 4448c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in1_alarm, alarm, 1); 4458c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in2_alarm, alarm, 2); 4468c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in3_alarm, alarm, 3); 4478c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in4_alarm, alarm, 8); 4488c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in5_alarm, alarm, 9); 4498c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(in6_alarm, alarm, 10); 4508c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(fan1_alarm, alarm, 6); 4518c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(fan2_alarm, alarm, 7); 4528c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(fan3_alarm, alarm, 11); 4538c2ecf20Sopenharmony_cistatic SENSOR_DEVICE_ATTR_RO(temp1_alarm, alarm, 4); 4548c2ecf20Sopenharmony_ci 4558c2ecf20Sopenharmony_cistatic struct attribute *lm78_attrs[] = { 4568c2ecf20Sopenharmony_ci &sensor_dev_attr_in0_input.dev_attr.attr, 4578c2ecf20Sopenharmony_ci &sensor_dev_attr_in0_min.dev_attr.attr, 4588c2ecf20Sopenharmony_ci &sensor_dev_attr_in0_max.dev_attr.attr, 4598c2ecf20Sopenharmony_ci &sensor_dev_attr_in0_alarm.dev_attr.attr, 4608c2ecf20Sopenharmony_ci &sensor_dev_attr_in1_input.dev_attr.attr, 4618c2ecf20Sopenharmony_ci &sensor_dev_attr_in1_min.dev_attr.attr, 4628c2ecf20Sopenharmony_ci &sensor_dev_attr_in1_max.dev_attr.attr, 4638c2ecf20Sopenharmony_ci &sensor_dev_attr_in1_alarm.dev_attr.attr, 4648c2ecf20Sopenharmony_ci &sensor_dev_attr_in2_input.dev_attr.attr, 4658c2ecf20Sopenharmony_ci &sensor_dev_attr_in2_min.dev_attr.attr, 4668c2ecf20Sopenharmony_ci &sensor_dev_attr_in2_max.dev_attr.attr, 4678c2ecf20Sopenharmony_ci &sensor_dev_attr_in2_alarm.dev_attr.attr, 4688c2ecf20Sopenharmony_ci &sensor_dev_attr_in3_input.dev_attr.attr, 4698c2ecf20Sopenharmony_ci &sensor_dev_attr_in3_min.dev_attr.attr, 4708c2ecf20Sopenharmony_ci &sensor_dev_attr_in3_max.dev_attr.attr, 4718c2ecf20Sopenharmony_ci &sensor_dev_attr_in3_alarm.dev_attr.attr, 4728c2ecf20Sopenharmony_ci &sensor_dev_attr_in4_input.dev_attr.attr, 4738c2ecf20Sopenharmony_ci &sensor_dev_attr_in4_min.dev_attr.attr, 4748c2ecf20Sopenharmony_ci &sensor_dev_attr_in4_max.dev_attr.attr, 4758c2ecf20Sopenharmony_ci &sensor_dev_attr_in4_alarm.dev_attr.attr, 4768c2ecf20Sopenharmony_ci &sensor_dev_attr_in5_input.dev_attr.attr, 4778c2ecf20Sopenharmony_ci &sensor_dev_attr_in5_min.dev_attr.attr, 4788c2ecf20Sopenharmony_ci &sensor_dev_attr_in5_max.dev_attr.attr, 4798c2ecf20Sopenharmony_ci &sensor_dev_attr_in5_alarm.dev_attr.attr, 4808c2ecf20Sopenharmony_ci &sensor_dev_attr_in6_input.dev_attr.attr, 4818c2ecf20Sopenharmony_ci &sensor_dev_attr_in6_min.dev_attr.attr, 4828c2ecf20Sopenharmony_ci &sensor_dev_attr_in6_max.dev_attr.attr, 4838c2ecf20Sopenharmony_ci &sensor_dev_attr_in6_alarm.dev_attr.attr, 4848c2ecf20Sopenharmony_ci &dev_attr_temp1_input.attr, 4858c2ecf20Sopenharmony_ci &dev_attr_temp1_max.attr, 4868c2ecf20Sopenharmony_ci &dev_attr_temp1_max_hyst.attr, 4878c2ecf20Sopenharmony_ci &sensor_dev_attr_temp1_alarm.dev_attr.attr, 4888c2ecf20Sopenharmony_ci &sensor_dev_attr_fan1_input.dev_attr.attr, 4898c2ecf20Sopenharmony_ci &sensor_dev_attr_fan1_min.dev_attr.attr, 4908c2ecf20Sopenharmony_ci &sensor_dev_attr_fan1_div.dev_attr.attr, 4918c2ecf20Sopenharmony_ci &sensor_dev_attr_fan1_alarm.dev_attr.attr, 4928c2ecf20Sopenharmony_ci &sensor_dev_attr_fan2_input.dev_attr.attr, 4938c2ecf20Sopenharmony_ci &sensor_dev_attr_fan2_min.dev_attr.attr, 4948c2ecf20Sopenharmony_ci &sensor_dev_attr_fan2_div.dev_attr.attr, 4958c2ecf20Sopenharmony_ci &sensor_dev_attr_fan2_alarm.dev_attr.attr, 4968c2ecf20Sopenharmony_ci &sensor_dev_attr_fan3_input.dev_attr.attr, 4978c2ecf20Sopenharmony_ci &sensor_dev_attr_fan3_min.dev_attr.attr, 4988c2ecf20Sopenharmony_ci &sensor_dev_attr_fan3_div.dev_attr.attr, 4998c2ecf20Sopenharmony_ci &sensor_dev_attr_fan3_alarm.dev_attr.attr, 5008c2ecf20Sopenharmony_ci &dev_attr_alarms.attr, 5018c2ecf20Sopenharmony_ci &dev_attr_cpu0_vid.attr, 5028c2ecf20Sopenharmony_ci 5038c2ecf20Sopenharmony_ci NULL 5048c2ecf20Sopenharmony_ci}; 5058c2ecf20Sopenharmony_ci 5068c2ecf20Sopenharmony_ciATTRIBUTE_GROUPS(lm78); 5078c2ecf20Sopenharmony_ci 5088c2ecf20Sopenharmony_ci/* 5098c2ecf20Sopenharmony_ci * ISA related code 5108c2ecf20Sopenharmony_ci */ 5118c2ecf20Sopenharmony_ci#ifdef CONFIG_ISA 5128c2ecf20Sopenharmony_ci 5138c2ecf20Sopenharmony_ci/* ISA device, if found */ 5148c2ecf20Sopenharmony_cistatic struct platform_device *pdev; 5158c2ecf20Sopenharmony_ci 5168c2ecf20Sopenharmony_cistatic unsigned short isa_address = 0x290; 5178c2ecf20Sopenharmony_ci 5188c2ecf20Sopenharmony_cistatic struct lm78_data *lm78_data_if_isa(void) 5198c2ecf20Sopenharmony_ci{ 5208c2ecf20Sopenharmony_ci return pdev ? platform_get_drvdata(pdev) : NULL; 5218c2ecf20Sopenharmony_ci} 5228c2ecf20Sopenharmony_ci 5238c2ecf20Sopenharmony_ci/* Returns 1 if the I2C chip appears to be an alias of the ISA chip */ 5248c2ecf20Sopenharmony_cistatic int lm78_alias_detect(struct i2c_client *client, u8 chipid) 5258c2ecf20Sopenharmony_ci{ 5268c2ecf20Sopenharmony_ci struct lm78_data *isa; 5278c2ecf20Sopenharmony_ci int i; 5288c2ecf20Sopenharmony_ci 5298c2ecf20Sopenharmony_ci if (!pdev) /* No ISA chip */ 5308c2ecf20Sopenharmony_ci return 0; 5318c2ecf20Sopenharmony_ci isa = platform_get_drvdata(pdev); 5328c2ecf20Sopenharmony_ci 5338c2ecf20Sopenharmony_ci if (lm78_read_value(isa, LM78_REG_I2C_ADDR) != client->addr) 5348c2ecf20Sopenharmony_ci return 0; /* Address doesn't match */ 5358c2ecf20Sopenharmony_ci if ((lm78_read_value(isa, LM78_REG_CHIPID) & 0xfe) != (chipid & 0xfe)) 5368c2ecf20Sopenharmony_ci return 0; /* Chip type doesn't match */ 5378c2ecf20Sopenharmony_ci 5388c2ecf20Sopenharmony_ci /* 5398c2ecf20Sopenharmony_ci * We compare all the limit registers, the config register and the 5408c2ecf20Sopenharmony_ci * interrupt mask registers 5418c2ecf20Sopenharmony_ci */ 5428c2ecf20Sopenharmony_ci for (i = 0x2b; i <= 0x3d; i++) { 5438c2ecf20Sopenharmony_ci if (lm78_read_value(isa, i) != 5448c2ecf20Sopenharmony_ci i2c_smbus_read_byte_data(client, i)) 5458c2ecf20Sopenharmony_ci return 0; 5468c2ecf20Sopenharmony_ci } 5478c2ecf20Sopenharmony_ci if (lm78_read_value(isa, LM78_REG_CONFIG) != 5488c2ecf20Sopenharmony_ci i2c_smbus_read_byte_data(client, LM78_REG_CONFIG)) 5498c2ecf20Sopenharmony_ci return 0; 5508c2ecf20Sopenharmony_ci for (i = 0x43; i <= 0x46; i++) { 5518c2ecf20Sopenharmony_ci if (lm78_read_value(isa, i) != 5528c2ecf20Sopenharmony_ci i2c_smbus_read_byte_data(client, i)) 5538c2ecf20Sopenharmony_ci return 0; 5548c2ecf20Sopenharmony_ci } 5558c2ecf20Sopenharmony_ci 5568c2ecf20Sopenharmony_ci return 1; 5578c2ecf20Sopenharmony_ci} 5588c2ecf20Sopenharmony_ci#else /* !CONFIG_ISA */ 5598c2ecf20Sopenharmony_ci 5608c2ecf20Sopenharmony_cistatic int lm78_alias_detect(struct i2c_client *client, u8 chipid) 5618c2ecf20Sopenharmony_ci{ 5628c2ecf20Sopenharmony_ci return 0; 5638c2ecf20Sopenharmony_ci} 5648c2ecf20Sopenharmony_ci 5658c2ecf20Sopenharmony_cistatic struct lm78_data *lm78_data_if_isa(void) 5668c2ecf20Sopenharmony_ci{ 5678c2ecf20Sopenharmony_ci return NULL; 5688c2ecf20Sopenharmony_ci} 5698c2ecf20Sopenharmony_ci#endif /* CONFIG_ISA */ 5708c2ecf20Sopenharmony_ci 5718c2ecf20Sopenharmony_cistatic int lm78_i2c_detect(struct i2c_client *client, 5728c2ecf20Sopenharmony_ci struct i2c_board_info *info) 5738c2ecf20Sopenharmony_ci{ 5748c2ecf20Sopenharmony_ci int i; 5758c2ecf20Sopenharmony_ci struct lm78_data *isa = lm78_data_if_isa(); 5768c2ecf20Sopenharmony_ci const char *client_name; 5778c2ecf20Sopenharmony_ci struct i2c_adapter *adapter = client->adapter; 5788c2ecf20Sopenharmony_ci int address = client->addr; 5798c2ecf20Sopenharmony_ci 5808c2ecf20Sopenharmony_ci if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 5818c2ecf20Sopenharmony_ci return -ENODEV; 5828c2ecf20Sopenharmony_ci 5838c2ecf20Sopenharmony_ci /* 5848c2ecf20Sopenharmony_ci * We block updates of the ISA device to minimize the risk of 5858c2ecf20Sopenharmony_ci * concurrent access to the same LM78 chip through different 5868c2ecf20Sopenharmony_ci * interfaces. 5878c2ecf20Sopenharmony_ci */ 5888c2ecf20Sopenharmony_ci if (isa) 5898c2ecf20Sopenharmony_ci mutex_lock(&isa->update_lock); 5908c2ecf20Sopenharmony_ci 5918c2ecf20Sopenharmony_ci if ((i2c_smbus_read_byte_data(client, LM78_REG_CONFIG) & 0x80) 5928c2ecf20Sopenharmony_ci || i2c_smbus_read_byte_data(client, LM78_REG_I2C_ADDR) != address) 5938c2ecf20Sopenharmony_ci goto err_nodev; 5948c2ecf20Sopenharmony_ci 5958c2ecf20Sopenharmony_ci /* Explicitly prevent the misdetection of Winbond chips */ 5968c2ecf20Sopenharmony_ci i = i2c_smbus_read_byte_data(client, 0x4f); 5978c2ecf20Sopenharmony_ci if (i == 0xa3 || i == 0x5c) 5988c2ecf20Sopenharmony_ci goto err_nodev; 5998c2ecf20Sopenharmony_ci 6008c2ecf20Sopenharmony_ci /* Determine the chip type. */ 6018c2ecf20Sopenharmony_ci i = i2c_smbus_read_byte_data(client, LM78_REG_CHIPID); 6028c2ecf20Sopenharmony_ci if (i == 0x00 || i == 0x20 /* LM78 */ 6038c2ecf20Sopenharmony_ci || i == 0x40) /* LM78-J */ 6048c2ecf20Sopenharmony_ci client_name = "lm78"; 6058c2ecf20Sopenharmony_ci else if ((i & 0xfe) == 0xc0) 6068c2ecf20Sopenharmony_ci client_name = "lm79"; 6078c2ecf20Sopenharmony_ci else 6088c2ecf20Sopenharmony_ci goto err_nodev; 6098c2ecf20Sopenharmony_ci 6108c2ecf20Sopenharmony_ci if (lm78_alias_detect(client, i)) { 6118c2ecf20Sopenharmony_ci dev_dbg(&adapter->dev, 6128c2ecf20Sopenharmony_ci "Device at 0x%02x appears to be the same as ISA device\n", 6138c2ecf20Sopenharmony_ci address); 6148c2ecf20Sopenharmony_ci goto err_nodev; 6158c2ecf20Sopenharmony_ci } 6168c2ecf20Sopenharmony_ci 6178c2ecf20Sopenharmony_ci if (isa) 6188c2ecf20Sopenharmony_ci mutex_unlock(&isa->update_lock); 6198c2ecf20Sopenharmony_ci 6208c2ecf20Sopenharmony_ci strlcpy(info->type, client_name, I2C_NAME_SIZE); 6218c2ecf20Sopenharmony_ci 6228c2ecf20Sopenharmony_ci return 0; 6238c2ecf20Sopenharmony_ci 6248c2ecf20Sopenharmony_ci err_nodev: 6258c2ecf20Sopenharmony_ci if (isa) 6268c2ecf20Sopenharmony_ci mutex_unlock(&isa->update_lock); 6278c2ecf20Sopenharmony_ci return -ENODEV; 6288c2ecf20Sopenharmony_ci} 6298c2ecf20Sopenharmony_ci 6308c2ecf20Sopenharmony_cistatic const struct i2c_device_id lm78_i2c_id[]; 6318c2ecf20Sopenharmony_ci 6328c2ecf20Sopenharmony_cistatic int lm78_i2c_probe(struct i2c_client *client) 6338c2ecf20Sopenharmony_ci{ 6348c2ecf20Sopenharmony_ci struct device *dev = &client->dev; 6358c2ecf20Sopenharmony_ci struct device *hwmon_dev; 6368c2ecf20Sopenharmony_ci struct lm78_data *data; 6378c2ecf20Sopenharmony_ci 6388c2ecf20Sopenharmony_ci data = devm_kzalloc(dev, sizeof(struct lm78_data), GFP_KERNEL); 6398c2ecf20Sopenharmony_ci if (!data) 6408c2ecf20Sopenharmony_ci return -ENOMEM; 6418c2ecf20Sopenharmony_ci 6428c2ecf20Sopenharmony_ci data->client = client; 6438c2ecf20Sopenharmony_ci data->type = i2c_match_id(lm78_i2c_id, client)->driver_data; 6448c2ecf20Sopenharmony_ci 6458c2ecf20Sopenharmony_ci /* Initialize the LM78 chip */ 6468c2ecf20Sopenharmony_ci lm78_init_device(data); 6478c2ecf20Sopenharmony_ci 6488c2ecf20Sopenharmony_ci hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name, 6498c2ecf20Sopenharmony_ci data, lm78_groups); 6508c2ecf20Sopenharmony_ci return PTR_ERR_OR_ZERO(hwmon_dev); 6518c2ecf20Sopenharmony_ci} 6528c2ecf20Sopenharmony_ci 6538c2ecf20Sopenharmony_cistatic const struct i2c_device_id lm78_i2c_id[] = { 6548c2ecf20Sopenharmony_ci { "lm78", lm78 }, 6558c2ecf20Sopenharmony_ci { "lm79", lm79 }, 6568c2ecf20Sopenharmony_ci { } 6578c2ecf20Sopenharmony_ci}; 6588c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, lm78_i2c_id); 6598c2ecf20Sopenharmony_ci 6608c2ecf20Sopenharmony_cistatic struct i2c_driver lm78_driver = { 6618c2ecf20Sopenharmony_ci .class = I2C_CLASS_HWMON, 6628c2ecf20Sopenharmony_ci .driver = { 6638c2ecf20Sopenharmony_ci .name = "lm78", 6648c2ecf20Sopenharmony_ci }, 6658c2ecf20Sopenharmony_ci .probe_new = lm78_i2c_probe, 6668c2ecf20Sopenharmony_ci .id_table = lm78_i2c_id, 6678c2ecf20Sopenharmony_ci .detect = lm78_i2c_detect, 6688c2ecf20Sopenharmony_ci .address_list = normal_i2c, 6698c2ecf20Sopenharmony_ci}; 6708c2ecf20Sopenharmony_ci 6718c2ecf20Sopenharmony_ci/* 6728c2ecf20Sopenharmony_ci * The SMBus locks itself, but ISA access must be locked explicitly! 6738c2ecf20Sopenharmony_ci * We don't want to lock the whole ISA bus, so we lock each client 6748c2ecf20Sopenharmony_ci * separately. 6758c2ecf20Sopenharmony_ci * We ignore the LM78 BUSY flag at this moment - it could lead to deadlocks, 6768c2ecf20Sopenharmony_ci * would slow down the LM78 access and should not be necessary. 6778c2ecf20Sopenharmony_ci */ 6788c2ecf20Sopenharmony_cistatic int lm78_read_value(struct lm78_data *data, u8 reg) 6798c2ecf20Sopenharmony_ci{ 6808c2ecf20Sopenharmony_ci struct i2c_client *client = data->client; 6818c2ecf20Sopenharmony_ci 6828c2ecf20Sopenharmony_ci#ifdef CONFIG_ISA 6838c2ecf20Sopenharmony_ci if (!client) { /* ISA device */ 6848c2ecf20Sopenharmony_ci int res; 6858c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 6868c2ecf20Sopenharmony_ci outb_p(reg, data->isa_addr + LM78_ADDR_REG_OFFSET); 6878c2ecf20Sopenharmony_ci res = inb_p(data->isa_addr + LM78_DATA_REG_OFFSET); 6888c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 6898c2ecf20Sopenharmony_ci return res; 6908c2ecf20Sopenharmony_ci } else 6918c2ecf20Sopenharmony_ci#endif 6928c2ecf20Sopenharmony_ci return i2c_smbus_read_byte_data(client, reg); 6938c2ecf20Sopenharmony_ci} 6948c2ecf20Sopenharmony_ci 6958c2ecf20Sopenharmony_cistatic int lm78_write_value(struct lm78_data *data, u8 reg, u8 value) 6968c2ecf20Sopenharmony_ci{ 6978c2ecf20Sopenharmony_ci struct i2c_client *client = data->client; 6988c2ecf20Sopenharmony_ci 6998c2ecf20Sopenharmony_ci#ifdef CONFIG_ISA 7008c2ecf20Sopenharmony_ci if (!client) { /* ISA device */ 7018c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 7028c2ecf20Sopenharmony_ci outb_p(reg, data->isa_addr + LM78_ADDR_REG_OFFSET); 7038c2ecf20Sopenharmony_ci outb_p(value, data->isa_addr + LM78_DATA_REG_OFFSET); 7048c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 7058c2ecf20Sopenharmony_ci return 0; 7068c2ecf20Sopenharmony_ci } else 7078c2ecf20Sopenharmony_ci#endif 7088c2ecf20Sopenharmony_ci return i2c_smbus_write_byte_data(client, reg, value); 7098c2ecf20Sopenharmony_ci} 7108c2ecf20Sopenharmony_ci 7118c2ecf20Sopenharmony_cistatic void lm78_init_device(struct lm78_data *data) 7128c2ecf20Sopenharmony_ci{ 7138c2ecf20Sopenharmony_ci u8 config; 7148c2ecf20Sopenharmony_ci int i; 7158c2ecf20Sopenharmony_ci 7168c2ecf20Sopenharmony_ci /* Start monitoring */ 7178c2ecf20Sopenharmony_ci config = lm78_read_value(data, LM78_REG_CONFIG); 7188c2ecf20Sopenharmony_ci if ((config & 0x09) != 0x01) 7198c2ecf20Sopenharmony_ci lm78_write_value(data, LM78_REG_CONFIG, 7208c2ecf20Sopenharmony_ci (config & 0xf7) | 0x01); 7218c2ecf20Sopenharmony_ci 7228c2ecf20Sopenharmony_ci /* A few vars need to be filled upon startup */ 7238c2ecf20Sopenharmony_ci for (i = 0; i < 3; i++) { 7248c2ecf20Sopenharmony_ci data->fan_min[i] = lm78_read_value(data, 7258c2ecf20Sopenharmony_ci LM78_REG_FAN_MIN(i)); 7268c2ecf20Sopenharmony_ci } 7278c2ecf20Sopenharmony_ci 7288c2ecf20Sopenharmony_ci mutex_init(&data->update_lock); 7298c2ecf20Sopenharmony_ci} 7308c2ecf20Sopenharmony_ci 7318c2ecf20Sopenharmony_cistatic struct lm78_data *lm78_update_device(struct device *dev) 7328c2ecf20Sopenharmony_ci{ 7338c2ecf20Sopenharmony_ci struct lm78_data *data = dev_get_drvdata(dev); 7348c2ecf20Sopenharmony_ci int i; 7358c2ecf20Sopenharmony_ci 7368c2ecf20Sopenharmony_ci mutex_lock(&data->update_lock); 7378c2ecf20Sopenharmony_ci 7388c2ecf20Sopenharmony_ci if (time_after(jiffies, data->last_updated + HZ + HZ / 2) 7398c2ecf20Sopenharmony_ci || !data->valid) { 7408c2ecf20Sopenharmony_ci 7418c2ecf20Sopenharmony_ci dev_dbg(dev, "Starting lm78 update\n"); 7428c2ecf20Sopenharmony_ci 7438c2ecf20Sopenharmony_ci for (i = 0; i <= 6; i++) { 7448c2ecf20Sopenharmony_ci data->in[i] = 7458c2ecf20Sopenharmony_ci lm78_read_value(data, LM78_REG_IN(i)); 7468c2ecf20Sopenharmony_ci data->in_min[i] = 7478c2ecf20Sopenharmony_ci lm78_read_value(data, LM78_REG_IN_MIN(i)); 7488c2ecf20Sopenharmony_ci data->in_max[i] = 7498c2ecf20Sopenharmony_ci lm78_read_value(data, LM78_REG_IN_MAX(i)); 7508c2ecf20Sopenharmony_ci } 7518c2ecf20Sopenharmony_ci for (i = 0; i < 3; i++) { 7528c2ecf20Sopenharmony_ci data->fan[i] = 7538c2ecf20Sopenharmony_ci lm78_read_value(data, LM78_REG_FAN(i)); 7548c2ecf20Sopenharmony_ci data->fan_min[i] = 7558c2ecf20Sopenharmony_ci lm78_read_value(data, LM78_REG_FAN_MIN(i)); 7568c2ecf20Sopenharmony_ci } 7578c2ecf20Sopenharmony_ci data->temp = lm78_read_value(data, LM78_REG_TEMP); 7588c2ecf20Sopenharmony_ci data->temp_over = 7598c2ecf20Sopenharmony_ci lm78_read_value(data, LM78_REG_TEMP_OVER); 7608c2ecf20Sopenharmony_ci data->temp_hyst = 7618c2ecf20Sopenharmony_ci lm78_read_value(data, LM78_REG_TEMP_HYST); 7628c2ecf20Sopenharmony_ci i = lm78_read_value(data, LM78_REG_VID_FANDIV); 7638c2ecf20Sopenharmony_ci data->vid = i & 0x0f; 7648c2ecf20Sopenharmony_ci if (data->type == lm79) 7658c2ecf20Sopenharmony_ci data->vid |= 7668c2ecf20Sopenharmony_ci (lm78_read_value(data, LM78_REG_CHIPID) & 7678c2ecf20Sopenharmony_ci 0x01) << 4; 7688c2ecf20Sopenharmony_ci else 7698c2ecf20Sopenharmony_ci data->vid |= 0x10; 7708c2ecf20Sopenharmony_ci data->fan_div[0] = (i >> 4) & 0x03; 7718c2ecf20Sopenharmony_ci data->fan_div[1] = i >> 6; 7728c2ecf20Sopenharmony_ci data->alarms = lm78_read_value(data, LM78_REG_ALARM1) + 7738c2ecf20Sopenharmony_ci (lm78_read_value(data, LM78_REG_ALARM2) << 8); 7748c2ecf20Sopenharmony_ci data->last_updated = jiffies; 7758c2ecf20Sopenharmony_ci data->valid = 1; 7768c2ecf20Sopenharmony_ci 7778c2ecf20Sopenharmony_ci data->fan_div[2] = 1; 7788c2ecf20Sopenharmony_ci } 7798c2ecf20Sopenharmony_ci 7808c2ecf20Sopenharmony_ci mutex_unlock(&data->update_lock); 7818c2ecf20Sopenharmony_ci 7828c2ecf20Sopenharmony_ci return data; 7838c2ecf20Sopenharmony_ci} 7848c2ecf20Sopenharmony_ci 7858c2ecf20Sopenharmony_ci#ifdef CONFIG_ISA 7868c2ecf20Sopenharmony_cistatic int lm78_isa_probe(struct platform_device *pdev) 7878c2ecf20Sopenharmony_ci{ 7888c2ecf20Sopenharmony_ci struct device *dev = &pdev->dev; 7898c2ecf20Sopenharmony_ci struct device *hwmon_dev; 7908c2ecf20Sopenharmony_ci struct lm78_data *data; 7918c2ecf20Sopenharmony_ci struct resource *res; 7928c2ecf20Sopenharmony_ci 7938c2ecf20Sopenharmony_ci /* Reserve the ISA region */ 7948c2ecf20Sopenharmony_ci res = platform_get_resource(pdev, IORESOURCE_IO, 0); 7958c2ecf20Sopenharmony_ci if (!devm_request_region(dev, res->start + LM78_ADDR_REG_OFFSET, 7968c2ecf20Sopenharmony_ci 2, "lm78")) 7978c2ecf20Sopenharmony_ci return -EBUSY; 7988c2ecf20Sopenharmony_ci 7998c2ecf20Sopenharmony_ci data = devm_kzalloc(dev, sizeof(struct lm78_data), GFP_KERNEL); 8008c2ecf20Sopenharmony_ci if (!data) 8018c2ecf20Sopenharmony_ci return -ENOMEM; 8028c2ecf20Sopenharmony_ci 8038c2ecf20Sopenharmony_ci mutex_init(&data->lock); 8048c2ecf20Sopenharmony_ci data->isa_addr = res->start; 8058c2ecf20Sopenharmony_ci platform_set_drvdata(pdev, data); 8068c2ecf20Sopenharmony_ci 8078c2ecf20Sopenharmony_ci if (lm78_read_value(data, LM78_REG_CHIPID) & 0x80) { 8088c2ecf20Sopenharmony_ci data->type = lm79; 8098c2ecf20Sopenharmony_ci data->name = "lm79"; 8108c2ecf20Sopenharmony_ci } else { 8118c2ecf20Sopenharmony_ci data->type = lm78; 8128c2ecf20Sopenharmony_ci data->name = "lm78"; 8138c2ecf20Sopenharmony_ci } 8148c2ecf20Sopenharmony_ci 8158c2ecf20Sopenharmony_ci /* Initialize the LM78 chip */ 8168c2ecf20Sopenharmony_ci lm78_init_device(data); 8178c2ecf20Sopenharmony_ci 8188c2ecf20Sopenharmony_ci hwmon_dev = devm_hwmon_device_register_with_groups(dev, data->name, 8198c2ecf20Sopenharmony_ci data, lm78_groups); 8208c2ecf20Sopenharmony_ci return PTR_ERR_OR_ZERO(hwmon_dev); 8218c2ecf20Sopenharmony_ci} 8228c2ecf20Sopenharmony_ci 8238c2ecf20Sopenharmony_cistatic struct platform_driver lm78_isa_driver = { 8248c2ecf20Sopenharmony_ci .driver = { 8258c2ecf20Sopenharmony_ci .name = "lm78", 8268c2ecf20Sopenharmony_ci }, 8278c2ecf20Sopenharmony_ci .probe = lm78_isa_probe, 8288c2ecf20Sopenharmony_ci}; 8298c2ecf20Sopenharmony_ci 8308c2ecf20Sopenharmony_ci/* return 1 if a supported chip is found, 0 otherwise */ 8318c2ecf20Sopenharmony_cistatic int __init lm78_isa_found(unsigned short address) 8328c2ecf20Sopenharmony_ci{ 8338c2ecf20Sopenharmony_ci int val, save, found = 0; 8348c2ecf20Sopenharmony_ci int port; 8358c2ecf20Sopenharmony_ci 8368c2ecf20Sopenharmony_ci /* 8378c2ecf20Sopenharmony_ci * Some boards declare base+0 to base+7 as a PNP device, some base+4 8388c2ecf20Sopenharmony_ci * to base+7 and some base+5 to base+6. So we better request each port 8398c2ecf20Sopenharmony_ci * individually for the probing phase. 8408c2ecf20Sopenharmony_ci */ 8418c2ecf20Sopenharmony_ci for (port = address; port < address + LM78_EXTENT; port++) { 8428c2ecf20Sopenharmony_ci if (!request_region(port, 1, "lm78")) { 8438c2ecf20Sopenharmony_ci pr_debug("Failed to request port 0x%x\n", port); 8448c2ecf20Sopenharmony_ci goto release; 8458c2ecf20Sopenharmony_ci } 8468c2ecf20Sopenharmony_ci } 8478c2ecf20Sopenharmony_ci 8488c2ecf20Sopenharmony_ci#define REALLY_SLOW_IO 8498c2ecf20Sopenharmony_ci /* 8508c2ecf20Sopenharmony_ci * We need the timeouts for at least some LM78-like 8518c2ecf20Sopenharmony_ci * chips. But only if we read 'undefined' registers. 8528c2ecf20Sopenharmony_ci */ 8538c2ecf20Sopenharmony_ci val = inb_p(address + 1); 8548c2ecf20Sopenharmony_ci if (inb_p(address + 2) != val 8558c2ecf20Sopenharmony_ci || inb_p(address + 3) != val 8568c2ecf20Sopenharmony_ci || inb_p(address + 7) != val) 8578c2ecf20Sopenharmony_ci goto release; 8588c2ecf20Sopenharmony_ci#undef REALLY_SLOW_IO 8598c2ecf20Sopenharmony_ci 8608c2ecf20Sopenharmony_ci /* 8618c2ecf20Sopenharmony_ci * We should be able to change the 7 LSB of the address port. The 8628c2ecf20Sopenharmony_ci * MSB (busy flag) should be clear initially, set after the write. 8638c2ecf20Sopenharmony_ci */ 8648c2ecf20Sopenharmony_ci save = inb_p(address + LM78_ADDR_REG_OFFSET); 8658c2ecf20Sopenharmony_ci if (save & 0x80) 8668c2ecf20Sopenharmony_ci goto release; 8678c2ecf20Sopenharmony_ci val = ~save & 0x7f; 8688c2ecf20Sopenharmony_ci outb_p(val, address + LM78_ADDR_REG_OFFSET); 8698c2ecf20Sopenharmony_ci if (inb_p(address + LM78_ADDR_REG_OFFSET) != (val | 0x80)) { 8708c2ecf20Sopenharmony_ci outb_p(save, address + LM78_ADDR_REG_OFFSET); 8718c2ecf20Sopenharmony_ci goto release; 8728c2ecf20Sopenharmony_ci } 8738c2ecf20Sopenharmony_ci 8748c2ecf20Sopenharmony_ci /* We found a device, now see if it could be an LM78 */ 8758c2ecf20Sopenharmony_ci outb_p(LM78_REG_CONFIG, address + LM78_ADDR_REG_OFFSET); 8768c2ecf20Sopenharmony_ci val = inb_p(address + LM78_DATA_REG_OFFSET); 8778c2ecf20Sopenharmony_ci if (val & 0x80) 8788c2ecf20Sopenharmony_ci goto release; 8798c2ecf20Sopenharmony_ci outb_p(LM78_REG_I2C_ADDR, address + LM78_ADDR_REG_OFFSET); 8808c2ecf20Sopenharmony_ci val = inb_p(address + LM78_DATA_REG_OFFSET); 8818c2ecf20Sopenharmony_ci if (val < 0x03 || val > 0x77) /* Not a valid I2C address */ 8828c2ecf20Sopenharmony_ci goto release; 8838c2ecf20Sopenharmony_ci 8848c2ecf20Sopenharmony_ci /* The busy flag should be clear again */ 8858c2ecf20Sopenharmony_ci if (inb_p(address + LM78_ADDR_REG_OFFSET) & 0x80) 8868c2ecf20Sopenharmony_ci goto release; 8878c2ecf20Sopenharmony_ci 8888c2ecf20Sopenharmony_ci /* Explicitly prevent the misdetection of Winbond chips */ 8898c2ecf20Sopenharmony_ci outb_p(0x4f, address + LM78_ADDR_REG_OFFSET); 8908c2ecf20Sopenharmony_ci val = inb_p(address + LM78_DATA_REG_OFFSET); 8918c2ecf20Sopenharmony_ci if (val == 0xa3 || val == 0x5c) 8928c2ecf20Sopenharmony_ci goto release; 8938c2ecf20Sopenharmony_ci 8948c2ecf20Sopenharmony_ci /* Explicitly prevent the misdetection of ITE chips */ 8958c2ecf20Sopenharmony_ci outb_p(0x58, address + LM78_ADDR_REG_OFFSET); 8968c2ecf20Sopenharmony_ci val = inb_p(address + LM78_DATA_REG_OFFSET); 8978c2ecf20Sopenharmony_ci if (val == 0x90) 8988c2ecf20Sopenharmony_ci goto release; 8998c2ecf20Sopenharmony_ci 9008c2ecf20Sopenharmony_ci /* Determine the chip type */ 9018c2ecf20Sopenharmony_ci outb_p(LM78_REG_CHIPID, address + LM78_ADDR_REG_OFFSET); 9028c2ecf20Sopenharmony_ci val = inb_p(address + LM78_DATA_REG_OFFSET); 9038c2ecf20Sopenharmony_ci if (val == 0x00 || val == 0x20 /* LM78 */ 9048c2ecf20Sopenharmony_ci || val == 0x40 /* LM78-J */ 9058c2ecf20Sopenharmony_ci || (val & 0xfe) == 0xc0) /* LM79 */ 9068c2ecf20Sopenharmony_ci found = 1; 9078c2ecf20Sopenharmony_ci 9088c2ecf20Sopenharmony_ci if (found) 9098c2ecf20Sopenharmony_ci pr_info("Found an %s chip at %#x\n", 9108c2ecf20Sopenharmony_ci val & 0x80 ? "LM79" : "LM78", (int)address); 9118c2ecf20Sopenharmony_ci 9128c2ecf20Sopenharmony_ci release: 9138c2ecf20Sopenharmony_ci for (port--; port >= address; port--) 9148c2ecf20Sopenharmony_ci release_region(port, 1); 9158c2ecf20Sopenharmony_ci return found; 9168c2ecf20Sopenharmony_ci} 9178c2ecf20Sopenharmony_ci 9188c2ecf20Sopenharmony_cistatic int __init lm78_isa_device_add(unsigned short address) 9198c2ecf20Sopenharmony_ci{ 9208c2ecf20Sopenharmony_ci struct resource res = { 9218c2ecf20Sopenharmony_ci .start = address, 9228c2ecf20Sopenharmony_ci .end = address + LM78_EXTENT - 1, 9238c2ecf20Sopenharmony_ci .name = "lm78", 9248c2ecf20Sopenharmony_ci .flags = IORESOURCE_IO, 9258c2ecf20Sopenharmony_ci }; 9268c2ecf20Sopenharmony_ci int err; 9278c2ecf20Sopenharmony_ci 9288c2ecf20Sopenharmony_ci pdev = platform_device_alloc("lm78", address); 9298c2ecf20Sopenharmony_ci if (!pdev) { 9308c2ecf20Sopenharmony_ci err = -ENOMEM; 9318c2ecf20Sopenharmony_ci pr_err("Device allocation failed\n"); 9328c2ecf20Sopenharmony_ci goto exit; 9338c2ecf20Sopenharmony_ci } 9348c2ecf20Sopenharmony_ci 9358c2ecf20Sopenharmony_ci err = platform_device_add_resources(pdev, &res, 1); 9368c2ecf20Sopenharmony_ci if (err) { 9378c2ecf20Sopenharmony_ci pr_err("Device resource addition failed (%d)\n", err); 9388c2ecf20Sopenharmony_ci goto exit_device_put; 9398c2ecf20Sopenharmony_ci } 9408c2ecf20Sopenharmony_ci 9418c2ecf20Sopenharmony_ci err = platform_device_add(pdev); 9428c2ecf20Sopenharmony_ci if (err) { 9438c2ecf20Sopenharmony_ci pr_err("Device addition failed (%d)\n", err); 9448c2ecf20Sopenharmony_ci goto exit_device_put; 9458c2ecf20Sopenharmony_ci } 9468c2ecf20Sopenharmony_ci 9478c2ecf20Sopenharmony_ci return 0; 9488c2ecf20Sopenharmony_ci 9498c2ecf20Sopenharmony_ci exit_device_put: 9508c2ecf20Sopenharmony_ci platform_device_put(pdev); 9518c2ecf20Sopenharmony_ci exit: 9528c2ecf20Sopenharmony_ci pdev = NULL; 9538c2ecf20Sopenharmony_ci return err; 9548c2ecf20Sopenharmony_ci} 9558c2ecf20Sopenharmony_ci 9568c2ecf20Sopenharmony_cistatic int __init lm78_isa_register(void) 9578c2ecf20Sopenharmony_ci{ 9588c2ecf20Sopenharmony_ci int res; 9598c2ecf20Sopenharmony_ci 9608c2ecf20Sopenharmony_ci if (lm78_isa_found(isa_address)) { 9618c2ecf20Sopenharmony_ci res = platform_driver_register(&lm78_isa_driver); 9628c2ecf20Sopenharmony_ci if (res) 9638c2ecf20Sopenharmony_ci goto exit; 9648c2ecf20Sopenharmony_ci 9658c2ecf20Sopenharmony_ci /* Sets global pdev as a side effect */ 9668c2ecf20Sopenharmony_ci res = lm78_isa_device_add(isa_address); 9678c2ecf20Sopenharmony_ci if (res) 9688c2ecf20Sopenharmony_ci goto exit_unreg_isa_driver; 9698c2ecf20Sopenharmony_ci } 9708c2ecf20Sopenharmony_ci 9718c2ecf20Sopenharmony_ci return 0; 9728c2ecf20Sopenharmony_ci 9738c2ecf20Sopenharmony_ci exit_unreg_isa_driver: 9748c2ecf20Sopenharmony_ci platform_driver_unregister(&lm78_isa_driver); 9758c2ecf20Sopenharmony_ci exit: 9768c2ecf20Sopenharmony_ci return res; 9778c2ecf20Sopenharmony_ci} 9788c2ecf20Sopenharmony_ci 9798c2ecf20Sopenharmony_cistatic void lm78_isa_unregister(void) 9808c2ecf20Sopenharmony_ci{ 9818c2ecf20Sopenharmony_ci if (pdev) { 9828c2ecf20Sopenharmony_ci platform_device_unregister(pdev); 9838c2ecf20Sopenharmony_ci platform_driver_unregister(&lm78_isa_driver); 9848c2ecf20Sopenharmony_ci } 9858c2ecf20Sopenharmony_ci} 9868c2ecf20Sopenharmony_ci#else /* !CONFIG_ISA */ 9878c2ecf20Sopenharmony_ci 9888c2ecf20Sopenharmony_cistatic int __init lm78_isa_register(void) 9898c2ecf20Sopenharmony_ci{ 9908c2ecf20Sopenharmony_ci return 0; 9918c2ecf20Sopenharmony_ci} 9928c2ecf20Sopenharmony_ci 9938c2ecf20Sopenharmony_cistatic void lm78_isa_unregister(void) 9948c2ecf20Sopenharmony_ci{ 9958c2ecf20Sopenharmony_ci} 9968c2ecf20Sopenharmony_ci#endif /* CONFIG_ISA */ 9978c2ecf20Sopenharmony_ci 9988c2ecf20Sopenharmony_cistatic int __init sm_lm78_init(void) 9998c2ecf20Sopenharmony_ci{ 10008c2ecf20Sopenharmony_ci int res; 10018c2ecf20Sopenharmony_ci 10028c2ecf20Sopenharmony_ci /* 10038c2ecf20Sopenharmony_ci * We register the ISA device first, so that we can skip the 10048c2ecf20Sopenharmony_ci * registration of an I2C interface to the same device. 10058c2ecf20Sopenharmony_ci */ 10068c2ecf20Sopenharmony_ci res = lm78_isa_register(); 10078c2ecf20Sopenharmony_ci if (res) 10088c2ecf20Sopenharmony_ci goto exit; 10098c2ecf20Sopenharmony_ci 10108c2ecf20Sopenharmony_ci res = i2c_add_driver(&lm78_driver); 10118c2ecf20Sopenharmony_ci if (res) 10128c2ecf20Sopenharmony_ci goto exit_unreg_isa_device; 10138c2ecf20Sopenharmony_ci 10148c2ecf20Sopenharmony_ci return 0; 10158c2ecf20Sopenharmony_ci 10168c2ecf20Sopenharmony_ci exit_unreg_isa_device: 10178c2ecf20Sopenharmony_ci lm78_isa_unregister(); 10188c2ecf20Sopenharmony_ci exit: 10198c2ecf20Sopenharmony_ci return res; 10208c2ecf20Sopenharmony_ci} 10218c2ecf20Sopenharmony_ci 10228c2ecf20Sopenharmony_cistatic void __exit sm_lm78_exit(void) 10238c2ecf20Sopenharmony_ci{ 10248c2ecf20Sopenharmony_ci lm78_isa_unregister(); 10258c2ecf20Sopenharmony_ci i2c_del_driver(&lm78_driver); 10268c2ecf20Sopenharmony_ci} 10278c2ecf20Sopenharmony_ci 10288c2ecf20Sopenharmony_ciMODULE_AUTHOR("Frodo Looijaard, Jean Delvare <jdelvare@suse.de>"); 10298c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("LM78/LM79 driver"); 10308c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 10318c2ecf20Sopenharmony_ci 10328c2ecf20Sopenharmony_cimodule_init(sm_lm78_init); 10338c2ecf20Sopenharmony_cimodule_exit(sm_lm78_exit); 1034