URL https://opencores.org/ocsvn/test_project/test_project/trunk

Subversion Repositories test_project

[/] [test_project/] [trunk/] [linux_sd_driver/] [drivers/] [hwmon/] [adm1029.c] - Blame information for rev 62

Details | Compare with Previous | View Log


/*
 * adm1029.c - Part of lm_sensors, Linux kernel modules for hardware monitoring
 *
 * Copyright (C) 2006 Corentin LABBE <corentin.labbe@geomatys.fr>
 *
 * Based on LM83 Driver by Jean Delvare <khali@linux-fr.org>
 *
 * Give only processor, motherboard temperatures and fan tachs
 * Very rare chip please let me know if you use it
 *
 * http://www.analog.com/UploadedFiles/Data_Sheets/ADM1029.pdf
 *
 *
 * 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 version 2 of the License
 *
 * 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.
 */
 
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/jiffies.h>
#include <linux/i2c.h>
#include <linux/hwmon-sysfs.h>
#include <linux/hwmon.h>
#include <linux/err.h>
#include <linux/mutex.h>
 
/*
 * Addresses to scan
 */
 
static unsigned short normal_i2c[] = {
        0x28, 0x29, 0x2a,
        0x2b, 0x2c, 0x2d,
        0x2e, 0x2f, I2C_CLIENT_END
};
 
/*
 * Insmod parameters
 */
 
I2C_CLIENT_INSMOD_1(adm1029);
 
/*
 * The ADM1029 registers
 * Manufacturer ID is 0x41 for Analog Devices
 */
 
#define ADM1029_REG_MAN_ID                      0x0D
#define ADM1029_REG_CHIP_ID                     0x0E
#define ADM1029_REG_CONFIG                      0x01
#define ADM1029_REG_NB_FAN_SUPPORT              0x02
 
#define ADM1029_REG_TEMP_DEVICES_INSTALLED      0x06
 
#define ADM1029_REG_LOCAL_TEMP                  0xA0
#define ADM1029_REG_REMOTE1_TEMP                0xA1
#define ADM1029_REG_REMOTE2_TEMP                0xA2
 
#define ADM1029_REG_LOCAL_TEMP_HIGH             0x90
#define ADM1029_REG_REMOTE1_TEMP_HIGH           0x91
#define ADM1029_REG_REMOTE2_TEMP_HIGH           0x92
 
#define ADM1029_REG_LOCAL_TEMP_LOW              0x98
#define ADM1029_REG_REMOTE1_TEMP_LOW            0x99
#define ADM1029_REG_REMOTE2_TEMP_LOW            0x9A
 
#define ADM1029_REG_FAN1                        0x70
#define ADM1029_REG_FAN2                        0x71
 
#define ADM1029_REG_FAN1_MIN                    0x78
#define ADM1029_REG_FAN2_MIN                    0x79
 
#define ADM1029_REG_FAN1_CONFIG                 0x68
#define ADM1029_REG_FAN2_CONFIG                 0x69
 
#define TEMP_FROM_REG(val)      ((val) * 1000)
 
#define DIV_FROM_REG(val)       ( 1 << (((val) >> 6) - 1))
 
/* Registers to be checked by adm1029_update_device() */
static const u8 ADM1029_REG_TEMP[] = {
        ADM1029_REG_LOCAL_TEMP,
        ADM1029_REG_REMOTE1_TEMP,
        ADM1029_REG_REMOTE2_TEMP,
        ADM1029_REG_LOCAL_TEMP_HIGH,
        ADM1029_REG_REMOTE1_TEMP_HIGH,
        ADM1029_REG_REMOTE2_TEMP_HIGH,
        ADM1029_REG_LOCAL_TEMP_LOW,
        ADM1029_REG_REMOTE1_TEMP_LOW,
        ADM1029_REG_REMOTE2_TEMP_LOW,
};
 
static const u8 ADM1029_REG_FAN[] = {
        ADM1029_REG_FAN1,
        ADM1029_REG_FAN2,
        ADM1029_REG_FAN1_MIN,
        ADM1029_REG_FAN2_MIN,
};
 
static const u8 ADM1029_REG_FAN_DIV[] = {
        ADM1029_REG_FAN1_CONFIG,
        ADM1029_REG_FAN2_CONFIG,
};
 
/*
 * Functions declaration
 */
 
static int adm1029_attach_adapter(struct i2c_adapter *adapter);
static int adm1029_detect(struct i2c_adapter *adapter, int address, int kind);
static int adm1029_detach_client(struct i2c_client *client);
static struct adm1029_data *adm1029_update_device(struct device *dev);
static int adm1029_init_client(struct i2c_client *client);
 
/*
 * Driver data (common to all clients)
 */
 
static struct i2c_driver adm1029_driver = {
        .driver = {
                .name = "adm1029",
        },
        .attach_adapter = adm1029_attach_adapter,
        .detach_client = adm1029_detach_client,
};
 
/*
 * Client data (each client gets its own)
 */
 
struct adm1029_data {
        struct i2c_client client;
        struct device *hwmon_dev;
        struct mutex update_lock;
        char valid;             /* zero until following fields are valid */
        unsigned long last_updated;     /* in jiffies */
 
        /* registers values, signed for temperature, unsigned for other stuff */
        s8 temp[ARRAY_SIZE(ADM1029_REG_TEMP)];
        u8 fan[ARRAY_SIZE(ADM1029_REG_FAN)];
        u8 fan_div[ARRAY_SIZE(ADM1029_REG_FAN_DIV)];
};
 
/*
 * Sysfs stuff
 */
 
static ssize_t
show_temp(struct device *dev, struct device_attribute *devattr, char *buf)
{
        struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
        struct adm1029_data *data = adm1029_update_device(dev);
        return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[attr->index]));
}
 
static ssize_t
show_fan(struct device *dev, struct device_attribute *devattr, char *buf)
{
        struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
        struct adm1029_data *data = adm1029_update_device(dev);
        u16 val;
        if (data->fan[attr->index] == 0 || data->fan_div[attr->index] == 0
            || data->fan[attr->index] == 255) {
                return sprintf(buf, "0\n");
        }
 
        val = 1880 * 120 / DIV_FROM_REG(data->fan_div[attr->index])
            / data->fan[attr->index];
        return sprintf(buf, "%d\n", val);
}
 
static ssize_t
show_fan_div(struct device *dev, struct device_attribute *devattr, char *buf)
{
        struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
        struct adm1029_data *data = adm1029_update_device(dev);
        if (data->fan_div[attr->index] == 0)
                return sprintf(buf, "0\n");
        return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[attr->index]));
}
 
static ssize_t set_fan_div(struct device *dev,
            struct device_attribute *devattr, const char *buf, size_t count)
{
        struct i2c_client *client = to_i2c_client(dev);
        struct adm1029_data *data = i2c_get_clientdata(client);
        struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
        long val = simple_strtol(buf, NULL, 10);
        u8 reg;
 
        mutex_lock(&data->update_lock);
 
        /*Read actual config */
        reg = i2c_smbus_read_byte_data(client,
                                       ADM1029_REG_FAN_DIV[attr->index]);
 
        switch (val) {
        case 1:
                val = 1;
                break;
        case 2:
                val = 2;
                break;
        case 4:
                val = 3;
                break;
        default:
                mutex_unlock(&data->update_lock);
                dev_err(&client->dev, "fan_div value %ld not "
                        "supported. Choose one of 1, 2 or 4!\n", val);
                return -EINVAL;
        }
        /* Update the value */
        reg = (reg & 0x3F) | (val << 6);
 
        /* Write value */
        i2c_smbus_write_byte_data(client,
                                  ADM1029_REG_FAN_DIV[attr->index], reg);
        mutex_unlock(&data->update_lock);
 
        return count;
}
 
/*
Access rights on sysfs, S_IRUGO stand for Is Readable by User, Group and Others
                        S_IWUSR stand for Is Writable by User
*/
static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);
static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1);
static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2);
 
static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO, show_temp, NULL, 3);
static SENSOR_DEVICE_ATTR(temp2_max, S_IRUGO, show_temp, NULL, 4);
static SENSOR_DEVICE_ATTR(temp3_max, S_IRUGO, show_temp, NULL, 5);
 
static SENSOR_DEVICE_ATTR(temp1_min, S_IRUGO, show_temp, NULL, 6);
static SENSOR_DEVICE_ATTR(temp2_min, S_IRUGO, show_temp, NULL, 7);
static SENSOR_DEVICE_ATTR(temp3_min, S_IRUGO, show_temp, NULL, 8);
 
static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
 
static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO, show_fan, NULL, 2);
static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO, show_fan, NULL, 3);
 
static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
                          show_fan_div, set_fan_div, 0);
static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
                          show_fan_div, set_fan_div, 1);
 
static struct attribute *adm1029_attributes[] = {
        &sensor_dev_attr_temp1_input.dev_attr.attr,
        &sensor_dev_attr_temp1_min.dev_attr.attr,
        &sensor_dev_attr_temp1_max.dev_attr.attr,
        &sensor_dev_attr_temp2_input.dev_attr.attr,
        &sensor_dev_attr_temp2_min.dev_attr.attr,
        &sensor_dev_attr_temp2_max.dev_attr.attr,
        &sensor_dev_attr_temp3_input.dev_attr.attr,
        &sensor_dev_attr_temp3_min.dev_attr.attr,
        &sensor_dev_attr_temp3_max.dev_attr.attr,
        &sensor_dev_attr_fan1_input.dev_attr.attr,
        &sensor_dev_attr_fan2_input.dev_attr.attr,
        &sensor_dev_attr_fan1_min.dev_attr.attr,
        &sensor_dev_attr_fan2_min.dev_attr.attr,
        &sensor_dev_attr_fan1_div.dev_attr.attr,
        &sensor_dev_attr_fan2_div.dev_attr.attr,
        NULL
};
 
static const struct attribute_group adm1029_group = {
        .attrs = adm1029_attributes,
};
 
/*
 * Real code
 */
 
static int adm1029_attach_adapter(struct i2c_adapter *adapter)
{
        if (!(adapter->class & I2C_CLASS_HWMON))
                return 0;
        return i2c_probe(adapter, &addr_data, adm1029_detect);
}
 
/*
 * The following function does more than just detection. If detection
 * succeeds, it also registers the new chip.
 */
 
static int adm1029_detect(struct i2c_adapter *adapter, int address, int kind)
{
        struct i2c_client *client;
        struct adm1029_data *data;
        int err = 0;
        const char *name = "";
        if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
                goto exit;
 
        if (!(data = kzalloc(sizeof(struct adm1029_data), GFP_KERNEL))) {
                err = -ENOMEM;
                goto exit;
        }
 
        client = &data->client;
        i2c_set_clientdata(client, data);
        client->addr = address;
        client->adapter = adapter;
        client->driver = &adm1029_driver;
 
        /* Now we do the detection and identification. A negative kind
         * means that the driver was loaded with no force parameter
         * (default), so we must both detect and identify the chip
         * (actually there is only one possible kind of chip for now, adm1029).
         * A zero kind means that the driver was loaded with the force
         * parameter, the detection step shall be skipped. A positive kind
         * means that the driver was loaded with the force parameter and a
         * given kind of chip is requested, so both the detection and the
         * identification steps are skipped. */
 
        /* Default to an adm1029 if forced */
        if (kind == 0)
                kind = adm1029;
 
        /* ADM1029 doesn't have CHIP ID, check just MAN ID
         * For better detection we check also ADM1029_TEMP_DEVICES_INSTALLED,
         * ADM1029_REG_NB_FAN_SUPPORT and compare it with possible values
         * documented
         */
 
        if (kind <= 0) { /* identification */
                u8 man_id, chip_id, temp_devices_installed, nb_fan_support;
 
                man_id = i2c_smbus_read_byte_data(client, ADM1029_REG_MAN_ID);
                chip_id = i2c_smbus_read_byte_data(client, ADM1029_REG_CHIP_ID);
                temp_devices_installed = i2c_smbus_read_byte_data(client,
                                        ADM1029_REG_TEMP_DEVICES_INSTALLED);
                nb_fan_support = i2c_smbus_read_byte_data(client,
                                                ADM1029_REG_NB_FAN_SUPPORT);
                /* 0x41 is Analog Devices */
                if (man_id == 0x41 && (temp_devices_installed & 0xf9) == 0x01
                    && nb_fan_support == 0x03) {
                        if ((chip_id & 0xF0) == 0x00) {
                                kind = adm1029;
                        } else {
                                /* There are no "official" CHIP ID, so actually
                                 * we use Major/Minor revision for that */
                                printk(KERN_INFO
                                       "adm1029: Unknown major revision %x, "
                                       "please let us know\n", chip_id);
                        }
                }
 
                if (kind <= 0) { /* identification failed */
                        pr_debug("adm1029: Unsupported chip (man_id=0x%02X, "
                                 "chip_id=0x%02X)\n", man_id, chip_id);
                        goto exit_free;
                }
        }
 
        if (kind == adm1029) {
                name = "adm1029";
        }
 
        /* We can fill in the remaining client fields */
        strlcpy(client->name, name, I2C_NAME_SIZE);
        mutex_init(&data->update_lock);
 
        /* Tell the I2C layer a new client has arrived */
        if ((err = i2c_attach_client(client)))
                goto exit_free;
 
        /*
         * Initialize the ADM1029 chip
         * Check config register
         */
        if (adm1029_init_client(client) == 0)
                goto exit_detach;
 
        /* Register sysfs hooks */
        if ((err = sysfs_create_group(&client->dev.kobj, &adm1029_group)))
                goto exit_detach;
 
        data->hwmon_dev = hwmon_device_register(&client->dev);
        if (IS_ERR(data->hwmon_dev)) {
                err = PTR_ERR(data->hwmon_dev);
                goto exit_remove_files;
        }
 
        return 0;
 
 exit_remove_files:
        sysfs_remove_group(&client->dev.kobj, &adm1029_group);
 exit_detach:
        i2c_detach_client(client);
 exit_free:
        kfree(data);
 exit:
        return err;
}
 
static int adm1029_init_client(struct i2c_client *client)
{
        u8 config;
        config = i2c_smbus_read_byte_data(client, ADM1029_REG_CONFIG);
        if ((config & 0x10) == 0) {
                i2c_smbus_write_byte_data(client, ADM1029_REG_CONFIG,
                                          config | 0x10);
        }
        /* recheck config */
        config = i2c_smbus_read_byte_data(client, ADM1029_REG_CONFIG);
        if ((config & 0x10) == 0) {
                dev_err(&client->dev, "Initialization failed!\n");
                return 0;
        }
        return 1;
}
 
static int adm1029_detach_client(struct i2c_client *client)
{
        struct adm1029_data *data = i2c_get_clientdata(client);
        int err;
 
        hwmon_device_unregister(data->hwmon_dev);
        sysfs_remove_group(&client->dev.kobj, &adm1029_group);
 
        if ((err = i2c_detach_client(client)))
                return err;
 
        kfree(data);
        return 0;
}
 
/*
function that update the status of the chips (temperature for exemple)
*/
static struct adm1029_data *adm1029_update_device(struct device *dev)
{
        struct i2c_client *client = to_i2c_client(dev);
        struct adm1029_data *data = i2c_get_clientdata(client);
 
        mutex_lock(&data->update_lock);
        /*
         * Use the "cache" Luke, don't recheck values
         * if there are already checked not a long time later
         */
        if (time_after(jiffies, data->last_updated + HZ * 2)
         || !data->valid) {
                int nr;
 
                dev_dbg(&client->dev, "Updating adm1029 data\n");
 
                for (nr = 0; nr < ARRAY_SIZE(ADM1029_REG_TEMP); nr++) {
                        data->temp[nr] =
                            i2c_smbus_read_byte_data(client,
                                                     ADM1029_REG_TEMP[nr]);
                }
                for (nr = 0; nr < ARRAY_SIZE(ADM1029_REG_FAN); nr++) {
                        data->fan[nr] =
                            i2c_smbus_read_byte_data(client,
                                                     ADM1029_REG_FAN[nr]);
                }
                for (nr = 0; nr < ARRAY_SIZE(ADM1029_REG_FAN_DIV); nr++) {
                        data->fan_div[nr] =
                            i2c_smbus_read_byte_data(client,
                                                     ADM1029_REG_FAN_DIV[nr]);
                }
 
                data->last_updated = jiffies;
                data->valid = 1;
        }
 
        mutex_unlock(&data->update_lock);
 
        return data;
}
 
/*
        Common module stuff
*/
static int __init sensors_adm1029_init(void)
{
 
        return i2c_add_driver(&adm1029_driver);
}
 
static void __exit sensors_adm1029_exit(void)
{
 
        i2c_del_driver(&adm1029_driver);
}
 
MODULE_AUTHOR("Corentin LABBE <corentin.labbe@geomatys.fr>");
MODULE_DESCRIPTION("adm1029 driver");
MODULE_LICENSE("GPL v2");
 
module_init(sensors_adm1029_init);
module_exit(sensors_adm1029_exit);

Browse

Tools

Subversion Repositories test_project

[/] [test_project/] [trunk/] [linux_sd_driver/] [drivers/] [hwmon/] [adm1029.c] - Blame information for rev 62

Line No.	Rev	Author	Line
1	62	marcus.erl	`/*`
2			`* adm1029.c - Part of lm_sensors, Linux kernel modules for hardware monitoring`
3			`*`
4			`* Copyright (C) 2006 Corentin LABBE <corentin.labbe@geomatys.fr>`
5			`*`
6			`* Based on LM83 Driver by Jean Delvare <khali@linux-fr.org>`
7			`*`
8			`* Give only processor, motherboard temperatures and fan tachs`
9			`* Very rare chip please let me know if you use it`
10			`*`
11			`* http://www.analog.com/UploadedFiles/Data_Sheets/ADM1029.pdf`
12			`*`
13			`*`
14			`* This program is free software; you can redistribute it and/or modify`
15			`* it under the terms of the GNU General Public License as published by`
16			`* the Free Software Foundation version 2 of the License`
17			`*`
18			`* This program is distributed in the hope that it will be useful,`
19			`* but WITHOUT ANY WARRANTY; without even the implied warranty of`
20			`* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the`
21			`* GNU General Public License for more details.`
22			`*`
23			`* You should have received a copy of the GNU General Public License`
24			`* along with this program; if not, write to the Free Software`
25			`* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.`
26			`*/`
27
28			`#include <linux/module.h>`
29			`#include <linux/init.h>`
30			`#include <linux/slab.h>`
31			`#include <linux/jiffies.h>`
32			`#include <linux/i2c.h>`
33			`#include <linux/hwmon-sysfs.h>`
34			`#include <linux/hwmon.h>`
35			`#include <linux/err.h>`
36			`#include <linux/mutex.h>`
37
38			`/*`
39			`* Addresses to scan`
40			`*/`
41
42			`static unsigned short normal_i2c[] = {`
43			`0x28, 0x29, 0x2a,`
44			`0x2b, 0x2c, 0x2d,`
45			`0x2e, 0x2f, I2C_CLIENT_END`
46			`};`
47
48			`/*`
49			`* Insmod parameters`
50			`*/`
51
52			`I2C_CLIENT_INSMOD_1(adm1029);`
53
54			`/*`
55			`* The ADM1029 registers`
56			`* Manufacturer ID is 0x41 for Analog Devices`
57			`*/`
58
59			`#define ADM1029_REG_MAN_ID 0x0D`
60			`#define ADM1029_REG_CHIP_ID 0x0E`
61			`#define ADM1029_REG_CONFIG 0x01`
62			`#define ADM1029_REG_NB_FAN_SUPPORT 0x02`
63
64			`#define ADM1029_REG_TEMP_DEVICES_INSTALLED 0x06`
65
66			`#define ADM1029_REG_LOCAL_TEMP 0xA0`
67			`#define ADM1029_REG_REMOTE1_TEMP 0xA1`
68			`#define ADM1029_REG_REMOTE2_TEMP 0xA2`
69
70			`#define ADM1029_REG_LOCAL_TEMP_HIGH 0x90`
71			`#define ADM1029_REG_REMOTE1_TEMP_HIGH 0x91`
72			`#define ADM1029_REG_REMOTE2_TEMP_HIGH 0x92`
73
74			`#define ADM1029_REG_LOCAL_TEMP_LOW 0x98`
75			`#define ADM1029_REG_REMOTE1_TEMP_LOW 0x99`
76			`#define ADM1029_REG_REMOTE2_TEMP_LOW 0x9A`
77
78			`#define ADM1029_REG_FAN1 0x70`
79			`#define ADM1029_REG_FAN2 0x71`
80
81			`#define ADM1029_REG_FAN1_MIN 0x78`
82			`#define ADM1029_REG_FAN2_MIN 0x79`
83
84			`#define ADM1029_REG_FAN1_CONFIG 0x68`
85			`#define ADM1029_REG_FAN2_CONFIG 0x69`
86
87			`#define TEMP_FROM_REG(val) ((val) * 1000)`
88
89			`#define DIV_FROM_REG(val) ( 1 << (((val) >> 6) - 1))`
90
91			`/* Registers to be checked by adm1029_update_device() */`
92			`static const u8 ADM1029_REG_TEMP[] = {`
93			`ADM1029_REG_LOCAL_TEMP,`
94			`ADM1029_REG_REMOTE1_TEMP,`
95			`ADM1029_REG_REMOTE2_TEMP,`
96			`ADM1029_REG_LOCAL_TEMP_HIGH,`
97			`ADM1029_REG_REMOTE1_TEMP_HIGH,`
98			`ADM1029_REG_REMOTE2_TEMP_HIGH,`
99			`ADM1029_REG_LOCAL_TEMP_LOW,`
100			`ADM1029_REG_REMOTE1_TEMP_LOW,`
101			`ADM1029_REG_REMOTE2_TEMP_LOW,`
102			`};`
103
104			`static const u8 ADM1029_REG_FAN[] = {`
105			`ADM1029_REG_FAN1,`
106			`ADM1029_REG_FAN2,`
107			`ADM1029_REG_FAN1_MIN,`
108			`ADM1029_REG_FAN2_MIN,`
109			`};`
110
111			`static const u8 ADM1029_REG_FAN_DIV[] = {`
112			`ADM1029_REG_FAN1_CONFIG,`
113			`ADM1029_REG_FAN2_CONFIG,`
114			`};`
115
116			`/*`
117			`* Functions declaration`
118			`*/`
119
120			`static int adm1029_attach_adapter(struct i2c_adapter *adapter);`
121			`static int adm1029_detect(struct i2c_adapter *adapter, int address, int kind);`
122			`static int adm1029_detach_client(struct i2c_client *client);`
123			`static struct adm1029_data adm1029_update_device(struct device dev);`
124			`static int adm1029_init_client(struct i2c_client *client);`
125
126			`/*`
127			`* Driver data (common to all clients)`
128			`*/`
129
130			`static struct i2c_driver adm1029_driver = {`
131			`.driver = {`
132			`.name = "adm1029",`
133			`},`
134			`.attach_adapter = adm1029_attach_adapter,`
135			`.detach_client = adm1029_detach_client,`
136			`};`
137
138			`/*`
139			`* Client data (each client gets its own)`
140			`*/`
141
142			`struct adm1029_data {`
143			`struct i2c_client client;`
144			`struct device *hwmon_dev;`
145			`struct mutex update_lock;`
146			`char valid; /* zero until following fields are valid */`
147			`unsigned long last_updated; /* in jiffies */`
148
149			`/* registers values, signed for temperature, unsigned for other stuff */`
150			`s8 temp[ARRAY_SIZE(ADM1029_REG_TEMP)];`
151			`u8 fan[ARRAY_SIZE(ADM1029_REG_FAN)];`
152			`u8 fan_div[ARRAY_SIZE(ADM1029_REG_FAN_DIV)];`
153			`};`
154
155			`/*`
156			`* Sysfs stuff`
157			`*/`
158
159			`static ssize_t`
160			`show_temp(struct device dev, struct device_attribute devattr, char *buf)`
161			`{`
162			`struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);`
163			`struct adm1029_data *data = adm1029_update_device(dev);`
164			`return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp[attr->index]));`
165			`}`
166
167			`static ssize_t`
168			`show_fan(struct device dev, struct device_attribute devattr, char *buf)`
169			`{`
170			`struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);`
171			`struct adm1029_data *data = adm1029_update_device(dev);`
172			`u16 val;`
173			`if (data->fan[attr->index] == 0 \|\| data->fan_div[attr->index] == 0`
174			`\|\| data->fan[attr->index] == 255) {`
175			`return sprintf(buf, "0\n");`
176			`}`
177
178			`val = 1880 * 120 / DIV_FROM_REG(data->fan_div[attr->index])`
179			`/ data->fan[attr->index];`
180			`return sprintf(buf, "%d\n", val);`
181			`}`
182
183			`static ssize_t`
184			`show_fan_div(struct device dev, struct device_attribute devattr, char *buf)`
185			`{`
186			`struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);`
187			`struct adm1029_data *data = adm1029_update_device(dev);`
188			`if (data->fan_div[attr->index] == 0)`
189			`return sprintf(buf, "0\n");`
190			`return sprintf(buf, "%d\n", DIV_FROM_REG(data->fan_div[attr->index]));`
191			`}`
192
193			`static ssize_t set_fan_div(struct device *dev,`
194			`struct device_attribute devattr, const char buf, size_t count)`
195			`{`
196			`struct i2c_client *client = to_i2c_client(dev);`
197			`struct adm1029_data *data = i2c_get_clientdata(client);`
198			`struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);`
199			`long val = simple_strtol(buf, NULL, 10);`
200			`u8 reg;`
201
202			`mutex_lock(&data->update_lock);`
203
204			`/Read actual config /`
205			`reg = i2c_smbus_read_byte_data(client,`
206			`ADM1029_REG_FAN_DIV[attr->index]);`
207
208			`switch (val) {`
209			`case 1:`
210			`val = 1;`
211			`break;`
212			`case 2:`
213			`val = 2;`
214			`break;`
215			`case 4:`
216			`val = 3;`
217			`break;`
218			`default:`
219			`mutex_unlock(&data->update_lock);`
220			`dev_err(&client->dev, "fan_div value %ld not "`
221			`"supported. Choose one of 1, 2 or 4!\n", val);`
222			`return -EINVAL;`
223			`}`
224			`/* Update the value */`
225			`reg = (reg & 0x3F) \| (val << 6);`
226
227			`/* Write value */`
228			`i2c_smbus_write_byte_data(client,`
229			`ADM1029_REG_FAN_DIV[attr->index], reg);`
230			`mutex_unlock(&data->update_lock);`
231
232			`return count;`
233			`}`
234
235			`/*`
236			`Access rights on sysfs, S_IRUGO stand for Is Readable by User, Group and Others`
237			`S_IWUSR stand for Is Writable by User`
238			`*/`
239			`static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);`
240			`static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1);`
241			`static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2);`
242
243			`static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO, show_temp, NULL, 3);`
244			`static SENSOR_DEVICE_ATTR(temp2_max, S_IRUGO, show_temp, NULL, 4);`
245			`static SENSOR_DEVICE_ATTR(temp3_max, S_IRUGO, show_temp, NULL, 5);`
246
247			`static SENSOR_DEVICE_ATTR(temp1_min, S_IRUGO, show_temp, NULL, 6);`
248			`static SENSOR_DEVICE_ATTR(temp2_min, S_IRUGO, show_temp, NULL, 7);`
249			`static SENSOR_DEVICE_ATTR(temp3_min, S_IRUGO, show_temp, NULL, 8);`
250
251			`static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);`
252			`static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);`
253
254			`static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO, show_fan, NULL, 2);`
255			`static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO, show_fan, NULL, 3);`
256
257			`static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO \| S_IWUSR,`
258			`show_fan_div, set_fan_div, 0);`
259			`static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO \| S_IWUSR,`
260			`show_fan_div, set_fan_div, 1);`
261
262			`static struct attribute *adm1029_attributes[] = {`
263			`&sensor_dev_attr_temp1_input.dev_attr.attr,`
264			`&sensor_dev_attr_temp1_min.dev_attr.attr,`
265			`&sensor_dev_attr_temp1_max.dev_attr.attr,`
266			`&sensor_dev_attr_temp2_input.dev_attr.attr,`
267			`&sensor_dev_attr_temp2_min.dev_attr.attr,`
268			`&sensor_dev_attr_temp2_max.dev_attr.attr,`
269			`&sensor_dev_attr_temp3_input.dev_attr.attr,`
270			`&sensor_dev_attr_temp3_min.dev_attr.attr,`
271			`&sensor_dev_attr_temp3_max.dev_attr.attr,`
272			`&sensor_dev_attr_fan1_input.dev_attr.attr,`
273			`&sensor_dev_attr_fan2_input.dev_attr.attr,`
274			`&sensor_dev_attr_fan1_min.dev_attr.attr,`
275			`&sensor_dev_attr_fan2_min.dev_attr.attr,`
276			`&sensor_dev_attr_fan1_div.dev_attr.attr,`
277			`&sensor_dev_attr_fan2_div.dev_attr.attr,`
278			`NULL`
279			`};`
280
281			`static const struct attribute_group adm1029_group = {`
282			`.attrs = adm1029_attributes,`
283			`};`
284
285			`/*`
286			`* Real code`
287			`*/`
288
289			`static int adm1029_attach_adapter(struct i2c_adapter *adapter)`
290			`{`
291			`if (!(adapter->class & I2C_CLASS_HWMON))`
292			`return 0;`
293			`return i2c_probe(adapter, &addr_data, adm1029_detect);`
294			`}`
295
296			`/*`
297			`* The following function does more than just detection. If detection`
298			`* succeeds, it also registers the new chip.`
299			`*/`
300
301			`static int adm1029_detect(struct i2c_adapter *adapter, int address, int kind)`
302			`{`
303			`struct i2c_client *client;`
304			`struct adm1029_data *data;`
305			`int err = 0;`
306			`const char *name = "";`
307			`if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))`
308			`goto exit;`
309
310			`if (!(data = kzalloc(sizeof(struct adm1029_data), GFP_KERNEL))) {`
311			`err = -ENOMEM;`
312			`goto exit;`
313			`}`
314
315			`client = &data->client;`
316			`i2c_set_clientdata(client, data);`
317			`client->addr = address;`
318			`client->adapter = adapter;`
319			`client->driver = &adm1029_driver;`
320
321			`/* Now we do the detection and identification. A negative kind`
322			`* means that the driver was loaded with no force parameter`
323			`* (default), so we must both detect and identify the chip`
324			`* (actually there is only one possible kind of chip for now, adm1029).`
325			`* A zero kind means that the driver was loaded with the force`
326			`* parameter, the detection step shall be skipped. A positive kind`
327			`* means that the driver was loaded with the force parameter and a`
328			`* given kind of chip is requested, so both the detection and the`
329			`* identification steps are skipped. */`
330
331			`/* Default to an adm1029 if forced */`
332			`if (kind == 0)`
333			`kind = adm1029;`
334
335			`/* ADM1029 doesn't have CHIP ID, check just MAN ID`
336			`* For better detection we check also ADM1029_TEMP_DEVICES_INSTALLED,`
337			`* ADM1029_REG_NB_FAN_SUPPORT and compare it with possible values`
338			`* documented`
339			`*/`
340
341			`if (kind <= 0) { /* identification */`
342			`u8 man_id, chip_id, temp_devices_installed, nb_fan_support;`
343
344			`man_id = i2c_smbus_read_byte_data(client, ADM1029_REG_MAN_ID);`
345			`chip_id = i2c_smbus_read_byte_data(client, ADM1029_REG_CHIP_ID);`
346			`temp_devices_installed = i2c_smbus_read_byte_data(client,`
347			`ADM1029_REG_TEMP_DEVICES_INSTALLED);`
348			`nb_fan_support = i2c_smbus_read_byte_data(client,`
349			`ADM1029_REG_NB_FAN_SUPPORT);`
350			`/* 0x41 is Analog Devices */`
351			`if (man_id == 0x41 && (temp_devices_installed & 0xf9) == 0x01`
352			`&& nb_fan_support == 0x03) {`
353			`if ((chip_id & 0xF0) == 0x00) {`
354			`kind = adm1029;`
355			`} else {`
356			`/* There are no "official" CHIP ID, so actually`
357			`* we use Major/Minor revision for that */`
358			`printk(KERN_INFO`
359			`"adm1029: Unknown major revision %x, "`
360			`"please let us know\n", chip_id);`
361			`}`
362			`}`
363
364			`if (kind <= 0) { /* identification failed */`
365			`pr_debug("adm1029: Unsupported chip (man_id=0x%02X, "`
366			`"chip_id=0x%02X)\n", man_id, chip_id);`
367			`goto exit_free;`
368			`}`
369			`}`
370
371			`if (kind == adm1029) {`
372			`name = "adm1029";`
373			`}`
374
375			`/* We can fill in the remaining client fields */`
376			`strlcpy(client->name, name, I2C_NAME_SIZE);`
377			`mutex_init(&data->update_lock);`
378
379			`/* Tell the I2C layer a new client has arrived */`
380			`if ((err = i2c_attach_client(client)))`
381			`goto exit_free;`
382
383			`/*`
384			`* Initialize the ADM1029 chip`
385			`* Check config register`
386			`*/`
387			`if (adm1029_init_client(client) == 0)`
388			`goto exit_detach;`
389
390			`/* Register sysfs hooks */`
391			`if ((err = sysfs_create_group(&client->dev.kobj, &adm1029_group)))`
392			`goto exit_detach;`
393
394			`data->hwmon_dev = hwmon_device_register(&client->dev);`
395			`if (IS_ERR(data->hwmon_dev)) {`
396			`err = PTR_ERR(data->hwmon_dev);`
397			`goto exit_remove_files;`
398			`}`
399
400			`return 0;`
401
402			`exit_remove_files:`
403			`sysfs_remove_group(&client->dev.kobj, &adm1029_group);`
404			`exit_detach:`
405			`i2c_detach_client(client);`
406			`exit_free:`
407			`kfree(data);`
408			`exit:`
409			`return err;`
410			`}`
411
412			`static int adm1029_init_client(struct i2c_client *client)`
413			`{`
414			`u8 config;`
415			`config = i2c_smbus_read_byte_data(client, ADM1029_REG_CONFIG);`
416			`if ((config & 0x10) == 0) {`
417			`i2c_smbus_write_byte_data(client, ADM1029_REG_CONFIG,`
418			`config \| 0x10);`
419			`}`
420			`/* recheck config */`
421			`config = i2c_smbus_read_byte_data(client, ADM1029_REG_CONFIG);`
422			`if ((config & 0x10) == 0) {`
423			`dev_err(&client->dev, "Initialization failed!\n");`
424			`return 0;`
425			`}`
426			`return 1;`
427			`}`
428
429			`static int adm1029_detach_client(struct i2c_client *client)`
430			`{`
431			`struct adm1029_data *data = i2c_get_clientdata(client);`
432			`int err;`
433
434			`hwmon_device_unregister(data->hwmon_dev);`
435			`sysfs_remove_group(&client->dev.kobj, &adm1029_group);`
436
437			`if ((err = i2c_detach_client(client)))`
438			`return err;`
439
440			`kfree(data);`
441			`return 0;`
442			`}`
443
444			`/*`
445			`function that update the status of the chips (temperature for exemple)`
446			`*/`
447			`static struct adm1029_data adm1029_update_device(struct device dev)`
448			`{`
449			`struct i2c_client *client = to_i2c_client(dev);`
450			`struct adm1029_data *data = i2c_get_clientdata(client);`
451
452			`mutex_lock(&data->update_lock);`
453			`/*`
454			`* Use the "cache" Luke, don't recheck values`
455			`* if there are already checked not a long time later`
456			`*/`
457			`if (time_after(jiffies, data->last_updated + HZ * 2)`
458			`\|\| !data->valid) {`
459			`int nr;`
460
461			`dev_dbg(&client->dev, "Updating adm1029 data\n");`
462
463			`for (nr = 0; nr < ARRAY_SIZE(ADM1029_REG_TEMP); nr++) {`
464			`data->temp[nr] =`
465			`i2c_smbus_read_byte_data(client,`
466			`ADM1029_REG_TEMP[nr]);`
467			`}`
468			`for (nr = 0; nr < ARRAY_SIZE(ADM1029_REG_FAN); nr++) {`
469			`data->fan[nr] =`
470			`i2c_smbus_read_byte_data(client,`
471			`ADM1029_REG_FAN[nr]);`
472			`}`
473			`for (nr = 0; nr < ARRAY_SIZE(ADM1029_REG_FAN_DIV); nr++) {`
474			`data->fan_div[nr] =`
475			`i2c_smbus_read_byte_data(client,`
476			`ADM1029_REG_FAN_DIV[nr]);`
477			`}`
478
479			`data->last_updated = jiffies;`
480			`data->valid = 1;`
481			`}`
482
483			`mutex_unlock(&data->update_lock);`
484
485			`return data;`
486			`}`
487
488			`/*`
489			`Common module stuff`
490			`*/`
491			`static int __init sensors_adm1029_init(void)`
492			`{`
493
494			`return i2c_add_driver(&adm1029_driver);`
495			`}`
496
497			`static void __exit sensors_adm1029_exit(void)`
498			`{`
499
500			`i2c_del_driver(&adm1029_driver);`
501			`}`
502
503			`MODULE_AUTHOR("Corentin LABBE <corentin.labbe@geomatys.fr>");`
504			`MODULE_DESCRIPTION("adm1029 driver");`
505			`MODULE_LICENSE("GPL v2");`
506
507			`module_init(sensors_adm1029_init);`
508			`module_exit(sensors_adm1029_exit);`