From patchwork Thu Nov 30 21:43:42 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Andreas Klinger X-Patchwork-Id: 10085689 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 24340602B9 for ; Thu, 30 Nov 2017 21:43:56 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 14A012A333 for ; Thu, 30 Nov 2017 21:43:56 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 0915D2A339; Thu, 30 Nov 2017 21:43:56 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-6.9 required=2.0 tests=BAYES_00,RCVD_IN_DNSWL_HI autolearn=unavailable version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 821212A333 for ; Thu, 30 Nov 2017 21:43:55 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751758AbdK3Vns (ORCPT ); Thu, 30 Nov 2017 16:43:48 -0500 Received: from mout.kundenserver.de ([217.72.192.75]:50238 "EHLO mout.kundenserver.de" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1750989AbdK3Vnp (ORCPT ); Thu, 30 Nov 2017 16:43:45 -0500 Received: from localhost ([46.78.254.35]) by mrelayeu.kundenserver.de (mreue104 [212.227.15.183]) with ESMTPSA (Nemesis) id 0Lucpk-1f2YZz3WUq-00zk5j; Thu, 30 Nov 2017 22:43:28 +0100 Date: Thu, 30 Nov 2017 22:43:42 +0100 From: Andreas Klinger To: jic23@kernel.org, knaack.h@gmx.de, lars@metafoo.de, pmeerw@pmeerw.net, singhalsimran0@gmail.com, linux-iio@vger.kernel.org Cc: linux-kernel@vger.kernel.org Subject: [PATCH v2 1/2] iio: hx711: add triggered buffer support Message-ID: <20171130214342.GA27320@arbeit> MIME-Version: 1.0 Content-Disposition: inline User-Agent: Mutt/1.5.23 (2014-03-12) X-Provags-ID: V03:K0:xlijmMyXOKeH8JDzdGZTE11LFfPrNmixV9LA4dBy/Xipugnnyje T4F9iVdyEP87M1YX+roFAzz2F0t+MIohZdZg/YKWzs+6/yDUfiOdgq7VuaOZR8+0gZOhCWt 9Uq6wY/4IMF5IYVdIb8UzQFblGygVbfI2NHx+VMTUD7HMA+MrOCVwVayft8YlGXsKB8vFPP s6nWKjhDItaM8BGOef8Hw== X-UI-Out-Filterresults: notjunk:1; V01:K0:iC4ykzzQij0=:8ArrzKTi0l/q1QEgkTfVJ1 jLcogRN10etSVhXNHS3UIy2JzSS8I/2C7QLkjVsmZOwNXIQHci2/ZHhRZbicS3jAADLP9HDPM LaPhqxzZJilrBzSx0vCdChlzZNoBrjpV3lkJt5MtlOiAEcRT0/+rVaBeJbIrz6ML6yGb4swlt RQS9JZyYUv3neKF1PitoKWD94HfdzZuRxdzM+8zA4z6OLwXSXnOq/1sZriqu58G5gFAU6lP6l q8BoBzPpEpL+yp6MNH3f9dmdPeUjxbNphMr4tM1EFon166+oy4kFfsJpw0u+Ez8iGYpbgTZw+ dOSgy98Wq/Vo9Nj9vKn/RmY6pRNbvKJD3NDh97xjuwbiYb7dNIUuAOxJ8Ky5JW4cO5APRsHwL MZ+JlloinpZ9mdR+ffn8OvfSOWDKmo8Xk5WdzM2KGq2RD0kmm5bZF6MJbF11ufXlN+h/p/UZt xhakgWClvEkadwCblQHSt+4GC+EqvDddbJ3X1CD6J4iq3ll04lDDSm+I1yjLZFFbuzVjUR3im QnWPi2Ewy0u19A1ElqEQgMVCcUFyQH3jxXR24iB4yF6/m+1F7XgE3tX7s0jZsrp5hFjw16qo3 2s9IyP9v26rKjacL+KJh9wXN1CZdPvxCNmoGO63QbKwhif+l21krfrGn7Z6z6FZpGrc2f45x9 mOxtURjR5kTHFvuZyqG9BMV3dJmroMQrZKK+hbfXzR8UbVspYdF9u4PT7gQjzwLrHUoDcCsSY cXHAY1YdUnR9OlJU6l7r0keIPawQXkt/wpaWpQ== Sender: linux-iio-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-iio@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Add buffer to device data struct and add trigger function Data format is quite simple: voltage - channel 0 32 Bit voltage - channel 1 32 Bit timestamp 64 Bit Using both channels at the same time is working quite slow because of changing the channel which needs a dummy read. Signed-off-by: Andreas Klinger --- drivers/iio/adc/Kconfig | 2 + drivers/iio/adc/hx711.c | 106 ++++++++++++++++++++++++++++++++++++++++-------- 2 files changed, 90 insertions(+), 18 deletions(-) diff --git a/drivers/iio/adc/Kconfig b/drivers/iio/adc/Kconfig index af4fc1279409..a83642e517d5 100644 --- a/drivers/iio/adc/Kconfig +++ b/drivers/iio/adc/Kconfig @@ -316,6 +316,8 @@ config HI8435 config HX711 tristate "AVIA HX711 ADC for weight cells" depends on GPIOLIB + select IIO_BUFFER + select IIO_TRIGGERED_BUFFER help If you say yes here you get support for AVIA HX711 ADC which is used for weigh cells diff --git a/drivers/iio/adc/hx711.c b/drivers/iio/adc/hx711.c index d10b9f13d557..d773fd69a76d 100644 --- a/drivers/iio/adc/hx711.c +++ b/drivers/iio/adc/hx711.c @@ -24,6 +24,9 @@ #include #include #include +#include +#include +#include #include #include @@ -89,6 +92,11 @@ struct hx711_data { int gain_set; /* gain set on device */ int gain_chan_a; /* gain for channel A */ struct mutex lock; + /* + * triggered buffer + * 2x32-bit channel + 2x32-bit timestamp + */ + u32 buffer[4]; }; static int hx711_cycle(struct hx711_data *hx711_data) @@ -236,34 +244,43 @@ static int hx711_set_gain_for_channel(struct hx711_data *hx711_data, int chan) return 0; } +static int hx711_reset_read(struct hx711_data *hx711_data, int chan) +{ + int ret; + int val; + + /* + * hx711_reset() must be called from here + * because it could be calling hx711_read() by itself + */ + if (hx711_reset(hx711_data)) { + mutex_unlock(&hx711_data->lock); + dev_err(hx711_data->dev, "reset failed!"); + return -EIO; + } + + ret = hx711_set_gain_for_channel(hx711_data, chan); + if (ret < 0) { + mutex_unlock(&hx711_data->lock); + return ret; + } + + val = hx711_read(hx711_data); + + return val; +} + static int hx711_read_raw(struct iio_dev *indio_dev, const struct iio_chan_spec *chan, int *val, int *val2, long mask) { struct hx711_data *hx711_data = iio_priv(indio_dev); - int ret; switch (mask) { case IIO_CHAN_INFO_RAW: mutex_lock(&hx711_data->lock); - /* - * hx711_reset() must be called from here - * because it could be calling hx711_read() by itself - */ - if (hx711_reset(hx711_data)) { - mutex_unlock(&hx711_data->lock); - dev_err(hx711_data->dev, "reset failed!"); - return -EIO; - } - - ret = hx711_set_gain_for_channel(hx711_data, chan->channel); - if (ret < 0) { - mutex_unlock(&hx711_data->lock); - return ret; - } - - *val = hx711_read(hx711_data); + *val = hx711_reset_read(hx711_data, chan->channel); mutex_unlock(&hx711_data->lock); @@ -339,6 +356,35 @@ static int hx711_write_raw_get_fmt(struct iio_dev *indio_dev, return IIO_VAL_INT_PLUS_NANO; } +static irqreturn_t hx711_trigger(int irq, void *p) +{ + struct iio_poll_func *pf = p; + struct iio_dev *indio_dev = pf->indio_dev; + struct hx711_data *hx711_data = iio_priv(indio_dev); + int i; + + mutex_lock(&hx711_data->lock); + + memset(hx711_data->buffer, 0, sizeof(hx711_data->buffer)); + + for (i = 0; i < indio_dev->masklength; i++) { + if (!test_bit(i, indio_dev->active_scan_mask)) + continue; + + hx711_data->buffer[i] = hx711_reset_read(hx711_data, + indio_dev->channels[i].channel); + } + + iio_push_to_buffers_with_timestamp(indio_dev, hx711_data->buffer, + pf->timestamp); + + mutex_unlock(&hx711_data->lock); + + iio_trigger_notify_done(indio_dev->trig); + + return IRQ_HANDLED; +} + static ssize_t hx711_scale_available_show(struct device *dev, struct device_attribute *attr, char *buf) @@ -387,6 +433,14 @@ static const struct iio_chan_spec hx711_chan_spec[] = { .indexed = 1, .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), + .scan_index = 0, + .scan_type = { + .sign = 'u', + .realbits = 24, + .storagebits = 32, + .shift = 0, + .endianness = IIO_CPU, + }, }, { .type = IIO_VOLTAGE, @@ -394,7 +448,16 @@ static const struct iio_chan_spec hx711_chan_spec[] = { .indexed = 1, .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), + .scan_index = 1, + .scan_type = { + .sign = 'u', + .realbits = 24, + .storagebits = 32, + .shift = 0, + .endianness = IIO_CPU, + }, }, + IIO_CHAN_SOFT_TIMESTAMP(2), }; static int hx711_probe(struct platform_device *pdev) @@ -482,6 +545,13 @@ static int hx711_probe(struct platform_device *pdev) indio_dev->channels = hx711_chan_spec; indio_dev->num_channels = ARRAY_SIZE(hx711_chan_spec); + ret = devm_iio_triggered_buffer_setup(dev, indio_dev, + iio_pollfunc_store_time, hx711_trigger, NULL); + if (ret < 0) { + dev_err(dev, "setup of iio triggered buffer failed\n"); + return ret; + } + ret = iio_device_register(indio_dev); if (ret < 0) { dev_err(dev, "Couldn't register the device\n");