Hi,
I've tested the patch, and it works without problems with the F71862FG
on my NC81-LF board.
Regards
Tony
On Mon, 2008-10-20 at 17:08 +0200, Hans de Goede wrote:
> Hi All,
>
> This patch adds support for the Fintek f71862fg superio monitoring functions to
> the f71882fg driver.
>
> This patch applies on to of the patches adding pwm support to the f71882fg driver.
>
> I'm waiting for feedback from Tony McConnell to actually test this as I don't
> have the hardware. I expect no troubles with testing and would appreciate a
> review now, so that this patch can get merged into 2.6.28 as soon as its tested.
>
> Signed-off-by: Hans de Goede <hdegoede at redhat.com>
>
> Regards,
>
> Hans
> plain text document attachment (f71882fg-add-f71862fg-support.patch)
> This patch adds support for the Fintek f71862fg superio monitoring functions to
> the f71882fg driver.
>
> Signed-off-by: Hans de Goede <hdegoede at redhat.com>
> --- f71882fg.c.pre-f71862fg 2008-10-20 11:32:17.000000000 +0200
> +++ f71882fg.c 2008-10-20 16:45:00.000000000 +0200
> @@ -1,6 +1,6 @@
> /***************************************************************************
> * Copyright (C) 2006 by Hans Edgington <hans at edgington.nl> *
> - * Copyright (C) 2007 by Hans de Goede <j.w.r.degoede at hhs.nl> *
> + * Copyright (C) 2007,2008 by Hans de Goede <hdegoede at redhat.com> *
> * *
> * 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 *
> @@ -43,6 +43,7 @@
> #define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */
>
> #define SIO_FINTEK_ID 0x1934 /* Manufacturers ID */
> +#define SIO_F71862_ID 0x0601 /* Chipset ID */
> #define SIO_F71882_ID 0x0541 /* Chipset ID */
>
> #define REGION_LENGTH 8
> @@ -51,10 +52,10 @@
>
> #define F71882FG_REG_PECI 0x0A
>
> -#define F71882FG_REG_IN_STATUS 0x12
> -#define F71882FG_REG_IN_BEEP 0x13
> +#define F71882FG_REG_IN_STATUS 0x12 /* f71882fg only */
> +#define F71882FG_REG_IN_BEEP 0x13 /* f71882fg only */
> #define F71882FG_REG_IN(nr) (0x20 + (nr))
> -#define F71882FG_REG_IN1_HIGH 0x32
> +#define F71882FG_REG_IN1_HIGH 0x32 /* f71882fg only */
>
> #define F71882FG_REG_FAN(nr) (0xA0 + (16 * (nr)))
> #define F71882FG_REG_FAN_TARGET(nr) (0xA2 + (16 * (nr)))
> @@ -97,6 +98,13 @@
> "(0=don't change, 1=pwm, 2=rpm)\n"
> "Note: this needs a write to pwm#_enable to take effect");
>
> +enum chips { f71862fg, f71882fg };
> +
> +static const char *f71882fg_names[] = {
> + "f71862fg",
> + "f71882fg",
> +};
> +
> static struct platform_device *f71882fg_pdev;
>
> /* Super-I/O Function prototypes */
> @@ -106,8 +114,14 @@
> static inline void superio_select(int base, int ld);
> static inline void superio_exit(int base);
>
> +struct f71882fg_sio_data {
> + enum chips type;
> +};
> +
> struct f71882fg_data {
> unsigned short addr;
> + enum chips type;
> + const char *name;
> struct device *hwmon_dev;
>
> struct mutex update_lock;
> @@ -229,10 +243,6 @@
>
> static int __devinit f71882fg_probe(struct platform_device * pdev);
> static int __devexit f71882fg_remove(struct platform_device *pdev);
> -static int __init f71882fg_init(void);
> -static int __init f71882fg_find(int sioaddr, unsigned short *address);
> -static int __init f71882fg_device_add(unsigned short address);
> -static void __exit f71882fg_exit(void);
>
> static struct platform_driver f71882fg_driver = {
> .driver = {
> @@ -243,20 +253,15 @@
> .remove = __devexit_p(f71882fg_remove),
> };
>
> -static struct device_attribute f71882fg_dev_attr[] =
> +static struct sensor_device_attribute_2 f71882fg_dev_attr[] =
> {
> - __ATTR( name, S_IRUGO, show_name, NULL ),
> + SENSOR_ATTR_2(name, S_IRUGO, show_name, NULL, 0, 0),
> };
>
> -static struct sensor_device_attribute_2 f71882fg_in_temp_attr[] =
> +static struct sensor_device_attribute_2 f718x2fg_in_temp_attr[] =
> {
> SENSOR_ATTR_2(in0_input, S_IRUGO, show_in, NULL, 0, 0),
> SENSOR_ATTR_2(in1_input, S_IRUGO, show_in, NULL, 0, 1),
> - SENSOR_ATTR_2(in1_max, S_IRUGO|S_IWUSR, show_in_max, store_in_max,
> - 0, 1),
> - SENSOR_ATTR_2(in1_beep, S_IRUGO|S_IWUSR, show_in_beep, store_in_beep,
> - 0, 1),
> - SENSOR_ATTR_2(in1_alarm, S_IRUGO, show_in_alarm, NULL, 0, 1),
> SENSOR_ATTR_2(in2_input, S_IRUGO, show_in, NULL, 0, 2),
> SENSOR_ATTR_2(in3_input, S_IRUGO, show_in, NULL, 0, 3),
> SENSOR_ATTR_2(in4_input, S_IRUGO, show_in, NULL, 0, 4),
> @@ -308,7 +313,15 @@
> SENSOR_ATTR_2(temp3_fault, S_IRUGO, show_temp_fault, NULL, 0, 2)
> };
>
> -static struct sensor_device_attribute_2 f71882fg_fan_attr[] = {
> +static struct sensor_device_attribute_2 f71882fg_in_temp_attr[] = {
> + SENSOR_ATTR_2(in1_max, S_IRUGO|S_IWUSR, show_in_max, store_in_max,
> + 0, 1),
> + SENSOR_ATTR_2(in1_beep, S_IRUGO|S_IWUSR, show_in_beep, store_in_beep,
> + 0, 1),
> + SENSOR_ATTR_2(in1_alarm, S_IRUGO, show_in_alarm, NULL, 0, 1),
> +};
> +
> +static struct sensor_device_attribute_2 f718x2fg_fan_attr[] = {
> SENSOR_ATTR_2(fan1_input, S_IRUGO, show_fan, NULL, 0, 0),
> SENSOR_ATTR_2(fan1_full_speed, S_IRUGO|S_IWUSR,
> show_fan_full_speed,
> @@ -330,13 +343,6 @@
> SENSOR_ATTR_2(fan3_beep, S_IRUGO|S_IWUSR, show_fan_beep,
> store_fan_beep, 0, 2),
> SENSOR_ATTR_2(fan3_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 2),
> - SENSOR_ATTR_2(fan4_input, S_IRUGO, show_fan, NULL, 0, 3),
> - SENSOR_ATTR_2(fan4_full_speed, S_IRUGO|S_IWUSR,
> - show_fan_full_speed,
> - store_fan_full_speed, 0, 3),
> - SENSOR_ATTR_2(fan4_beep, S_IRUGO|S_IWUSR, show_fan_beep,
> - store_fan_beep, 0, 3),
> - SENSOR_ATTR_2(fan4_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 3),
>
> SENSOR_ATTR_2(pwm1, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 0),
> SENSOR_ATTR_2(pwm1_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
> @@ -346,6 +352,75 @@
> SENSOR_ATTR_2(pwm1_auto_channels_temp, S_IRUGO|S_IWUSR,
> show_pwm_auto_point_channel,
> store_pwm_auto_point_channel, 0, 0),
> +
> + SENSOR_ATTR_2(pwm2, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 1),
> + SENSOR_ATTR_2(pwm2_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
> + store_pwm_enable, 0, 1),
> + SENSOR_ATTR_2(pwm2_interpolate, S_IRUGO|S_IWUSR,
> + show_pwm_interpolate, store_pwm_interpolate, 0, 1),
> + SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_channel,
> + store_pwm_auto_point_channel, 0, 1),
> +
> + SENSOR_ATTR_2(pwm3, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 2),
> + SENSOR_ATTR_2(pwm3_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
> + store_pwm_enable, 0, 2),
> + SENSOR_ATTR_2(pwm3_interpolate, S_IRUGO|S_IWUSR,
> + show_pwm_interpolate, store_pwm_interpolate, 0, 2),
> + SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_channel,
> + store_pwm_auto_point_channel, 0, 2),
> +};
> +
> +static struct sensor_device_attribute_2 f71862fg_fan_attr[] = {
> + SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
> + 1, 0),
> + SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
> + 4, 0),
> + SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_temp, store_pwm_auto_point_temp,
> + 0, 0),
> + SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_temp, store_pwm_auto_point_temp,
> + 3, 0),
> + SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_temp_hyst,
> + store_pwm_auto_point_temp_hyst,
> + 0, 0),
> + SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
> + show_pwm_auto_point_temp_hyst, NULL, 3, 0),
> +
> + SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
> + 1, 1),
> + SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
> + 4, 1),
> + SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_temp, store_pwm_auto_point_temp,
> + 0, 1),
> + SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_temp, store_pwm_auto_point_temp,
> + 3, 1),
> + SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
> + show_pwm_auto_point_temp_hyst,
> + store_pwm_auto_point_temp_hyst,
> + 0, 1),
> + SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
> + show_pwm_auto_point_temp_hyst, NULL, 3, 1),
> +};
> +
> +static struct sensor_device_attribute_2 f71882fg_fan_attr[] = {
> + SENSOR_ATTR_2(fan4_input, S_IRUGO, show_fan, NULL, 0, 3),
> + SENSOR_ATTR_2(fan4_full_speed, S_IRUGO|S_IWUSR,
> + show_fan_full_speed,
> + store_fan_full_speed, 0, 3),
> + SENSOR_ATTR_2(fan4_beep, S_IRUGO|S_IWUSR, show_fan_beep,
> + store_fan_beep, 0, 3),
> + SENSOR_ATTR_2(fan4_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 3),
> +
> SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
> show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
> 0, 0),
> @@ -384,14 +459,6 @@
> SENSOR_ATTR_2(pwm1_auto_point4_temp_hyst, S_IRUGO,
> show_pwm_auto_point_temp_hyst, NULL, 3, 0),
>
> - SENSOR_ATTR_2(pwm2, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 1),
> - SENSOR_ATTR_2(pwm2_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
> - store_pwm_enable, 0, 1),
> - SENSOR_ATTR_2(pwm2_interpolate, S_IRUGO|S_IWUSR,
> - show_pwm_interpolate, store_pwm_interpolate, 0, 1),
> - SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
> - show_pwm_auto_point_channel,
> - store_pwm_auto_point_channel, 0, 1),
> SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
> show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
> 0, 1),
> @@ -430,14 +497,6 @@
> SENSOR_ATTR_2(pwm2_auto_point4_temp_hyst, S_IRUGO,
> show_pwm_auto_point_temp_hyst, NULL, 3, 1),
>
> - SENSOR_ATTR_2(pwm3, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 2),
> - SENSOR_ATTR_2(pwm3_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
> - store_pwm_enable, 0, 2),
> - SENSOR_ATTR_2(pwm3_interpolate, S_IRUGO|S_IWUSR,
> - show_pwm_interpolate, store_pwm_interpolate, 0, 2),
> - SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
> - show_pwm_auto_point_channel,
> - store_pwm_auto_point_channel, 0, 2),
> SENSOR_ATTR_2(pwm3_auto_point1_pwm, S_IRUGO|S_IWUSR,
> show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
> 0, 2),
> @@ -608,14 +667,19 @@
> {
> struct f71882fg_data *data = dev_get_drvdata(dev);
> int nr, reg, reg2;
> + int no_fans = (data->type == f71862fg) ? 3 : 4;
>
> mutex_lock(&data->update_lock);
>
> /* Update once every 60 seconds */
> if ( time_after(jiffies, data->last_limits + 60 * HZ ) ||
> !data->valid) {
> - data->in1_max = f71882fg_read8(data, F71882FG_REG_IN1_HIGH);
> - data->in_beep = f71882fg_read8(data, F71882FG_REG_IN_BEEP);
> + if (data->type == f71882fg) {
> + data->in1_max =
> + f71882fg_read8(data, F71882FG_REG_IN1_HIGH);
> + data->in_beep =
> + f71882fg_read8(data, F71882FG_REG_IN_BEEP);
> + }
>
> /* Get High & boundary temps*/
> for (nr = 0; nr < 3; nr++) {
> @@ -656,24 +720,42 @@
> F71882FG_REG_FAN_HYST0);
> data->pwm_auto_point_hyst[1] = f71882fg_read8(data,
> F71882FG_REG_FAN_HYST1);
> - for (nr = 0; nr < 4; nr++) {
> - int point;
> -
> + for (nr = 0; nr < no_fans; nr++) {
> data->pwm_auto_point_mapping[nr] =
> f71882fg_read8(data,
> F71882FG_REG_POINT_MAPPING(nr));
>
> - for (point = 0; point < 5; point++) {
> - data->pwm_auto_point_pwm[nr][point] =
> - f71882fg_read8(data,
> - F71882FG_REG_POINT_PWM
> - (nr, point));
> - }
> - for (point = 0; point < 4; point++) {
> - data->pwm_auto_point_temp[nr][point] =
> - f71882fg_read8(data,
> - F71882FG_REG_POINT_TEMP
> - (nr, point));
> + if (data->type == f71882fg) {
> + int point;
> + for (point = 0; point < 5; point++) {
> + data->pwm_auto_point_pwm[nr][point] =
> + f71882fg_read8(data,
> + F71882FG_REG_POINT_PWM
> + (nr, point));
> + }
> + for (point = 0; point < 4; point++) {
> + data->pwm_auto_point_temp[nr][point] =
> + f71882fg_read8(data,
> + F71882FG_REG_POINT_TEMP
> + (nr, point));
> + }
> + } else {
> + data->pwm_auto_point_pwm[nr][1] =
> + f71882fg_read8(data,
> + F71882FG_REG_POINT_PWM
> + (nr, 1));
> + data->pwm_auto_point_pwm[nr][4] =
> + f71882fg_read8(data,
> + F71882FG_REG_POINT_PWM
> + (nr, 4));
> + data->pwm_auto_point_temp[nr][0] =
> + f71882fg_read8(data,
> + F71882FG_REG_POINT_TEMP
> + (nr, 0));
> + data->pwm_auto_point_temp[nr][3] =
> + f71882fg_read8(data,
> + F71882FG_REG_POINT_TEMP
> + (nr, 3));
> }
> }
> data->last_limits = jiffies;
> @@ -691,7 +773,7 @@
>
> data->fan_status = f71882fg_read8(data,
> F71882FG_REG_FAN_STATUS);
> - for (nr = 0; nr < 4; nr++) {
> + for (nr = 0; nr < no_fans; nr++) {
> data->fan[nr] = f71882fg_read16(data,
> F71882FG_REG_FAN(nr));
> data->fan_target[nr] =
> @@ -703,7 +785,8 @@
> f71882fg_read8(data, F71882FG_REG_PWM(nr));
> }
>
> - data->in_status = f71882fg_read8(data,
> + if (data->type == f71882fg)
> + data->in_status = f71882fg_read8(data,
> F71882FG_REG_IN_STATUS);
> for (nr = 0; nr < 9; nr++)
> data->in[nr] = f71882fg_read8(data,
> @@ -1151,13 +1234,15 @@
> data->pwm_enable &= ~(2 << (2 * nr));
> break; /* Temperature ctrl */
> }
> - switch (fan_mode[nr]) {
> - case 1:
> - data->pwm_enable |= 1 << (2 * nr);
> - break; /* Duty cycle mode */
> - case 2:
> - data->pwm_enable &= ~(1 << (2 * nr));
> - break; /* RPM mode */
> + if (data->type == f71882fg) {
> + switch (fan_mode[nr]) {
> + case 1:
> + data->pwm_enable |= 1 << (2 * nr);
> + break; /* Duty cycle mode */
> + case 2:
> + data->pwm_enable &= ~(1 << (2 * nr));
> + break; /* RPM mode */
> + }
> }
> f71882fg_write8(data, F71882FG_REG_PWM_ENABLE, data->pwm_enable);
> mutex_unlock(&data->update_lock);
> @@ -1393,69 +1478,92 @@
> static ssize_t show_name(struct device *dev, struct device_attribute *devattr,
> char *buf)
> {
> - return sprintf(buf, DRVNAME "\n");
> + struct f71882fg_data *data = dev_get_drvdata(dev);
> + return sprintf(buf, "%s\n", data->name);
> }
>
> +static int __devinit f71882fg_create_sysfs_files(struct platform_device *pdev,
> + struct sensor_device_attribute_2 *attr, int count)
> +{
> + int err, i;
> +
> + for (i = 0; i < count; i++) {
> + err = device_create_file(&pdev->dev, &attr[i].dev_attr);
> + if (err)
> + return err;
> + }
> + return 0;
> +}
>
> -static int __devinit f71882fg_probe(struct platform_device * pdev)
> +static int __devinit f71882fg_probe(struct platform_device *pdev)
> {
> struct f71882fg_data *data;
> - int err, i;
> + struct f71882fg_sio_data *sio_data = pdev->dev.platform_data;
> + int err;
> u8 start_reg;
>
> - if (!(data = kzalloc(sizeof(struct f71882fg_data), GFP_KERNEL)))
> + data = kzalloc(sizeof(struct f71882fg_data), GFP_KERNEL);
> + if (!data)
> return -ENOMEM;
>
> data->addr = platform_get_resource(pdev, IORESOURCE_IO, 0)->start;
> + data->type = sio_data->type;
> + data->name = f71882fg_names[sio_data->type];
> mutex_init(&data->update_lock);
> platform_set_drvdata(pdev, data);
>
> /* Register sysfs interface files */
> - for (i = 0; i < ARRAY_SIZE(f71882fg_dev_attr); i++) {
> - err = device_create_file(&pdev->dev, &f71882fg_dev_attr[i]);
> - if (err)
> - goto exit_unregister_sysfs;
> - }
> + err = f71882fg_create_sysfs_files(pdev, f71882fg_dev_attr,
> + ARRAY_SIZE(f71882fg_dev_attr));
> + if (err)
> + goto exit_unregister_sysfs;
>
> start_reg = f71882fg_read8(data, F71882FG_REG_START);
> if (start_reg & 0x01) {
> - for (i = 0; i < ARRAY_SIZE(f71882fg_in_temp_attr); i++) {
> - err = device_create_file(&pdev->dev,
> - &f71882fg_in_temp_attr[i].dev_attr);
> + err = f71882fg_create_sysfs_files(pdev, f718x2fg_in_temp_attr,
> + ARRAY_SIZE(f718x2fg_in_temp_attr));
> + if (err)
> + goto exit_unregister_sysfs;
> +
> + if (data->type == f71882fg) {
> + err = f71882fg_create_sysfs_files(pdev,
> + f71882fg_in_temp_attr,
> + ARRAY_SIZE(f71882fg_in_temp_attr));
> if (err)
> goto exit_unregister_sysfs;
> }
> }
>
> if (start_reg & 0x02) {
> - for (i = 0; i < ARRAY_SIZE(f71882fg_fan_attr); i++) {
> - err = device_create_file(&pdev->dev,
> - &f71882fg_fan_attr[i].dev_attr);
> - if (err)
> - goto exit_unregister_sysfs;
> + err = f71882fg_create_sysfs_files(pdev, f718x2fg_fan_attr,
> + ARRAY_SIZE(f718x2fg_fan_attr));
> + if (err)
> + goto exit_unregister_sysfs;
> +
> + if (data->type == f71862fg) {
> + err = f71882fg_create_sysfs_files(pdev,
> + f71862fg_fan_attr,
> + ARRAY_SIZE(f71862fg_fan_attr));
> + } else {
> + err = f71882fg_create_sysfs_files(pdev,
> + f71882fg_fan_attr,
> + ARRAY_SIZE(f71882fg_fan_attr));
> }
> + if (err)
> + goto exit_unregister_sysfs;
> }
>
> data->hwmon_dev = hwmon_device_register(&pdev->dev);
> if (IS_ERR(data->hwmon_dev)) {
> err = PTR_ERR(data->hwmon_dev);
> + data->hwmon_dev = NULL;
> goto exit_unregister_sysfs;
> }
>
> return 0;
>
> exit_unregister_sysfs:
> - for (i = 0; i < ARRAY_SIZE(f71882fg_dev_attr); i++)
> - device_remove_file(&pdev->dev, &f71882fg_dev_attr[i]);
> -
> - for (i = 0; i < ARRAY_SIZE(f71882fg_in_temp_attr); i++)
> - device_remove_file(&pdev->dev,
> - &f71882fg_in_temp_attr[i].dev_attr);
> -
> - for (i = 0; i < ARRAY_SIZE(f71882fg_fan_attr); i++)
> - device_remove_file(&pdev->dev, &f71882fg_fan_attr[i].dev_attr);
> -
> - kfree(data);
> + f71882fg_remove(pdev); /* Will unregister the sysfs files for us */
>
> return err;
> }
> @@ -1466,15 +1574,26 @@
> struct f71882fg_data *data = platform_get_drvdata(pdev);
>
> platform_set_drvdata(pdev, NULL);
> - hwmon_device_unregister(data->hwmon_dev);
> + if (data->hwmon_dev)
> + hwmon_device_unregister(data->hwmon_dev);
>
> for (i = 0; i < ARRAY_SIZE(f71882fg_dev_attr); i++)
> - device_remove_file(&pdev->dev, &f71882fg_dev_attr[i]);
> + device_remove_file(&pdev->dev, &f71882fg_dev_attr[i].dev_attr);
> +
> + for (i = 0; i < ARRAY_SIZE(f718x2fg_in_temp_attr); i++)
> + device_remove_file(&pdev->dev,
> + &f718x2fg_in_temp_attr[i].dev_attr);
>
> for (i = 0; i < ARRAY_SIZE(f71882fg_in_temp_attr); i++)
> device_remove_file(&pdev->dev,
> &f71882fg_in_temp_attr[i].dev_attr);
>
> + for (i = 0; i < ARRAY_SIZE(f718x2fg_fan_attr); i++)
> + device_remove_file(&pdev->dev, &f718x2fg_fan_attr[i].dev_attr);
> +
> + for (i = 0; i < ARRAY_SIZE(f71862fg_fan_attr); i++)
> + device_remove_file(&pdev->dev, &f71862fg_fan_attr[i].dev_attr);
> +
> for (i = 0; i < ARRAY_SIZE(f71882fg_fan_attr); i++)
> device_remove_file(&pdev->dev, &f71882fg_fan_attr[i].dev_attr);
>
> @@ -1483,11 +1602,12 @@
> return 0;
> }
>
> -static int __init f71882fg_find(int sioaddr, unsigned short *address)
> +static int __init f71882fg_find(int sioaddr, unsigned short *address,
> + struct f71882fg_sio_data *sio_data)
> {
> int err = -ENODEV;
> u16 devid;
> - u8 start_reg;
> + u8 reg;
> struct f71882fg_data data;
>
> superio_enter(sioaddr);
> @@ -1499,7 +1619,14 @@
> }
>
> devid = force_id ? force_id : superio_inw(sioaddr, SIO_REG_DEVID);
> - if (devid != SIO_F71882_ID) {
> + switch (devid) {
> + case SIO_F71862_ID:
> + sio_data->type = f71862fg;
> + break;
> + case SIO_F71882_ID:
> + sio_data->type = f71882fg;
> + break;
> + default:
> printk(KERN_INFO DRVNAME ": Unsupported Fintek device\n");
> goto exit;
> }
> @@ -1519,23 +1646,35 @@
> *address &= ~(REGION_LENGTH - 1); /* Ignore 3 LSB */
>
> data.addr = *address;
> - start_reg = f71882fg_read8(&data, F71882FG_REG_START);
> - if (!(start_reg & 0x03)) {
> + reg = f71882fg_read8(&data, F71882FG_REG_START);
> + if (!(reg & 0x03)) {
> printk(KERN_WARNING DRVNAME
> ": Hardware monitoring not activated\n");
> goto exit;
> }
>
> + /* If its a 71862 and the fan / pwm part is enabled sanity check
> + the pwm settings */
> + if (sio_data->type == f71862fg && (reg & 0x02)) {
> + reg = f71882fg_read8(&data, F71882FG_REG_PWM_ENABLE);
> + if ((reg & 0x15) != 0x15) {
> + printk(KERN_ERR DRVNAME
> + ": Invalid (reserved) pwm settings: 0x%02x\n",
> + (unsigned int)reg);
> + goto exit;
> + }
> + }
> err = 0;
> - printk(KERN_INFO DRVNAME ": Found F71882FG chip at %#x, revision %d\n",
> - (unsigned int)*address,
> + printk(KERN_INFO DRVNAME ": Found %s chip at %#x, revision %d\n",
> + f71882fg_names[sio_data->type], (unsigned int)*address,
> (int)superio_inb(sioaddr, SIO_REG_DEVREV));
> exit:
> superio_exit(sioaddr);
> return err;
> }
>
> -static int __init f71882fg_device_add(unsigned short address)
> +static int __init f71882fg_device_add(unsigned short address,
> + const struct f71882fg_sio_data *sio_data)
> {
> struct resource res = {
> .start = address,
> @@ -1555,6 +1694,13 @@
> goto exit_device_put;
> }
>
> + err = platform_device_add_data(f71882fg_pdev, sio_data,
> + sizeof(struct f71882fg_sio_data));
> + if (err) {
> + printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
> + goto exit_device_put;
> + }
> +
> err = platform_device_add(f71882fg_pdev);
> if (err) {
> printk(KERN_ERR DRVNAME ": Device addition failed\n");
> @@ -1573,14 +1719,18 @@
> {
> int err = -ENODEV;
> unsigned short address;
> + struct f71882fg_sio_data sio_data;
>
> - if (f71882fg_find(0x2e, &address) && f71882fg_find(0x4e, &address))
> + if (f71882fg_find(0x2e, &address, &sio_data) &&
> + f71882fg_find(0x4e, &address, &sio_data))
> goto exit;
>
> - if ((err = platform_driver_register(&f71882fg_driver)))
> + err = platform_driver_register(&f71882fg_driver);
> + if (err)
> goto exit;
>
> - if ((err = f71882fg_device_add(address)))
> + err = f71882fg_device_add(address, &sio_data);
> + if (err)
> goto exit_driver;
>
> return 0;
> @@ -1598,7 +1748,7 @@
> }
>
> MODULE_DESCRIPTION("F71882FG Hardware Monitoring Driver");
> -MODULE_AUTHOR("Hans Edgington (hans at edgington.nl)");
> +MODULE_AUTHOR("Hans de Goede (hdegoede at redhat.com)");
> MODULE_LICENSE("GPL");
>
> module_init(f71882fg_init);
