|
@@ -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
|