it87 driver converted to sysfs
Greg,
I have converted it87 i2c driver to use sysfs. Please review it and submit it for inclusion.
Thank you,
florin
drivers/i2c/chips/it87.c +1002 -0
@@ -0,0 +1,1002 @@ +/* +it87.c - Part of lm_sensors, Linux kernel modules for hardware +monitoring. + +Supports: IT8705F Super I/O chip w/LPC interface +IT8712F Super I/O chup w/LPC interface & SMbus +Sis950 A clone of the IT8705F + +Copyright (c) 2001 Chris Gauthron <[email protected]> +Largely inspired by lm78.c of the same package + +This program is free software; you can redistribute it and/or modify +it under the terms of the GNU General Public License as published by +the Free Software Foundation; either version 2 of the License, or +(at your option) any later version. + +This program is distributed in the hope that it will be useful, +but WITHOUT ANY WARRANTY; without even the implied warranty of +MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +GNU General Public License for more details. + +You should have received a copy of the GNU General Public License +along with this program; if not, write to the Free Software +Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. +*/ + +/* +[email protected] David Gesswein 7/18/01 +Modified to fix bug with not all alarms enabled. +Added ability to read battery voltage and select temperature sensor +type at module load time. +*/ + +#include <linux/module.h> +#include <linux/init.h> +#include <linux/slab.h> +#include <linux/i2c.h> +#include <linux/i2c-sensor.h> +#include <asm/io.h> + + +/* Addresses to scan */ +static unsigned short normal_i2c[] = {SENSORS_I2C_END }; +static unsigned short normal_i2c_range[] = {0x20 ,0x2f ,SENSORS_I2C_END }; +static unsigned int normal_isa[] = {0x0290 ,SENSORS_ISA_END }; +static unsigned int normal_isa_range[] = {SENSORS_ISA_END }; + +/* Insmod parameters */ +SENSORS_INSMOD_4 (it87, it8705, it8712, sis950); + + +/* Update battery voltage after every reading if true */ +static int update_vbat =0 ; + + +/* Enable Temp1 as thermal resistor */ +/* Enable Temp2 as thermal diode */ +/* Enable Temp3 as thermal resistor */ +static int temp_type =0x2a ; + +/* Many IT87 constants specified below */ + +/* Length of ISA address segment */ +#define IT87_EXTENT 8 + +/* Where are the ISA address/data registers relative to the base address */ +#define IT87_ADDR_REG_OFFSET 5 +#define IT87_DATA_REG_OFFSET 6 + +/*----- The IT87 registers -----*/ + +#define IT87_REG_CONFIG 0x00 + +#define IT87_REG_ALARM1 0x01 +#define IT87_REG_ALARM2 0x02 +#define IT87_REG_ALARM3 0x03 + +#define IT87_REG_VID 0x0a +#define IT87_REG_FAN_DIV 0x0b + +/* Monitors: 9 voltage (0 to 7, battery), 3 temp (1 to 3), 3 fan (1 to 3) */ + +#define IT87_REG_FAN (nr) (0x0c + (nr)) +#define IT87_REG_FAN_MIN (nr) (0x0f + (nr)) +#define IT87_REG_FAN_CTRL 0x13 + +#define IT87_REG_VIN (nr) (0x20 + (nr)) +#define IT87_REG_TEMP (nr) (0x28 + (nr)) + +#define IT87_REG_VIN_MAX (nr) (0x30 + (nr) * 2) +#define IT87_REG_VIN_MIN (nr) (0x31 + (nr) * 2) +#define IT87_REG_TEMP_HIGH (nr) (0x3e + (nr) * 2) +#define IT87_REG_TEMP_LOW (nr) (0x3f + (nr) * 2) + +#define IT87_REG_I2C_ADDR 0x48 + +#define IT87_REG_VIN_ENABLE 0x50 +#define IT87_REG_TEMP_ENABLE 0x51 + +#define IT87_REG_CHIPID 0x58 + +static inline u8 IN_TO_REG (long val,int inNum) +{ +/* to avoid floating point, we multiply everything by 100. +val is guaranteed to be positive, so we can achieve the effect of +rounding by (...*10+5)/10. Note that the *10 is hidden in the +/250 (which should really be /2500). +At the end, we need to /100 because we *100 everything and we need +to /10 because of the rounding thing, so we /1000. */ +if (inNum <=1 ) +return (u8 ) +SENSORS_LIMIT (((val *210240 -13300 ) /250 +5 ) /1000 , +0 ,255 ); +else if (inNum ==2 ) +return (u8 ) +SENSORS_LIMIT (((val *157370 -13300 ) /250 +5 ) /1000 , +0 ,255 ); +else if (inNum ==3 ) +return (u8 ) +SENSORS_LIMIT (((val *101080 -13300 ) /250 +5 ) /1000 , +0 ,255 ); +else +return (u8 )SENSORS_LIMIT (((val *41714 -13300 ) /250 +5 ) + /1000 ,0 ,255 ); +} + +static inline long IN_FROM_REG (u8 val,int inNum) +{ +/* to avoid floating point, we multiply everything by 100. +val is guaranteed to be positive, so we can achieve the effect of +rounding by adding 0.5. Or, to avoid fp math, we do (...*10+5)/10. +We need to scale with *100 anyway, so no need to /100 at the end. */ +if (inNum <=1 ) +return (long ) (((250000 * val +13300 ) /210240 *10 +5 ) /10 ); +else if (inNum ==2 ) +return (long ) (((250000 * val +13300 ) /157370 *10 +5 ) /10 ); +else if (inNum ==3 ) +return (long ) (((250000 * val +13300 ) /101080 *10 +5 ) /10 ); +else +return (long ) (((250000 * val +13300 ) /41714 *10 +5 ) /10 ); +} + +static inline u8 FAN_TO_REG (long rpm,int div) +{ +if (rpm ==0 ) +return 255 ; + rpm =SENSORS_LIMIT (rpm,1 ,1000000 ); +return SENSORS_LIMIT ((1350000 + rpm * div /2 ) / (rpm * div),1 , +254 ); +} + +#define FAN_FROM_REG (val,div) ((val)==0?-1:(val)==255?0:1350000/((val)*(div))) + +#define TEMP_TO_REG (val) (SENSORS_LIMIT(((val)<0?(((val)-5)/10):\ + ((val)+5)/10),0,255)) +#define TEMP_FROM_REG (val) (((val)>0x80?(val)-0x100:(val))*10) + +#define VID_FROM_REG (val) ((val)==0x1f?0:(val)>=0x10?510-(val)*10:\ + 205-(val)*5) +#define ALARMS_FROM_REG (val) (val) + +#define DIV_TO_REG (val) ((val)==8?3:(val)==4?2:(val)==1?0:1) +#define DIV_FROM_REG (val) (1 << (val)) + +/* Initial limits. Use the config file to set better limits. */ +#define IT87_INIT_IN_0 170 +#define IT87_INIT_IN_1 250 +#define IT87_INIT_IN_2 (330 / 2) +#define IT87_INIT_IN_3 (((500) * 100)/168) +#define IT87_INIT_IN_4 (((1200) * 10)/38) +#define IT87_INIT_IN_5 (((1200) * 10)/72) +#define IT87_INIT_IN_6 (((500) * 10)/56) +#define IT87_INIT_IN_7 (((500) * 100)/168) + +#define IT87_INIT_IN_PERCENTAGE 10 + +#define IT87_INIT_IN_MIN_0 \ + (IT87_INIT_IN_0 - IT87_INIT_IN_0 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_0 \ + (IT87_INIT_IN_0 + IT87_INIT_IN_0 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_1 \ + (IT87_INIT_IN_1 - IT87_INIT_IN_1 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_1 \ + (IT87_INIT_IN_1 + IT87_INIT_IN_1 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_2 \ + (IT87_INIT_IN_2 - IT87_INIT_IN_2 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_2 \ + (IT87_INIT_IN_2 + IT87_INIT_IN_2 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_3 \ + (IT87_INIT_IN_3 - IT87_INIT_IN_3 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_3 \ + (IT87_INIT_IN_3 + IT87_INIT_IN_3 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_4 \ + (IT87_INIT_IN_4 - IT87_INIT_IN_4 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_4 \ + (IT87_INIT_IN_4 + IT87_INIT_IN_4 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_5 \ + (IT87_INIT_IN_5 - IT87_INIT_IN_5 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_5 \ + (IT87_INIT_IN_5 + IT87_INIT_IN_5 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_6 \ + (IT87_INIT_IN_6 - IT87_INIT_IN_6 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_6 \ + (IT87_INIT_IN_6 + IT87_INIT_IN_6 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_7 \ + (IT87_INIT_IN_7 - IT87_INIT_IN_7 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_7 \ + (IT87_INIT_IN_7 + IT87_INIT_IN_7 * IT87_INIT_IN_PERCENTAGE / 100) + +#define IT87_INIT_FAN_MIN_1 3000 +#define IT87_INIT_FAN_MIN_2 3000 +#define IT87_INIT_FAN_MIN_3 3000 + +#define IT87_INIT_TEMP_HIGH_1 600 +#define IT87_INIT_TEMP_LOW_1 200 +#define IT87_INIT_TEMP_HIGH_2 600 +#define IT87_INIT_TEMP_LOW_2 200 +#define IT87_INIT_TEMP_HIGH_3 600 +#define IT87_INIT_TEMP_LOW_3 200 + +/* For each registered IT87, we need to keep some data in memory. That +data is pointed to by it87_list[NR]->data. The structure itself is +dynamically allocated, at the same time when a new it87 client is +allocated. */ +struct it87_data { +struct semaphore lock; +int sysctl_id; +enum chips type; + +struct semaphore update_lock; +char valid;/* !=0 if following fields are valid */ +unsigned long last_updated;/* In jiffies */ + +u8 in[9 ];/* Register value */ +u8 in_max[9 ];/* Register value */ +u8 in_min[9 ];/* Register value */ +u8 fan[3 ];/* Register value */ +u8 fan_min[3 ];/* Register value */ +u8 temp[3 ];/* Register value */ +u8 temp_high[3 ];/* Register value */ +u8 temp_low[3 ];/* Register value */ +u8 fan_div[3 ];/* Register encoding, shifted right */ +u8 vid;/* Register encoding, combined */ +u32 alarms;/* Register encoding, combined */ +}; + + +static int it87_attach_adapter (struct i2c_adapter *adapter); +static int it87_detect (struct i2c_adapter *adapter,int address,int kind); +static int it87_detach_client (struct i2c_client *client); + +static int it87_read_value (struct i2c_client *client,u8 register); +static int it87_write_value (struct i2c_client *client,u8 register, +u8 value); +static void it87_update_client (struct i2c_client *client); +static void it87_init_client (struct i2c_client *client); + + +static struct i2c_driver it87_driver = { + .owner =THIS_MODULE , + .name ="IT87xx sensor driver" , + .id =I2C_DRIVERID_IT87 , + .flags =I2C_DF_NOTIFY , + .attach_adapter = it87_attach_adapter, + .detach_client = it87_detach_client, +}; + +static int it87_id =0 ; + +/* The /proc/sys entries */ + +/* -- SENSORS SYSCTL START -- */ +#define IT87_SYSCTL_IN0 1000/* Volts * 100 */ +#define IT87_SYSCTL_IN1 1001 +#define IT87_SYSCTL_IN2 1002 +#define IT87_SYSCTL_IN3 1003 +#define IT87_SYSCTL_IN4 1004 +#define IT87_SYSCTL_IN5 1005 +#define IT87_SYSCTL_IN6 1006 +#define IT87_SYSCTL_IN7 1007 +#define IT87_SYSCTL_IN8 1008 +#define IT87_SYSCTL_FAN1 1101/* Rotations/min */ +#define IT87_SYSCTL_FAN2 1102 +#define IT87_SYSCTL_FAN3 1103 +#define IT87_SYSCTL_TEMP1 1200/* Degrees Celcius * 10 */ +#define IT87_SYSCTL_TEMP2 1201/* Degrees Celcius * 10 */ +#define IT87_SYSCTL_TEMP3 1202/* Degrees Celcius * 10 */ +#define IT87_SYSCTL_VID 1300/* Volts * 100 */ +#define IT87_SYSCTL_FAN_DIV 2000/* 1, 2, 4 or 8 */ +#define IT87_SYSCTL_ALARMS 2004/* bitvector */ + +#define IT87_ALARM_IN0 0x000100 +#define IT87_ALARM_IN1 0x000200 +#define IT87_ALARM_IN2 0x000400 +#define IT87_ALARM_IN3 0x000800 +#define IT87_ALARM_IN4 0x001000 +#define IT87_ALARM_IN5 0x002000 +#define IT87_ALARM_IN6 0x004000 +#define IT87_ALARM_IN7 0x008000 +#define IT87_ALARM_FAN1 0x0001 +#define IT87_ALARM_FAN2 0x0002 +#define IT87_ALARM_FAN3 0x0004 +#define IT87_ALARM_TEMP1 0x00010000 +#define IT87_ALARM_TEMP2 0x00020000 +#define IT87_ALARM_TEMP3 0x00040000 + +/* -- SENSORS SYSCTL END -- */ + +/* These files are created for each detected IT87. This is just a template; +though at first sight, you might think we could use a statically +allocated list, we need some way to get back to the parent - which +is done through one of the 'extra' fields which are initialized +when a new copy is allocated. +static ctl_table it87_dir_table_template[] = { +{IT87_SYSCTL_IN0, "in0", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN1, "in1", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN2, "in2", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN3, "in3", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN4, "in4", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN5, "in5", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN6, "in6", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN7, "in7", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_IN8, "in8", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_in}, +{IT87_SYSCTL_FAN1, "fan1", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_fan}, +{IT87_SYSCTL_FAN2, "fan2", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_fan}, +{IT87_SYSCTL_FAN3, "fan3", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_fan}, +{IT87_SYSCTL_TEMP1, "temp1", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_temp}, +{IT87_SYSCTL_TEMP2, "temp2", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_temp}, +{IT87_SYSCTL_TEMP3, "temp3", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_temp}, +{IT87_SYSCTL_VID, "vid", NULL, 0, 0444, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_vid}, +{IT87_SYSCTL_FAN_DIV, "fan_div", NULL, 0, 0644, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_fan_div}, +{IT87_SYSCTL_ALARMS, "alarms", NULL, 0, 0444, NULL, &i2c_proc_real, +&i2c_sysctl_real, NULL, &it87_alarms}, +{0} +}; + +*/ + +static ssize_t show_in (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%ld\n" ,IN_FROM_REG (data->in[nr], nr)*10 ); +} + +static ssize_t show_in_min (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%ld\n" ,IN_FROM_REG (data->in_min[nr], nr)*10 ); +} + +static ssize_t show_in_max (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%ld\n" ,IN_FROM_REG (data->in_max[nr], nr)*10 ); +} + +static ssize_t set_in_min (struct device *dev,const char *buf, +size_t count,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +unsigned long val =simple_strtoul (buf,NULL ,10 )/10 ; + data->in_min[nr] =IN_TO_REG (val,nr); +it87_write_value (client,IT87_REG_VIN_MIN (nr), + data->in_min[nr]); +return count; +} +static ssize_t set_in_max (struct device *dev,const char *buf, +size_t count,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +unsigned long val =simple_strtoul (buf,NULL ,10 )/10 ; + data->in_max[nr] =IN_TO_REG (val,nr); +it87_write_value (client,IT87_REG_VIN_MAX (nr), + data->in_max[nr]); +return count; +} +#define show_in_offset (offset) \ +static ssize_t \ + show_in##offset (struct device *dev, char *buf) \ +{ \ + return show_in(dev, buf, 0x##offset); \ +} \ +static ssize_t \ + show_in##offset##_min (struct device *dev, char *buf) \ +{ \ + return show_in_min(dev, buf, 0x##offset); \ +} \ +static ssize_t \ + show_in##offset##_max (struct device *dev, char *buf) \ +{ \ + return show_in_max(dev, buf, 0x##offset); \ +} \ +static ssize_t set_in##offset##_min (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_in_min(dev, buf, count, 0x##offset); \ +} \ +static ssize_t set_in##offset##_max (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_in_max(dev, buf, count, 0x##offset); \ +} \ +static DEVICE_ATTR(in_input##offset, S_IRUGO, show_in##offset, NULL) \ +static DEVICE_ATTR(in_min##offset, S_IRUGO | S_IWUSR, \ + show_in##offset##_min, set_in##offset##_min) \ +static DEVICE_ATTR(in_max##offset, S_IRUGO | S_IWUSR, \ + show_in##offset##_max, set_in##offset##_max) + +show_in_offset (0 ); +show_in_offset (1 ); +show_in_offset (2 ); +show_in_offset (3 ); +show_in_offset (4 ); + +/* 3 temperatures */ +static ssize_t show_temp (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,TEMP_FROM_REG (data->temp[nr])*10 ); +} +/* more like overshoot temperature */ +static ssize_t show_temp_max (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,TEMP_FROM_REG (data->temp_high[nr])*10 ); +} +/* more like hysteresis temperature */ +static ssize_t show_temp_min (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,TEMP_FROM_REG (data->temp_low[nr])*10 ); +} +static ssize_t set_temp_max (struct device *dev,const char *buf, +size_t count,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 )/10 ; + data->temp_high[nr] =TEMP_TO_REG (val); +it87_write_value (client,IT87_REG_TEMP_HIGH (nr), data->temp_high[nr]); +return count; +} +static ssize_t set_temp_min (struct device *dev,const char *buf, +size_t count,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 )/10 ; + data->temp_low[nr] =TEMP_TO_REG (val); +it87_write_value (client,IT87_REG_TEMP_LOW (nr), data->temp_low[nr]); +return count; +} +#define show_temp_offset (offset) \ +static ssize_t show_temp_##offset (struct device *dev, char *buf) \ +{ \ + return show_temp(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t \ +show_temp_##offset##_max (struct device *dev, char *buf) \ +{ \ + return show_temp_max(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t \ +show_temp_##offset##_min (struct device *dev, char *buf) \ +{ \ + return show_temp_min(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t set_temp_##offset##_max (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_temp_max(dev, buf, count, 0x##offset - 1); \ +} \ +static ssize_t set_temp_##offset##_min (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_temp_min(dev, buf, count, 0x##offset - 1); \ +} \ +static DEVICE_ATTR(temp_input##offset, S_IRUGO, show_temp_##offset, NULL) \ +static DEVICE_ATTR(temp_max##offset, S_IRUGO | S_IWUSR, \ + show_temp_##offset##_max, set_temp_##offset##_max) \ +static DEVICE_ATTR(temp_min##offset, S_IRUGO | S_IWUSR, \ + show_temp_##offset##_min, set_temp_##offset##_min) + +show_temp_offset (1 ); +show_temp_offset (2 ); +show_temp_offset (3 ); + +/* 2 Fans */ +static ssize_t show_fan (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,FAN_FROM_REG (data->fan[nr], +DIV_FROM_REG (data->fan_div[nr])) ); +} +static ssize_t show_fan_min (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" , +FAN_FROM_REG (data->fan_min[nr],DIV_FROM_REG (data->fan_div[nr])) ); +} +static ssize_t show_fan_div (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,DIV_FROM_REG (data->fan_div[nr]) ); +} +static ssize_t set_fan_min (struct device *dev,const char *buf, +size_t count,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 ); + data->fan_min[nr] =FAN_TO_REG (val,DIV_FROM_REG (data->fan_div[nr])); +it87_write_value (client,IT87_REG_FAN_MIN (nr+1 ), data->fan_min[nr]); +return count; +} +static ssize_t set_fan_div (struct device *dev,const char *buf, +size_t count,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 ); +int old =it87_read_value (client,IT87_REG_FAN_DIV ); + data->fan_div[nr] =DIV_TO_REG (val); + old = (old &0x0f ) | (data->fan_div[1 ] <<6 ) | (data->fan_div[0 ] <<4 ); +it87_write_value (client,IT87_REG_FAN_DIV , old); +return count; +} + +#define show_fan_offset (offset) \ +static ssize_t show_fan_##offset (struct device *dev, char *buf) \ +{ \ + return show_fan(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t show_fan_##offset##_min (struct device *dev, char *buf) \ +{ \ + return show_fan_min(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t show_fan_##offset##_div (struct device *dev, char *buf) \ +{ \ + return show_fan_div(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t set_fan_##offset##_min (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_fan_min(dev, buf, count, 0x##offset - 1); \ +} \ +static ssize_t set_fan_##offset##_div (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_fan_div(dev, buf, count, 0x##offset - 1); \ +} \ +static DEVICE_ATTR(fan_input##offset, S_IRUGO, show_fan_##offset, NULL) \ +static DEVICE_ATTR(fan_min##offset, S_IRUGO | S_IWUSR, \ + show_fan_##offset##_min, set_fan_##offset##_min) \ +static DEVICE_ATTR(fan_div##offset, S_IRUGO | S_IWUSR, \ + show_fan_##offset##_div, set_fan_##offset##_div) + +show_fan_offset (1 ); +show_fan_offset (2 ); + +/* Alarm */ +static ssize_t show_alarm (struct device *dev,char *buf) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,ALARMS_FROM_REG (data->alarms)); +} +static DEVICE_ATTR(alarm, S_IRUGO | S_IWUSR, show_alarm, NULL); + +/* This function is called when: +* it87_driver is inserted (when this module is loaded), for each +available adapter +* when a new adapter is inserted (and it87_driver is still present) */ +static int it87_attach_adapter (struct i2c_adapter *adapter) +{ +return i2c_detect (adapter, &addr_data, it87_detect); +} + +/* This function is called by i2c_detect */ +int it87_detect (struct i2c_adapter *adapter,int address,int kind) +{ +int i; +struct i2c_client *new_client; +struct it87_data *data; +int err =0 ; +const char *name ="" ; +const char *client_name ="" ; +int is_isa =i2c_is_isa_adapter (adapter); + +if (!is_isa + && !i2c_check_functionality (adapter, +I2C_FUNC_SMBUS_BYTE_DATA )) goto + ERROR0; + +if (is_isa) { +if (check_region (address,IT87_EXTENT )) + goto ERROR0; + } + +/* Probe whether there is anything available on this address. Already +done for SMBus clients */ +if (kind <0 ) { +if (is_isa) { + +#define REALLY_SLOW_IO +/* We need the timeouts for at least some IT87-like chips. But only +if we read 'undefined' registers. */ + i =inb_p (address +1 ); +if (inb_p (address +2 ) != i) + goto ERROR0; +if (inb_p (address +3 ) != i) + goto ERROR0; +if (inb_p (address +7 ) != i) + goto ERROR0; +#undef REALLY_SLOW_IO + +/* Let's just hope nothing breaks here */ + i =inb_p (address +5 ) &0x7f ; +outb_p (~i &0x7f , address +5 ); +if ((inb_p (address +5 ) &0x7f ) != (~i &0x7f )) { +outb_p (i, address +5 ); +return 0 ; + } + } + } + +/* OK. For now, we presume we have a valid client. We now create the +client structure, even though we cannot fill it completely yet. +But it allows us to access it87_{read,write}_value. */ + +if (!(new_client =kmalloc ((sizeof (struct i2c_client )) + +sizeof (struct it87_data ), +GFP_KERNEL ))) { + err = -ENOMEM ; + goto ERROR0; + } + + data = (struct it87_data *) (new_client +1 ); +if (is_isa) +init_MUTEX (&data->lock); +i2c_set_clientdata (new_client, data); + new_client->addr = address; + new_client->adapter = adapter; + new_client->driver = &it87_driver; + new_client->flags =0 ; + +/* Now, we do the remaining detection. */ + +if (kind <0 ) { +if (it87_read_value (new_client,IT87_REG_CONFIG ) &0x80 ) + goto ERROR1; +if (!is_isa + && (it87_read_value (new_client,IT87_REG_I2C_ADDR ) != + address)) goto ERROR1; + } + +/* Determine the chip type. */ +if (kind <=0 ) { + i =it87_read_value (new_client,IT87_REG_CHIPID ); +if (i ==0x90 ) { + kind = it87; + } +else { +if (kind ==0 ) +printk + ("it87.o: Ignoring 'force' parameter for unknown chip at " +"adapter %d, address 0x%02x\n" , +i2c_adapter_id (adapter), address); + goto ERROR1; + } + } + +if (kind == it87) { + name ="it87" ; + client_name ="IT87 chip" ; + }/* else if (kind == it8712) { +name = "it8712"; +client_name = "IT87-J chip"; +} */ else { +dev_dbg (&adapter->dev,"Internal error: unknown kind (%d)?!?" , + kind); + goto ERROR1; + } + +/* Reserve the ISA region */ +if (is_isa) +request_region (address,IT87_EXTENT , name); + +/* Fill in the remaining client fields and put it into the global list */ +strncpy (new_client->dev.name, name,DEVICE_NAME_SIZE ); + + data->type = kind; + + new_client->id = it87_id++; + data->valid =0 ; +init_MUTEX (&data->update_lock); + +/* Tell the I2C layer a new client has arrived */ +if ((err =i2c_attach_client (new_client))) + goto ERROR3; + +/* register sysfs hooks */ +device_create_file (&new_client->dev, &dev_attr_in_input0); +device_create_file (&new_client->dev, &dev_attr_in_input1); +device_create_file (&new_client->dev, &dev_attr_in_input2); +device_create_file (&new_client->dev, &dev_attr_in_input3); +device_create_file (&new_client->dev, &dev_attr_in_input4); +device_create_file (&new_client->dev, &dev_attr_in_min0); +device_create_file (&new_client->dev, &dev_attr_in_min1); +device_create_file (&new_client->dev, &dev_attr_in_min2); +device_create_file (&new_client->dev, &dev_attr_in_min3); +device_create_file (&new_client->dev, &dev_attr_in_min4); +device_create_file (&new_client->dev, &dev_attr_in_max0); +device_create_file (&new_client->dev, &dev_attr_in_max1); +device_create_file (&new_client->dev, &dev_attr_in_max2); +device_create_file (&new_client->dev, &dev_attr_in_max3); +device_create_file (&new_client->dev, &dev_attr_in_max4); +device_create_file (&new_client->dev, &dev_attr_temp_input1); +device_create_file (&new_client->dev, &dev_attr_temp_input2); +device_create_file (&new_client->dev, &dev_attr_temp_input3); +device_create_file (&new_client->dev, &dev_attr_temp_max1); +device_create_file (&new_client->dev, &dev_attr_temp_max2); +device_create_file (&new_client->dev, &dev_attr_temp_max3); +device_create_file (&new_client->dev, &dev_attr_temp_min1); +device_create_file (&new_client->dev, &dev_attr_temp_min2); +device_create_file (&new_client->dev, &dev_attr_temp_min3); +device_create_file (&new_client->dev, &dev_attr_fan_input1); +device_create_file (&new_client->dev, &dev_attr_fan_input2); +device_create_file (&new_client->dev, &dev_attr_fan_min1); +device_create_file (&new_client->dev, &dev_attr_fan_min2); +device_create_file (&new_client->dev, &dev_attr_fan_div1); +device_create_file (&new_client->dev, &dev_attr_fan_div2); +device_create_file (&new_client->dev, &dev_attr_alarm); + +/* Initialize the IT87 chip */ +it87_init_client (new_client); +return 0 ; + +/* OK, this is not exactly good programming practice, usually. But it is +very code-efficient in this case. */ + + ERROR3: +if (is_isa) +release_region (address,IT87_EXTENT ); + ERROR1: +kfree (new_client); + ERROR0: +return err; +} + +static int it87_detach_client (struct i2c_client *client) +{ +int err; + +if ((err =i2c_detach_client (client))) { +dev_err (&client->dev, +"Client deregistration failed, client not detached.\n" ); +return err; + } + +if (i2c_is_isa_client (client)) +release_region (client->addr,IT87_EXTENT ); +kfree (client); + +return 0 ; +} + +/* The SMBus locks itself, but ISA access must be locked explicitely! +We don't want to lock the whole ISA bus, so we lock each client +separately. +We ignore the IT87 BUSY flag at this moment - it could lead to deadlocks, +would slow down the IT87 access and should not be necessary. +There are some ugly typecasts here, but the good new is - they should +nowhere else be necessary! */ +static int it87_read_value (struct i2c_client *client,u8 reg) +{ +struct it87_data *data =i2c_get_clientdata (client); + +int res; +if (i2c_is_isa_client (client)) { +down (&data->lock); +outb_p (reg, client->addr +IT87_ADDR_REG_OFFSET ); + res =inb_p (client->addr +IT87_DATA_REG_OFFSET ); +up (&data->lock); +return res; + }else +return i2c_smbus_read_byte_data (client, reg); +} + +/* The SMBus locks itself, but ISA access muse be locked explicitely! +We don't want to lock the whole ISA bus, so we lock each client +separately. +We ignore the IT87 BUSY flag at this moment - it could lead to deadlocks, +would slow down the IT87 access and should not be necessary. +There are some ugly typecasts here, but the good new is - they should +nowhere else be necessary! */ +static int it87_write_value (struct i2c_client *client,u8 reg,u8 value) +{ +struct it87_data *data =i2c_get_clientdata (client); + +if (i2c_is_isa_client (client)) { +down (&data->lock); +outb_p (reg, client->addr +IT87_ADDR_REG_OFFSET ); +outb_p (value, client->addr +IT87_DATA_REG_OFFSET ); +up (&data->lock); +return 0 ; + }else +return i2c_smbus_write_byte_data (client, reg, value); +} + +/* Called when we have found a new IT87. It should set limits, etc. */ +static void it87_init_client (struct i2c_client *client) +{ +/* Reset all except Watchdog values and last conversion values +This sets fan-divs to 2, among others */ +it87_write_value (client,IT87_REG_CONFIG ,0x80 ); +it87_write_value (client,IT87_REG_VIN_MIN (0 ), +IN_TO_REG (IT87_INIT_IN_MIN_0 ,0 )); +it87_write_value (client,IT87_REG_VIN_MAX (0 ), +IN_TO_REG (IT87_INIT_IN_MAX_0 ,0 )); +it87_write_value (client,IT87_REG_VIN_MIN (1 ), +IN_TO_REG (IT87_INIT_IN_MIN_1 ,1 )); +it87_write_value (client,IT87_REG_VIN_MAX (1 ), +IN_TO_REG (IT87_INIT_IN_MAX_1 ,1 )); +it87_write_value (client,IT87_REG_VIN_MIN (2 ), +IN_TO_REG (IT87_INIT_IN_MIN_2 ,2 )); +it87_write_value (client,IT87_REG_VIN_MAX (2 ), +IN_TO_REG (IT87_INIT_IN_MAX_2 ,2 )); +it87_write_value (client,IT87_REG_VIN_MIN (3 ), +IN_TO_REG (IT87_INIT_IN_MIN_3 ,3 )); +it87_write_value (client,IT87_REG_VIN_MAX (3 ), +IN_TO_REG (IT87_INIT_IN_MAX_3 ,3 )); +it87_write_value (client,IT87_REG_VIN_MIN (4 ), +IN_TO_REG (IT87_INIT_IN_MIN_4 ,4 )); +it87_write_value (client,IT87_REG_VIN_MAX (4 ), +IN_TO_REG (IT87_INIT_IN_MAX_4 ,4 )); +it87_write_value (client,IT87_REG_VIN_MIN (5 ), +IN_TO_REG (IT87_INIT_IN_MIN_5 ,5 )); +it87_write_value (client,IT87_REG_VIN_MAX (5 ), +IN_TO_REG (IT87_INIT_IN_MAX_5 ,5 )); +it87_write_value (client,IT87_REG_VIN_MIN (6 ), +IN_TO_REG (IT87_INIT_IN_MIN_6 ,6 )); +it87_write_value (client,IT87_REG_VIN_MAX (6 ), +IN_TO_REG (IT87_INIT_IN_MAX_6 ,6 )); +it87_write_value (client,IT87_REG_VIN_MIN (7 ), +IN_TO_REG (IT87_INIT_IN_MIN_7 ,7 )); +it87_write_value (client,IT87_REG_VIN_MAX (7 ), +IN_TO_REG (IT87_INIT_IN_MAX_7 ,7 )); +/* Note: Battery voltage does not have limit registers */ +it87_write_value (client,IT87_REG_FAN_MIN (1 ), +FAN_TO_REG (IT87_INIT_FAN_MIN_1 ,2 )); +it87_write_value (client,IT87_REG_FAN_MIN (2 ), +FAN_TO_REG (IT87_INIT_FAN_MIN_2 ,2 )); +it87_write_value (client,IT87_REG_FAN_MIN (3 ), +FAN_TO_REG (IT87_INIT_FAN_MIN_3 ,2 )); +it87_write_value (client,IT87_REG_TEMP_HIGH (1 ), +TEMP_TO_REG (IT87_INIT_TEMP_HIGH_1 )); +it87_write_value (client,IT87_REG_TEMP_LOW (1 ), +TEMP_TO_REG (IT87_INIT_TEMP_LOW_1 )); +it87_write_value (client,IT87_REG_TEMP_HIGH (2 ), +TEMP_TO_REG (IT87_INIT_TEMP_HIGH_2 )); +it87_write_value (client,IT87_REG_TEMP_LOW (2 ), +TEMP_TO_REG (IT87_INIT_TEMP_LOW_2 )); +it87_write_value (client,IT87_REG_TEMP_HIGH (3 ), +TEMP_TO_REG (IT87_INIT_TEMP_HIGH_3 )); +it87_write_value (client,IT87_REG_TEMP_LOW (3 ), +TEMP_TO_REG (IT87_INIT_TEMP_LOW_3 )); + +/* Enable voltage monitors */ +it87_write_value (client,IT87_REG_VIN_ENABLE ,0xff ); + +/* Enable Temp1-Temp3 */ +it87_write_value (client,IT87_REG_TEMP_ENABLE , + (it87_read_value (client,IT87_REG_TEMP_ENABLE ) &0xc0 ) + | (temp_type &0x3f )); + +/* Enable fans */ +it87_write_value (client,IT87_REG_FAN_CTRL , + (it87_read_value (client,IT87_REG_FAN_CTRL ) &0x8f ) + |0x70 ); + +/* Start monitoring */ +it87_write_value (client,IT87_REG_CONFIG , + (it87_read_value (client,IT87_REG_CONFIG ) &0xb7 ) + | (update_vbat ?0x41 :0x01 )); +} + +static void it87_update_client (struct i2c_client *client) +{ +struct it87_data *data =i2c_get_clientdata (client); +int i; + +down (&data->update_lock); + +if ((jiffies - data->last_updated >HZ +HZ /2 ) || + (jiffies < data->last_updated) || !data->valid) { + +if (update_vbat) { +/* Cleared after each update, so reenable. Value +returned by this read will be previous value */ +it87_write_value (client,IT87_REG_CONFIG , +it87_read_value (client,IT87_REG_CONFIG ) |0x40 ); + } +for (i =0 ; i <=7 ; i++) { + data->in[i] = +it87_read_value (client,IT87_REG_VIN (i)); + data->in_min[i] = +it87_read_value (client,IT87_REG_VIN_MIN (i)); + data->in_max[i] = +it87_read_value (client,IT87_REG_VIN_MAX (i)); + } + data->in[8 ] = +it87_read_value (client,IT87_REG_VIN (8 )); +/* Temperature sensor doesn't have limit registers, set +to min and max value */ + data->in_min[8 ] =0 ; + data->in_max[8 ] =255 ; + +for (i =1 ; i <=3 ; i++) { + data->fan[i -1 ] = +it87_read_value (client,IT87_REG_FAN (i)); + data->fan_min[i -1 ] = +it87_read_value (client,IT87_REG_FAN_MIN (i)); + } +for (i =1 ; i <=3 ; i++) { + data->temp[i -1 ] = +it87_read_value (client,IT87_REG_TEMP (i)); + data->temp_high[i -1 ] = +it87_read_value (client,IT87_REG_TEMP_HIGH (i)); + data->temp_low[i -1 ] = +it87_read_value (client,IT87_REG_TEMP_LOW (i)); + } + +/* The 8705 does not have VID capability */ +/*if (data->type == it8712) { +data->vid = it87_read_value(client, IT87_REG_VID); +data->vid &= 0x1f; +} +else */ { + data->vid =0x1f ; + } + + i =it87_read_value (client,IT87_REG_FAN_DIV ); + data->fan_div[0 ] = i &0x07 ; + data->fan_div[1 ] = (i >>3 ) &0x07 ; + data->fan_div[2 ] =1 ; + + data->alarms = +it87_read_value (client,IT87_REG_ALARM1 ) | + (it87_read_value (client,IT87_REG_ALARM2 ) <<8 ) | + (it87_read_value (client,IT87_REG_ALARM3 ) <<16 ); + + data->last_updated = jiffies; + data->valid =1 ; + } + +up (&data->update_lock); +} + +static int __init sm_it87_init (void ) +{ +return i2c_add_driver (&it87_driver); +} + +static void __exit sm_it87_exit(void) +{ +i2c_del_driver (&it87_driver); +} + + +MODULE_AUTHOR ("Chris Gauthron <[email protected]>" ); +MODULE_DESCRIPTION ("IT8705F, IT8712F, Sis950 driver" ); +MODULE_PARM (update_vbat,"i" ); +MODULE_PARM_DESC (update_vbat,"Update vbat if set else return powerup value" ); +MODULE_PARM (temp_type,"i" ); +MODULE_PARM_DESC (temp_type,"Temperature sensor type, normally leave unset" ); +MODULE_LICENSE ("GPL" ); + +module_init (sm_it87_init); +module_exit (sm_it87_exit);
drivers/i2c/chips/Kconfig +12 -2
@@ -64,10 +64,20 @@ in the lm_sensors package, which you can download at http://www.lm-sensors.nu +config SENSORS_IT87 + tristate " ITE IT87 and compatibles" + depends on I2C && EXPERIMENTAL + help + The module will be called it87. + + You will also need the latest user-space utilties: you can find them + in the lm_sensors package, which you can download at + http://www.lm-sensors.nu + config I2C_SENSOR tristate - default y if SENSORS_ADM1021=y || SENSORS_LM75=y || SENSORS_VIA686A=y || SENSORS_W83781D=y - default m if SENSORS_ADM1021=m || SENSORS_LM75=m || SENSORS_VIA686A=m || SENSORS_W83781D=m + default y if SENSORS_ADM1021=y || SENSORS_LM75=y || SENSORS_VIA686A=y || SENSORS_W83781D=y || SENSORS_IT87=y + default m if SENSORS_ADM1021=m || SENSORS_LM75=m || SENSORS_VIA686A=m || SENSORS_W83781D=m || SENSORS_IT87=m default n endmenu
drivers/i2c/chips/Makefile +1 -0
@@ -6,3 +6,4 @@ obj-$(CONFIG_SENSORS_LM75) += lm75.o obj-$(CONFIG_SENSORS_VIA686A) += via686a.o obj-$(CONFIG_SENSORS_W83781D) += w83781d.o +obj-$(CONFIG_SENSORS_IT87) += it87.o
Signature · 1 line
"NT is to UNIX what a doughnut is to a particle accelerator."
Quoted 4 lines · Florin Iucha
Greg,
I have converted it87 i2c driver to use sysfs. Please review it and submit it for inclusion.
A few comments:
drivers/i2c/chips/it87.c line 266
Quoted 8 lines
drivers/i2c/chips/it87.c +8
-0+static struct i2c_driver it87_driver = { + .owner =THIS_MODULE , + .name ="IT87xx sensor driver" , + .id =I2C_DRIVERID_IT87 , + .flags =I2C_DF_NOTIFY , + .attach_adapter = it87_attach_adapter, + .detach_client = it87_detach_client, +};
Isn't that name too big for sysfs? Why not just drop the " sensor driver" portion of it, as that is pretty redundant.
drivers/i2c/chips/it87.c line 272
Quoted 3 lines
drivers/i2c/chips/it87.c +3
-0+/* The /proc/sys entries */ + +/* -- SENSORS SYSCTL START -- */
<snip>
These are no longer needed, right?
drivers/i2c/chips/it87.c line 314
Quoted 6 lines
drivers/i2c/chips/it87.c +6
-0+/* These files are created for each detected IT87. This is just a template; +though at first sight, you might think we could use a statically +allocated list, we need some way to get back to the parent - which +is done through one of the 'extra' fields which are initialized +when a new copy is allocated. +static ctl_table it87_dir_table_template[] = {
Nor is this table needed anymore either. Yeah, it's commented out, might as well just delete the whole thing :)
drivers/i2c/chips/it87.c line 361
Quoted 6 lines
drivers/i2c/chips/it87.c +6
-0+static ssize_t show_in (struct device *dev,char *buf,int nr) { +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%ld\n" ,IN_FROM_REG (data->in[nr], nr)*10 ); +}
Please use the kernel coding style as documented in Documentation/CodingStyle (hint, use tabs, and the '{' for a function should be on a new line.)
drivers/i2c/chips/it87.c line 762
Quoted 2 lines
drivers/i2c/chips/it87.c +2
-0+/* OK, this is not exactly good programming practice, usually. But it is +very code-efficient in this case. */
This comment can go, as it is good programming practice.
Quoted 7 lines
diff -Nru linux-2.5.68/drivers/i2c/chips/Kconfig linux-2.5.68-it87/drivers/i2c/chips/Kconfig
drivers/i2c/chips/Kconfig +0
-0@@ -64,10 +64,20 @@ in the lm_sensors package, which you can download at http://www.lm-sensors.nu
drivers/i2c/chips/Kconfig line 76
Quoted 10 lines
drivers/i2c/chips/Kconfig +10
-0+config SENSORS_IT87 + tristate " ITE IT87 and compatibles" + depends on I2C && EXPERIMENTAL + help + The module will be called it87. + + You will also need the latest user-space utilties: you can find them + in the lm_sensors package, which you can download at + http://www.lm-sensors.nu +
Can you place this in alphabetical order in the file? Makes is nicer looking.
drivers/i2c/chips/Makefile line 9
Quoted 8 lines
diff -Nru linux-2.5.68/drivers/i2c/chips/Makefile linux-2.5.68-it87/drivers/i2c/chips/Makefile
drivers/i2c/chips/Makefile +1
-0@@ -6,3 +6,4 @@ obj-$(CONFIG_SENSORS_LM75) += lm75.o obj-$(CONFIG_SENSORS_VIA686A) += via686a.o obj-$(CONFIG_SENSORS_W83781D) += w83781d.o +obj-$(CONFIG_SENSORS_IT87) += it87.o
Same thing with the alphabetical order here.
Other than those very minor things the patch looks good. Mind fixing them and sending it to me again?
thanks,
greg k-h
Quoted 1 line · Greg KH
A few comments:
[snip]
Quoted 2 lines
Other than those very minor things the patch looks good. Mind fixing them and sending it to me again?
Thank you, fixed patch inlined.
drivers/i2c/chips/it87.c +930 -0
@@ -0,0 +1,930 @@ +/* +it87.c - Part of lm_sensors, Linux kernel modules for hardware +monitoring. + +Supports: IT8705F Super I/O chip w/LPC interface +IT8712F Super I/O chup w/LPC interface & SMbus +Sis950 A clone of the IT8705F + +Copyright (c) 2001 Chris Gauthron <[email protected]> +Largely inspired by lm78.c of the same package + +This program is free software; you can redistribute it and/or modify +it under the terms of the GNU General Public License as published by +the Free Software Foundation; either version 2 of the License, or +(at your option) any later version. + +This program is distributed in the hope that it will be useful, +but WITHOUT ANY WARRANTY; without even the implied warranty of +MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +GNU General Public License for more details. + +You should have received a copy of the GNU General Public License +along with this program; if not, write to the Free Software +Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. +*/ + +/* +[email protected] David Gesswein 7/18/01 +Modified to fix bug with not all alarms enabled. +Added ability to read battery voltage and select temperature sensor +type at module load time. +*/ + +#include <linux/module.h> +#include <linux/init.h> +#include <linux/slab.h> +#include <linux/i2c.h> +#include <linux/i2c-sensor.h> +#include <asm/io.h> + + +/* Addresses to scan */ +static unsigned short normal_i2c[] = {SENSORS_I2C_END }; +static unsigned short normal_i2c_range[] = {0x20 ,0x2f ,SENSORS_I2C_END }; +static unsigned int normal_isa[] = {0x0290 ,SENSORS_ISA_END }; +static unsigned int normal_isa_range[] = {SENSORS_ISA_END }; + +/* Insmod parameters */ +SENSORS_INSMOD_4 (it87, it8705, it8712, sis950); + + +/* Update battery voltage after every reading if true */ +static int update_vbat =0 ; + + +/* Enable Temp1 as thermal resistor */ +/* Enable Temp2 as thermal diode */ +/* Enable Temp3 as thermal resistor */ +static int temp_type =0x2a ; + +/* Many IT87 constants specified below */ + +/* Length of ISA address segment */ +#define IT87_EXTENT 8 + +/* Where are the ISA address/data registers relative to the base address */ +#define IT87_ADDR_REG_OFFSET 5 +#define IT87_DATA_REG_OFFSET 6 + +/*----- The IT87 registers -----*/ + +#define IT87_REG_CONFIG 0x00 + +#define IT87_REG_ALARM1 0x01 +#define IT87_REG_ALARM2 0x02 +#define IT87_REG_ALARM3 0x03 + +#define IT87_REG_VID 0x0a +#define IT87_REG_FAN_DIV 0x0b + +/* Monitors: 9 voltage (0 to 7, battery), 3 temp (1 to 3), 3 fan (1 to 3) */ + +#define IT87_REG_FAN (nr) (0x0c + (nr)) +#define IT87_REG_FAN_MIN (nr) (0x0f + (nr)) +#define IT87_REG_FAN_CTRL 0x13 + +#define IT87_REG_VIN (nr) (0x20 + (nr)) +#define IT87_REG_TEMP (nr) (0x28 + (nr)) + +#define IT87_REG_VIN_MAX (nr) (0x30 + (nr) * 2) +#define IT87_REG_VIN_MIN (nr) (0x31 + (nr) * 2) +#define IT87_REG_TEMP_HIGH (nr) (0x3e + (nr) * 2) +#define IT87_REG_TEMP_LOW (nr) (0x3f + (nr) * 2) + +#define IT87_REG_I2C_ADDR 0x48 + +#define IT87_REG_VIN_ENABLE 0x50 +#define IT87_REG_TEMP_ENABLE 0x51 + +#define IT87_REG_CHIPID 0x58 + +static inline u8 IN_TO_REG (long val,int inNum) +{ +/* to avoid floating point, we multiply everything by 100. +val is guaranteed to be positive, so we can achieve the effect of +rounding by (...*10+5)/10. Note that the *10 is hidden in the +/250 (which should really be /2500). +At the end, we need to /100 because we *100 everything and we need +to /10 because of the rounding thing, so we /1000. */ +if (inNum <=1 ) +return (u8 ) +SENSORS_LIMIT (((val *210240 -13300 ) /250 +5 ) /1000 , +0 ,255 ); +else if (inNum ==2 ) +return (u8 ) +SENSORS_LIMIT (((val *157370 -13300 ) /250 +5 ) /1000 , +0 ,255 ); +else if (inNum ==3 ) +return (u8 ) +SENSORS_LIMIT (((val *101080 -13300 ) /250 +5 ) /1000 , +0 ,255 ); +else +return (u8 )SENSORS_LIMIT (((val *41714 -13300 ) /250 +5 ) + /1000 ,0 ,255 ); +} + +static inline long IN_FROM_REG (u8 val,int inNum) +{ +/* to avoid floating point, we multiply everything by 100. +val is guaranteed to be positive, so we can achieve the effect of +rounding by adding 0.5. Or, to avoid fp math, we do (...*10+5)/10. +We need to scale with *100 anyway, so no need to /100 at the end. */ +if (inNum <=1 ) +return (long ) (((250000 * val +13300 ) /210240 *10 +5 ) /10 ); +else if (inNum ==2 ) +return (long ) (((250000 * val +13300 ) /157370 *10 +5 ) /10 ); +else if (inNum ==3 ) +return (long ) (((250000 * val +13300 ) /101080 *10 +5 ) /10 ); +else +return (long ) (((250000 * val +13300 ) /41714 *10 +5 ) /10 ); +} + +static inline u8 FAN_TO_REG (long rpm,int div) +{ +if (rpm ==0 ) +return 255 ; + rpm =SENSORS_LIMIT (rpm,1 ,1000000 ); +return SENSORS_LIMIT ((1350000 + rpm * div /2 ) / (rpm * div),1 , +254 ); +} + +#define FAN_FROM_REG (val,div) ((val)==0?-1:(val)==255?0:1350000/((val)*(div))) + +#define TEMP_TO_REG (val) (SENSORS_LIMIT(((val)<0?(((val)-5)/10):\ + ((val)+5)/10),0,255)) +#define TEMP_FROM_REG (val) (((val)>0x80?(val)-0x100:(val))*10) + +#define VID_FROM_REG (val) ((val)==0x1f?0:(val)>=0x10?510-(val)*10:\ + 205-(val)*5) +#define ALARMS_FROM_REG (val) (val) + +#define DIV_TO_REG (val) ((val)==8?3:(val)==4?2:(val)==1?0:1) +#define DIV_FROM_REG (val) (1 << (val)) + +/* Initial limits. Use the config file to set better limits. */ +#define IT87_INIT_IN_0 170 +#define IT87_INIT_IN_1 250 +#define IT87_INIT_IN_2 (330 / 2) +#define IT87_INIT_IN_3 (((500) * 100)/168) +#define IT87_INIT_IN_4 (((1200) * 10)/38) +#define IT87_INIT_IN_5 (((1200) * 10)/72) +#define IT87_INIT_IN_6 (((500) * 10)/56) +#define IT87_INIT_IN_7 (((500) * 100)/168) + +#define IT87_INIT_IN_PERCENTAGE 10 + +#define IT87_INIT_IN_MIN_0 \ + (IT87_INIT_IN_0 - IT87_INIT_IN_0 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_0 \ + (IT87_INIT_IN_0 + IT87_INIT_IN_0 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_1 \ + (IT87_INIT_IN_1 - IT87_INIT_IN_1 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_1 \ + (IT87_INIT_IN_1 + IT87_INIT_IN_1 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_2 \ + (IT87_INIT_IN_2 - IT87_INIT_IN_2 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_2 \ + (IT87_INIT_IN_2 + IT87_INIT_IN_2 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_3 \ + (IT87_INIT_IN_3 - IT87_INIT_IN_3 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_3 \ + (IT87_INIT_IN_3 + IT87_INIT_IN_3 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_4 \ + (IT87_INIT_IN_4 - IT87_INIT_IN_4 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_4 \ + (IT87_INIT_IN_4 + IT87_INIT_IN_4 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_5 \ + (IT87_INIT_IN_5 - IT87_INIT_IN_5 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_5 \ + (IT87_INIT_IN_5 + IT87_INIT_IN_5 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_6 \ + (IT87_INIT_IN_6 - IT87_INIT_IN_6 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_6 \ + (IT87_INIT_IN_6 + IT87_INIT_IN_6 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MIN_7 \ + (IT87_INIT_IN_7 - IT87_INIT_IN_7 * IT87_INIT_IN_PERCENTAGE / 100) +#define IT87_INIT_IN_MAX_7 \ + (IT87_INIT_IN_7 + IT87_INIT_IN_7 * IT87_INIT_IN_PERCENTAGE / 100) + +#define IT87_INIT_FAN_MIN_1 3000 +#define IT87_INIT_FAN_MIN_2 3000 +#define IT87_INIT_FAN_MIN_3 3000 + +#define IT87_INIT_TEMP_HIGH_1 600 +#define IT87_INIT_TEMP_LOW_1 200 +#define IT87_INIT_TEMP_HIGH_2 600 +#define IT87_INIT_TEMP_LOW_2 200 +#define IT87_INIT_TEMP_HIGH_3 600 +#define IT87_INIT_TEMP_LOW_3 200 + +/* For each registered IT87, we need to keep some data in memory. That +data is pointed to by it87_list[NR]->data. The structure itself is +dynamically allocated, at the same time when a new it87 client is +allocated. */ +struct it87_data { +struct semaphore lock; +int sysctl_id; +enum chips type; + +struct semaphore update_lock; +char valid;/* !=0 if following fields are valid */ +unsigned long last_updated;/* In jiffies */ + +u8 in[9 ];/* Register value */ +u8 in_max[9 ];/* Register value */ +u8 in_min[9 ];/* Register value */ +u8 fan[3 ];/* Register value */ +u8 fan_min[3 ];/* Register value */ +u8 temp[3 ];/* Register value */ +u8 temp_high[3 ];/* Register value */ +u8 temp_low[3 ];/* Register value */ +u8 fan_div[3 ];/* Register encoding, shifted right */ +u8 vid;/* Register encoding, combined */ +u32 alarms;/* Register encoding, combined */ +}; + + +static int it87_attach_adapter (struct i2c_adapter *adapter); +static int it87_detect (struct i2c_adapter *adapter,int address,int kind); +static int it87_detach_client (struct i2c_client *client); + +static int it87_read_value (struct i2c_client *client,u8 register); +static int it87_write_value (struct i2c_client *client,u8 register, +u8 value); +static void it87_update_client (struct i2c_client *client); +static void it87_init_client (struct i2c_client *client); + + +static struct i2c_driver it87_driver = { + .owner =THIS_MODULE , + .name ="IT87xx" , + .id =I2C_DRIVERID_IT87 , + .flags =I2C_DF_NOTIFY , + .attach_adapter = it87_attach_adapter, + .detach_client = it87_detach_client, +}; + +static int it87_id =0 ; + +static ssize_t show_in (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%ld\n" ,IN_FROM_REG (data->in[nr], nr)*10 ); +} + +static ssize_t show_in_min (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%ld\n" ,IN_FROM_REG (data->in_min[nr], nr)*10 ); +} + +static ssize_t show_in_max (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%ld\n" ,IN_FROM_REG (data->in_max[nr], nr)*10 ); +} + +static ssize_t set_in_min (struct device *dev,const char *buf, +size_t count,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +unsigned long val =simple_strtoul (buf,NULL ,10 )/10 ; + data->in_min[nr] =IN_TO_REG (val,nr); +it87_write_value (client,IT87_REG_VIN_MIN (nr), + data->in_min[nr]); +return count; +} +static ssize_t set_in_max (struct device *dev,const char *buf, +size_t count,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +unsigned long val =simple_strtoul (buf,NULL ,10 )/10 ; + data->in_max[nr] =IN_TO_REG (val,nr); +it87_write_value (client,IT87_REG_VIN_MAX (nr), + data->in_max[nr]); +return count; +} + +#define show_in_offset (offset) \ +static ssize_t \ + show_in##offset (struct device *dev, char *buf) \ +{ \ + return show_in(dev, buf, 0x##offset); \ +} \ +static ssize_t \ + show_in##offset##_min (struct device *dev, char *buf) \ +{ \ + return show_in_min(dev, buf, 0x##offset); \ +} \ +static ssize_t \ + show_in##offset##_max (struct device *dev, char *buf) \ +{ \ + return show_in_max(dev, buf, 0x##offset); \ +} \ +static ssize_t set_in##offset##_min (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_in_min(dev, buf, count, 0x##offset); \ +} \ +static ssize_t set_in##offset##_max (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_in_max(dev, buf, count, 0x##offset); \ +} \ +static DEVICE_ATTR(in_input##offset, S_IRUGO, show_in##offset, NULL) \ +static DEVICE_ATTR(in_min##offset, S_IRUGO | S_IWUSR, \ + show_in##offset##_min, set_in##offset##_min) \ +static DEVICE_ATTR(in_max##offset, S_IRUGO | S_IWUSR, \ + show_in##offset##_max, set_in##offset##_max) + +show_in_offset (0 ); +show_in_offset (1 ); +show_in_offset (2 ); +show_in_offset (3 ); +show_in_offset (4 ); + +/* 3 temperatures */ +static ssize_t show_temp (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,TEMP_FROM_REG (data->temp[nr])*10 ); +} +/* more like overshoot temperature */ +static ssize_t show_temp_max (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,TEMP_FROM_REG (data->temp_high[nr])*10 ); +} +/* more like hysteresis temperature */ +static ssize_t show_temp_min (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,TEMP_FROM_REG (data->temp_low[nr])*10 ); +} +static ssize_t set_temp_max (struct device *dev,const char *buf, +size_t count,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 )/10 ; + data->temp_high[nr] =TEMP_TO_REG (val); +it87_write_value (client,IT87_REG_TEMP_HIGH (nr), data->temp_high[nr]); +return count; +} +static ssize_t set_temp_min (struct device *dev,const char *buf, +size_t count,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 )/10 ; + data->temp_low[nr] =TEMP_TO_REG (val); +it87_write_value (client,IT87_REG_TEMP_LOW (nr), data->temp_low[nr]); +return count; +} +#define show_temp_offset (offset) \ +static ssize_t show_temp_##offset (struct device *dev, char *buf) \ +{ \ + return show_temp(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t \ +show_temp_##offset##_max (struct device *dev, char *buf) \ +{ \ + return show_temp_max(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t \ +show_temp_##offset##_min (struct device *dev, char *buf) \ +{ \ + return show_temp_min(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t set_temp_##offset##_max (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_temp_max(dev, buf, count, 0x##offset - 1); \ +} \ +static ssize_t set_temp_##offset##_min (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_temp_min(dev, buf, count, 0x##offset - 1); \ +} \ +static DEVICE_ATTR(temp_input##offset, S_IRUGO, show_temp_##offset, NULL) \ +static DEVICE_ATTR(temp_max##offset, S_IRUGO | S_IWUSR, \ + show_temp_##offset##_max, set_temp_##offset##_max) \ +static DEVICE_ATTR(temp_min##offset, S_IRUGO | S_IWUSR, \ + show_temp_##offset##_min, set_temp_##offset##_min) + +show_temp_offset (1 ); +show_temp_offset (2 ); +show_temp_offset (3 ); + +/* 2 Fans */ +static ssize_t show_fan (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,FAN_FROM_REG (data->fan[nr], +DIV_FROM_REG (data->fan_div[nr])) ); +} +static ssize_t show_fan_min (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" , +FAN_FROM_REG (data->fan_min[nr],DIV_FROM_REG (data->fan_div[nr])) ); +} +static ssize_t show_fan_div (struct device *dev,char *buf,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,DIV_FROM_REG (data->fan_div[nr]) ); +} +static ssize_t set_fan_min (struct device *dev,const char *buf, +size_t count,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 ); + data->fan_min[nr] =FAN_TO_REG (val,DIV_FROM_REG (data->fan_div[nr])); +it87_write_value (client,IT87_REG_FAN_MIN (nr+1 ), data->fan_min[nr]); +return count; +} +static ssize_t set_fan_div (struct device *dev,const char *buf, +size_t count,int nr) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +int val =simple_strtol (buf,NULL ,10 ); +int old =it87_read_value (client,IT87_REG_FAN_DIV ); + data->fan_div[nr] =DIV_TO_REG (val); + old = (old &0x0f ) | (data->fan_div[1 ] <<6 ) | (data->fan_div[0 ] <<4 ); +it87_write_value (client,IT87_REG_FAN_DIV , old); +return count; +} + +#define show_fan_offset (offset) \ +static ssize_t show_fan_##offset (struct device *dev, char *buf) \ +{ \ + return show_fan(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t show_fan_##offset##_min (struct device *dev, char *buf) \ +{ \ + return show_fan_min(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t show_fan_##offset##_div (struct device *dev, char *buf) \ +{ \ + return show_fan_div(dev, buf, 0x##offset - 1); \ +} \ +static ssize_t set_fan_##offset##_min (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_fan_min(dev, buf, count, 0x##offset - 1); \ +} \ +static ssize_t set_fan_##offset##_div (struct device *dev, \ + const char *buf, size_t count) \ +{ \ + return set_fan_div(dev, buf, count, 0x##offset - 1); \ +} \ +static DEVICE_ATTR(fan_input##offset, S_IRUGO, show_fan_##offset, NULL) \ +static DEVICE_ATTR(fan_min##offset, S_IRUGO | S_IWUSR, \ + show_fan_##offset##_min, set_fan_##offset##_min) \ +static DEVICE_ATTR(fan_div##offset, S_IRUGO | S_IWUSR, \ + show_fan_##offset##_div, set_fan_##offset##_div) + +show_fan_offset (1 ); +show_fan_offset (2 ); + +/* Alarm */ +static ssize_t show_alarm (struct device *dev,char *buf) +{ +struct i2c_client *client =to_i2c_client (dev); +struct it87_data *data =i2c_get_clientdata (client); +it87_update_client (client); +return sprintf (buf,"%d\n" ,ALARMS_FROM_REG (data->alarms)); +} +static DEVICE_ATTR(alarm, S_IRUGO | S_IWUSR, show_alarm, NULL); + +/* This function is called when: +* it87_driver is inserted (when this module is loaded), for each +available adapter +* when a new adapter is inserted (and it87_driver is still present) */ +static int it87_attach_adapter (struct i2c_adapter *adapter) +{ +return i2c_detect (adapter, &addr_data, it87_detect); +} + +/* This function is called by i2c_detect */ +int it87_detect (struct i2c_adapter *adapter,int address,int kind) +{ +int i; +struct i2c_client *new_client; +struct it87_data *data; +int err =0 ; +const char *name ="" ; +const char *client_name ="" ; +int is_isa =i2c_is_isa_adapter (adapter); + +if (!is_isa + && !i2c_check_functionality (adapter, +I2C_FUNC_SMBUS_BYTE_DATA )) goto + ERROR0; + +if (is_isa) { +if (check_region (address,IT87_EXTENT )) + goto ERROR0; + } + +/* Probe whether there is anything available on this address. Already +done for SMBus clients */ +if (kind <0 ) { +if (is_isa) { + +#define REALLY_SLOW_IO +/* We need the timeouts for at least some IT87-like chips. But only +if we read 'undefined' registers. */ + i =inb_p (address +1 ); +if (inb_p (address +2 ) != i) + goto ERROR0; +if (inb_p (address +3 ) != i) + goto ERROR0; +if (inb_p (address +7 ) != i) + goto ERROR0; +#undef REALLY_SLOW_IO + +/* Let's just hope nothing breaks here */ + i =inb_p (address +5 ) &0x7f ; +outb_p (~i &0x7f , address +5 ); +if ((inb_p (address +5 ) &0x7f ) != (~i &0x7f )) { +outb_p (i, address +5 ); +return 0 ; + } + } + } + +/* OK. For now, we presume we have a valid client. We now create the +client structure, even though we cannot fill it completely yet. +But it allows us to access it87_{read,write}_value. */ + +if (!(new_client =kmalloc ((sizeof (struct i2c_client )) + +sizeof (struct it87_data ), +GFP_KERNEL ))) { + err = -ENOMEM ; + goto ERROR0; + } + + data = (struct it87_data *) (new_client +1 ); +if (is_isa) +init_MUTEX (&data->lock); +i2c_set_clientdata (new_client, data); + new_client->addr = address; + new_client->adapter = adapter; + new_client->driver = &it87_driver; + new_client->flags =0 ; + +/* Now, we do the remaining detection. */ + +if (kind <0 ) { +if (it87_read_value (new_client,IT87_REG_CONFIG ) &0x80 ) + goto ERROR1; +if (!is_isa + && (it87_read_value (new_client,IT87_REG_I2C_ADDR ) != + address)) goto ERROR1; + } + +/* Determine the chip type. */ +if (kind <=0 ) { + i =it87_read_value (new_client,IT87_REG_CHIPID ); +if (i ==0x90 ) { + kind = it87; + } +else { +if (kind ==0 ) +printk + ("it87.o: Ignoring 'force' parameter for unknown chip at " +"adapter %d, address 0x%02x\n" , +i2c_adapter_id (adapter), address); + goto ERROR1; + } + } + +if (kind == it87) { + name ="it87" ; + client_name ="IT87 chip" ; + }/* else if (kind == it8712) { +name = "it8712"; +client_name = "IT87-J chip"; +} */ else { +dev_dbg (&adapter->dev,"Internal error: unknown kind (%d)?!?" , + kind); + goto ERROR1; + } + +/* Reserve the ISA region */ +if (is_isa) +request_region (address,IT87_EXTENT , name); + +/* Fill in the remaining client fields and put it into the global list */ +strncpy (new_client->dev.name, name,DEVICE_NAME_SIZE ); + + data->type = kind; + + new_client->id = it87_id++; + data->valid =0 ; +init_MUTEX (&data->update_lock); + +/* Tell the I2C layer a new client has arrived */ +if ((err =i2c_attach_client (new_client))) + goto ERROR2; + +/* register sysfs hooks */ +device_create_file (&new_client->dev, &dev_attr_in_input0); +device_create_file (&new_client->dev, &dev_attr_in_input1); +device_create_file (&new_client->dev, &dev_attr_in_input2); +device_create_file (&new_client->dev, &dev_attr_in_input3); +device_create_file (&new_client->dev, &dev_attr_in_input4); +device_create_file (&new_client->dev, &dev_attr_in_min0); +device_create_file (&new_client->dev, &dev_attr_in_min1); +device_create_file (&new_client->dev, &dev_attr_in_min2); +device_create_file (&new_client->dev, &dev_attr_in_min3); +device_create_file (&new_client->dev, &dev_attr_in_min4); +device_create_file (&new_client->dev, &dev_attr_in_max0); +device_create_file (&new_client->dev, &dev_attr_in_max1); +device_create_file (&new_client->dev, &dev_attr_in_max2); +device_create_file (&new_client->dev, &dev_attr_in_max3); +device_create_file (&new_client->dev, &dev_attr_in_max4); +device_create_file (&new_client->dev, &dev_attr_temp_input1); +device_create_file (&new_client->dev, &dev_attr_temp_input2); +device_create_file (&new_client->dev, &dev_attr_temp_input3); +device_create_file (&new_client->dev, &dev_attr_temp_max1); +device_create_file (&new_client->dev, &dev_attr_temp_max2); +device_create_file (&new_client->dev, &dev_attr_temp_max3); +device_create_file (&new_client->dev, &dev_attr_temp_min1); +device_create_file (&new_client->dev, &dev_attr_temp_min2); +device_create_file (&new_client->dev, &dev_attr_temp_min3); +device_create_file (&new_client->dev, &dev_attr_fan_input1); +device_create_file (&new_client->dev, &dev_attr_fan_input2); +device_create_file (&new_client->dev, &dev_attr_fan_min1); +device_create_file (&new_client->dev, &dev_attr_fan_min2); +device_create_file (&new_client->dev, &dev_attr_fan_div1); +device_create_file (&new_client->dev, &dev_attr_fan_div2); +device_create_file (&new_client->dev, &dev_attr_alarm); + +/* Initialize the IT87 chip */ +it87_init_client (new_client); +return 0 ; + + ERROR2: +if (is_isa) +release_region (address,IT87_EXTENT ); + ERROR1: +kfree (new_client); + ERROR0: +return err; +} + +static int it87_detach_client (struct i2c_client *client) +{ +int err; + +if ((err =i2c_detach_client (client))) { +dev_err (&client->dev, +"Client deregistration failed, client not detached.\n" ); +return err; + } + +if (i2c_is_isa_client (client)) +release_region (client->addr,IT87_EXTENT ); +kfree (client); + +return 0 ; +} + +/* The SMBus locks itself, but ISA access must be locked explicitely! +We don't want to lock the whole ISA bus, so we lock each client +separately. +We ignore the IT87 BUSY flag at this moment - it could lead to deadlocks, +would slow down the IT87 access and should not be necessary. +There are some ugly typecasts here, but the good new is - they should +nowhere else be necessary! */ +static int it87_read_value (struct i2c_client *client,u8 reg) +{ +struct it87_data *data =i2c_get_clientdata (client); + +int res; +if (i2c_is_isa_client (client)) { +down (&data->lock); +outb_p (reg, client->addr +IT87_ADDR_REG_OFFSET ); + res =inb_p (client->addr +IT87_DATA_REG_OFFSET ); +up (&data->lock); +return res; + }else +return i2c_smbus_read_byte_data (client, reg); +} + +/* The SMBus locks itself, but ISA access muse be locked explicitely! +We don't want to lock the whole ISA bus, so we lock each client +separately. +We ignore the IT87 BUSY flag at this moment - it could lead to deadlocks, +would slow down the IT87 access and should not be necessary. +There are some ugly typecasts here, but the good new is - they should +nowhere else be necessary! */ +static int it87_write_value (struct i2c_client *client,u8 reg,u8 value) +{ +struct it87_data *data =i2c_get_clientdata (client); + +if (i2c_is_isa_client (client)) { +down (&data->lock); +outb_p (reg, client->addr +IT87_ADDR_REG_OFFSET ); +outb_p (value, client->addr +IT87_DATA_REG_OFFSET ); +up (&data->lock); +return 0 ; + }else +return i2c_smbus_write_byte_data (client, reg, value); +} + +/* Called when we have found a new IT87. It should set limits, etc. */ +static void it87_init_client (struct i2c_client *client) +{ +/* Reset all except Watchdog values and last conversion values +This sets fan-divs to 2, among others */ +it87_write_value (client,IT87_REG_CONFIG ,0x80 ); +it87_write_value (client,IT87_REG_VIN_MIN (0 ), +IN_TO_REG (IT87_INIT_IN_MIN_0 ,0 )); +it87_write_value (client,IT87_REG_VIN_MAX (0 ), +IN_TO_REG (IT87_INIT_IN_MAX_0 ,0 )); +it87_write_value (client,IT87_REG_VIN_MIN (1 ), +IN_TO_REG (IT87_INIT_IN_MIN_1 ,1 )); +it87_write_value (client,IT87_REG_VIN_MAX (1 ), +IN_TO_REG (IT87_INIT_IN_MAX_1 ,1 )); +it87_write_value (client,IT87_REG_VIN_MIN (2 ), +IN_TO_REG (IT87_INIT_IN_MIN_2 ,2 )); +it87_write_value (client,IT87_REG_VIN_MAX (2 ), +IN_TO_REG (IT87_INIT_IN_MAX_2 ,2 )); +it87_write_value (client,IT87_REG_VIN_MIN (3 ), +IN_TO_REG (IT87_INIT_IN_MIN_3 ,3 )); +it87_write_value (client,IT87_REG_VIN_MAX (3 ), +IN_TO_REG (IT87_INIT_IN_MAX_3 ,3 )); +it87_write_value (client,IT87_REG_VIN_MIN (4 ), +IN_TO_REG (IT87_INIT_IN_MIN_4 ,4 )); +it87_write_value (client,IT87_REG_VIN_MAX (4 ), +IN_TO_REG (IT87_INIT_IN_MAX_4 ,4 )); +it87_write_value (client,IT87_REG_VIN_MIN (5 ), +IN_TO_REG (IT87_INIT_IN_MIN_5 ,5 )); +it87_write_value (client,IT87_REG_VIN_MAX (5 ), +IN_TO_REG (IT87_INIT_IN_MAX_5 ,5 )); +it87_write_value (client,IT87_REG_VIN_MIN (6 ), +IN_TO_REG (IT87_INIT_IN_MIN_6 ,6 )); +it87_write_value (client,IT87_REG_VIN_MAX (6 ), +IN_TO_REG (IT87_INIT_IN_MAX_6 ,6 )); +it87_write_value (client,IT87_REG_VIN_MIN (7 ), +IN_TO_REG (IT87_INIT_IN_MIN_7 ,7 )); +it87_write_value (client,IT87_REG_VIN_MAX (7 ), +IN_TO_REG (IT87_INIT_IN_MAX_7 ,7 )); +/* Note: Battery voltage does not have limit registers */ +it87_write_value (client,IT87_REG_FAN_MIN (1 ), +FAN_TO_REG (IT87_INIT_FAN_MIN_1 ,2 )); +it87_write_value (client,IT87_REG_FAN_MIN (2 ), +FAN_TO_REG (IT87_INIT_FAN_MIN_2 ,2 )); +it87_write_value (client,IT87_REG_FAN_MIN (3 ), +FAN_TO_REG (IT87_INIT_FAN_MIN_3 ,2 )); +it87_write_value (client,IT87_REG_TEMP_HIGH (1 ), +TEMP_TO_REG (IT87_INIT_TEMP_HIGH_1 )); +it87_write_value (client,IT87_REG_TEMP_LOW (1 ), +TEMP_TO_REG (IT87_INIT_TEMP_LOW_1 )); +it87_write_value (client,IT87_REG_TEMP_HIGH (2 ), +TEMP_TO_REG (IT87_INIT_TEMP_HIGH_2 )); +it87_write_value (client,IT87_REG_TEMP_LOW (2 ), +TEMP_TO_REG (IT87_INIT_TEMP_LOW_2 )); +it87_write_value (client,IT87_REG_TEMP_HIGH (3 ), +TEMP_TO_REG (IT87_INIT_TEMP_HIGH_3 )); +it87_write_value (client,IT87_REG_TEMP_LOW (3 ), +TEMP_TO_REG (IT87_INIT_TEMP_LOW_3 )); + +/* Enable voltage monitors */ +it87_write_value (client,IT87_REG_VIN_ENABLE ,0xff ); + +/* Enable Temp1-Temp3 */ +it87_write_value (client,IT87_REG_TEMP_ENABLE , + (it87_read_value (client,IT87_REG_TEMP_ENABLE ) &0xc0 ) + | (temp_type &0x3f )); + +/* Enable fans */ +it87_write_value (client,IT87_REG_FAN_CTRL , + (it87_read_value (client,IT87_REG_FAN_CTRL ) &0x8f ) + |0x70 ); + +/* Start monitoring */ +it87_write_value (client,IT87_REG_CONFIG , + (it87_read_value (client,IT87_REG_CONFIG ) &0xb7 ) + | (update_vbat ?0x41 :0x01 )); +} + +static void it87_update_client (struct i2c_client *client) +{ +struct it87_data *data =i2c_get_clientdata (client); +int i; + +down (&data->update_lock); + +if ((jiffies - data->last_updated >HZ +HZ /2 ) || + (jiffies < data->last_updated) || !data->valid) { + +if (update_vbat) { +/* Cleared after each update, so reenable. Value +returned by this read will be previous value */ +it87_write_value (client,IT87_REG_CONFIG , +it87_read_value (client,IT87_REG_CONFIG ) |0x40 ); + } +for (i =0 ; i <=7 ; i++) { + data->in[i] = +it87_read_value (client,IT87_REG_VIN (i)); + data->in_min[i] = +it87_read_value (client,IT87_REG_VIN_MIN (i)); + data->in_max[i] = +it87_read_value (client,IT87_REG_VIN_MAX (i)); + } + data->in[8 ] = +it87_read_value (client,IT87_REG_VIN (8 )); +/* Temperature sensor doesn't have limit registers, set +to min and max value */ + data->in_min[8 ] =0 ; + data->in_max[8 ] =255 ; + +for (i =1 ; i <=3 ; i++) { + data->fan[i -1 ] = +it87_read_value (client,IT87_REG_FAN (i)); + data->fan_min[i -1 ] = +it87_read_value (client,IT87_REG_FAN_MIN (i)); + } +for (i =1 ; i <=3 ; i++) { + data->temp[i -1 ] = +it87_read_value (client,IT87_REG_TEMP (i)); + data->temp_high[i -1 ] = +it87_read_value (client,IT87_REG_TEMP_HIGH (i)); + data->temp_low[i -1 ] = +it87_read_value (client,IT87_REG_TEMP_LOW (i)); + } + +/* The 8705 does not have VID capability */ +/*if (data->type == it8712) { +data->vid = it87_read_value(client, IT87_REG_VID); +data->vid &= 0x1f; +} +else */ { + data->vid =0x1f ; + } + + i =it87_read_value (client,IT87_REG_FAN_DIV ); + data->fan_div[0 ] = i &0x07 ; + data->fan_div[1 ] = (i >>3 ) &0x07 ; + data->fan_div[2 ] =1 ; + + data->alarms = +it87_read_value (client,IT87_REG_ALARM1 ) | + (it87_read_value (client,IT87_REG_ALARM2 ) <<8 ) | + (it87_read_value (client,IT87_REG_ALARM3 ) <<16 ); + + data->last_updated = jiffies; + data->valid =1 ; + } + +up (&data->update_lock); +} + +static int __init sm_it87_init (void ) +{ +return i2c_add_driver (&it87_driver); +} + +static void __exit sm_it87_exit(void) +{ +i2c_del_driver (&it87_driver); +} + + +MODULE_AUTHOR ("Chris Gauthron <[email protected]>" ); +MODULE_DESCRIPTION ("IT8705F, IT8712F, Sis950 driver" ); +MODULE_PARM (update_vbat,"i" ); +MODULE_PARM_DESC (update_vbat,"Update vbat if set else return powerup value" ); +MODULE_PARM (temp_type,"i" ); +MODULE_PARM_DESC (temp_type,"Temperature sensor type, normally leave unset" ); +MODULE_LICENSE ("GPL" ); + +module_init (sm_it87_init); +module_exit (sm_it87_exit);
drivers/i2c/chips/Kconfig +12 -2
@@ -22,6 +22,16 @@ in the lm_sensors package, which you can download at http://www.lm-sensors.nu +config SENSORS_IT87 + tristate " National Semiconductors IT87 and compatibles" + depends on I2C && EXPERIMENTAL + help + The module will be called it87. + + You will also need the latest user-space utilties: you can find them + in the lm_sensors package, which you can download at + http://www.lm-sensors.nu + config SENSORS_LM75 tristate " National Semiconductors LM75 and compatibles" depends on I2C && EXPERIMENTAL
@@ -66,8 +76,8 @@ config I2C_SENSOR tristate - default y if SENSORS_ADM1021=y || SENSORS_LM75=y || SENSORS_VIA686A=y || SENSORS_W83781D=y - default m if SENSORS_ADM1021=m || SENSORS_LM75=m || SENSORS_VIA686A=m || SENSORS_W83781D=m + default y if SENSORS_ADM1021=y || SENSORS_IT87=y || SENSORS_LM75=y || SENSORS_VIA686A=y || SENSORS_W83781D=y + default m if SENSORS_ADM1021=m || SENSORS_IT87=m || SENSORS_LM75=m || SENSORS_VIA686A=m || SENSORS_W83781D=m default n endmenu
drivers/i2c/chips/Makefile +1 -0
@@ -3,6 +3,7 @@ # obj-$(CONFIG_SENSORS_ADM1021) += adm1021.o +obj-$(CONFIG_SENSORS_IT87) += it87.o obj-$(CONFIG_SENSORS_LM75) += lm75.o obj-$(CONFIG_SENSORS_VIA686A) += via686a.o obj-$(CONFIG_SENSORS_W83781D) += w83781d.o
Signature · 1 line
"NT is to UNIX what a doughnut is to a particle accelerator."
Quoted 7 lines · Florin Iucha
Quoted 1 line · Greg KH
A few comments:
[snip]
Quoted 2 lines
Other than those very minor things the patch looks good. Mind fixing them and sending it to me again?
Thank you, fixed patch inlined.
Thanks, I've applied this and will send it on in a bit.
Oops, I've fixed the call to check_region, which should not have been made. Sorry I missed that last time.
greg k-h
Quoted 4 lines · Greg KH
Thanks, I've applied this and will send it on in a bit.
Oops, I've fixed the call to
check_region, which should not have been made. Sorry I missed that last time.
I have booted 2.5.68-bk6 and upon modprobe it87 I get this:
i2c /dev entries driver module version 2.7.0 (20021208) registering 0-0290
Unable to handle kernel NULL pointer dereference at virtual address 0000006c printing eip: c022ea13 *pde = 00000000 Oops: 0000 [#1] CPU: 0 EIP: 0060:[<c022ea13>] Not tainted EFLAGS: 00010206
EIP is at kobject_get+0x13/0x50
eax: ef27e000 ebx: 0000005c ecx: c03b1db0 edx: 00000296
esi: f0858388 edi: ef55ec00 ebp: ef55ec00 esp: ef27fea8
ds: 007b es: 007b ss: 0068
Process modprobe (pid: 69, threadinfo=ef27e000 task=ef6e2700)
Stack: ef55ec44 c022e71d 0000005c ef55ec18 c027f5a6 ef55ec44 ef55ec18 c027f703
ef55ec18 ef55eca2 f08736df ef55ec18 ef55eca2 f0875127 00000000 00000290
ef55ece0 f08821a3 ef55eca2 f0881573 ef55ec00 00000058 00000008 f08821a3
Call Trace:
[<c022e71d>] kobject_init+0x2d/0x50
[<c027f5a6>] device_initialize+0x16/0x50
[<c027f703>] device_register+0x13/0x30
[<f08736df>] i2c_attach_client+0xff/0x150 [i2c_core]
[<f0875127>] +0xb/0x24 [i2c_core]
[<f08821a3>] +0x130/0x14d [it87]
[<f0881573>] it87_detect+0x163/0x540 [it87]
[<f08821a3>] +0x130/0x14d [it87]
[<f0883a08>] forces+0x28/0x40 [it87]
[<c0122046>] __check_region+0x46/0x50
[<f0883a08>] forces+0x28/0x40 [it87]
[<f085a34f>] +0x34f/0x4b0 [i2c_sensor]
[<f0858360>] isa_adapter+0x0/0x1a0 [i2c_isa]
[<f08776a4>] i2c_bus_type+0x44/0xe0 [i2c_core]
[<f0877660>] i2c_bus_type+0x0/0xe0 [i2c_core]
[<c02806a0>] bus_add_driver+0xd0/0xe0
[<f0883be0>] it87_driver+0x0/0xa4 [it87]
[<f08813ff>] it87_attach_adapter+0x1f/0x30 [it87]
[<f0858360>] isa_adapter+0x0/0x1a0 [i2c_isa]
[<f0883ba0>] addr_data+0x0/0x24 [it87]
[<f0881410>] it87_detect+0x0/0x540 [it87]
[<f0873374>] i2c_add_driver+0xc4/0xf0 [i2c_core]
[<f0858360>] isa_adapter+0x0/0x1a0 [i2c_isa]
[<f0883e80>] +0x0/0x140 [it87]
[<f085200f>] +0xf/0x13 [it87]
[<f0883be0>] it87_driver+0x0/0xa4 [it87]
[<c01329ff>] sys_init_module+0x12f/0x1e0
[<f0883e80>] +0x0/0x140 [it87]
[<c010ab77>] syscall_call+0x7/0xb
Code: 8b 43 10 85 c0 7e 26 ff 43 10 b8 00 e0 ff ff 21 e0 ff 48 14
<6>note: modprobe[69] exited with preempt_count 1
bad: scheduling while atomic!
Call Trace:
[<c011a5b9>] schedule+0x399/0x3a0
[<c01410f3>] unmap_page_range+0x43/0x70
[<c01412e0>] unmap_vmas+0x1c0/0x220
[<c01450cb>] exit_mmap+0x7b/0x190
[<c011be84>] mmput+0x54/0xb0
[<c011fb9d>] do_exit+0x10d/0x400
[<c010bbb1>] die+0xe1/0xf0
[<c0118caa>] do_page_fault+0x14a/0x457
[<c010b4e4>] common_interrupt+0x18/0x20
[<c0272860>] serial_in+0x20/0x40
[<c022f8f2>] __delay+0x12/0x20
[<c02751d5>] serial8250_console_write+0x155/0x240
[<c011dfc4>] __call_console_drivers+0x54/0x60
[<c0118b60>] do_page_fault+0x0/0x457
[<c010b581>] error_code+0x2d/0x38
[<f0858388>] isa_adapter+0x28/0x1a0 [i2c_isa]
[<c022ea13>] kobject_get+0x13/0x50
[<c022e71d>] kobject_init+0x2d/0x50
[<c027f5a6>] device_initialize+0x16/0x50
[<c027f703>] device_register+0x13/0x30
[<f08736df>] i2c_attach_client+0xff/0x150 [i2c_core]
[<f0875127>] +0xb/0x24 [i2c_core]
[<f08821a3>] +0x130/0x14d [it87]
[<f0881573>] it87_detect+0x163/0x540 [it87]
[<f08821a3>] +0x130/0x14d [it87]
[<f0883a08>] forces+0x28/0x40 [it87]
[<c0122046>] __check_region+0x46/0x50
[<f0883a08>] forces+0x28/0x40 [it87]
[<f085a34f>] +0x34f/0x4b0 [i2c_sensor]
[<f0858360>] isa_adapter+0x0/0x1a0 [i2c_isa]
[<f08776a4>] i2c_bus_type+0x44/0xe0 [i2c_core]
[<f0877660>] i2c_bus_type+0x0/0xe0 [i2c_core]
[<c02806a0>] bus_add_driver+0xd0/0xe0
[<f0883be0>] it87_driver+0x0/0xa4 [it87]
[<f08813ff>] it87_attach_adapter+0x1f/0x30 [it87]
[<f0858360>] isa_adapter+0x0/0x1a0 [i2c_isa]
[<f0883ba0>] addr_data+0x0/0x24 [it87]
[<f0881410>] it87_detect+0x0/0x540 [it87]
[<f0873374>] i2c_add_driver+0xc4/0xf0 [i2c_core]
[<f0858360>] isa_adapter+0x0/0x1a0 [i2c_isa]
[<f0883e80>] +0x0/0x140 [it87]
[<f085200f>] +0xf/0x13 [it87]
[<f0883be0>] it87_driver+0x0/0xa4 [it87]
[<c01329ff>] sys_init_module+0x12f/0x1e0
[<f0883e80>] +0x0/0x140 [it87]
[<c010ab77>] syscall_call+0x7/0xb-bk3 with my version of it87 works fine.
Cheers,
florin
Signature · 1 line
"NT is to UNIX what a doughnut is to a particle accelerator."
Quoted 7 lines · Florin Iucha
Quoted 4 lines · Greg KH
Thanks, I've applied this and will send it on in a bit.
Oops, I've fixed the call to
check_region, which should not have been made. Sorry I missed that last time.I have booted 2.5.68-bk6 and upon modprobe it87 I get this:
Let me know if this patch fixes it or not.
thanks,
greg k-h
drivers/i2c/chips/it87.c +1 -0
@@ -585,6 +585,7 @@ err = -ENOMEM ; goto ERROR1; } +memset (new_client,0x00 ,sizeof (struct i2c_client )+sizeof (struct it87_data )); data = (struct it87_data *) (new_client +1 );if (is_isa)
Quoted 1 line · Greg KH
Let me know if this patch fixes it or not.
Yes, it does.
Thank you,
florin
Signature · 1 line
"NT is to UNIX what a doughnut is to a particle accelerator."