Linux Audio

Check our new training course

Loading...
v3.1
 
   1/*
   2	vt8231.c - Part of lm_sensors, Linux kernel modules
   3				for hardware monitoring
 
 
 
 
 
   4
   5	Copyright (c) 2005 Roger Lucas <vt8231@hiddenengine.co.uk>
   6	Copyright (c) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
   7			   Aaron M. Marsh <amarsh@sdf.lonestar.org>
   8
   9	This program is free software; you can redistribute it and/or modify
  10	it under the terms of the GNU General Public License as published by
  11	the Free Software Foundation; either version 2 of the License, or
  12	(at your option) any later version.
  13
  14	This program is distributed in the hope that it will be useful,
  15	but WITHOUT ANY WARRANTY; without even the implied warranty of
  16	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17	GNU General Public License for more details.
  18
  19	You should have received a copy of the GNU General Public License
  20	along with this program; if not, write to the Free Software
  21	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22*/
  23
  24/* Supports VIA VT8231 South Bridge embedded sensors
  25*/
  26
  27#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  28
  29#include <linux/module.h>
  30#include <linux/init.h>
  31#include <linux/slab.h>
  32#include <linux/pci.h>
  33#include <linux/jiffies.h>
  34#include <linux/platform_device.h>
  35#include <linux/hwmon.h>
  36#include <linux/hwmon-sysfs.h>
  37#include <linux/hwmon-vid.h>
  38#include <linux/err.h>
  39#include <linux/mutex.h>
  40#include <linux/acpi.h>
  41#include <linux/io.h>
  42
  43static int force_addr;
  44module_param(force_addr, int, 0);
  45MODULE_PARM_DESC(force_addr, "Initialize the base address of the sensors");
  46
  47static struct platform_device *pdev;
  48
  49#define VT8231_EXTENT 0x80
  50#define VT8231_BASE_REG 0x70
  51#define VT8231_ENABLE_REG 0x74
  52
  53/* The VT8231 registers
  54
  55   The reset value for the input channel configuration is used (Reg 0x4A=0x07)
  56   which sets the selected inputs marked with '*' below if multiple options are
  57   possible:
  58
  59	            Voltage Mode	  Temperature Mode
  60	Sensor	      Linux Id	      Linux Id        VIA Id
  61	--------      --------	      --------        ------
  62	CPU Diode	N/A		temp1		0
  63	UIC1		in0		temp2 *		1
  64	UIC2		in1 *		temp3   	2
  65	UIC3		in2 *		temp4		3
  66	UIC4		in3 *		temp5		4
  67	UIC5		in4 *		temp6		5
  68	3.3V		in5		N/A
  69
  70   Note that the BIOS may set the configuration register to a different value
  71   to match the motherboard configuration.
  72*/
 
 
 
  73
  74/* fans numbered 0-1 */
  75#define VT8231_REG_FAN_MIN(nr)	(0x3b + (nr))
  76#define VT8231_REG_FAN(nr)	(0x29 + (nr))
  77
  78/* Voltage inputs numbered 0-5 */
  79
  80static const u8 regvolt[]    = { 0x21, 0x22, 0x23, 0x24, 0x25, 0x26 };
  81static const u8 regvoltmax[] = { 0x3d, 0x2b, 0x2d, 0x2f, 0x31, 0x33 };
  82static const u8 regvoltmin[] = { 0x3e, 0x2c, 0x2e, 0x30, 0x32, 0x34 };
  83
  84/* Temperatures are numbered 1-6 according to the Linux kernel specification.
  85**
  86** In the VIA datasheet, however, the temperatures are numbered from zero.
  87** Since it is important that this driver can easily be compared to the VIA
  88** datasheet, we will use the VIA numbering within this driver and map the
  89** kernel sysfs device name to the VIA number in the sysfs callback.
  90*/
 
  91
  92#define VT8231_REG_TEMP_LOW01	0x49
  93#define VT8231_REG_TEMP_LOW25	0x4d
  94
  95static const u8 regtemp[]    = { 0x1f, 0x21, 0x22, 0x23, 0x24, 0x25 };
  96static const u8 regtempmax[] = { 0x39, 0x3d, 0x2b, 0x2d, 0x2f, 0x31 };
  97static const u8 regtempmin[] = { 0x3a, 0x3e, 0x2c, 0x2e, 0x30, 0x32 };
  98
  99#define TEMP_FROM_REG(reg)		(((253 * 4 - (reg)) * 550 + 105) / 210)
 100#define TEMP_MAXMIN_FROM_REG(reg)	(((253 - (reg)) * 2200 + 105) / 210)
 101#define TEMP_MAXMIN_TO_REG(val)		(253 - ((val) * 210 + 1100) / 2200)
 102
 103#define VT8231_REG_CONFIG 0x40
 104#define VT8231_REG_ALARM1 0x41
 105#define VT8231_REG_ALARM2 0x42
 106#define VT8231_REG_FANDIV 0x47
 107#define VT8231_REG_UCH_CONFIG 0x4a
 108#define VT8231_REG_TEMP1_CONFIG 0x4b
 109#define VT8231_REG_TEMP2_CONFIG 0x4c
 110
 111/* temps 0-5 as numbered in VIA datasheet - see later for mapping to Linux
 112** numbering
 113*/
 
 114#define ISTEMP(i, ch_config) ((i) == 0 ? 1 : \
 115			      ((ch_config) >> ((i)+1)) & 0x01)
 116/* voltages 0-5 */
 117#define ISVOLT(i, ch_config) ((i) == 5 ? 1 : \
 118			      !(((ch_config) >> ((i)+2)) & 0x01))
 119
 120#define DIV_FROM_REG(val) (1 << (val))
 121
 122/* NB  The values returned here are NOT temperatures.  The calibration curves
 123**     for the thermistor curves are board-specific and must go in the
 124**     sensors.conf file.  Temperature sensors are actually ten bits, but the
 125**     VIA datasheet only considers the 8 MSBs obtained from the regtemp[]
 126**     register.  The temperature value returned should have a magnitude of 3,
 127**     so we use the VIA scaling as the "true" scaling and use the remaining 2
 128**     LSBs as fractional precision.
 129**
 130**     All the on-chip hardware temperature comparisons for the alarms are only
 131**     8-bits wide, and compare against the 8 MSBs of the temperature.  The bits
 132**     in the registers VT8231_REG_TEMP_LOW01 and VT8231_REG_TEMP_LOW25 are
 133**     ignored.
 134*/
 135
 136/******** FAN RPM CONVERSIONS ********
 137** This chip saturates back at 0, not at 255 like many the other chips.
 138** So, 0 means 0 RPM
 139*/
 
 
 140static inline u8 FAN_TO_REG(long rpm, int div)
 141{
 142	if (rpm == 0)
 143		return 0;
 144	return SENSORS_LIMIT(1310720 / (rpm * div), 1, 255);
 145}
 146
 147#define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : 1310720 / ((val) * (div)))
 148
 149struct vt8231_data {
 150	unsigned short addr;
 151	const char *name;
 152
 153	struct mutex update_lock;
 154	struct device *hwmon_dev;
 155	char valid;		/* !=0 if following fields are valid */
 156	unsigned long last_updated;	/* In jiffies */
 157
 158	u8 in[6];		/* Register value */
 159	u8 in_max[6];		/* Register value */
 160	u8 in_min[6];		/* Register value */
 161	u16 temp[6];		/* Register value 10 bit, right aligned */
 162	u8 temp_max[6];		/* Register value */
 163	u8 temp_min[6];		/* Register value */
 164	u8 fan[2];		/* Register value */
 165	u8 fan_min[2];		/* Register value */
 166	u8 fan_div[2];		/* Register encoding, shifted right */
 167	u16 alarms;		/* Register encoding */
 168	u8 uch_config;
 169};
 170
 171static struct pci_dev *s_bridge;
 172static int vt8231_probe(struct platform_device *pdev);
 173static int __devexit vt8231_remove(struct platform_device *pdev);
 174static struct vt8231_data *vt8231_update_device(struct device *dev);
 175static void vt8231_init_device(struct vt8231_data *data);
 176
 177static inline int vt8231_read_value(struct vt8231_data *data, u8 reg)
 178{
 179	return inb_p(data->addr + reg);
 180}
 181
 182static inline void vt8231_write_value(struct vt8231_data *data, u8 reg,
 183					u8 value)
 184{
 185	outb_p(value, data->addr + reg);
 186}
 187
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 188/* following are the sysfs callback functions */
 189static ssize_t show_in(struct device *dev, struct device_attribute *attr,
 190		char *buf)
 191{
 192	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 193	int nr = sensor_attr->index;
 194	struct vt8231_data *data = vt8231_update_device(dev);
 195
 196	return sprintf(buf, "%d\n", ((data->in[nr] - 3) * 10000) / 958);
 197}
 198
 199static ssize_t show_in_min(struct device *dev, struct device_attribute *attr,
 200		char *buf)
 201{
 202	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 203	int nr = sensor_attr->index;
 204	struct vt8231_data *data = vt8231_update_device(dev);
 205
 206	return sprintf(buf, "%d\n", ((data->in_min[nr] - 3) * 10000) / 958);
 207}
 208
 209static ssize_t show_in_max(struct device *dev, struct device_attribute *attr,
 210		char *buf)
 211{
 212	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 213	int nr = sensor_attr->index;
 214	struct vt8231_data *data = vt8231_update_device(dev);
 215
 216	return sprintf(buf, "%d\n", (((data->in_max[nr] - 3) * 10000) / 958));
 217}
 218
 219static ssize_t set_in_min(struct device *dev, struct device_attribute *attr,
 220		const char *buf, size_t count)
 221{
 222	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 223	int nr = sensor_attr->index;
 224	struct vt8231_data *data = dev_get_drvdata(dev);
 225	unsigned long val = simple_strtoul(buf, NULL, 10);
 
 
 
 
 
 226
 227	mutex_lock(&data->update_lock);
 228	data->in_min[nr] = SENSORS_LIMIT(((val * 958) / 10000) + 3, 0, 255);
 229	vt8231_write_value(data, regvoltmin[nr], data->in_min[nr]);
 230	mutex_unlock(&data->update_lock);
 231	return count;
 232}
 233
 234static ssize_t set_in_max(struct device *dev, struct device_attribute *attr,
 235		const char *buf, size_t count)
 236{
 237	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 238	int nr = sensor_attr->index;
 239	struct vt8231_data *data = dev_get_drvdata(dev);
 240	unsigned long val = simple_strtoul(buf, NULL, 10);
 
 
 
 
 
 241
 242	mutex_lock(&data->update_lock);
 243	data->in_max[nr] = SENSORS_LIMIT(((val * 958) / 10000) + 3, 0, 255);
 244	vt8231_write_value(data, regvoltmax[nr], data->in_max[nr]);
 245	mutex_unlock(&data->update_lock);
 246	return count;
 247}
 248
 249/* Special case for input 5 as this has 3.3V scaling built into the chip */
 250static ssize_t show_in5(struct device *dev, struct device_attribute *attr,
 251		char *buf)
 252{
 253	struct vt8231_data *data = vt8231_update_device(dev);
 254
 255	return sprintf(buf, "%d\n",
 256		(((data->in[5] - 3) * 10000 * 54) / (958 * 34)));
 257}
 258
 259static ssize_t show_in5_min(struct device *dev, struct device_attribute *attr,
 260		char *buf)
 261{
 262	struct vt8231_data *data = vt8231_update_device(dev);
 263
 264	return sprintf(buf, "%d\n",
 265		(((data->in_min[5] - 3) * 10000 * 54) / (958 * 34)));
 266}
 267
 268static ssize_t show_in5_max(struct device *dev, struct device_attribute *attr,
 269		char *buf)
 270{
 271	struct vt8231_data *data = vt8231_update_device(dev);
 272
 273	return sprintf(buf, "%d\n",
 274		(((data->in_max[5] - 3) * 10000 * 54) / (958 * 34)));
 275}
 276
 277static ssize_t set_in5_min(struct device *dev, struct device_attribute *attr,
 278		const char *buf, size_t count)
 
 279{
 280	struct vt8231_data *data = dev_get_drvdata(dev);
 281	unsigned long val = simple_strtoul(buf, NULL, 10);
 
 
 
 
 
 282
 283	mutex_lock(&data->update_lock);
 284	data->in_min[5] = SENSORS_LIMIT(((val * 958 * 34) / (10000 * 54)) + 3,
 285					0, 255);
 286	vt8231_write_value(data, regvoltmin[5], data->in_min[5]);
 287	mutex_unlock(&data->update_lock);
 288	return count;
 289}
 290
 291static ssize_t set_in5_max(struct device *dev, struct device_attribute *attr,
 292		const char *buf, size_t count)
 
 293{
 294	struct vt8231_data *data = dev_get_drvdata(dev);
 295	unsigned long val = simple_strtoul(buf, NULL, 10);
 
 
 
 
 
 296
 297	mutex_lock(&data->update_lock);
 298	data->in_max[5] = SENSORS_LIMIT(((val * 958 * 34) / (10000 * 54)) + 3,
 299					0, 255);
 300	vt8231_write_value(data, regvoltmax[5], data->in_max[5]);
 301	mutex_unlock(&data->update_lock);
 302	return count;
 303}
 304
 305#define define_voltage_sysfs(offset)				\
 306static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO,		\
 307		show_in, NULL, offset);				\
 308static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR,	\
 309		show_in_min, set_in_min, offset);		\
 310static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR,	\
 311		show_in_max, set_in_max, offset)
 312
 313define_voltage_sysfs(0);
 314define_voltage_sysfs(1);
 315define_voltage_sysfs(2);
 316define_voltage_sysfs(3);
 317define_voltage_sysfs(4);
 318
 319static DEVICE_ATTR(in5_input, S_IRUGO, show_in5, NULL);
 320static DEVICE_ATTR(in5_min, S_IRUGO | S_IWUSR, show_in5_min, set_in5_min);
 321static DEVICE_ATTR(in5_max, S_IRUGO | S_IWUSR, show_in5_max, set_in5_max);
 
 
 322
 323/* Temperatures */
 324static ssize_t show_temp0(struct device *dev, struct device_attribute *attr,
 325		char *buf)
 326{
 327	struct vt8231_data *data = vt8231_update_device(dev);
 328	return sprintf(buf, "%d\n", data->temp[0] * 250);
 329}
 330
 331static ssize_t show_temp0_max(struct device *dev, struct device_attribute *attr,
 332		char *buf)
 333{
 334	struct vt8231_data *data = vt8231_update_device(dev);
 335	return sprintf(buf, "%d\n", data->temp_max[0] * 1000);
 336}
 337
 338static ssize_t show_temp0_min(struct device *dev, struct device_attribute *attr,
 339		char *buf)
 340{
 341	struct vt8231_data *data = vt8231_update_device(dev);
 342	return sprintf(buf, "%d\n", data->temp_min[0] * 1000);
 343}
 344
 345static ssize_t set_temp0_max(struct device *dev, struct device_attribute *attr,
 346		const char *buf, size_t count)
 
 347{
 348	struct vt8231_data *data = dev_get_drvdata(dev);
 349	int val = simple_strtol(buf, NULL, 10);
 
 
 
 
 
 350
 351	mutex_lock(&data->update_lock);
 352	data->temp_max[0] = SENSORS_LIMIT((val + 500) / 1000, 0, 255);
 353	vt8231_write_value(data, regtempmax[0], data->temp_max[0]);
 354	mutex_unlock(&data->update_lock);
 355	return count;
 356}
 357static ssize_t set_temp0_min(struct device *dev, struct device_attribute *attr,
 358		const char *buf, size_t count)
 
 359{
 360	struct vt8231_data *data = dev_get_drvdata(dev);
 361	int val = simple_strtol(buf, NULL, 10);
 
 
 
 
 
 362
 363	mutex_lock(&data->update_lock);
 364	data->temp_min[0] = SENSORS_LIMIT((val + 500) / 1000, 0, 255);
 365	vt8231_write_value(data, regtempmin[0], data->temp_min[0]);
 366	mutex_unlock(&data->update_lock);
 367	return count;
 368}
 369
 370static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
 371		char *buf)
 372{
 373	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 374	int nr = sensor_attr->index;
 375	struct vt8231_data *data = vt8231_update_device(dev);
 376	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr]));
 377}
 378
 379static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr,
 380		char *buf)
 381{
 382	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 383	int nr = sensor_attr->index;
 384	struct vt8231_data *data = vt8231_update_device(dev);
 385	return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_max[nr]));
 386}
 387
 388static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr,
 389		char *buf)
 390{
 391	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 392	int nr = sensor_attr->index;
 393	struct vt8231_data *data = vt8231_update_device(dev);
 394	return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_min[nr]));
 395}
 396
 397static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
 398		const char *buf, size_t count)
 
 399{
 400	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 401	int nr = sensor_attr->index;
 402	struct vt8231_data *data = dev_get_drvdata(dev);
 403	int val = simple_strtol(buf, NULL, 10);
 
 
 
 
 
 404
 405	mutex_lock(&data->update_lock);
 406	data->temp_max[nr] = SENSORS_LIMIT(TEMP_MAXMIN_TO_REG(val), 0, 255);
 407	vt8231_write_value(data, regtempmax[nr], data->temp_max[nr]);
 408	mutex_unlock(&data->update_lock);
 409	return count;
 410}
 411static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
 412		const char *buf, size_t count)
 
 413{
 414	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 415	int nr = sensor_attr->index;
 416	struct vt8231_data *data = dev_get_drvdata(dev);
 417	int val = simple_strtol(buf, NULL, 10);
 
 
 
 
 
 418
 419	mutex_lock(&data->update_lock);
 420	data->temp_min[nr] = SENSORS_LIMIT(TEMP_MAXMIN_TO_REG(val), 0, 255);
 421	vt8231_write_value(data, regtempmin[nr], data->temp_min[nr]);
 422	mutex_unlock(&data->update_lock);
 423	return count;
 424}
 425
 426/* Note that these map the Linux temperature sensor numbering (1-6) to the VIA
 427** temperature sensor numbering (0-5)
 428*/
 429#define define_temperature_sysfs(offset)				\
 430static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO,		\
 431		show_temp, NULL, offset - 1);				\
 432static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR,	\
 433		show_temp_max, set_temp_max, offset - 1);		\
 434static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO | S_IWUSR,	\
 435		show_temp_min, set_temp_min, offset - 1)
 436
 437static DEVICE_ATTR(temp1_input, S_IRUGO, show_temp0, NULL);
 438static DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp0_max, set_temp0_max);
 439static DEVICE_ATTR(temp1_max_hyst, S_IRUGO | S_IWUSR, show_temp0_min, set_temp0_min);
 440
 441define_temperature_sysfs(2);
 442define_temperature_sysfs(3);
 443define_temperature_sysfs(4);
 444define_temperature_sysfs(5);
 445define_temperature_sysfs(6);
 
 
 
 
 446
 447/* Fans */
 448static ssize_t show_fan(struct device *dev, struct device_attribute *attr,
 449		char *buf)
 450{
 451	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 452	int nr = sensor_attr->index;
 453	struct vt8231_data *data = vt8231_update_device(dev);
 454	return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
 455				DIV_FROM_REG(data->fan_div[nr])));
 456}
 457
 458static ssize_t show_fan_min(struct device *dev, struct device_attribute *attr,
 459		char *buf)
 460{
 461	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 462	int nr = sensor_attr->index;
 463	struct vt8231_data *data = vt8231_update_device(dev);
 464	return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr],
 465			DIV_FROM_REG(data->fan_div[nr])));
 466}
 467
 468static ssize_t show_fan_div(struct device *dev, struct device_attribute *attr,
 469		char *buf)
 470{
 471	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 472	int nr = sensor_attr->index;
 473	struct vt8231_data *data = vt8231_update_device(dev);
 474	return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]));
 475}
 476
 477static ssize_t set_fan_min(struct device *dev, struct device_attribute *attr,
 478		const char *buf, size_t count)
 
 479{
 480	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 481	int nr = sensor_attr->index;
 482	struct vt8231_data *data = dev_get_drvdata(dev);
 483	int val = simple_strtoul(buf, NULL, 10);
 
 
 
 
 
 484
 485	mutex_lock(&data->update_lock);
 486	data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
 487	vt8231_write_value(data, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
 488	mutex_unlock(&data->update_lock);
 489	return count;
 490}
 491
 492static ssize_t set_fan_div(struct device *dev, struct device_attribute *attr,
 493		const char *buf, size_t count)
 
 494{
 495	struct vt8231_data *data = dev_get_drvdata(dev);
 496	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 497	unsigned long val = simple_strtoul(buf, NULL, 10);
 498	int nr = sensor_attr->index;
 499	int old = vt8231_read_value(data, VT8231_REG_FANDIV);
 500	long min = FAN_FROM_REG(data->fan_min[nr],
 501				 DIV_FROM_REG(data->fan_div[nr]));
 
 
 
 
 
 502
 503	mutex_lock(&data->update_lock);
 504	switch (val) {
 505	case 1: data->fan_div[nr] = 0; break;
 506	case 2: data->fan_div[nr] = 1; break;
 507	case 4: data->fan_div[nr] = 2; break;
 508	case 8: data->fan_div[nr] = 3; break;
 
 
 
 
 
 
 
 
 509	default:
 510		dev_err(dev, "fan_div value %ld not supported. "
 511		        "Choose one of 1, 2, 4 or 8!\n", val);
 
 512		mutex_unlock(&data->update_lock);
 513		return -EINVAL;
 514	}
 515
 516	/* Correct the fan minimum speed */
 517	data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
 518	vt8231_write_value(data, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
 519
 520	old = (old & 0x0f) | (data->fan_div[1] << 6) | (data->fan_div[0] << 4);
 521	vt8231_write_value(data, VT8231_REG_FANDIV, old);
 522	mutex_unlock(&data->update_lock);
 523	return count;
 524}
 525
 526
 527#define define_fan_sysfs(offset)					\
 528static SENSOR_DEVICE_ATTR(fan##offset##_input, S_IRUGO,			\
 529		show_fan, NULL, offset - 1);				\
 530static SENSOR_DEVICE_ATTR(fan##offset##_div, S_IRUGO | S_IWUSR,		\
 531		show_fan_div, set_fan_div, offset - 1);			\
 532static SENSOR_DEVICE_ATTR(fan##offset##_min, S_IRUGO | S_IWUSR,		\
 533		show_fan_min, set_fan_min, offset - 1)
 534
 535define_fan_sysfs(1);
 536define_fan_sysfs(2);
 537
 538/* Alarms */
 539static ssize_t show_alarms(struct device *dev, struct device_attribute *attr,
 540			   char *buf)
 541{
 542	struct vt8231_data *data = vt8231_update_device(dev);
 543	return sprintf(buf, "%d\n", data->alarms);
 544}
 545static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL);
 546
 547static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
 548			  char *buf)
 549{
 550	int bitnr = to_sensor_dev_attr(attr)->index;
 551	struct vt8231_data *data = vt8231_update_device(dev);
 552	return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
 553}
 554static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
 555static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 11);
 556static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 0);
 557static SENSOR_DEVICE_ATTR(temp4_alarm, S_IRUGO, show_alarm, NULL, 1);
 558static SENSOR_DEVICE_ATTR(temp5_alarm, S_IRUGO, show_alarm, NULL, 3);
 559static SENSOR_DEVICE_ATTR(temp6_alarm, S_IRUGO, show_alarm, NULL, 8);
 560static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 11);
 561static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 0);
 562static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 1);
 563static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
 564static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
 565static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 2);
 566static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
 567static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
 568
 569static ssize_t show_name(struct device *dev, struct device_attribute
 570			 *devattr, char *buf)
 571{
 572	struct vt8231_data *data = dev_get_drvdata(dev);
 573	return sprintf(buf, "%s\n", data->name);
 574}
 575static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
 576
 577static struct attribute *vt8231_attributes_temps[6][5] = {
 578	{
 579		&dev_attr_temp1_input.attr,
 580		&dev_attr_temp1_max_hyst.attr,
 581		&dev_attr_temp1_max.attr,
 582		&sensor_dev_attr_temp1_alarm.dev_attr.attr,
 583		NULL
 584	}, {
 585		&sensor_dev_attr_temp2_input.dev_attr.attr,
 586		&sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
 587		&sensor_dev_attr_temp2_max.dev_attr.attr,
 588		&sensor_dev_attr_temp2_alarm.dev_attr.attr,
 589		NULL
 590	}, {
 591		&sensor_dev_attr_temp3_input.dev_attr.attr,
 592		&sensor_dev_attr_temp3_max_hyst.dev_attr.attr,
 593		&sensor_dev_attr_temp3_max.dev_attr.attr,
 594		&sensor_dev_attr_temp3_alarm.dev_attr.attr,
 595		NULL
 596	}, {
 597		&sensor_dev_attr_temp4_input.dev_attr.attr,
 598		&sensor_dev_attr_temp4_max_hyst.dev_attr.attr,
 599		&sensor_dev_attr_temp4_max.dev_attr.attr,
 600		&sensor_dev_attr_temp4_alarm.dev_attr.attr,
 601		NULL
 602	}, {
 603		&sensor_dev_attr_temp5_input.dev_attr.attr,
 604		&sensor_dev_attr_temp5_max_hyst.dev_attr.attr,
 605		&sensor_dev_attr_temp5_max.dev_attr.attr,
 606		&sensor_dev_attr_temp5_alarm.dev_attr.attr,
 607		NULL
 608	}, {
 609		&sensor_dev_attr_temp6_input.dev_attr.attr,
 610		&sensor_dev_attr_temp6_max_hyst.dev_attr.attr,
 611		&sensor_dev_attr_temp6_max.dev_attr.attr,
 612		&sensor_dev_attr_temp6_alarm.dev_attr.attr,
 613		NULL
 614	}
 615};
 616
 617static const struct attribute_group vt8231_group_temps[6] = {
 618	{ .attrs = vt8231_attributes_temps[0] },
 619	{ .attrs = vt8231_attributes_temps[1] },
 620	{ .attrs = vt8231_attributes_temps[2] },
 621	{ .attrs = vt8231_attributes_temps[3] },
 622	{ .attrs = vt8231_attributes_temps[4] },
 623	{ .attrs = vt8231_attributes_temps[5] },
 624};
 625
 626static struct attribute *vt8231_attributes_volts[6][5] = {
 627	{
 628		&sensor_dev_attr_in0_input.dev_attr.attr,
 629		&sensor_dev_attr_in0_min.dev_attr.attr,
 630		&sensor_dev_attr_in0_max.dev_attr.attr,
 631		&sensor_dev_attr_in0_alarm.dev_attr.attr,
 632		NULL
 633	}, {
 634		&sensor_dev_attr_in1_input.dev_attr.attr,
 635		&sensor_dev_attr_in1_min.dev_attr.attr,
 636		&sensor_dev_attr_in1_max.dev_attr.attr,
 637		&sensor_dev_attr_in1_alarm.dev_attr.attr,
 638		NULL
 639	}, {
 640		&sensor_dev_attr_in2_input.dev_attr.attr,
 641		&sensor_dev_attr_in2_min.dev_attr.attr,
 642		&sensor_dev_attr_in2_max.dev_attr.attr,
 643		&sensor_dev_attr_in2_alarm.dev_attr.attr,
 644		NULL
 645	}, {
 646		&sensor_dev_attr_in3_input.dev_attr.attr,
 647		&sensor_dev_attr_in3_min.dev_attr.attr,
 648		&sensor_dev_attr_in3_max.dev_attr.attr,
 649		&sensor_dev_attr_in3_alarm.dev_attr.attr,
 650		NULL
 651	}, {
 652		&sensor_dev_attr_in4_input.dev_attr.attr,
 653		&sensor_dev_attr_in4_min.dev_attr.attr,
 654		&sensor_dev_attr_in4_max.dev_attr.attr,
 655		&sensor_dev_attr_in4_alarm.dev_attr.attr,
 656		NULL
 657	}, {
 658		&dev_attr_in5_input.attr,
 659		&dev_attr_in5_min.attr,
 660		&dev_attr_in5_max.attr,
 661		&sensor_dev_attr_in5_alarm.dev_attr.attr,
 662		NULL
 663	}
 664};
 665
 666static const struct attribute_group vt8231_group_volts[6] = {
 667	{ .attrs = vt8231_attributes_volts[0] },
 668	{ .attrs = vt8231_attributes_volts[1] },
 669	{ .attrs = vt8231_attributes_volts[2] },
 670	{ .attrs = vt8231_attributes_volts[3] },
 671	{ .attrs = vt8231_attributes_volts[4] },
 672	{ .attrs = vt8231_attributes_volts[5] },
 673};
 674
 675static struct attribute *vt8231_attributes[] = {
 676	&sensor_dev_attr_fan1_input.dev_attr.attr,
 677	&sensor_dev_attr_fan2_input.dev_attr.attr,
 678	&sensor_dev_attr_fan1_min.dev_attr.attr,
 679	&sensor_dev_attr_fan2_min.dev_attr.attr,
 680	&sensor_dev_attr_fan1_div.dev_attr.attr,
 681	&sensor_dev_attr_fan2_div.dev_attr.attr,
 682	&sensor_dev_attr_fan1_alarm.dev_attr.attr,
 683	&sensor_dev_attr_fan2_alarm.dev_attr.attr,
 684	&dev_attr_alarms.attr,
 685	&dev_attr_name.attr,
 686	NULL
 687};
 688
 689static const struct attribute_group vt8231_group = {
 690	.attrs = vt8231_attributes,
 691};
 692
 693static struct platform_driver vt8231_driver = {
 694	.driver = {
 695		.owner	= THIS_MODULE,
 696		.name	= "vt8231",
 697	},
 698	.probe	= vt8231_probe,
 699	.remove	= __devexit_p(vt8231_remove),
 700};
 701
 702static const struct pci_device_id vt8231_pci_ids[] = {
 703	{ PCI_DEVICE(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8231_4) },
 704	{ 0, }
 705};
 706
 707MODULE_DEVICE_TABLE(pci, vt8231_pci_ids);
 708
 709static int __devinit vt8231_pci_probe(struct pci_dev *dev,
 710			 	      const struct pci_device_id *id);
 711
 712static struct pci_driver vt8231_pci_driver = {
 713	.name		= "vt8231",
 714	.id_table	= vt8231_pci_ids,
 715	.probe		= vt8231_pci_probe,
 716};
 717
 718static int vt8231_probe(struct platform_device *pdev)
 719{
 720	struct resource *res;
 721	struct vt8231_data *data;
 722	int err = 0, i;
 723
 724	/* Reserve the ISA region */
 725	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
 726	if (!request_region(res->start, VT8231_EXTENT,
 727			    vt8231_driver.driver.name)) {
 728		dev_err(&pdev->dev, "Region 0x%lx-0x%lx already in use!\n",
 729			(unsigned long)res->start, (unsigned long)res->end);
 730		return -ENODEV;
 731	}
 732
 733	if (!(data = kzalloc(sizeof(struct vt8231_data), GFP_KERNEL))) {
 734		err = -ENOMEM;
 735		goto exit_release;
 736	}
 737
 738	platform_set_drvdata(pdev, data);
 739	data->addr = res->start;
 740	data->name = "vt8231";
 741
 742	mutex_init(&data->update_lock);
 743	vt8231_init_device(data);
 744
 745	/* Register sysfs hooks */
 746	if ((err = sysfs_create_group(&pdev->dev.kobj, &vt8231_group)))
 747		goto exit_free;
 
 748
 749	/* Must update device information to find out the config field */
 750	data->uch_config = vt8231_read_value(data, VT8231_REG_UCH_CONFIG);
 751
 752	for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++) {
 753		if (ISTEMP(i, data->uch_config)) {
 754			if ((err = sysfs_create_group(&pdev->dev.kobj,
 755					&vt8231_group_temps[i])))
 
 756				goto exit_remove_files;
 757		}
 758	}
 759
 760	for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++) {
 761		if (ISVOLT(i, data->uch_config)) {
 762			if ((err = sysfs_create_group(&pdev->dev.kobj,
 763					&vt8231_group_volts[i])))
 
 764				goto exit_remove_files;
 765		}
 766	}
 767
 768	data->hwmon_dev = hwmon_device_register(&pdev->dev);
 769	if (IS_ERR(data->hwmon_dev)) {
 770		err = PTR_ERR(data->hwmon_dev);
 771		goto exit_remove_files;
 772	}
 773	return 0;
 774
 775exit_remove_files:
 776	for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++)
 777		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_volts[i]);
 778
 779	for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++)
 780		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_temps[i]);
 781
 782	sysfs_remove_group(&pdev->dev.kobj, &vt8231_group);
 783
 784exit_free:
 785	platform_set_drvdata(pdev, NULL);
 786	kfree(data);
 787
 788exit_release:
 789	release_region(res->start, VT8231_EXTENT);
 790	return err;
 791}
 792
 793static int __devexit vt8231_remove(struct platform_device *pdev)
 794{
 795	struct vt8231_data *data = platform_get_drvdata(pdev);
 796	int i;
 797
 798	hwmon_device_unregister(data->hwmon_dev);
 799
 800	for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++)
 801		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_volts[i]);
 802
 803	for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++)
 804		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_temps[i]);
 805
 806	sysfs_remove_group(&pdev->dev.kobj, &vt8231_group);
 807
 808	release_region(data->addr, VT8231_EXTENT);
 809	platform_set_drvdata(pdev, NULL);
 810	kfree(data);
 811	return 0;
 812}
 813
 814static void vt8231_init_device(struct vt8231_data *data)
 815{
 816	vt8231_write_value(data, VT8231_REG_TEMP1_CONFIG, 0);
 817	vt8231_write_value(data, VT8231_REG_TEMP2_CONFIG, 0);
 818}
 819
 820static struct vt8231_data *vt8231_update_device(struct device *dev)
 821{
 822	struct vt8231_data *data = dev_get_drvdata(dev);
 823	int i;
 824	u16 low;
 825
 826	mutex_lock(&data->update_lock);
 827
 828	if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
 829	    || !data->valid) {
 830		for (i = 0; i < 6; i++) {
 831			if (ISVOLT(i, data->uch_config)) {
 832				data->in[i] = vt8231_read_value(data,
 833						regvolt[i]);
 834				data->in_min[i] = vt8231_read_value(data,
 835						regvoltmin[i]);
 836				data->in_max[i] = vt8231_read_value(data,
 837						regvoltmax[i]);
 838			}
 839		}
 840		for (i = 0; i < 2; i++) {
 841			data->fan[i] = vt8231_read_value(data,
 842						VT8231_REG_FAN(i));
 843			data->fan_min[i] = vt8231_read_value(data,
 844						VT8231_REG_FAN_MIN(i));
 845		}
 846
 847		low = vt8231_read_value(data, VT8231_REG_TEMP_LOW01);
 848		low = (low >> 6) | ((low & 0x30) >> 2)
 849		    | (vt8231_read_value(data, VT8231_REG_TEMP_LOW25) << 4);
 850		for (i = 0; i < 6; i++) {
 851			if (ISTEMP(i, data->uch_config)) {
 852				data->temp[i] = (vt8231_read_value(data,
 853						       regtemp[i]) << 2)
 854						| ((low >> (2 * i)) & 0x03);
 855				data->temp_max[i] = vt8231_read_value(data,
 856						      regtempmax[i]);
 857				data->temp_min[i] = vt8231_read_value(data,
 858						      regtempmin[i]);
 859			}
 860		}
 861
 862		i = vt8231_read_value(data, VT8231_REG_FANDIV);
 863		data->fan_div[0] = (i >> 4) & 0x03;
 864		data->fan_div[1] = i >> 6;
 865		data->alarms = vt8231_read_value(data, VT8231_REG_ALARM1) |
 866			(vt8231_read_value(data, VT8231_REG_ALARM2) << 8);
 867
 868		/* Set alarm flags correctly */
 869		if (!data->fan[0] && data->fan_min[0]) {
 870			data->alarms |= 0x40;
 871		} else if (data->fan[0] && !data->fan_min[0]) {
 872			data->alarms &= ~0x40;
 873		}
 874
 875		if (!data->fan[1] && data->fan_min[1]) {
 876			data->alarms |= 0x80;
 877		} else if (data->fan[1] && !data->fan_min[1]) {
 878			data->alarms &= ~0x80;
 879		}
 880
 881		data->last_updated = jiffies;
 882		data->valid = 1;
 883	}
 884
 885	mutex_unlock(&data->update_lock);
 
 
 
 886
 887	return data;
 888}
 889
 890static int __devinit vt8231_device_add(unsigned short address)
 891{
 892	struct resource res = {
 893		.start	= address,
 894		.end	= address + VT8231_EXTENT - 1,
 895		.name	= "vt8231",
 896		.flags	= IORESOURCE_IO,
 897	};
 898	int err;
 899
 900	err = acpi_check_resource_conflict(&res);
 901	if (err)
 902		goto exit;
 903
 904	pdev = platform_device_alloc("vt8231", address);
 905	if (!pdev) {
 906		err = -ENOMEM;
 907		pr_err("Device allocation failed\n");
 908		goto exit;
 909	}
 910
 911	err = platform_device_add_resources(pdev, &res, 1);
 912	if (err) {
 913		pr_err("Device resource addition failed (%d)\n", err);
 914		goto exit_device_put;
 915	}
 916
 917	err = platform_device_add(pdev);
 918	if (err) {
 919		pr_err("Device addition failed (%d)\n", err);
 920		goto exit_device_put;
 921	}
 922
 923	return 0;
 924
 925exit_device_put:
 926	platform_device_put(pdev);
 927exit:
 928	return err;
 929}
 930
 931static int __devinit vt8231_pci_probe(struct pci_dev *dev,
 932				const struct pci_device_id *id)
 933{
 934	u16 address, val;
 
 
 935	if (force_addr) {
 936		address = force_addr & 0xff00;
 937		dev_warn(&dev->dev, "Forcing ISA address 0x%x\n",
 938			 address);
 939
 940		if (PCIBIOS_SUCCESSFUL !=
 941		    pci_write_config_word(dev, VT8231_BASE_REG, address | 1))
 942			return -ENODEV;
 943	}
 944
 945	if (PCIBIOS_SUCCESSFUL != pci_read_config_word(dev, VT8231_BASE_REG,
 946							&val))
 947		return -ENODEV;
 948
 949	address = val & ~(VT8231_EXTENT - 1);
 950	if (address == 0) {
 951		dev_err(&dev->dev, "base address not set - upgrade BIOS or use force_addr=0xaddr\n");
 952		return -ENODEV;
 953	}
 954
 955	if (PCIBIOS_SUCCESSFUL != pci_read_config_word(dev, VT8231_ENABLE_REG,
 956							&val))
 957		return -ENODEV;
 958
 959	if (!(val & 0x0001)) {
 960		dev_warn(&dev->dev, "enabling sensors\n");
 961		if (PCIBIOS_SUCCESSFUL !=
 962			pci_write_config_word(dev, VT8231_ENABLE_REG,
 963							val | 0x0001))
 964			return -ENODEV;
 965	}
 966
 967	if (platform_driver_register(&vt8231_driver))
 968		goto exit;
 969
 970	/* Sets global pdev as a side effect */
 971	if (vt8231_device_add(address))
 972		goto exit_unregister;
 973
 974	/* Always return failure here.  This is to allow other drivers to bind
 
 975	 * to this pci device.  We don't really want to have control over the
 976	 * pci device, we only wanted to read as few register values from it.
 977	 */
 978
 979	/* We do, however, mark ourselves as using the PCI device to stop it
 980	   getting unloaded. */
 
 
 981	s_bridge = pci_dev_get(dev);
 982	return -ENODEV;
 983
 984exit_unregister:
 985	platform_driver_unregister(&vt8231_driver);
 986exit:
 987	return -ENODEV;
 988}
 
 
 
 
 
 
 989
 990static int __init sm_vt8231_init(void)
 991{
 992	return pci_register_driver(&vt8231_pci_driver);
 993}
 994
 995static void __exit sm_vt8231_exit(void)
 996{
 997	pci_unregister_driver(&vt8231_pci_driver);
 998	if (s_bridge != NULL) {
 999		platform_device_unregister(pdev);
1000		platform_driver_unregister(&vt8231_driver);
1001		pci_dev_put(s_bridge);
1002		s_bridge = NULL;
1003	}
1004}
1005
1006MODULE_AUTHOR("Roger Lucas <vt8231@hiddenengine.co.uk>");
1007MODULE_DESCRIPTION("VT8231 sensors");
1008MODULE_LICENSE("GPL");
1009
1010module_init(sm_vt8231_init);
1011module_exit(sm_vt8231_exit);
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 * vt8231.c - Part of lm_sensors, Linux kernel modules
   4 *	      for hardware monitoring
   5 *
   6 * Copyright (c) 2005 Roger Lucas <vt8231@hiddenengine.co.uk>
   7 * Copyright (c) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
   8 *		      Aaron M. Marsh <amarsh@sdf.lonestar.org>
   9 */
  10
  11/*
  12 * Supports VIA VT8231 South Bridge embedded sensors
  13 */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  14
  15#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  16
  17#include <linux/module.h>
  18#include <linux/init.h>
  19#include <linux/slab.h>
  20#include <linux/pci.h>
  21#include <linux/jiffies.h>
  22#include <linux/platform_device.h>
  23#include <linux/hwmon.h>
  24#include <linux/hwmon-sysfs.h>
 
  25#include <linux/err.h>
  26#include <linux/mutex.h>
  27#include <linux/acpi.h>
  28#include <linux/io.h>
  29
  30static int force_addr;
  31module_param(force_addr, int, 0);
  32MODULE_PARM_DESC(force_addr, "Initialize the base address of the sensors");
  33
  34static struct platform_device *pdev;
  35
  36#define VT8231_EXTENT 0x80
  37#define VT8231_BASE_REG 0x70
  38#define VT8231_ENABLE_REG 0x74
  39
  40#define DRIVER_NAME "vt8231"
  41
  42/*
  43 * The VT8231 registers
  44 *
  45 * The reset value for the input channel configuration is used (Reg 0x4A=0x07)
  46 * which sets the selected inputs marked with '*' below if multiple options are
  47 * possible:
  48 *
  49 *		    Voltage Mode	  Temperature Mode
  50 *	Sensor	      Linux Id	      Linux Id	      VIA Id
  51 *	--------      --------	      --------	      ------
  52 *	CPU Diode	N/A		temp1		0
  53 *	UIC1		in0		temp2 *		1
  54 *	UIC2		in1 *		temp3		2
  55 *	UIC3		in2 *		temp4		3
  56 *	UIC4		in3 *		temp5		4
  57 *	UIC5		in4 *		temp6		5
  58 *	3.3V		in5		N/A
  59 *
  60 * Note that the BIOS may set the configuration register to a different value
  61 * to match the motherboard configuration.
  62 */
  63
  64/* fans numbered 0-1 */
  65#define VT8231_REG_FAN_MIN(nr)	(0x3b + (nr))
  66#define VT8231_REG_FAN(nr)	(0x29 + (nr))
  67
  68/* Voltage inputs numbered 0-5 */
  69
  70static const u8 regvolt[]    = { 0x21, 0x22, 0x23, 0x24, 0x25, 0x26 };
  71static const u8 regvoltmax[] = { 0x3d, 0x2b, 0x2d, 0x2f, 0x31, 0x33 };
  72static const u8 regvoltmin[] = { 0x3e, 0x2c, 0x2e, 0x30, 0x32, 0x34 };
  73
  74/*
  75 * Temperatures are numbered 1-6 according to the Linux kernel specification.
  76 *
  77 * In the VIA datasheet, however, the temperatures are numbered from zero.
  78 * Since it is important that this driver can easily be compared to the VIA
  79 * datasheet, we will use the VIA numbering within this driver and map the
  80 * kernel sysfs device name to the VIA number in the sysfs callback.
  81 */
  82
  83#define VT8231_REG_TEMP_LOW01	0x49
  84#define VT8231_REG_TEMP_LOW25	0x4d
  85
  86static const u8 regtemp[]    = { 0x1f, 0x21, 0x22, 0x23, 0x24, 0x25 };
  87static const u8 regtempmax[] = { 0x39, 0x3d, 0x2b, 0x2d, 0x2f, 0x31 };
  88static const u8 regtempmin[] = { 0x3a, 0x3e, 0x2c, 0x2e, 0x30, 0x32 };
  89
  90#define TEMP_FROM_REG(reg)		(((253 * 4 - (reg)) * 550 + 105) / 210)
  91#define TEMP_MAXMIN_FROM_REG(reg)	(((253 - (reg)) * 2200 + 105) / 210)
  92#define TEMP_MAXMIN_TO_REG(val)		(253 - ((val) * 210 + 1100) / 2200)
  93
  94#define VT8231_REG_CONFIG 0x40
  95#define VT8231_REG_ALARM1 0x41
  96#define VT8231_REG_ALARM2 0x42
  97#define VT8231_REG_FANDIV 0x47
  98#define VT8231_REG_UCH_CONFIG 0x4a
  99#define VT8231_REG_TEMP1_CONFIG 0x4b
 100#define VT8231_REG_TEMP2_CONFIG 0x4c
 101
 102/*
 103 * temps 0-5 as numbered in VIA datasheet - see later for mapping to Linux
 104 * numbering
 105 */
 106#define ISTEMP(i, ch_config) ((i) == 0 ? 1 : \
 107			      ((ch_config) >> ((i)+1)) & 0x01)
 108/* voltages 0-5 */
 109#define ISVOLT(i, ch_config) ((i) == 5 ? 1 : \
 110			      !(((ch_config) >> ((i)+2)) & 0x01))
 111
 112#define DIV_FROM_REG(val) (1 << (val))
 113
 114/*
 115 * NB  The values returned here are NOT temperatures.  The calibration curves
 116 *     for the thermistor curves are board-specific and must go in the
 117 *     sensors.conf file.  Temperature sensors are actually ten bits, but the
 118 *     VIA datasheet only considers the 8 MSBs obtained from the regtemp[]
 119 *     register.  The temperature value returned should have a magnitude of 3,
 120 *     so we use the VIA scaling as the "true" scaling and use the remaining 2
 121 *     LSBs as fractional precision.
 122 *
 123 *     All the on-chip hardware temperature comparisons for the alarms are only
 124 *     8-bits wide, and compare against the 8 MSBs of the temperature.  The bits
 125 *     in the registers VT8231_REG_TEMP_LOW01 and VT8231_REG_TEMP_LOW25 are
 126 *     ignored.
 127 */
 128
 129/*
 130 ****** FAN RPM CONVERSIONS ********
 131 * This chip saturates back at 0, not at 255 like many the other chips.
 132 * So, 0 means 0 RPM
 133 */
 134static inline u8 FAN_TO_REG(long rpm, int div)
 135{
 136	if (rpm <= 0 || rpm > 1310720)
 137		return 0;
 138	return clamp_val(1310720 / (rpm * div), 1, 255);
 139}
 140
 141#define FAN_FROM_REG(val, div) ((val) == 0 ? 0 : 1310720 / ((val) * (div)))
 142
 143struct vt8231_data {
 144	unsigned short addr;
 145	const char *name;
 146
 147	struct mutex update_lock;
 148	struct device *hwmon_dev;
 149	bool valid;		/* true if following fields are valid */
 150	unsigned long last_updated;	/* In jiffies */
 151
 152	u8 in[6];		/* Register value */
 153	u8 in_max[6];		/* Register value */
 154	u8 in_min[6];		/* Register value */
 155	u16 temp[6];		/* Register value 10 bit, right aligned */
 156	u8 temp_max[6];		/* Register value */
 157	u8 temp_min[6];		/* Register value */
 158	u8 fan[2];		/* Register value */
 159	u8 fan_min[2];		/* Register value */
 160	u8 fan_div[2];		/* Register encoding, shifted right */
 161	u16 alarms;		/* Register encoding */
 162	u8 uch_config;
 163};
 164
 165static struct pci_dev *s_bridge;
 
 
 
 
 166
 167static inline int vt8231_read_value(struct vt8231_data *data, u8 reg)
 168{
 169	return inb_p(data->addr + reg);
 170}
 171
 172static inline void vt8231_write_value(struct vt8231_data *data, u8 reg,
 173					u8 value)
 174{
 175	outb_p(value, data->addr + reg);
 176}
 177
 178static struct vt8231_data *vt8231_update_device(struct device *dev)
 179{
 180	struct vt8231_data *data = dev_get_drvdata(dev);
 181	int i;
 182	u16 low;
 183
 184	mutex_lock(&data->update_lock);
 185
 186	if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
 187	    || !data->valid) {
 188		for (i = 0; i < 6; i++) {
 189			if (ISVOLT(i, data->uch_config)) {
 190				data->in[i] = vt8231_read_value(data,
 191						regvolt[i]);
 192				data->in_min[i] = vt8231_read_value(data,
 193						regvoltmin[i]);
 194				data->in_max[i] = vt8231_read_value(data,
 195						regvoltmax[i]);
 196			}
 197		}
 198		for (i = 0; i < 2; i++) {
 199			data->fan[i] = vt8231_read_value(data,
 200						VT8231_REG_FAN(i));
 201			data->fan_min[i] = vt8231_read_value(data,
 202						VT8231_REG_FAN_MIN(i));
 203		}
 204
 205		low = vt8231_read_value(data, VT8231_REG_TEMP_LOW01);
 206		low = (low >> 6) | ((low & 0x30) >> 2)
 207		    | (vt8231_read_value(data, VT8231_REG_TEMP_LOW25) << 4);
 208		for (i = 0; i < 6; i++) {
 209			if (ISTEMP(i, data->uch_config)) {
 210				data->temp[i] = (vt8231_read_value(data,
 211						       regtemp[i]) << 2)
 212						| ((low >> (2 * i)) & 0x03);
 213				data->temp_max[i] = vt8231_read_value(data,
 214						      regtempmax[i]);
 215				data->temp_min[i] = vt8231_read_value(data,
 216						      regtempmin[i]);
 217			}
 218		}
 219
 220		i = vt8231_read_value(data, VT8231_REG_FANDIV);
 221		data->fan_div[0] = (i >> 4) & 0x03;
 222		data->fan_div[1] = i >> 6;
 223		data->alarms = vt8231_read_value(data, VT8231_REG_ALARM1) |
 224			(vt8231_read_value(data, VT8231_REG_ALARM2) << 8);
 225
 226		/* Set alarm flags correctly */
 227		if (!data->fan[0] && data->fan_min[0])
 228			data->alarms |= 0x40;
 229		else if (data->fan[0] && !data->fan_min[0])
 230			data->alarms &= ~0x40;
 231
 232		if (!data->fan[1] && data->fan_min[1])
 233			data->alarms |= 0x80;
 234		else if (data->fan[1] && !data->fan_min[1])
 235			data->alarms &= ~0x80;
 236
 237		data->last_updated = jiffies;
 238		data->valid = true;
 239	}
 240
 241	mutex_unlock(&data->update_lock);
 242
 243	return data;
 244}
 245
 246/* following are the sysfs callback functions */
 247static ssize_t in_show(struct device *dev, struct device_attribute *attr,
 248		       char *buf)
 249{
 250	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 251	int nr = sensor_attr->index;
 252	struct vt8231_data *data = vt8231_update_device(dev);
 253
 254	return sprintf(buf, "%d\n", ((data->in[nr] - 3) * 10000) / 958);
 255}
 256
 257static ssize_t in_min_show(struct device *dev, struct device_attribute *attr,
 258			   char *buf)
 259{
 260	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 261	int nr = sensor_attr->index;
 262	struct vt8231_data *data = vt8231_update_device(dev);
 263
 264	return sprintf(buf, "%d\n", ((data->in_min[nr] - 3) * 10000) / 958);
 265}
 266
 267static ssize_t in_max_show(struct device *dev, struct device_attribute *attr,
 268			   char *buf)
 269{
 270	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 271	int nr = sensor_attr->index;
 272	struct vt8231_data *data = vt8231_update_device(dev);
 273
 274	return sprintf(buf, "%d\n", (((data->in_max[nr] - 3) * 10000) / 958));
 275}
 276
 277static ssize_t in_min_store(struct device *dev, struct device_attribute *attr,
 278			    const char *buf, size_t count)
 279{
 280	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 281	int nr = sensor_attr->index;
 282	struct vt8231_data *data = dev_get_drvdata(dev);
 283	unsigned long val;
 284	int err;
 285
 286	err = kstrtoul(buf, 10, &val);
 287	if (err)
 288		return err;
 289
 290	mutex_lock(&data->update_lock);
 291	data->in_min[nr] = clamp_val(((val * 958) / 10000) + 3, 0, 255);
 292	vt8231_write_value(data, regvoltmin[nr], data->in_min[nr]);
 293	mutex_unlock(&data->update_lock);
 294	return count;
 295}
 296
 297static ssize_t in_max_store(struct device *dev, struct device_attribute *attr,
 298			    const char *buf, size_t count)
 299{
 300	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 301	int nr = sensor_attr->index;
 302	struct vt8231_data *data = dev_get_drvdata(dev);
 303	unsigned long val;
 304	int err;
 305
 306	err = kstrtoul(buf, 10, &val);
 307	if (err)
 308		return err;
 309
 310	mutex_lock(&data->update_lock);
 311	data->in_max[nr] = clamp_val(((val * 958) / 10000) + 3, 0, 255);
 312	vt8231_write_value(data, regvoltmax[nr], data->in_max[nr]);
 313	mutex_unlock(&data->update_lock);
 314	return count;
 315}
 316
 317/* Special case for input 5 as this has 3.3V scaling built into the chip */
 318static ssize_t in5_input_show(struct device *dev,
 319			      struct device_attribute *attr, char *buf)
 320{
 321	struct vt8231_data *data = vt8231_update_device(dev);
 322
 323	return sprintf(buf, "%d\n",
 324		(((data->in[5] - 3) * 10000 * 54) / (958 * 34)));
 325}
 326
 327static ssize_t in5_min_show(struct device *dev, struct device_attribute *attr,
 328		char *buf)
 329{
 330	struct vt8231_data *data = vt8231_update_device(dev);
 331
 332	return sprintf(buf, "%d\n",
 333		(((data->in_min[5] - 3) * 10000 * 54) / (958 * 34)));
 334}
 335
 336static ssize_t in5_max_show(struct device *dev, struct device_attribute *attr,
 337		char *buf)
 338{
 339	struct vt8231_data *data = vt8231_update_device(dev);
 340
 341	return sprintf(buf, "%d\n",
 342		(((data->in_max[5] - 3) * 10000 * 54) / (958 * 34)));
 343}
 344
 345static ssize_t in5_min_store(struct device *dev,
 346			     struct device_attribute *attr, const char *buf,
 347			     size_t count)
 348{
 349	struct vt8231_data *data = dev_get_drvdata(dev);
 350	unsigned long val;
 351	int err;
 352
 353	err = kstrtoul(buf, 10, &val);
 354	if (err)
 355		return err;
 356
 357	mutex_lock(&data->update_lock);
 358	data->in_min[5] = clamp_val(((val * 958 * 34) / (10000 * 54)) + 3,
 359				    0, 255);
 360	vt8231_write_value(data, regvoltmin[5], data->in_min[5]);
 361	mutex_unlock(&data->update_lock);
 362	return count;
 363}
 364
 365static ssize_t in5_max_store(struct device *dev,
 366			     struct device_attribute *attr, const char *buf,
 367			     size_t count)
 368{
 369	struct vt8231_data *data = dev_get_drvdata(dev);
 370	unsigned long val;
 371	int err;
 372
 373	err = kstrtoul(buf, 10, &val);
 374	if (err)
 375		return err;
 376
 377	mutex_lock(&data->update_lock);
 378	data->in_max[5] = clamp_val(((val * 958 * 34) / (10000 * 54)) + 3,
 379				    0, 255);
 380	vt8231_write_value(data, regvoltmax[5], data->in_max[5]);
 381	mutex_unlock(&data->update_lock);
 382	return count;
 383}
 384
 385static SENSOR_DEVICE_ATTR_RO(in0_input, in, 0);
 386static SENSOR_DEVICE_ATTR_RW(in0_min, in_min, 0);
 387static SENSOR_DEVICE_ATTR_RW(in0_max, in_max, 0);
 388static SENSOR_DEVICE_ATTR_RO(in1_input, in, 1);
 389static SENSOR_DEVICE_ATTR_RW(in1_min, in_min, 1);
 390static SENSOR_DEVICE_ATTR_RW(in1_max, in_max, 1);
 391static SENSOR_DEVICE_ATTR_RO(in2_input, in, 2);
 392static SENSOR_DEVICE_ATTR_RW(in2_min, in_min, 2);
 393static SENSOR_DEVICE_ATTR_RW(in2_max, in_max, 2);
 394static SENSOR_DEVICE_ATTR_RO(in3_input, in, 3);
 395static SENSOR_DEVICE_ATTR_RW(in3_min, in_min, 3);
 396static SENSOR_DEVICE_ATTR_RW(in3_max, in_max, 3);
 397static SENSOR_DEVICE_ATTR_RO(in4_input, in, 4);
 398static SENSOR_DEVICE_ATTR_RW(in4_min, in_min, 4);
 399static SENSOR_DEVICE_ATTR_RW(in4_max, in_max, 4);
 400
 401static DEVICE_ATTR_RO(in5_input);
 402static DEVICE_ATTR_RW(in5_min);
 403static DEVICE_ATTR_RW(in5_max);
 404
 405/* Temperatures */
 406static ssize_t temp1_input_show(struct device *dev,
 407				struct device_attribute *attr, char *buf)
 408{
 409	struct vt8231_data *data = vt8231_update_device(dev);
 410	return sprintf(buf, "%d\n", data->temp[0] * 250);
 411}
 412
 413static ssize_t temp1_max_show(struct device *dev, struct device_attribute *attr,
 414		char *buf)
 415{
 416	struct vt8231_data *data = vt8231_update_device(dev);
 417	return sprintf(buf, "%d\n", data->temp_max[0] * 1000);
 418}
 419
 420static ssize_t temp1_max_hyst_show(struct device *dev,
 421				   struct device_attribute *attr, char *buf)
 422{
 423	struct vt8231_data *data = vt8231_update_device(dev);
 424	return sprintf(buf, "%d\n", data->temp_min[0] * 1000);
 425}
 426
 427static ssize_t temp1_max_store(struct device *dev,
 428			       struct device_attribute *attr, const char *buf,
 429			       size_t count)
 430{
 431	struct vt8231_data *data = dev_get_drvdata(dev);
 432	long val;
 433	int err;
 434
 435	err = kstrtol(buf, 10, &val);
 436	if (err)
 437		return err;
 438
 439	mutex_lock(&data->update_lock);
 440	data->temp_max[0] = clamp_val((val + 500) / 1000, 0, 255);
 441	vt8231_write_value(data, regtempmax[0], data->temp_max[0]);
 442	mutex_unlock(&data->update_lock);
 443	return count;
 444}
 445static ssize_t temp1_max_hyst_store(struct device *dev,
 446				    struct device_attribute *attr,
 447				    const char *buf, size_t count)
 448{
 449	struct vt8231_data *data = dev_get_drvdata(dev);
 450	long val;
 451	int err;
 452
 453	err = kstrtol(buf, 10, &val);
 454	if (err)
 455		return err;
 456
 457	mutex_lock(&data->update_lock);
 458	data->temp_min[0] = clamp_val((val + 500) / 1000, 0, 255);
 459	vt8231_write_value(data, regtempmin[0], data->temp_min[0]);
 460	mutex_unlock(&data->update_lock);
 461	return count;
 462}
 463
 464static ssize_t temp_show(struct device *dev, struct device_attribute *attr,
 465			 char *buf)
 466{
 467	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 468	int nr = sensor_attr->index;
 469	struct vt8231_data *data = vt8231_update_device(dev);
 470	return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[nr]));
 471}
 472
 473static ssize_t temp_max_show(struct device *dev,
 474			     struct device_attribute *attr, char *buf)
 475{
 476	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 477	int nr = sensor_attr->index;
 478	struct vt8231_data *data = vt8231_update_device(dev);
 479	return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_max[nr]));
 480}
 481
 482static ssize_t temp_min_show(struct device *dev,
 483			     struct device_attribute *attr, char *buf)
 484{
 485	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 486	int nr = sensor_attr->index;
 487	struct vt8231_data *data = vt8231_update_device(dev);
 488	return sprintf(buf, "%d\n", TEMP_MAXMIN_FROM_REG(data->temp_min[nr]));
 489}
 490
 491static ssize_t temp_max_store(struct device *dev,
 492			      struct device_attribute *attr, const char *buf,
 493			      size_t count)
 494{
 495	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 496	int nr = sensor_attr->index;
 497	struct vt8231_data *data = dev_get_drvdata(dev);
 498	long val;
 499	int err;
 500
 501	err = kstrtol(buf, 10, &val);
 502	if (err)
 503		return err;
 504
 505	mutex_lock(&data->update_lock);
 506	data->temp_max[nr] = clamp_val(TEMP_MAXMIN_TO_REG(val), 0, 255);
 507	vt8231_write_value(data, regtempmax[nr], data->temp_max[nr]);
 508	mutex_unlock(&data->update_lock);
 509	return count;
 510}
 511static ssize_t temp_min_store(struct device *dev,
 512			      struct device_attribute *attr, const char *buf,
 513			      size_t count)
 514{
 515	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 516	int nr = sensor_attr->index;
 517	struct vt8231_data *data = dev_get_drvdata(dev);
 518	long val;
 519	int err;
 520
 521	err = kstrtol(buf, 10, &val);
 522	if (err)
 523		return err;
 524
 525	mutex_lock(&data->update_lock);
 526	data->temp_min[nr] = clamp_val(TEMP_MAXMIN_TO_REG(val), 0, 255);
 527	vt8231_write_value(data, regtempmin[nr], data->temp_min[nr]);
 528	mutex_unlock(&data->update_lock);
 529	return count;
 530}
 531
 532/*
 533 * Note that these map the Linux temperature sensor numbering (1-6) to the VIA
 534 * temperature sensor numbering (0-5)
 535 */
 536
 537static DEVICE_ATTR_RO(temp1_input);
 538static DEVICE_ATTR_RW(temp1_max);
 539static DEVICE_ATTR_RW(temp1_max_hyst);
 540
 541static SENSOR_DEVICE_ATTR_RO(temp2_input, temp, 1);
 542static SENSOR_DEVICE_ATTR_RW(temp2_max, temp_max, 1);
 543static SENSOR_DEVICE_ATTR_RW(temp2_max_hyst, temp_min, 1);
 544static SENSOR_DEVICE_ATTR_RO(temp3_input, temp, 2);
 545static SENSOR_DEVICE_ATTR_RW(temp3_max, temp_max, 2);
 546static SENSOR_DEVICE_ATTR_RW(temp3_max_hyst, temp_min, 2);
 547static SENSOR_DEVICE_ATTR_RO(temp4_input, temp, 3);
 548static SENSOR_DEVICE_ATTR_RW(temp4_max, temp_max, 3);
 549static SENSOR_DEVICE_ATTR_RW(temp4_max_hyst, temp_min, 3);
 550static SENSOR_DEVICE_ATTR_RO(temp5_input, temp, 4);
 551static SENSOR_DEVICE_ATTR_RW(temp5_max, temp_max, 4);
 552static SENSOR_DEVICE_ATTR_RW(temp5_max_hyst, temp_min, 4);
 553static SENSOR_DEVICE_ATTR_RO(temp6_input, temp, 5);
 554static SENSOR_DEVICE_ATTR_RW(temp6_max, temp_max, 5);
 555static SENSOR_DEVICE_ATTR_RW(temp6_max_hyst, temp_min, 5);
 556
 557/* Fans */
 558static ssize_t fan_show(struct device *dev, struct device_attribute *attr,
 559			char *buf)
 560{
 561	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 562	int nr = sensor_attr->index;
 563	struct vt8231_data *data = vt8231_update_device(dev);
 564	return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[nr],
 565				DIV_FROM_REG(data->fan_div[nr])));
 566}
 567
 568static ssize_t fan_min_show(struct device *dev, struct device_attribute *attr,
 569			    char *buf)
 570{
 571	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 572	int nr = sensor_attr->index;
 573	struct vt8231_data *data = vt8231_update_device(dev);
 574	return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan_min[nr],
 575			DIV_FROM_REG(data->fan_div[nr])));
 576}
 577
 578static ssize_t fan_div_show(struct device *dev, struct device_attribute *attr,
 579			    char *buf)
 580{
 581	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 582	int nr = sensor_attr->index;
 583	struct vt8231_data *data = vt8231_update_device(dev);
 584	return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[nr]));
 585}
 586
 587static ssize_t fan_min_store(struct device *dev,
 588			     struct device_attribute *attr, const char *buf,
 589			     size_t count)
 590{
 591	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 592	int nr = sensor_attr->index;
 593	struct vt8231_data *data = dev_get_drvdata(dev);
 594	unsigned long val;
 595	int err;
 596
 597	err = kstrtoul(buf, 10, &val);
 598	if (err)
 599		return err;
 600
 601	mutex_lock(&data->update_lock);
 602	data->fan_min[nr] = FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
 603	vt8231_write_value(data, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
 604	mutex_unlock(&data->update_lock);
 605	return count;
 606}
 607
 608static ssize_t fan_div_store(struct device *dev,
 609			     struct device_attribute *attr, const char *buf,
 610			     size_t count)
 611{
 612	struct vt8231_data *data = dev_get_drvdata(dev);
 613	struct sensor_device_attribute *sensor_attr = to_sensor_dev_attr(attr);
 614	unsigned long val;
 615	int nr = sensor_attr->index;
 616	int old = vt8231_read_value(data, VT8231_REG_FANDIV);
 617	long min = FAN_FROM_REG(data->fan_min[nr],
 618				 DIV_FROM_REG(data->fan_div[nr]));
 619	int err;
 620
 621	err = kstrtoul(buf, 10, &val);
 622	if (err)
 623		return err;
 624
 625	mutex_lock(&data->update_lock);
 626	switch (val) {
 627	case 1:
 628		data->fan_div[nr] = 0;
 629		break;
 630	case 2:
 631		data->fan_div[nr] = 1;
 632		break;
 633	case 4:
 634		data->fan_div[nr] = 2;
 635		break;
 636	case 8:
 637		data->fan_div[nr] = 3;
 638		break;
 639	default:
 640		dev_err(dev,
 641			"fan_div value %ld not supported. Choose one of 1, 2, 4 or 8!\n",
 642			val);
 643		mutex_unlock(&data->update_lock);
 644		return -EINVAL;
 645	}
 646
 647	/* Correct the fan minimum speed */
 648	data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
 649	vt8231_write_value(data, VT8231_REG_FAN_MIN(nr), data->fan_min[nr]);
 650
 651	old = (old & 0x0f) | (data->fan_div[1] << 6) | (data->fan_div[0] << 4);
 652	vt8231_write_value(data, VT8231_REG_FANDIV, old);
 653	mutex_unlock(&data->update_lock);
 654	return count;
 655}
 656
 657static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0);
 658static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0);
 659static SENSOR_DEVICE_ATTR_RW(fan1_div, fan_div, 0);
 660static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1);
 661static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1);
 662static SENSOR_DEVICE_ATTR_RW(fan2_div, fan_div, 1);
 
 
 
 
 
 663
 664/* Alarms */
 665static ssize_t alarms_show(struct device *dev, struct device_attribute *attr,
 666			   char *buf)
 667{
 668	struct vt8231_data *data = vt8231_update_device(dev);
 669	return sprintf(buf, "%d\n", data->alarms);
 670}
 671static DEVICE_ATTR_RO(alarms);
 672
 673static ssize_t alarm_show(struct device *dev, struct device_attribute *attr,
 674			  char *buf)
 675{
 676	int bitnr = to_sensor_dev_attr(attr)->index;
 677	struct vt8231_data *data = vt8231_update_device(dev);
 678	return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
 679}
 680static SENSOR_DEVICE_ATTR_RO(temp1_alarm, alarm, 4);
 681static SENSOR_DEVICE_ATTR_RO(temp2_alarm, alarm, 11);
 682static SENSOR_DEVICE_ATTR_RO(temp3_alarm, alarm, 0);
 683static SENSOR_DEVICE_ATTR_RO(temp4_alarm, alarm, 1);
 684static SENSOR_DEVICE_ATTR_RO(temp5_alarm, alarm, 3);
 685static SENSOR_DEVICE_ATTR_RO(temp6_alarm, alarm, 8);
 686static SENSOR_DEVICE_ATTR_RO(in0_alarm, alarm, 11);
 687static SENSOR_DEVICE_ATTR_RO(in1_alarm, alarm, 0);
 688static SENSOR_DEVICE_ATTR_RO(in2_alarm, alarm, 1);
 689static SENSOR_DEVICE_ATTR_RO(in3_alarm, alarm, 3);
 690static SENSOR_DEVICE_ATTR_RO(in4_alarm, alarm, 8);
 691static SENSOR_DEVICE_ATTR_RO(in5_alarm, alarm, 2);
 692static SENSOR_DEVICE_ATTR_RO(fan1_alarm, alarm, 6);
 693static SENSOR_DEVICE_ATTR_RO(fan2_alarm, alarm, 7);
 694
 695static ssize_t name_show(struct device *dev, struct device_attribute
 696			 *devattr, char *buf)
 697{
 698	struct vt8231_data *data = dev_get_drvdata(dev);
 699	return sprintf(buf, "%s\n", data->name);
 700}
 701static DEVICE_ATTR_RO(name);
 702
 703static struct attribute *vt8231_attributes_temps[6][5] = {
 704	{
 705		&dev_attr_temp1_input.attr,
 706		&dev_attr_temp1_max_hyst.attr,
 707		&dev_attr_temp1_max.attr,
 708		&sensor_dev_attr_temp1_alarm.dev_attr.attr,
 709		NULL
 710	}, {
 711		&sensor_dev_attr_temp2_input.dev_attr.attr,
 712		&sensor_dev_attr_temp2_max_hyst.dev_attr.attr,
 713		&sensor_dev_attr_temp2_max.dev_attr.attr,
 714		&sensor_dev_attr_temp2_alarm.dev_attr.attr,
 715		NULL
 716	}, {
 717		&sensor_dev_attr_temp3_input.dev_attr.attr,
 718		&sensor_dev_attr_temp3_max_hyst.dev_attr.attr,
 719		&sensor_dev_attr_temp3_max.dev_attr.attr,
 720		&sensor_dev_attr_temp3_alarm.dev_attr.attr,
 721		NULL
 722	}, {
 723		&sensor_dev_attr_temp4_input.dev_attr.attr,
 724		&sensor_dev_attr_temp4_max_hyst.dev_attr.attr,
 725		&sensor_dev_attr_temp4_max.dev_attr.attr,
 726		&sensor_dev_attr_temp4_alarm.dev_attr.attr,
 727		NULL
 728	}, {
 729		&sensor_dev_attr_temp5_input.dev_attr.attr,
 730		&sensor_dev_attr_temp5_max_hyst.dev_attr.attr,
 731		&sensor_dev_attr_temp5_max.dev_attr.attr,
 732		&sensor_dev_attr_temp5_alarm.dev_attr.attr,
 733		NULL
 734	}, {
 735		&sensor_dev_attr_temp6_input.dev_attr.attr,
 736		&sensor_dev_attr_temp6_max_hyst.dev_attr.attr,
 737		&sensor_dev_attr_temp6_max.dev_attr.attr,
 738		&sensor_dev_attr_temp6_alarm.dev_attr.attr,
 739		NULL
 740	}
 741};
 742
 743static const struct attribute_group vt8231_group_temps[6] = {
 744	{ .attrs = vt8231_attributes_temps[0] },
 745	{ .attrs = vt8231_attributes_temps[1] },
 746	{ .attrs = vt8231_attributes_temps[2] },
 747	{ .attrs = vt8231_attributes_temps[3] },
 748	{ .attrs = vt8231_attributes_temps[4] },
 749	{ .attrs = vt8231_attributes_temps[5] },
 750};
 751
 752static struct attribute *vt8231_attributes_volts[6][5] = {
 753	{
 754		&sensor_dev_attr_in0_input.dev_attr.attr,
 755		&sensor_dev_attr_in0_min.dev_attr.attr,
 756		&sensor_dev_attr_in0_max.dev_attr.attr,
 757		&sensor_dev_attr_in0_alarm.dev_attr.attr,
 758		NULL
 759	}, {
 760		&sensor_dev_attr_in1_input.dev_attr.attr,
 761		&sensor_dev_attr_in1_min.dev_attr.attr,
 762		&sensor_dev_attr_in1_max.dev_attr.attr,
 763		&sensor_dev_attr_in1_alarm.dev_attr.attr,
 764		NULL
 765	}, {
 766		&sensor_dev_attr_in2_input.dev_attr.attr,
 767		&sensor_dev_attr_in2_min.dev_attr.attr,
 768		&sensor_dev_attr_in2_max.dev_attr.attr,
 769		&sensor_dev_attr_in2_alarm.dev_attr.attr,
 770		NULL
 771	}, {
 772		&sensor_dev_attr_in3_input.dev_attr.attr,
 773		&sensor_dev_attr_in3_min.dev_attr.attr,
 774		&sensor_dev_attr_in3_max.dev_attr.attr,
 775		&sensor_dev_attr_in3_alarm.dev_attr.attr,
 776		NULL
 777	}, {
 778		&sensor_dev_attr_in4_input.dev_attr.attr,
 779		&sensor_dev_attr_in4_min.dev_attr.attr,
 780		&sensor_dev_attr_in4_max.dev_attr.attr,
 781		&sensor_dev_attr_in4_alarm.dev_attr.attr,
 782		NULL
 783	}, {
 784		&dev_attr_in5_input.attr,
 785		&dev_attr_in5_min.attr,
 786		&dev_attr_in5_max.attr,
 787		&sensor_dev_attr_in5_alarm.dev_attr.attr,
 788		NULL
 789	}
 790};
 791
 792static const struct attribute_group vt8231_group_volts[6] = {
 793	{ .attrs = vt8231_attributes_volts[0] },
 794	{ .attrs = vt8231_attributes_volts[1] },
 795	{ .attrs = vt8231_attributes_volts[2] },
 796	{ .attrs = vt8231_attributes_volts[3] },
 797	{ .attrs = vt8231_attributes_volts[4] },
 798	{ .attrs = vt8231_attributes_volts[5] },
 799};
 800
 801static struct attribute *vt8231_attributes[] = {
 802	&sensor_dev_attr_fan1_input.dev_attr.attr,
 803	&sensor_dev_attr_fan2_input.dev_attr.attr,
 804	&sensor_dev_attr_fan1_min.dev_attr.attr,
 805	&sensor_dev_attr_fan2_min.dev_attr.attr,
 806	&sensor_dev_attr_fan1_div.dev_attr.attr,
 807	&sensor_dev_attr_fan2_div.dev_attr.attr,
 808	&sensor_dev_attr_fan1_alarm.dev_attr.attr,
 809	&sensor_dev_attr_fan2_alarm.dev_attr.attr,
 810	&dev_attr_alarms.attr,
 811	&dev_attr_name.attr,
 812	NULL
 813};
 814
 815static const struct attribute_group vt8231_group = {
 816	.attrs = vt8231_attributes,
 817};
 818
 819static void vt8231_init_device(struct vt8231_data *data)
 820{
 821	vt8231_write_value(data, VT8231_REG_TEMP1_CONFIG, 0);
 822	vt8231_write_value(data, VT8231_REG_TEMP2_CONFIG, 0);
 823}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 824
 825static int vt8231_probe(struct platform_device *pdev)
 826{
 827	struct resource *res;
 828	struct vt8231_data *data;
 829	int err = 0, i;
 830
 831	/* Reserve the ISA region */
 832	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
 833	if (!devm_request_region(&pdev->dev, res->start, VT8231_EXTENT,
 834				 DRIVER_NAME)) {
 835		dev_err(&pdev->dev, "Region 0x%lx-0x%lx already in use!\n",
 836			(unsigned long)res->start, (unsigned long)res->end);
 837		return -ENODEV;
 838	}
 839
 840	data = devm_kzalloc(&pdev->dev, sizeof(struct vt8231_data), GFP_KERNEL);
 841	if (!data)
 842		return -ENOMEM;
 
 843
 844	platform_set_drvdata(pdev, data);
 845	data->addr = res->start;
 846	data->name = DRIVER_NAME;
 847
 848	mutex_init(&data->update_lock);
 849	vt8231_init_device(data);
 850
 851	/* Register sysfs hooks */
 852	err = sysfs_create_group(&pdev->dev.kobj, &vt8231_group);
 853	if (err)
 854		return err;
 855
 856	/* Must update device information to find out the config field */
 857	data->uch_config = vt8231_read_value(data, VT8231_REG_UCH_CONFIG);
 858
 859	for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++) {
 860		if (ISTEMP(i, data->uch_config)) {
 861			err = sysfs_create_group(&pdev->dev.kobj,
 862						 &vt8231_group_temps[i]);
 863			if (err)
 864				goto exit_remove_files;
 865		}
 866	}
 867
 868	for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++) {
 869		if (ISVOLT(i, data->uch_config)) {
 870			err = sysfs_create_group(&pdev->dev.kobj,
 871						 &vt8231_group_volts[i]);
 872			if (err)
 873				goto exit_remove_files;
 874		}
 875	}
 876
 877	data->hwmon_dev = hwmon_device_register(&pdev->dev);
 878	if (IS_ERR(data->hwmon_dev)) {
 879		err = PTR_ERR(data->hwmon_dev);
 880		goto exit_remove_files;
 881	}
 882	return 0;
 883
 884exit_remove_files:
 885	for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++)
 886		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_volts[i]);
 887
 888	for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++)
 889		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_temps[i]);
 890
 891	sysfs_remove_group(&pdev->dev.kobj, &vt8231_group);
 
 
 
 
 
 
 
 892	return err;
 893}
 894
 895static void vt8231_remove(struct platform_device *pdev)
 896{
 897	struct vt8231_data *data = platform_get_drvdata(pdev);
 898	int i;
 899
 900	hwmon_device_unregister(data->hwmon_dev);
 901
 902	for (i = 0; i < ARRAY_SIZE(vt8231_group_volts); i++)
 903		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_volts[i]);
 904
 905	for (i = 0; i < ARRAY_SIZE(vt8231_group_temps); i++)
 906		sysfs_remove_group(&pdev->dev.kobj, &vt8231_group_temps[i]);
 907
 908	sysfs_remove_group(&pdev->dev.kobj, &vt8231_group);
 
 
 
 
 
 909}
 910
 
 
 
 
 
 911
 912static struct platform_driver vt8231_driver = {
 913	.driver	= {
 914		.name	= DRIVER_NAME,
 915	},
 916	.probe	= vt8231_probe,
 917	.remove	= vt8231_remove,
 918};
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 919
 920static const struct pci_device_id vt8231_pci_ids[] = {
 921	{ PCI_DEVICE(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8231_4) },
 922	{ 0, }
 923};
 924
 925MODULE_DEVICE_TABLE(pci, vt8231_pci_ids);
 
 926
 927static int vt8231_device_add(unsigned short address)
 928{
 929	struct resource res = {
 930		.start	= address,
 931		.end	= address + VT8231_EXTENT - 1,
 932		.name	= DRIVER_NAME,
 933		.flags	= IORESOURCE_IO,
 934	};
 935	int err;
 936
 937	err = acpi_check_resource_conflict(&res);
 938	if (err)
 939		goto exit;
 940
 941	pdev = platform_device_alloc(DRIVER_NAME, address);
 942	if (!pdev) {
 943		err = -ENOMEM;
 944		pr_err("Device allocation failed\n");
 945		goto exit;
 946	}
 947
 948	err = platform_device_add_resources(pdev, &res, 1);
 949	if (err) {
 950		pr_err("Device resource addition failed (%d)\n", err);
 951		goto exit_device_put;
 952	}
 953
 954	err = platform_device_add(pdev);
 955	if (err) {
 956		pr_err("Device addition failed (%d)\n", err);
 957		goto exit_device_put;
 958	}
 959
 960	return 0;
 961
 962exit_device_put:
 963	platform_device_put(pdev);
 964exit:
 965	return err;
 966}
 967
 968static int vt8231_pci_probe(struct pci_dev *dev,
 969				const struct pci_device_id *id)
 970{
 971	u16 address, val;
 972	int ret;
 973
 974	if (force_addr) {
 975		address = force_addr & 0xff00;
 976		dev_warn(&dev->dev, "Forcing ISA address 0x%x\n",
 977			 address);
 978
 979		ret = pci_write_config_word(dev, VT8231_BASE_REG, address | 1);
 980		if (ret != PCIBIOS_SUCCESSFUL)
 981			return -ENODEV;
 982	}
 983
 984	pci_read_config_word(dev, VT8231_BASE_REG, &val);
 985	if (val == (u16)~0)
 986		return -ENODEV;
 987
 988	address = val & ~(VT8231_EXTENT - 1);
 989	if (address == 0) {
 990		dev_err(&dev->dev, "base address not set - upgrade BIOS or use force_addr=0xaddr\n");
 991		return -ENODEV;
 992	}
 993
 994	pci_read_config_word(dev, VT8231_ENABLE_REG, &val);
 995	if (val == (u16)~0)
 996		return -ENODEV;
 997
 998	if (!(val & 0x0001)) {
 999		dev_warn(&dev->dev, "enabling sensors\n");
1000		ret = pci_write_config_word(dev, VT8231_ENABLE_REG, val | 0x1);
1001		if (ret != PCIBIOS_SUCCESSFUL)
 
1002			return -ENODEV;
1003	}
1004
1005	if (platform_driver_register(&vt8231_driver))
1006		goto exit;
1007
1008	/* Sets global pdev as a side effect */
1009	if (vt8231_device_add(address))
1010		goto exit_unregister;
1011
1012	/*
1013	 * Always return failure here.  This is to allow other drivers to bind
1014	 * to this pci device.  We don't really want to have control over the
1015	 * pci device, we only wanted to read as few register values from it.
1016	 */
1017
1018	/*
1019	 * We do, however, mark ourselves as using the PCI device to stop it
1020	 * getting unloaded.
1021	 */
1022	s_bridge = pci_dev_get(dev);
1023	return -ENODEV;
1024
1025exit_unregister:
1026	platform_driver_unregister(&vt8231_driver);
1027exit:
1028	return -ENODEV;
1029}
1030
1031static struct pci_driver vt8231_pci_driver = {
1032	.name		= DRIVER_NAME,
1033	.id_table	= vt8231_pci_ids,
1034	.probe		= vt8231_pci_probe,
1035};
1036
1037static int __init sm_vt8231_init(void)
1038{
1039	return pci_register_driver(&vt8231_pci_driver);
1040}
1041
1042static void __exit sm_vt8231_exit(void)
1043{
1044	pci_unregister_driver(&vt8231_pci_driver);
1045	if (s_bridge != NULL) {
1046		platform_device_unregister(pdev);
1047		platform_driver_unregister(&vt8231_driver);
1048		pci_dev_put(s_bridge);
1049		s_bridge = NULL;
1050	}
1051}
1052
1053MODULE_AUTHOR("Roger Lucas <vt8231@hiddenengine.co.uk>");
1054MODULE_DESCRIPTION("VT8231 sensors");
1055MODULE_LICENSE("GPL");
1056
1057module_init(sm_vt8231_init);
1058module_exit(sm_vt8231_exit);