iio: multiplexer: Make use of device properties
Convert the module to be property provider agnostic and allow it to be used on non-OF platforms. Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Acked-by: Peter Rosin <peda@axentia.se> Link: https://lore.kernel.org/r/20220302160025.54348-1-andriy.shevchenko@linux.intel.com Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
This commit is contained in:
Родитель
fee4ac3299
Коммит
879a523797
|
@ -9,7 +9,6 @@ menu "Multiplexers"
|
||||||
config IIO_MUX
|
config IIO_MUX
|
||||||
tristate "IIO multiplexer driver"
|
tristate "IIO multiplexer driver"
|
||||||
select MULTIPLEXER
|
select MULTIPLEXER
|
||||||
depends on OF || COMPILE_TEST
|
|
||||||
help
|
help
|
||||||
Say yes here to build support for the IIO multiplexer.
|
Say yes here to build support for the IIO multiplexer.
|
||||||
|
|
||||||
|
|
|
@ -10,11 +10,12 @@
|
||||||
#include <linux/err.h>
|
#include <linux/err.h>
|
||||||
#include <linux/iio/consumer.h>
|
#include <linux/iio/consumer.h>
|
||||||
#include <linux/iio/iio.h>
|
#include <linux/iio/iio.h>
|
||||||
|
#include <linux/mod_devicetable.h>
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
#include <linux/mutex.h>
|
#include <linux/mutex.h>
|
||||||
#include <linux/mux/consumer.h>
|
#include <linux/mux/consumer.h>
|
||||||
#include <linux/of.h>
|
|
||||||
#include <linux/platform_device.h>
|
#include <linux/platform_device.h>
|
||||||
|
#include <linux/property.h>
|
||||||
|
|
||||||
struct mux_ext_info_cache {
|
struct mux_ext_info_cache {
|
||||||
char *data;
|
char *data;
|
||||||
|
@ -324,37 +325,21 @@ static int mux_configure_channel(struct device *dev, struct mux *mux,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
|
||||||
* Same as of_property_for_each_string(), but also keeps track of the
|
|
||||||
* index of each string.
|
|
||||||
*/
|
|
||||||
#define of_property_for_each_string_index(np, propname, prop, s, i) \
|
|
||||||
for (prop = of_find_property(np, propname, NULL), \
|
|
||||||
s = of_prop_next_string(prop, NULL), \
|
|
||||||
i = 0; \
|
|
||||||
s; \
|
|
||||||
s = of_prop_next_string(prop, s), \
|
|
||||||
i++)
|
|
||||||
|
|
||||||
static int mux_probe(struct platform_device *pdev)
|
static int mux_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct device *dev = &pdev->dev;
|
struct device *dev = &pdev->dev;
|
||||||
struct device_node *np = pdev->dev.of_node;
|
|
||||||
struct iio_dev *indio_dev;
|
struct iio_dev *indio_dev;
|
||||||
struct iio_channel *parent;
|
struct iio_channel *parent;
|
||||||
struct mux *mux;
|
struct mux *mux;
|
||||||
struct property *prop;
|
const char **labels;
|
||||||
const char *label;
|
int all_children;
|
||||||
|
int children;
|
||||||
u32 state;
|
u32 state;
|
||||||
int sizeof_ext_info;
|
int sizeof_ext_info;
|
||||||
int children;
|
|
||||||
int sizeof_priv;
|
int sizeof_priv;
|
||||||
int i;
|
int i;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
if (!np)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
parent = devm_iio_channel_get(dev, "parent");
|
parent = devm_iio_channel_get(dev, "parent");
|
||||||
if (IS_ERR(parent))
|
if (IS_ERR(parent))
|
||||||
return dev_err_probe(dev, PTR_ERR(parent),
|
return dev_err_probe(dev, PTR_ERR(parent),
|
||||||
|
@ -366,9 +351,21 @@ static int mux_probe(struct platform_device *pdev)
|
||||||
sizeof_ext_info *= sizeof(*mux->ext_info);
|
sizeof_ext_info *= sizeof(*mux->ext_info);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
all_children = device_property_string_array_count(dev, "channels");
|
||||||
|
if (all_children < 0)
|
||||||
|
return all_children;
|
||||||
|
|
||||||
|
labels = devm_kmalloc_array(dev, all_children, sizeof(*labels), GFP_KERNEL);
|
||||||
|
if (!labels)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
ret = device_property_read_string_array(dev, "channels", labels, all_children);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
children = 0;
|
children = 0;
|
||||||
of_property_for_each_string(np, "channels", prop, label) {
|
for (state = 0; state < all_children; state++) {
|
||||||
if (*label)
|
if (*labels[state])
|
||||||
children++;
|
children++;
|
||||||
}
|
}
|
||||||
if (children <= 0) {
|
if (children <= 0) {
|
||||||
|
@ -395,7 +392,7 @@ static int mux_probe(struct platform_device *pdev)
|
||||||
mux->cached_state = -1;
|
mux->cached_state = -1;
|
||||||
|
|
||||||
mux->delay_us = 0;
|
mux->delay_us = 0;
|
||||||
of_property_read_u32(np, "settle-time-us", &mux->delay_us);
|
device_property_read_u32(dev, "settle-time-us", &mux->delay_us);
|
||||||
|
|
||||||
indio_dev->name = dev_name(dev);
|
indio_dev->name = dev_name(dev);
|
||||||
indio_dev->info = &mux_info;
|
indio_dev->info = &mux_info;
|
||||||
|
@ -426,11 +423,11 @@ static int mux_probe(struct platform_device *pdev)
|
||||||
}
|
}
|
||||||
|
|
||||||
i = 0;
|
i = 0;
|
||||||
of_property_for_each_string_index(np, "channels", prop, label, state) {
|
for (state = 0; state < all_children; state++) {
|
||||||
if (!*label)
|
if (!*labels[state])
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
ret = mux_configure_channel(dev, mux, state, label, i++);
|
ret = mux_configure_channel(dev, mux, state, labels[state], i++);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
Загрузка…
Ссылка в новой задаче