therm_adt746x: Convert to a new-style i2c driver
The legacy i2c binding model is going away soon, so convert the ppc therm_adt746x driver to the new model or it will break. Signed-off-by: Jean Delvare <khali@linux-fr.org> Tested-by: Andreas Schwab <schwab@linux-m68k.org> Tested-by: Paul Mackerras <paulus@samba.org> Cc: Benjamin Herrenschmidt <benh@kernel.crashing.org>
This commit is contained in:
parent
351ca3e311
commit
2e613e7f69
1 changed files with 42 additions and 42 deletions
|
@ -71,7 +71,7 @@ MODULE_PARM_DESC(verbose,"Verbose log operations "
|
|||
"(default 0)");
|
||||
|
||||
struct thermostat {
|
||||
struct i2c_client clt;
|
||||
struct i2c_client *clt;
|
||||
u8 temps[3];
|
||||
u8 cached_temp[3];
|
||||
u8 initial_limits[3];
|
||||
|
@ -86,9 +86,6 @@ static struct of_device * of_dev;
|
|||
static struct thermostat* thermostat;
|
||||
static struct task_struct *thread_therm = NULL;
|
||||
|
||||
static int attach_one_thermostat(struct i2c_adapter *adapter, int addr,
|
||||
int busno);
|
||||
|
||||
static void write_both_fan_speed(struct thermostat *th, int speed);
|
||||
static void write_fan_speed(struct thermostat *th, int speed, int fan);
|
||||
|
||||
|
@ -100,7 +97,7 @@ write_reg(struct thermostat* th, int reg, u8 data)
|
|||
|
||||
tmp[0] = reg;
|
||||
tmp[1] = data;
|
||||
rc = i2c_master_send(&th->clt, (const char *)tmp, 2);
|
||||
rc = i2c_master_send(th->clt, (const char *)tmp, 2);
|
||||
if (rc < 0)
|
||||
return rc;
|
||||
if (rc != 2)
|
||||
|
@ -115,12 +112,12 @@ read_reg(struct thermostat* th, int reg)
|
|||
int rc;
|
||||
|
||||
reg_addr = (u8)reg;
|
||||
rc = i2c_master_send(&th->clt, ®_addr, 1);
|
||||
rc = i2c_master_send(th->clt, ®_addr, 1);
|
||||
if (rc < 0)
|
||||
return rc;
|
||||
if (rc != 1)
|
||||
return -ENODEV;
|
||||
rc = i2c_master_recv(&th->clt, (char *)&data, 1);
|
||||
rc = i2c_master_recv(th->clt, (char *)&data, 1);
|
||||
if (rc < 0)
|
||||
return rc;
|
||||
return data;
|
||||
|
@ -130,26 +127,36 @@ static int
|
|||
attach_thermostat(struct i2c_adapter *adapter)
|
||||
{
|
||||
unsigned long bus_no;
|
||||
struct i2c_board_info info;
|
||||
struct i2c_client *client;
|
||||
|
||||
if (strncmp(adapter->name, "uni-n", 5))
|
||||
return -ENODEV;
|
||||
bus_no = simple_strtoul(adapter->name + 6, NULL, 10);
|
||||
if (bus_no != therm_bus)
|
||||
return -ENODEV;
|
||||
return attach_one_thermostat(adapter, therm_address, bus_no);
|
||||
|
||||
memset(&info, 0, sizeof(struct i2c_board_info));
|
||||
strlcpy(info.type, "therm_adt746x", I2C_NAME_SIZE);
|
||||
info.addr = therm_address;
|
||||
client = i2c_new_device(adapter, &info);
|
||||
if (!client)
|
||||
return -ENODEV;
|
||||
|
||||
/*
|
||||
* Let i2c-core delete that device on driver removal.
|
||||
* This is safe because i2c-core holds the core_lock mutex for us.
|
||||
*/
|
||||
list_add_tail(&client->detected, &client->driver->clients);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int
|
||||
detach_thermostat(struct i2c_adapter *adapter)
|
||||
remove_thermostat(struct i2c_client *client)
|
||||
{
|
||||
struct thermostat* th;
|
||||
struct thermostat *th = i2c_get_clientdata(client);
|
||||
int i;
|
||||
|
||||
if (thermostat == NULL)
|
||||
return 0;
|
||||
|
||||
th = thermostat;
|
||||
|
||||
if (thread_therm != NULL) {
|
||||
kthread_stop(thread_therm);
|
||||
}
|
||||
|
@ -165,8 +172,6 @@ detach_thermostat(struct i2c_adapter *adapter)
|
|||
|
||||
write_both_fan_speed(th, -1);
|
||||
|
||||
i2c_detach_client(&th->clt);
|
||||
|
||||
thermostat = NULL;
|
||||
|
||||
kfree(th);
|
||||
|
@ -174,14 +179,6 @@ detach_thermostat(struct i2c_adapter *adapter)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static struct i2c_driver thermostat_driver = {
|
||||
.driver = {
|
||||
.name = "therm_adt746x",
|
||||
},
|
||||
.attach_adapter = attach_thermostat,
|
||||
.detach_adapter = detach_thermostat,
|
||||
};
|
||||
|
||||
static int read_fan_speed(struct thermostat *th, u8 addr)
|
||||
{
|
||||
u8 tmp[2];
|
||||
|
@ -369,8 +366,8 @@ static void set_limit(struct thermostat *th, int i)
|
|||
th->limits[i] = default_limits_local[i] + limit_adjust;
|
||||
}
|
||||
|
||||
static int attach_one_thermostat(struct i2c_adapter *adapter, int addr,
|
||||
int busno)
|
||||
static int probe_thermostat(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct thermostat* th;
|
||||
int rc;
|
||||
|
@ -383,16 +380,12 @@ static int attach_one_thermostat(struct i2c_adapter *adapter, int addr,
|
|||
if (!th)
|
||||
return -ENOMEM;
|
||||
|
||||
th->clt.addr = addr;
|
||||
th->clt.adapter = adapter;
|
||||
th->clt.driver = &thermostat_driver;
|
||||
strcpy(th->clt.name, "thermostat");
|
||||
i2c_set_clientdata(client, th);
|
||||
th->clt = client;
|
||||
|
||||
rc = read_reg(th, 0);
|
||||
if (rc < 0) {
|
||||
printk(KERN_ERR "adt746x: Thermostat failed to read config "
|
||||
"from bus %d !\n",
|
||||
busno);
|
||||
dev_err(&client->dev, "Thermostat failed to read config!\n");
|
||||
kfree(th);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
@ -421,14 +414,6 @@ static int attach_one_thermostat(struct i2c_adapter *adapter, int addr,
|
|||
|
||||
thermostat = th;
|
||||
|
||||
if (i2c_attach_client(&th->clt)) {
|
||||
printk(KERN_INFO "adt746x: Thermostat failed to attach "
|
||||
"client !\n");
|
||||
thermostat = NULL;
|
||||
kfree(th);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
/* be sure to really write fan speed the first time */
|
||||
th->last_speed[0] = -2;
|
||||
th->last_speed[1] = -2;
|
||||
|
@ -454,6 +439,21 @@ static int attach_one_thermostat(struct i2c_adapter *adapter, int addr,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static const struct i2c_device_id therm_adt746x_id[] = {
|
||||
{ "therm_adt746x", 0 },
|
||||
{ }
|
||||
};
|
||||
|
||||
static struct i2c_driver thermostat_driver = {
|
||||
.driver = {
|
||||
.name = "therm_adt746x",
|
||||
},
|
||||
.attach_adapter = attach_thermostat,
|
||||
.probe = probe_thermostat,
|
||||
.remove = remove_thermostat,
|
||||
.id_table = therm_adt746x_id,
|
||||
};
|
||||
|
||||
/*
|
||||
* Now, unfortunately, sysfs doesn't give us a nice void * we could
|
||||
* pass around to the attribute functions, so we don't really have
|
||||
|
|
Loading…
Reference in a new issue