Commit 07cc6899 authored by Marco Felsch's avatar Marco Felsch Committed by Jonathan Cameron

iio: temperature: tmp117: improve fallback capabilities

Don't error if the device-id found don't match the device-id for the
TMP117 sensor since other TMPxxx might be compatible to the TMP117. The
fallback mechanism tries to gather the required information from the
of_device_id or from the i2c_client information.

The commit also prepares the driver for adding new devices more easily
by making use of switch-case at the relevant parts.
Signed-off-by: default avatarMarco Felsch <m.felsch@pengutronix.de>
Link: https://lore.kernel.org/r/20230228090518.529811-3-m.felsch@pengutronix.deSigned-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 70ed9ced
...@@ -16,6 +16,7 @@ ...@@ -16,6 +16,7 @@
#include <linux/types.h> #include <linux/types.h>
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/limits.h> #include <linux/limits.h>
#include <linux/property.h>
#include <linux/iio/iio.h> #include <linux/iio/iio.h>
...@@ -115,23 +116,40 @@ static const struct iio_info tmp117_info = { ...@@ -115,23 +116,40 @@ static const struct iio_info tmp117_info = {
static int tmp117_identify(struct i2c_client *client) static int tmp117_identify(struct i2c_client *client)
{ {
const struct i2c_device_id *id;
unsigned long match_data;
int dev_id; int dev_id;
dev_id = i2c_smbus_read_word_swapped(client, TMP117_REG_DEVICE_ID); dev_id = i2c_smbus_read_word_swapped(client, TMP117_REG_DEVICE_ID);
if (dev_id < 0) if (dev_id < 0)
return dev_id; return dev_id;
if (dev_id != TMP117_DEVICE_ID) {
dev_err(&client->dev, "TMP117 not found\n"); switch (dev_id) {
return -ENODEV; case TMP117_DEVICE_ID:
return dev_id;
} }
return 0;
dev_info(&client->dev, "Unknown device id (0x%x), use fallback compatible\n",
dev_id);
match_data = (uintptr_t)device_get_match_data(&client->dev);
if (match_data)
return match_data;
id = i2c_client_get_device_id(client);
if (id)
return id->driver_data;
dev_err(&client->dev, "Failed to identify unsupported device\n");
return -ENODEV;
} }
static int tmp117_probe(struct i2c_client *client) static int tmp117_probe(struct i2c_client *client)
{ {
struct tmp117_data *data; struct tmp117_data *data;
struct iio_dev *indio_dev; struct iio_dev *indio_dev;
int ret; int ret, dev_id;
if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_WORD_DATA)) if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_WORD_DATA))
return -EOPNOTSUPP; return -EOPNOTSUPP;
...@@ -140,6 +158,8 @@ static int tmp117_probe(struct i2c_client *client) ...@@ -140,6 +158,8 @@ static int tmp117_probe(struct i2c_client *client)
if (ret < 0) if (ret < 0)
return ret; return ret;
dev_id = ret;
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
if (!indio_dev) if (!indio_dev)
return -ENOMEM; return -ENOMEM;
...@@ -148,24 +168,28 @@ static int tmp117_probe(struct i2c_client *client) ...@@ -148,24 +168,28 @@ static int tmp117_probe(struct i2c_client *client)
data->client = client; data->client = client;
data->calibbias = 0; data->calibbias = 0;
indio_dev->name = "tmp117";
indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->modes = INDIO_DIRECT_MODE;
indio_dev->info = &tmp117_info; indio_dev->info = &tmp117_info;
indio_dev->channels = tmp117_channels; switch (dev_id) {
indio_dev->num_channels = ARRAY_SIZE(tmp117_channels); case TMP117_DEVICE_ID:
indio_dev->channels = tmp117_channels;
indio_dev->num_channels = ARRAY_SIZE(tmp117_channels);
indio_dev->name = "tmp117";
break;
}
return devm_iio_device_register(&client->dev, indio_dev); return devm_iio_device_register(&client->dev, indio_dev);
} }
static const struct of_device_id tmp117_of_match[] = { static const struct of_device_id tmp117_of_match[] = {
{ .compatible = "ti,tmp117", }, { .compatible = "ti,tmp117", .data = (void *)TMP117_DEVICE_ID },
{ } { }
}; };
MODULE_DEVICE_TABLE(of, tmp117_of_match); MODULE_DEVICE_TABLE(of, tmp117_of_match);
static const struct i2c_device_id tmp117_id[] = { static const struct i2c_device_id tmp117_id[] = {
{ "tmp117", 0 }, { "tmp117", TMP117_DEVICE_ID },
{ } { }
}; };
MODULE_DEVICE_TABLE(i2c, tmp117_id); MODULE_DEVICE_TABLE(i2c, tmp117_id);
......
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