From: Alexandru Ardelean <alexandru.ardelean@analog.com>
To: <linux-iio@vger.kernel.org>, <linux-kernel@vger.kernel.org>
Cc: <jic23@kernel.org>, <lars@metafoo.de>,
Alexandru Ardelean <alexandru.ardelean@analog.com>
Subject: [RFC PATCH 4/4] iio: Track enabled channels on a per channel basis
Date: Fri, 24 Apr 2020 08:18:18 +0300 [thread overview]
Message-ID: <20200424051818.6408-5-alexandru.ardelean@analog.com> (raw)
In-Reply-To: <20200424051818.6408-1-alexandru.ardelean@analog.com>
From: Lars-Peter Clausen <lars@metafoo.de>
Now that we support multiple channels with the same scan index we can no
longer use the scan mask to track which channels have been enabled.
Otherwise it is not possible to enable channels with the same scan index
independently.
Introduce a new channel mask which is used instead of the scan mask to
track which channels are enabled. Whenever the channel mask is changed a
new scan mask is computed based on it.
Signed-off-by: Lars-Peter Clausen <lars@metafoo.de>
Signed-off-by: Alexandru Ardelean <alexandru.ardelean@analog.com>
---
drivers/iio/industrialio-buffer.c | 62 +++++++++++++++++++++----------
drivers/iio/inkern.c | 19 +++++++++-
include/linux/iio/buffer_impl.h | 3 ++
include/linux/iio/consumer.h | 2 +
4 files changed, 64 insertions(+), 22 deletions(-)
diff --git a/drivers/iio/industrialio-buffer.c b/drivers/iio/industrialio-buffer.c
index c06691281287..1821a3e32fb3 100644
--- a/drivers/iio/industrialio-buffer.c
+++ b/drivers/iio/industrialio-buffer.c
@@ -216,12 +216,20 @@ int iio_buffer_alloc_scanmask(struct iio_buffer *buffer,
if (buffer->scan_mask == NULL)
return -ENOMEM;
+ buffer->channel_mask = bitmap_zalloc(indio_dev->num_channels,
+ GFP_KERNEL);
+ if (buffer->channel_mask == NULL) {
+ bitmap_free(buffer->scan_mask);
+ return -ENOMEM;
+ }
+
return 0;
}
EXPORT_SYMBOL_GPL(iio_buffer_alloc_scanmask);
void iio_buffer_free_scanmask(struct iio_buffer *buffer)
{
+ bitmap_free(buffer->channel_mask);
bitmap_free(buffer->scan_mask);
}
EXPORT_SYMBOL_GPL(iio_buffer_free_scanmask);
@@ -285,7 +293,7 @@ static ssize_t iio_scan_el_show(struct device *dev,
/* Ensure ret is 0 or 1. */
ret = !!test_bit(to_iio_dev_attr(attr)->address,
- indio_dev->buffer->scan_mask);
+ indio_dev->buffer->channel_mask);
return sprintf(buf, "%d\n", ret);
}
@@ -330,11 +338,12 @@ static bool iio_validate_scan_mask(struct iio_dev *indio_dev,
* buffers might request, hence this code only verifies that the
* individual buffers request is plausible.
*/
-static int iio_scan_mask_set(struct iio_dev *indio_dev,
- struct iio_buffer *buffer, int bit)
+static int iio_channel_mask_set(struct iio_dev *indio_dev,
+ struct iio_buffer *buffer, int bit)
{
const unsigned long *mask;
unsigned long *trialmask;
+ unsigned int ch;
trialmask = bitmap_zalloc(indio_dev->masklength, GFP_KERNEL);
if (trialmask == NULL)
@@ -343,8 +352,11 @@ static int iio_scan_mask_set(struct iio_dev *indio_dev,
WARN(1, "Trying to set scanmask prior to registering buffer\n");
goto err_invalid_mask;
}
- bitmap_copy(trialmask, buffer->scan_mask, indio_dev->masklength);
- set_bit(bit, trialmask);
+
+ set_bit(bit, buffer->channel_mask);
+
+ for_each_set_bit(ch, buffer->channel_mask, indio_dev->num_channels)
+ set_bit(indio_dev->channels[ch].scan_index, trialmask);
if (!iio_validate_scan_mask(indio_dev, trialmask))
goto err_invalid_mask;
@@ -363,28 +375,37 @@ static int iio_scan_mask_set(struct iio_dev *indio_dev,
return 0;
err_invalid_mask:
+ clear_bit(bit, buffer->channel_mask);
bitmap_free(trialmask);
return -EINVAL;
}
-static int iio_scan_mask_clear(struct iio_buffer *buffer, int bit)
+static int iio_channel_mask_clear(struct iio_dev *indio_dev,
+ struct iio_buffer *buffer, int bit)
{
- clear_bit(bit, buffer->scan_mask);
+ unsigned int ch;
+
+ clear_bit(bit, buffer->channel_mask);
+
+ bitmap_clear(buffer->scan_mask, 0, indio_dev->masklength);
+
+ for_each_set_bit(ch, buffer->channel_mask, indio_dev->num_channels)
+ set_bit(indio_dev->channels[ch].scan_index, buffer->scan_mask);
return 0;
}
-static int iio_scan_mask_query(struct iio_dev *indio_dev,
- struct iio_buffer *buffer, int bit)
+static int iio_channel_mask_query(struct iio_dev *indio_dev,
+ struct iio_buffer *buffer, int bit)
{
- if (bit > indio_dev->masklength)
+ if (bit > indio_dev->num_channels)
return -EINVAL;
- if (!buffer->scan_mask)
+ if (!buffer->channel_mask)
return 0;
/* Ensure return value is 0 or 1. */
- return !!test_bit(bit, buffer->scan_mask);
-};
+ return !!test_bit(bit, buffer->channel_mask);
+}
static ssize_t iio_scan_el_store(struct device *dev,
struct device_attribute *attr,
@@ -405,15 +426,15 @@ static ssize_t iio_scan_el_store(struct device *dev,
ret = -EBUSY;
goto error_ret;
}
- ret = iio_scan_mask_query(indio_dev, buffer, this_attr->address);
+ ret = iio_channel_mask_query(indio_dev, buffer, this_attr->address);
if (ret < 0)
goto error_ret;
if (!state && ret) {
- ret = iio_scan_mask_clear(buffer, this_attr->address);
+ ret = iio_channel_mask_clear(indio_dev, buffer, this_attr->address);
if (ret)
goto error_ret;
} else if (state && !ret) {
- ret = iio_scan_mask_set(indio_dev, buffer, this_attr->address);
+ ret = iio_channel_mask_set(indio_dev, buffer, this_attr->address);
if (ret)
goto error_ret;
}
@@ -459,7 +480,8 @@ static ssize_t iio_scan_el_ts_store(struct device *dev,
}
static int iio_buffer_add_channel_sysfs(struct iio_dev *indio_dev,
- const struct iio_chan_spec *chan)
+ const struct iio_chan_spec *chan,
+ unsigned int address)
{
int ret, attrcount = 0;
struct iio_buffer *buffer = indio_dev->buffer;
@@ -491,7 +513,7 @@ static int iio_buffer_add_channel_sysfs(struct iio_dev *indio_dev,
chan,
&iio_scan_el_show,
&iio_scan_el_store,
- chan->scan_index,
+ address,
0,
&indio_dev->dev,
&buffer->scan_el_dev_attr_list);
@@ -500,7 +522,7 @@ static int iio_buffer_add_channel_sysfs(struct iio_dev *indio_dev,
chan,
&iio_scan_el_ts_show,
&iio_scan_el_ts_store,
- chan->scan_index,
+ address,
0,
&indio_dev->dev,
&buffer->scan_el_dev_attr_list);
@@ -1313,7 +1335,7 @@ int iio_buffer_alloc_sysfs_and_mask(struct iio_dev *indio_dev)
continue;
ret = iio_buffer_add_channel_sysfs(indio_dev,
- &channels[i]);
+ &channels[i], i);
if (ret < 0)
goto error_cleanup_dynamic;
attrcount += ret;
diff --git a/drivers/iio/inkern.c b/drivers/iio/inkern.c
index f35cb9985edc..57cf4b01c403 100644
--- a/drivers/iio/inkern.c
+++ b/drivers/iio/inkern.c
@@ -150,6 +150,7 @@ static int __of_iio_channel_get(struct iio_channel *channel,
if (index < 0)
goto err_put;
channel->channel = &indio_dev->channels[index];
+ channel->channel_index = index;
return 0;
@@ -861,14 +862,28 @@ EXPORT_SYMBOL_GPL(iio_write_channel_raw);
void iio_buffer_channel_enable(struct iio_buffer *buffer,
const struct iio_channel *chan)
{
- set_bit(chan->channel->scan_index, buffer->scan_mask);
+ unsigned int ch;
+
+ set_bit(chan->channel_index, buffer->channel_mask);
+
+ bitmap_clear(buffer->scan_mask, 0, chan->indio_dev->masklength);
+
+ for_each_set_bit(ch, buffer->channel_mask, chan->indio_dev->num_channels)
+ set_bit(chan->indio_dev->channels[ch].scan_index, buffer->scan_mask);
}
EXPORT_SYMBOL_GPL(iio_buffer_channel_enable);
void iio_buffer_channel_disable(struct iio_buffer *buffer,
const struct iio_channel *chan)
{
- clear_bit(chan->channel->scan_index, buffer->scan_mask);
+ unsigned int ch;
+
+ clear_bit(chan->channel_index, buffer->channel_mask);
+
+ bitmap_clear(buffer->scan_mask, 0, chan->indio_dev->masklength);
+
+ for_each_set_bit(ch, buffer->channel_mask, chan->indio_dev->num_channels)
+ set_bit(chan->indio_dev->channels[ch].scan_index, buffer->scan_mask);
}
EXPORT_SYMBOL_GPL(iio_buffer_channel_disable);
diff --git a/include/linux/iio/buffer_impl.h b/include/linux/iio/buffer_impl.h
index a63dc07b7350..801e6ffa062c 100644
--- a/include/linux/iio/buffer_impl.h
+++ b/include/linux/iio/buffer_impl.h
@@ -84,6 +84,9 @@ struct iio_buffer {
/** @scan_mask: Bitmask used in masking scan mode elements. */
long *scan_mask;
+ /** @channel_mask: Bitmask used in masking scan mode elements (per channel). */
+ long *channel_mask;
+
/** @demux_list: List of operations required to demux the scan. */
struct list_head demux_list;
diff --git a/include/linux/iio/consumer.h b/include/linux/iio/consumer.h
index dbc87c26250a..6efd7091d3dd 100644
--- a/include/linux/iio/consumer.h
+++ b/include/linux/iio/consumer.h
@@ -19,11 +19,13 @@ struct device;
* struct iio_channel - everything needed for a consumer to use a channel
* @indio_dev: Device on which the channel exists.
* @channel: Full description of the channel.
+ * @channel_index: Offset of the channel into the devices channel array.
* @data: Data about the channel used by consumer.
*/
struct iio_channel {
struct iio_dev *indio_dev;
const struct iio_chan_spec *channel;
+ unsigned int channel_index;
void *data;
};
--
2.17.1
next prev parent reply other threads:[~2020-04-24 5:18 UTC|newest]
Thread overview: 18+ messages / expand[flat|nested] mbox.gz Atom feed top
2020-04-24 5:18 [RFC PATCH 0/4] iio: scan_mask rework to track enabled channels on per-channel basis Alexandru Ardelean
2020-04-24 5:18 ` [RFC PATCH 1/4] iio: Move scan mask management to the core Alexandru Ardelean
2020-04-26 9:45 ` Jonathan Cameron
2020-04-26 10:22 ` Jonathan Cameron
2020-04-27 6:25 ` Ardelean, Alexandru
2020-05-02 18:12 ` Jonathan Cameron
2020-04-24 5:18 ` [RFC PATCH 2/4] iio: hw_consumer: use new scanmask functions Alexandru Ardelean
2020-04-24 5:18 ` [RFC PATCH 3/4] iio: Allow channels to share storage elements Alexandru Ardelean
2020-04-26 10:28 ` Jonathan Cameron
2020-04-24 5:18 ` Alexandru Ardelean [this message]
2020-04-24 7:51 ` [RFC PATCH 4/4] iio: Track enabled channels on a per channel basis Sa, Nuno
2020-04-26 10:50 ` Jonathan Cameron
2020-04-27 12:09 ` Sa, Nuno
2020-05-02 17:19 ` Jonathan Cameron
2020-05-04 8:24 ` Sa, Nuno
2020-05-04 9:28 ` Jonathan Cameron
2020-04-26 10:40 ` Jonathan Cameron
2020-04-24 7:51 ` [RFC PATCH 0/4] iio: scan_mask rework to track enabled channels on per-channel basis Sa, Nuno
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20200424051818.6408-5-alexandru.ardelean@analog.com \
--to=alexandru.ardelean@analog.com \
--cc=jic23@kernel.org \
--cc=lars@metafoo.de \
--cc=linux-iio@vger.kernel.org \
--cc=linux-kernel@vger.kernel.org \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).