From patchwork Mon Apr 6 15:58:04 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Kamel BOUHARA X-Patchwork-Id: 11475765 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id C7FE81744 for ; Mon, 6 Apr 2020 15:59:04 +0000 (UTC) Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 6C540248E7 for ; Mon, 6 Apr 2020 15:59:04 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="Djfo/03q" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 6C540248E7 Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=bootlin.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20170209; h=Sender: Content-Transfer-Encoding:Content-Type:Cc:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-Id:Date:Subject:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=qPWxTh9HKYXE89Hyvljs+paooEiHvbl1+HsZ01kz5zQ=; b=Djfo/03qnZfier 8joDTkHcYCN0Rw9lFzUdZS1LvxF7YgvT3CkQ9Ncs0NWp5FVIh53LPeVos5CNiAD2J+Sv7T2AcGyFg 91dUkXmZcIAwMdqYWAUyToBwyuHBm6wfczi21pSdAMs2YMxIN3n7orq5dmCojBDSLEihYkbgfszRJ 4MWOjMOnHWqVTQWtYJygt3a/TW9a+gLMwlK8ajQFZxh04DPu0mup+IDgXLP67LGQhUXSPNwALhmEK T2nTmNYkIveRSXsiBGDGCRq+HQxvPAM/gyAOUko7/Xa2MZ7/pi4YlUaqsaUHWa9p2zySUl4sgljUh rRUggU6bqAFHSaxnFm6w==; Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1jLU9N-0008KZ-06; Mon, 06 Apr 2020 15:59:01 +0000 Received: from relay1-d.mail.gandi.net ([217.70.183.193]) by bombadil.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1jLU8r-0007o5-4l for linux-arm-kernel@lists.infradead.org; Mon, 06 Apr 2020 15:58:31 +0000 X-Originating-IP: 78.193.40.249 Received: from localhost (unknown [78.193.40.249]) (Authenticated sender: kamel.bouhara@bootlin.com) by relay1-d.mail.gandi.net (Postfix) with ESMTPSA id C8941240004; Mon, 6 Apr 2020 15:58:24 +0000 (UTC) From: Kamel Bouhara To: Dmitry Torokhov , William Breathitt Gray , Rob Herring , Mark Rutland Subject: [PATCH 1/3] counter: add an inkernel API Date: Mon, 6 Apr 2020 17:58:04 +0200 Message-Id: <20200406155806.1295169-2-kamel.bouhara@bootlin.com> X-Mailer: git-send-email 2.25.0 In-Reply-To: <20200406155806.1295169-1-kamel.bouhara@bootlin.com> References: <20200406155806.1295169-1-kamel.bouhara@bootlin.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20200406_085829_527898_E40D3A6A X-CRM114-Status: GOOD ( 20.88 ) X-Spam-Score: -0.7 (/) X-Spam-Report: SpamAssassin version 3.4.4 on bombadil.infradead.org summary: Content analysis details: (-0.7 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.7 RCVD_IN_DNSWL_LOW RBL: Sender listed at https://www.dnswl.org/, low trust [217.70.183.193 listed in list.dnswl.org] -0.0 RCVD_IN_MSPIKE_H3 RBL: Good reputation (+3) [217.70.183.193 listed in wl.mailspike.net] -0.0 SPF_PASS SPF: sender matches SPF record 0.0 SPF_HELO_NONE SPF: HELO does not publish an SPF Record -0.0 RCVD_IN_MSPIKE_WL Mailspike good senders X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: devicetree@vger.kernel.org, Alexandre Belloni , Kamel Bouhara , linux-iio@vger.kernel.org, linux-kernel@vger.kernel.org, Ludovic Desroches , Thomas Petazzoni , linux-input@vger.kernel.org, linux-arm-kernel@lists.infradead.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org Currently, counter devices are exposed directly to user-space through a sysfs interface. However, there are situations where it might makes sense for another kernel driver to use a counter handled by the counter subsystem. An example is the implementation of an input driver for a rotary encoder that is connected to hardware counters handled by the counter subsystem. This is very much like what happens with IIO subsystem, where ADC channels are directly accessible by user-space through sysfs, or can be used through the IIO in-kernel API by other kernel drivers, such as the adc-keys input keyboard driver. The proposed API is fairly simple: - devm_counter_get() allows a driver to get a reference to a counter device. From a Device Tree point of view, a counter-phandle property allows to indicate which counter device should be used. devm_counter_get() returns a reference to the counter_device structure. - counter_count_get() and counter_count_set() allow respectively to read and set a count value. - counter_function_get() and counter_function_set() allow to read and set the current count function. - counter_action_get() and counter_action_set allow to read and set the current count action/synapse. Signed-off-by: Kamel Bouhara --- drivers/counter/counter.c | 213 ++++++++++++++++++++++++++++++++++++++ include/linux/counter.h | 27 +++++ 2 files changed, 240 insertions(+) diff --git a/drivers/counter/counter.c b/drivers/counter/counter.c index 6a683d086008..f81d2d1dbca7 100644 --- a/drivers/counter/counter.c +++ b/drivers/counter/counter.c @@ -19,6 +19,7 @@ #include #include #include +#include const char *const counter_count_direction_str[2] = { [COUNTER_COUNT_DIRECTION_FORWARD] = "forward", @@ -1460,6 +1461,218 @@ static int devm_counter_match(struct device *dev, void *res, void *data) return *r == data; } +static int match(struct device *dev, const void *data) +{ + return (dev->of_node == data) && + (dev->type == &counter_device_type); +} + +/* Internal counter request function */ +static struct counter_device *counter_get(struct device *dev) +{ + struct device_node *np; + struct device *counter_dev; + struct counter_device_state *counter_ds; + struct counter_device *counter; + + /* Try DT lookup */ + np = of_parse_phandle(dev->of_node, "counter", 0); + if (!np) { + dev_dbg(dev, + "Looking up from device tree %pOF failed\n", np); + return ERR_PTR(-ENODEV); + } + + counter_dev = bus_find_device(&counter_bus_type, NULL, np, match); + of_node_put(np); + if (!counter_dev) + return ERR_PTR(-EPROBE_DEFER); + + counter_ds = to_counter_device_state(counter_dev); + + counter = dev_get_drvdata(&counter_ds->dev); + if (!counter) + return ERR_PTR(-ENODEV); + + /* Check if device is already owned otherwise set the busy bit */ + if (test_and_set_bit(COUNTER_BUSY_BIT_POS, &counter->flags)) { + pr_info("counter is busy\n"); + return ERR_PTR(-EBUSY); + } + + pr_info("counter acquired\n"); + get_device(&counter_ds->dev); + + return counter; +} + +static void devm_counter_release(struct device *dev, void *res) +{ + struct counter_device *counter = *(struct counter_device **)res; + + if (!counter) + return; + clear_bit(COUNTER_BUSY_BIT_POS, &counter->flags); + put_device(&counter->device_state->dev); +} + +/* + * devm_counter_get - Obtain an exclusive access to a counter. + * @dev: device for counter "consumer" + * + * Returns a struct counter_device matching the counter producer, or + * IS_ERR() condition containing errno. + * + */ +struct counter_device *devm_counter_get(struct device *dev) +{ + struct counter_device **ptr, *counter; + + ptr = devres_alloc(devm_counter_release, sizeof(*ptr), GFP_KERNEL); + if (!ptr) + return ERR_PTR(-ENOMEM); + + counter = counter_get(dev); + if (IS_ERR(counter)) { + devres_free(ptr); + return counter; + } + + *ptr = counter; + devres_add(dev, ptr); + + return counter; +} +EXPORT_SYMBOL_GPL(devm_counter_get); + +/* + * counter_action_get - get counter synapse mode + * @counter: counter device to operate with + * @action: pointer to store the current counter synapse mode + * returns: + * 0 on success, error code on failure. + */ +int counter_action_get(struct counter_device *counter, int *mode) +{ + struct counter_synapse *synapse = counter->counts->synapses; + size_t action_index; + int err; + + err = counter->ops->action_get(counter, counter->counts, synapse, + &action_index); + if (err) + return err; + + *mode = synapse->actions_list[action_index]; + + return 0; +} +EXPORT_SYMBOL_GPL(counter_action_get); + +/* + * counter_action_set - set counter device synapse + * @counter: counter device to operate with + * @action: enum of the synapse mode + * returns: + * 0 on success, error code on failure. + */ +int counter_action_set(struct counter_device *counter, + enum counter_synapse_action action) +{ + struct counter_synapse *synapse = counter->counts->synapses; + const size_t num_actions = synapse->num_actions; + size_t action_index; + + /* Find requested action mode */ + for (action_index = 0; action_index < num_actions; action_index++) { + if (action == synapse->actions_list[action_index]) + break; + } + + if (action_index >= num_actions) + return -EINVAL; + + return counter->ops->action_set(counter, counter->counts, synapse, + action_index); +} +EXPORT_SYMBOL_GPL(counter_action_set); + +/* + * counter_function_get - get the count function + * @counter: pointer to counter device to operate with + * @mode: pointer to store the current counter function mode + * returns: + * 0 on success, error code on failure. + */ +int counter_function_get(struct counter_device *counter, int *mode) +{ + size_t func_index; + int err; + + err = counter->ops->function_get(counter, counter->counts, + &func_index); + if (err) + return err; + + *mode = counter->counts->functions_list[func_index]; + + return 0; +} +EXPORT_SYMBOL_GPL(counter_function_get); + +/* + * counter_function_set - set a count function + * @counter: pointer to a counter device to operate with + * @function: enum of the function mode + * returns: + * 0 on success, error code on failure. + */ +int counter_function_set(struct counter_device *counter, + enum counter_count_function function) +{ + const size_t num_functions = counter->counts->num_functions; + size_t func_index; + + for (func_index = 0; func_index < num_functions; func_index++) { + if (function == counter->counts->functions_list[func_index]) + break; + } + + if (func_index >= num_functions) + return -EINVAL; + + return counter->ops->function_set(counter, counter->counts, func_index); +} +EXPORT_SYMBOL_GPL(counter_function_set); + +/* + * counter_count_set - set a count value + * @counter: pointer to the counter device to operate with + * @val: count value to write into the counter + * @len: length of the value written to the counter + * returns: + * bytes length of the value on success, error code on failure. + */ +size_t counter_count_set(struct counter_device *counter, + unsigned long val, size_t len) +{ + return counter->ops->count_write(counter, counter->counts, val); +} +EXPORT_SYMBOL_GPL(counter_count_set); + +/* + * counter_count_get - read the count value + * @counter: pointer to the counter device to operate with + * @val: pointer to store the count value + * returns: + * 0 on success, error code on failure. + */ +int counter_count_get(struct counter_device *counter, unsigned long *val) +{ + return counter->ops->count_read(counter, counter->counts, val); +} +EXPORT_SYMBOL_GPL(counter_count_get); + /** * devm_counter_unregister - Resource-managed counter_unregister * @dev: device this counter_device belongs to diff --git a/include/linux/counter.h b/include/linux/counter.h index 9dbd5df4cd34..81f63479be55 100644 --- a/include/linux/counter.h +++ b/include/linux/counter.h @@ -10,6 +10,8 @@ #include #include +#define COUNTER_BUSY_BIT_POS 1 + enum counter_count_direction { COUNTER_COUNT_DIRECTION_FORWARD = 0, COUNTER_COUNT_DIRECTION_BACKWARD @@ -290,6 +292,15 @@ struct counter_device_state { const struct attribute_group **groups; }; +/** + * to_counter_device_state - Returns a &struct counter_device_state + * from the &struct device embedded in it. + * + * @d:pointer to &struct device + */ +#define to_counter_device_state(d) \ + container_of(d, struct counter_device_state, dev) + enum counter_signal_value { COUNTER_SIGNAL_LOW = 0, COUNTER_SIGNAL_HIGH @@ -424,6 +435,7 @@ struct counter_device_enum_ext { * @num_counts: number of Counts specified in @counts * @ext: optional array of Counter device extensions * @num_ext: number of Counter device extensions specified in @ext + * @flags: internal device flags including a busy flag. * @priv: optional private data supplied by driver */ struct counter_device { @@ -440,6 +452,7 @@ struct counter_device { const struct counter_device_ext *ext; size_t num_ext; + unsigned long flags; void *priv; }; @@ -450,5 +463,19 @@ int devm_counter_register(struct device *dev, struct counter_device *const counter); void devm_counter_unregister(struct device *dev, struct counter_device *const counter); +/* inkernel interface */ +int __must_check counter_count_get(struct counter_device *counter, + unsigned long *val); +size_t __must_check counter_count_set(struct counter_device *counter, + unsigned long val, size_t len); +int __must_check counter_function_get(struct counter_device *counter, + int *mode); +int __must_check counter_function_set(struct counter_device *counter, + enum counter_count_function function); +int __must_check counter_action_get(struct counter_device *counter, + int *mode); +int __must_check counter_action_set(struct counter_device *counter, + enum counter_synapse_action action); +struct counter_device *__must_check devm_counter_get(struct device *dev); #endif /* _COUNTER_H_ */