Commit bd8d421f authored by Jean Delvare's avatar Jean Delvare Committed by Jean Delvare

i2c: Convert the max6875 driver to a new-style i2c driver

The new-style max6875 driver implements the optional detect() callback
to cover the use cases of the legacy driver. I'm curious if anyone
really needs this though, so it might be removed in the feature.
Signed-off-by: default avatarJean Delvare <khali@linux-fr.org>
parent 3d63430a
...@@ -49,7 +49,7 @@ $ modprobe max6875 force=0,0x50 ...@@ -49,7 +49,7 @@ $ modprobe max6875 force=0,0x50
The MAX6874/MAX6875 ignores address bit 0, so this driver attaches to multiple The MAX6874/MAX6875 ignores address bit 0, so this driver attaches to multiple
addresses. For example, for address 0x50, it also reserves 0x51. addresses. For example, for address 0x50, it also reserves 0x51.
The even-address instance is called 'max6875', the odd one is 'max6875 subclient'. The even-address instance is called 'max6875', the odd one is 'dummy'.
Programming the chip using i2c-dev Programming the chip using i2c-dev
......
...@@ -53,7 +53,7 @@ I2C_CLIENT_INSMOD_1(max6875); ...@@ -53,7 +53,7 @@ I2C_CLIENT_INSMOD_1(max6875);
/* Each client has this additional data */ /* Each client has this additional data */
struct max6875_data { struct max6875_data {
struct i2c_client client; struct i2c_client *fake_client;
struct mutex update_lock; struct mutex update_lock;
u32 valid; u32 valid;
...@@ -61,19 +61,6 @@ struct max6875_data { ...@@ -61,19 +61,6 @@ struct max6875_data {
unsigned long last_updated[USER_EEPROM_SLICES]; unsigned long last_updated[USER_EEPROM_SLICES];
}; };
static int max6875_attach_adapter(struct i2c_adapter *adapter);
static int max6875_detect(struct i2c_adapter *adapter, int address, int kind);
static int max6875_detach_client(struct i2c_client *client);
/* This is the driver that will be inserted */
static struct i2c_driver max6875_driver = {
.driver = {
.name = "max6875",
},
.attach_adapter = max6875_attach_adapter,
.detach_client = max6875_detach_client,
};
static void max6875_update_slice(struct i2c_client *client, int slice) static void max6875_update_slice(struct i2c_client *client, int slice)
{ {
struct max6875_data *data = i2c_get_clientdata(client); struct max6875_data *data = i2c_get_clientdata(client);
...@@ -159,96 +146,87 @@ static struct bin_attribute user_eeprom_attr = { ...@@ -159,96 +146,87 @@ static struct bin_attribute user_eeprom_attr = {
.read = max6875_read, .read = max6875_read,
}; };
static int max6875_attach_adapter(struct i2c_adapter *adapter) /* Return 0 if detection is successful, -ENODEV otherwise */
static int max6875_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info)
{ {
return i2c_probe(adapter, &addr_data, max6875_detect); struct i2c_adapter *adapter = client->adapter;
}
/* This function is called by i2c_probe */
static int max6875_detect(struct i2c_adapter *adapter, int address, int kind)
{
struct i2c_client *real_client;
struct i2c_client *fake_client;
struct max6875_data *data;
int err;
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WRITE_BYTE_DATA if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WRITE_BYTE_DATA
| I2C_FUNC_SMBUS_READ_BYTE)) | I2C_FUNC_SMBUS_READ_BYTE))
return 0; return -ENODEV;
/* Only check even addresses */ /* Only check even addresses */
if (address & 1) if (client->addr & 1)
return 0; return -ENODEV;
strlcpy(info->type, "max6875", I2C_NAME_SIZE);
return 0;
}
static int max6875_probe(struct i2c_client *client,
const struct i2c_device_id *id)
{
struct max6875_data *data;
int err;
if (!(data = kzalloc(sizeof(struct max6875_data), GFP_KERNEL))) if (!(data = kzalloc(sizeof(struct max6875_data), GFP_KERNEL)))
return -ENOMEM; return -ENOMEM;
/* A fake client is created on the odd address */ /* A fake client is created on the odd address */
if (!(fake_client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL))) { data->fake_client = i2c_new_dummy(client->adapter, client->addr + 1);
if (!data->fake_client) {
err = -ENOMEM; err = -ENOMEM;
goto exit_kfree1; goto exit_kfree;
} }
/* Init real i2c_client */ /* Init real i2c_client */
real_client = &data->client; i2c_set_clientdata(client, data);
i2c_set_clientdata(real_client, data);
real_client->addr = address;
real_client->adapter = adapter;
real_client->driver = &max6875_driver;
strlcpy(real_client->name, "max6875", I2C_NAME_SIZE);
mutex_init(&data->update_lock); mutex_init(&data->update_lock);
/* Init fake client data */ err = sysfs_create_bin_file(&client->dev.kobj, &user_eeprom_attr);
i2c_set_clientdata(fake_client, NULL);
fake_client->addr = address | 1;
fake_client->adapter = adapter;
fake_client->driver = &max6875_driver;
strlcpy(fake_client->name, "max6875 subclient", I2C_NAME_SIZE);
if ((err = i2c_attach_client(real_client)) != 0)
goto exit_kfree2;
if ((err = i2c_attach_client(fake_client)) != 0)
goto exit_detach1;
err = sysfs_create_bin_file(&real_client->dev.kobj, &user_eeprom_attr);
if (err) if (err)
goto exit_detach2; goto exit_remove_fake;
return 0; return 0;
exit_detach2: exit_remove_fake:
i2c_detach_client(fake_client); i2c_unregister_device(data->fake_client);
exit_detach1: exit_kfree:
i2c_detach_client(real_client);
exit_kfree2:
kfree(fake_client);
exit_kfree1:
kfree(data); kfree(data);
return err; return err;
} }
/* Will be called for both the real client and the fake client */ static int max6875_remove(struct i2c_client *client)
static int max6875_detach_client(struct i2c_client *client)
{ {
int err;
struct max6875_data *data = i2c_get_clientdata(client); struct max6875_data *data = i2c_get_clientdata(client);
/* data is NULL for the fake client */ i2c_unregister_device(data->fake_client);
if (data)
sysfs_remove_bin_file(&client->dev.kobj, &user_eeprom_attr);
err = i2c_detach_client(client); sysfs_remove_bin_file(&client->dev.kobj, &user_eeprom_attr);
if (err) kfree(data);
return err;
if (data) /* real client */
kfree(data);
else /* fake client */
kfree(client);
return 0; return 0;
} }
static const struct i2c_device_id max6875_id[] = {
{ "max6875", 0 },
{ }
};
static struct i2c_driver max6875_driver = {
.driver = {
.name = "max6875",
},
.probe = max6875_probe,
.remove = max6875_remove,
.id_table = max6875_id,
.detect = max6875_detect,
.address_data = &addr_data,
};
static int __init max6875_init(void) static int __init max6875_init(void)
{ {
return i2c_add_driver(&max6875_driver); return i2c_add_driver(&max6875_driver);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment