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