Source of thmc50.c - linux-imx - PHYTEC BitBucket (Stash)

Ignore whitespace
Show whitespace characters
Hide e-diff
Unified diff
Side-by-side diff
Source viewDiff to previous
 
static const u8 THMC50_REG_TEMP_MIN[] = { 0x3A, 0x38, 0x2C };
static const u8 THMC50_REG_TEMP_MAX[] = { 0x39, 0x37, 0x2B };
static const u8 THMC50_REG_TEMP_CRITICAL[] = { 0x13, 0x14, 0x14 };
static const u8 THMC50_REG_TEMP_DEFAULT[] = { 0x17, 0x18, 0x18 };
​
#define THMC50_REG_CONF_nFANOFF         0x20
#define THMC50_REG_CONF_PROGRAMMED      0x08
​
/* Each client has this additional data */
struct thmc50_data {
    struct device *hwmon_dev;
    struct i2c_client *client;
    const struct attribute_group *groups[3];
​
    struct mutex update_lock;
    enum chips type;
    unsigned long last_updated; /* In jiffies */
    char has_temp3;     /* !=0 if it is ADM1022 in temp3 mode */
    char valid;     /* !=0 if following fields are valid */
​
    /* Register values */
    s8 temp_input[3];
    s8 temp_max[3];
    s8 temp_min[3];
    s8 temp_critical[3];
    u8 analog_out;
    u8 alarms;
};
​
static struct thmc50_data *thmc50_update_device(struct device *dev)
{
    struct i2c_client *client = to_i2c_client(dev);
    struct thmc50_data *data = i2c_get_clientdata(client);
    struct thmc50_data *data = dev_get_drvdata(dev);
    struct i2c_client *client = data->client;
    int timeout = HZ / 5 + (data->type == thmc50 ? HZ : 0);
​
    mutex_lock(&data->update_lock);
​
    if (time_after(jiffies, data->last_updated + timeout)
        || !data->valid) {
​
        int temps = data->has_temp3 ? 3 : 2;
        int i;
        int prog = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
Show more
                   struct device_attribute *attr, char *buf)
{
    struct thmc50_data *data = thmc50_update_device(dev);
    return sprintf(buf, "%d\n", data->analog_out);
}
​
static ssize_t set_analog_out(struct device *dev,
                  struct device_attribute *attr,
                  const char *buf, size_t count)
{
    struct i2c_client *client = to_i2c_client(dev);
    struct thmc50_data *data = i2c_get_clientdata(client);
    struct thmc50_data *data = dev_get_drvdata(dev);
    struct i2c_client *client = data->client;
    int config;
    unsigned long tmp;
    int err;
​
    err = kstrtoul(buf, 10, &tmp);
    if (err)
        return err;
​
    mutex_lock(&data->update_lock);
    data->analog_out = clamp_val(tmp, 0, 255);
Show more
{
    int nr = to_sensor_dev_attr(attr)->index;
    struct thmc50_data *data = thmc50_update_device(dev);
    return sprintf(buf, "%d\n", data->temp_min[nr] * 1000);
}
​
static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
                const char *buf, size_t count)
{
    int nr = to_sensor_dev_attr(attr)->index;
    struct i2c_client *client = to_i2c_client(dev);
    struct thmc50_data *data = i2c_get_clientdata(client);
    struct thmc50_data *data = dev_get_drvdata(dev);
    struct i2c_client *client = data->client;
    long val;
    int err;
​
    err = kstrtol(buf, 10, &val);
    if (err)
        return err;
​
    mutex_lock(&data->update_lock);
    data->temp_min[nr] = clamp_val(val / 1000, -128, 127);
    i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MIN[nr],
Show more
{
    int nr = to_sensor_dev_attr(attr)->index;
    struct thmc50_data *data = thmc50_update_device(dev);
    return sprintf(buf, "%d\n", data->temp_max[nr] * 1000);
}
​
static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
                const char *buf, size_t count)
{
    int nr = to_sensor_dev_attr(attr)->index;
    struct i2c_client *client = to_i2c_client(dev);
    struct thmc50_data *data = i2c_get_clientdata(client);
    struct thmc50_data *data = dev_get_drvdata(dev);
    struct i2c_client *client = data->client;
    long val;
    int err;
​
    err = kstrtol(buf, 10, &val);
    if (err)
        return err;
​
    mutex_lock(&data->update_lock);
    data->temp_max[nr] = clamp_val(val / 1000, -128, 127);
    i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MAX[nr],
Show more
    }
​
    pr_debug("thmc50: Detected %s (version %x, revision %x)\n",
         type_name, (revision >> 4) - 0xc, revision & 0xf);
​
    strlcpy(info->type, type_name, I2C_NAME_SIZE);
​
    return 0;
}
​
static void thmc50_init_client(struct i2c_client *client)
static void thmc50_init_client(struct thmc50_data *data)
{
    struct thmc50_data *data = i2c_get_clientdata(client);
    struct i2c_client *client = data->client;
    int config;
​
    data->analog_out = i2c_smbus_read_byte_data(client,
                            THMC50_REG_ANALOG_OUT);
    /* set up to at least 1 */
    if (data->analog_out == 0) {
        data->analog_out = 1;
        i2c_smbus_write_byte_data(client, THMC50_REG_ANALOG_OUT,
                      data->analog_out);
    }
    config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
    config |= 0x1;  /* start the chip if it is in standby mode */
    if (data->type == adm1022 && (config & (1 << 7)))
        data->has_temp3 = 1;
    i2c_smbus_write_byte_data(client, THMC50_REG_CONF, config);
}
​
static int thmc50_probe(struct i2c_client *client,
            const struct i2c_device_id *id)
{
    struct device *dev = &client->dev;
    struct thmc50_data *data;
    int err;
    struct device *hwmon_dev;
    int idx = 0;
​
    data = devm_kzalloc(&client->dev, sizeof(struct thmc50_data),
                GFP_KERNEL);
    data = devm_kzalloc(dev, sizeof(struct thmc50_data), GFP_KERNEL);
    if (!data)
        return -ENOMEM;
​
    i2c_set_clientdata(client, data);
    data->client = client;
    data->type = id->driver_data;
    mutex_init(&data->update_lock);
​
    thmc50_init_client(client);
    thmc50_init_client(data);
​
    /* Register sysfs hooks */
    err = sysfs_create_group(&client->dev.kobj, &thmc50_group);
    if (err)
        return err;
​
    /* Register ADM1022 sysfs hooks */
    if (data->has_temp3) {
        err = sysfs_create_group(&client->dev.kobj, &temp3_group);
        if (err)
            goto exit_remove_sysfs_thmc50;
    }
​
    /* Register a new directory entry with module sensors */
    data->hwmon_dev = hwmon_device_register(&client->dev);
    if (IS_ERR(data->hwmon_dev)) {
        err = PTR_ERR(data->hwmon_dev);
        goto exit_remove_sysfs;
    }
    /* sysfs hooks */
    data->groups[idx++] = &thmc50_group;
​
    return 0;
​
exit_remove_sysfs:
    if (data->has_temp3)
        sysfs_remove_group(&client->dev.kobj, &temp3_group);
exit_remove_sysfs_thmc50:
    sysfs_remove_group(&client->dev.kobj, &thmc50_group);
    return err;
}
​
static int thmc50_remove(struct i2c_client *client)
{
    struct thmc50_data *data = i2c_get_clientdata(client);
​
    hwmon_device_unregister(data->hwmon_dev);
    sysfs_remove_group(&client->dev.kobj, &thmc50_group);
    /* Register additional ADM1022 sysfs hooks */
    if (data->has_temp3)
        sysfs_remove_group(&client->dev.kobj, &temp3_group);
        data->groups[idx++] = &temp3_group;
​
    return 0;
    hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name,
                               data, data->groups);
    return PTR_ERR_OR_ZERO(hwmon_dev);
}
​
static const struct i2c_device_id thmc50_id[] = {
    { "adm1022", adm1022 },
    { "thmc50", thmc50 },
    { }
};
MODULE_DEVICE_TABLE(i2c, thmc50_id);
​
static struct i2c_driver thmc50_driver = {
    .class = I2C_CLASS_HWMON,
    .driver = {
        .name = "thmc50",
    },
    .probe = thmc50_probe,
    .remove = thmc50_remove,
    .id_table = thmc50_id,
    .detect = thmc50_detect,
    .address_list = normal_i2c,
};
​
module_i2c_driver(thmc50_driver);
​
MODULE_AUTHOR("Krzysztof Helt <krzysztof.h1@wp.pl>");
MODULE_DESCRIPTION("THMC50 driver");