Received: by 10.223.185.111 with SMTP id b44csp635516wrg; Fri, 9 Mar 2018 10:44:25 -0800 (PST) X-Google-Smtp-Source: AG47ELvfz6fjM5QtQg8Okw/ZXAu2hRYnzYoNFz473a0Bht1K8izRati5Yz0WHnDUx+773onaF5Yu X-Received: by 2002:a17:902:2e83:: with SMTP id r3-v6mr28971399plb.84.1520621065132; Fri, 09 Mar 2018 10:44:25 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1520621065; cv=none; d=google.com; s=arc-20160816; b=pBxz+0Sl8lntq8bnAuN46F+owwDwhVjKWrSnIHl49fp4I7cWTWOZpi17sg7RlrXduJ BaCweuWlKB9OPiI5SXFGgQ5K9wB3wxkxgWXbgBMw/46vO9R5TGIAOmqzGWEjtyy5U8EV 2gFpdPvbx2Bm/N8vchlxj9j/pMRsRXL1ke0ZsF7LriHAle41gtt5DG1xtg9GBQ+05hdf ZVyv07hJco8w+9YXtJezQdhNTUMYaa9sgu2ZilYpV79JCoUQGM7kaOuALTAA4+bLYEI6 NOiVo45oUxPjd45fX9vA7oEh1fPGYA5qanyTLQJri26YW/qQ/zG7JvG8ggI0hn71D6Hm jfcg== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:references:in-reply-to:message-id:date :subject:cc:to:from:dkim-signature:arc-authentication-results; bh=IXLYTC9Vjd78RQlUoIhDWXnqYON8VRvwPn71/QKUaGU=; b=0HxhrGLCwNvoBlFJOyin7MZr+dOUemtnfutmfb6l1I8DKwmGTFlL5duHXh0IyXYMcm A0aoO5FUAznq3HUN5saocfa8ScfPNTKvdq2SEXuvs1HkmpmsPW6CLpevPBFohVk0aaMg k9vigegMLRagxucg3nYNVphwBfftMFOfWJwpMXjIlSWsWlFZPzAH9lTKP5pSTrsVU+aT n+ybhOcSklbCkX81v/2Thjze82pQLdFeTPAaoY+Fag4SdR8Y+v9O9lYwQyFyhUXcadk7 K7pAWVBRRP0b+uyEYnAkb138KtI11jSSgLGfBO/MnJFEtpBaDSLXHQbdDUZuWqGIwjE0 JCkg== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@gmail.com header.s=20161025 header.b=npiY1FHT; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmail.com Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id x70si1076925pgd.724.2018.03.09.10.44.10; Fri, 09 Mar 2018 10:44:25 -0800 (PST) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@gmail.com header.s=20161025 header.b=npiY1FHT; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmail.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S932439AbeCISme (ORCPT + 99 others); Fri, 9 Mar 2018 13:42:34 -0500 Received: from mail-yw0-f193.google.com ([209.85.161.193]:45487 "EHLO mail-yw0-f193.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751788AbeCISmb (ORCPT ); Fri, 9 Mar 2018 13:42:31 -0500 Received: by mail-yw0-f193.google.com with SMTP id s199so1493005ywg.12; Fri, 09 Mar 2018 10:42:31 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=IXLYTC9Vjd78RQlUoIhDWXnqYON8VRvwPn71/QKUaGU=; b=npiY1FHThEo1+ChiM8oPqst0Ap+T1InBxTEl07Efy9QzSge3v/N1mhPtFF67aJDniZ LjnTMqQiotqjPKo/b0x1d97SbzkBj854iS9+tH+DwZPPyuc1RzOplyCJ+gR61mL8Tkcp 8ikf9bh/lIgAlBiuRiS82o2LOxGjc1jwSj8nX/CZIQYa8jO0Kw0j0Qrke9wXhZFgjEFS b0cVPcWlAbMlXiXQnkoEs2Z55tFg5BANSW/BmiL69bqB3BAhcstAsMjKpuNo7t+1HaId wOuMcKJzU0mu4v5q3p9MR13mXIjXm4Mc5vp6iSgMBMGsrVqB/6a0ZFjoMhAH9x9ztFTW uKuA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=IXLYTC9Vjd78RQlUoIhDWXnqYON8VRvwPn71/QKUaGU=; b=C66XmhWYOpCqGVxyl/nzySEmBtCOdzCJS+6uCUoz5X4Dasst7zVtELHPwR6u2e3BIg eTIOENwZpxLN19xYB6VySrfMKl3ubWd6CdOr2Kd60OK8+uHL3U0jhJUDoHXnzdL/FzDB wSrK2foS5iViiZSzXmjz5bLRug9vyBwyr4ECns/39K4H+nI2iuhL3pceB76SuCLizgAf dvBMngBS19G8T0fDQRhZFIt+gzC+AuhGHFV2XaV7A+SQo6sVMR5w5rkLAKZt6xYR7i98 ZYl6LaBg85NsH2/7blvkwBTQLRRFzsnc38eHo2IJV5/EO3n6dzk4v0XIVZNx/hw0JjN4 S4Iw== X-Gm-Message-State: AElRT7GuOpvX0cGSLyYsAIg7VRzVUfH5WIu/sdFJCYx5uudAfOWjorap KqOzZRHIhKZYtFCDMUhd+Do= X-Received: by 2002:a25:44d4:: with SMTP id r203-v6mr4670079yba.28.1520620949468; Fri, 09 Mar 2018 10:42:29 -0800 (PST) Received: from localhost ([72.188.97.40]) by smtp.gmail.com with ESMTPSA id c9sm564816ywh.83.2018.03.09.10.42.28 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Fri, 09 Mar 2018 10:42:29 -0800 (PST) From: William Breathitt Gray To: jic23@kernel.org, knaack.h@gmx.de, lars@metafoo.de, pmeerw@pmeerw.net Cc: benjamin.gaignard@st.com, linux-iio@vger.kernel.org, linux-kernel@vger.kernel.org, William Breathitt Gray Subject: [PATCH v5 1/8] counter: Introduce the Generic Counter interface Date: Fri, 9 Mar 2018 13:42:23 -0500 Message-Id: X-Mailer: git-send-email 2.16.2 In-Reply-To: References: Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org This patch introduces the Generic Counter interface for supporting counter devices. In the context of the Generic Counter interface, a counter is defined as a device that reports one or more "counts" based on the state changes of one or more "signals" as evaluated by a defined "count function." Driver callbacks should be provided to communicate with the device: to read and write various Signals and Counts, and to set and get the "action mode" and "count function" for various Synapses and Counts respectively. To support a counter device, a driver must first allocate the available Counter Signals via counter_signal structures. These Signals should be stored as an array and set to the signals array member of an allocated counter_device structure before the Counter is registered to the system. Counter Counts may be allocated via counter_count structures, and respective Counter Signal associations (Synapses) made via counter_synapse structures. Associated counter_synapse structures are stored as an array and set to the the synapses array member of the respective counter_count structure. These counter_count structures are set to the counts array member of an allocated counter_device structure before the Counter is registered to the system. A counter device is registered to the system by passing the respective initialized counter_device structure to the counter_register function; similarly, the counter_unregister function unregisters the respective Counter. The devm_counter_register and devm_counter_unregister functions serve as device memory-managed versions of the counter_register and counter_unregister functions respectively. Signed-off-by: William Breathitt Gray --- MAINTAINERS | 7 + drivers/Kconfig | 2 + drivers/Makefile | 1 + drivers/{iio => }/counter/104-quad-8.c | 0 drivers/{iio => }/counter/Kconfig | 23 +- drivers/{iio => }/counter/Makefile | 5 +- drivers/counter/generic-counter.c | 1416 +++++++++++++++++++++++++ drivers/{iio => }/counter/stm32-lptimer-cnt.c | 0 drivers/iio/Kconfig | 1 - drivers/iio/Makefile | 1 - include/linux/counter.h | 524 +++++++++ 11 files changed, 1973 insertions(+), 7 deletions(-) rename drivers/{iio => }/counter/104-quad-8.c (100%) rename drivers/{iio => }/counter/Kconfig (56%) rename drivers/{iio => }/counter/Makefile (62%) create mode 100644 drivers/counter/generic-counter.c rename drivers/{iio => }/counter/stm32-lptimer-cnt.c (100%) create mode 100644 include/linux/counter.h diff --git a/MAINTAINERS b/MAINTAINERS index 885d20072d97..2be01a95b7a5 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -3668,6 +3668,13 @@ W: http://www.fi.muni.cz/~kas/cosa/ S: Maintained F: drivers/net/wan/cosa* +COUNTER SUBSYSTEM +M: William Breathitt Gray +L: linux-iio@vger.kernel.org +S: Maintained +F: drivers/counter/ +F: include/linux/counter.h + CPMAC ETHERNET DRIVER M: Florian Fainelli L: netdev@vger.kernel.org diff --git a/drivers/Kconfig b/drivers/Kconfig index 879dc0604cba..21a67f49c17b 100644 --- a/drivers/Kconfig +++ b/drivers/Kconfig @@ -165,6 +165,8 @@ source "drivers/memory/Kconfig" source "drivers/iio/Kconfig" +source "drivers/counter/Kconfig" + source "drivers/ntb/Kconfig" source "drivers/vme/Kconfig" diff --git a/drivers/Makefile b/drivers/Makefile index 24cd47014657..5914c78688c3 100644 --- a/drivers/Makefile +++ b/drivers/Makefile @@ -165,6 +165,7 @@ obj-$(CONFIG_PM_DEVFREQ) += devfreq/ obj-$(CONFIG_EXTCON) += extcon/ obj-$(CONFIG_MEMORY) += memory/ obj-$(CONFIG_IIO) += iio/ +obj-$(CONFIG_COUNTER) += counter/ obj-$(CONFIG_VME_BUS) += vme/ obj-$(CONFIG_IPACK_BUS) += ipack/ obj-$(CONFIG_NTB) += ntb/ diff --git a/drivers/iio/counter/104-quad-8.c b/drivers/counter/104-quad-8.c similarity index 100% rename from drivers/iio/counter/104-quad-8.c rename to drivers/counter/104-quad-8.c diff --git a/drivers/iio/counter/Kconfig b/drivers/counter/Kconfig similarity index 56% rename from drivers/iio/counter/Kconfig rename to drivers/counter/Kconfig index 474e1ac4e7c0..0b28d3ff524b 100644 --- a/drivers/iio/counter/Kconfig +++ b/drivers/counter/Kconfig @@ -3,11 +3,25 @@ # # When adding new entries keep the list in alphabetical order -menu "Counters" +menuconfig COUNTER + tristate "Counter support" + help + Provides Generic Counter interface support for counter devices. + + Counter devices are prevalent within a diverse spectrum of industries. + The ubiquitous presence of these devices necessitates a common + interface and standard of interaction and exposure. This driver API + attempts to resolve the issue of duplicate code found among existing + counter device drivers by providing a generic counter interface for + consumption. The Generic Counter interface enables drivers to support + and expose a common set of components and functionality present in + counter devices. + +if COUNTER config 104_QUAD_8 tristate "ACCES 104-QUAD-8 driver" - depends on PC104 && X86 && ISA_BUS_API + depends on PC104 && X86 && ISA_BUS_API && IIO help Say yes here to build support for the ACCES 104-QUAD-8 quadrature encoder counter/interface device family (104-QUAD-8, 104-QUAD-4). @@ -23,11 +37,12 @@ config 104_QUAD_8 config STM32_LPTIMER_CNT tristate "STM32 LP Timer encoder counter driver" - depends on MFD_STM32_LPTIMER || COMPILE_TEST + depends on (MFD_STM32_LPTIMER || COMPILE_TEST) && IIO help Select this option to enable STM32 Low-Power Timer quadrature encoder and counter driver. To compile this driver as a module, choose M here: the module will be called stm32-lptimer-cnt. -endmenu + +endif # COUNTER diff --git a/drivers/iio/counter/Makefile b/drivers/counter/Makefile similarity index 62% rename from drivers/iio/counter/Makefile rename to drivers/counter/Makefile index 1b9a896eb488..d721a40aa4a2 100644 --- a/drivers/iio/counter/Makefile +++ b/drivers/counter/Makefile @@ -1,8 +1,11 @@ # -# Makefile for IIO counter devices +# Makefile for Counter devices # # When adding new entries keep the list in alphabetical order +obj-$(CONFIG_COUNTER) += counter.o +counter-y := generic-counter.o + obj-$(CONFIG_104_QUAD_8) += 104-quad-8.o obj-$(CONFIG_STM32_LPTIMER_CNT) += stm32-lptimer-cnt.o diff --git a/drivers/counter/generic-counter.c b/drivers/counter/generic-counter.c new file mode 100644 index 000000000000..03803356aac8 --- /dev/null +++ b/drivers/counter/generic-counter.c @@ -0,0 +1,1416 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Generic Counter interface + * Copyright (C) 2017 William Breathitt Gray + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License, version 2, as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but + * WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * General Public License for more details. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +ssize_t counter_signal_enum_read(struct counter_device *counter, + struct counter_signal *signal, void *priv, char *buf) +{ + const struct counter_signal_enum_ext *const e = priv; + int err; + size_t index; + + if (!e->get) + return -EINVAL; + + err = e->get(counter, signal, &index); + if (err) + return err; + + if (index >= e->num_items) + return -EINVAL; + + return scnprintf(buf, PAGE_SIZE, "%s\n", e->items[index]); +} +EXPORT_SYMBOL(counter_signal_enum_read); + +ssize_t counter_signal_enum_write(struct counter_device *counter, + struct counter_signal *signal, void *priv, const char *buf, size_t len) +{ + const struct counter_signal_enum_ext *const e = priv; + ssize_t index; + int err; + + if (!e->set) + return -EINVAL; + + index = __sysfs_match_string(e->items, e->num_items, buf); + if (index < 0) + return index; + + err = e->set(counter, signal, index); + if (err) + return err; + + return len; +} +EXPORT_SYMBOL(counter_signal_enum_write); + +ssize_t counter_signal_enum_available_read(struct counter_device *counter, + struct counter_signal *signal, void *priv, char *buf) +{ + const struct counter_signal_enum_ext *const e = priv; + size_t i; + size_t len = 0; + + if (!e->num_items) + return 0; + + for (i = 0; i < e->num_items; i++) + len += scnprintf(buf + len, PAGE_SIZE - len, "%s\n", + e->items[i]); + + return len; +} +EXPORT_SYMBOL(counter_signal_enum_available_read); + +ssize_t counter_count_enum_read(struct counter_device *counter, + struct counter_count *count, void *priv, char *buf) +{ + const struct counter_count_enum_ext *const e = priv; + int err; + size_t index; + + if (!e->get) + return -EINVAL; + + err = e->get(counter, count, &index); + if (err) + return err; + + if (index >= e->num_items) + return -EINVAL; + + return scnprintf(buf, PAGE_SIZE, "%s\n", e->items[index]); +} +EXPORT_SYMBOL(counter_count_enum_read); + +ssize_t counter_count_enum_write(struct counter_device *counter, + struct counter_count *count, void *priv, const char *buf, size_t len) +{ + const struct counter_count_enum_ext *const e = priv; + ssize_t index; + int err; + + if (!e->set) + return -EINVAL; + + index = __sysfs_match_string(e->items, e->num_items, buf); + if (index < 0) + return index; + + err = e->set(counter, count, index); + if (err) + return err; + + return len; +} +EXPORT_SYMBOL(counter_count_enum_write); + +ssize_t counter_count_enum_available_read(struct counter_device *counter, + struct counter_count *count, void *priv, char *buf) +{ + const struct counter_count_enum_ext *const e = priv; + size_t i; + size_t len = 0; + + if (!e->num_items) + return 0; + + for (i = 0; i < e->num_items; i++) + len += scnprintf(buf + len, PAGE_SIZE - len, "%s\n", + e->items[i]); + + return len; +} +EXPORT_SYMBOL(counter_count_enum_available_read); + +ssize_t counter_device_enum_read(struct counter_device *counter, void *priv, + char *buf) +{ + const struct counter_device_enum_ext *const e = priv; + int err; + size_t index; + + if (!e->get) + return -EINVAL; + + err = e->get(counter, &index); + if (err) + return err; + + if (index >= e->num_items) + return -EINVAL; + + return scnprintf(buf, PAGE_SIZE, "%s\n", e->items[index]); +} +EXPORT_SYMBOL(counter_device_enum_read); + +ssize_t counter_device_enum_write(struct counter_device *counter, void *priv, + const char *buf, size_t len) +{ + const struct counter_device_enum_ext *const e = priv; + ssize_t index; + int err; + + if (!e->set) + return -EINVAL; + + index = __sysfs_match_string(e->items, e->num_items, buf); + if (index < 0) + return index; + + err = e->set(counter, index); + if (err) + return err; + + return len; +} +EXPORT_SYMBOL(counter_device_enum_write); + +ssize_t counter_device_enum_available_read(struct counter_device *counter, + void *priv, char *buf) +{ + const struct counter_device_enum_ext *const e = priv; + size_t i; + size_t len = 0; + + if (!e->num_items) + return 0; + + for (i = 0; i < e->num_items; i++) + len += scnprintf(buf + len, PAGE_SIZE - len, "%s\n", + e->items[i]); + + return len; +} +EXPORT_SYMBOL(counter_device_enum_available_read); + +static const char *const signal_level_str[] = { + [SIGNAL_LEVEL_LOW] = "low", + [SIGNAL_LEVEL_HIGH] = "high" +}; + +/** + * set_signal_read_value - set signal_read_value data + * @val: signal_read_value structure to set + * @type: property Signal data represents + * @data: Signal data + * + * This function sets an opaque signal_read_value structure with the provided + * Signal data. + */ +void set_signal_read_value(struct signal_read_value *const val, + const enum signal_value_type type, void *const data) +{ + if (type == SIGNAL_LEVEL) + val->len = scnprintf(val->buf, PAGE_SIZE, "%s\n", + signal_level_str[*(enum signal_level *)data]); + else + val->len = 0; +} +EXPORT_SYMBOL(set_signal_read_value); + +/** + * set_count_read_value - set count_read_value data + * @val: count_read_value structure to set + * @type: property Count data represents + * @data: Count data + * + * This function sets an opaque count_read_value structure with the provided + * Count data. + */ +void set_count_read_value(struct count_read_value *const val, + const enum count_value_type type, void *const data) +{ + switch (type) { + case COUNT_POSITION_UNSIGNED: + val->len = scnprintf(val->buf, PAGE_SIZE, "%lu\n", + *(unsigned long *)data); + break; + case COUNT_POSITION_SIGNED: + val->len = scnprintf(val->buf, PAGE_SIZE, "%ld\n", + *(long *)data); + break; + default: + val->len = 0; + } +} +EXPORT_SYMBOL(set_count_read_value); + +/** + * get_count_write_value - get count_write_value data + * @data: Count data + * @type: property Count data represents + * @val: count_write_value structure containing data + * + * This function extracts Count data from the provided opaque count_write_value + * structure and stores it at the address provided by @data. + * + * RETURNS: + * 0 on success, negative error number on failure. + */ +int get_count_write_value(void *const data, + const enum count_value_type type, + const struct count_write_value *const val) +{ + int err; + + switch (type) { + case COUNT_POSITION_UNSIGNED: + err = kstrtoul(val->buf, 0, data); + if (err) + return err; + break; + case COUNT_POSITION_SIGNED: + err = kstrtol(val->buf, 0, data); + if (err) + return err; + break; + } + + return 0; +} +EXPORT_SYMBOL(get_count_write_value); + +struct counter_device_attr { + struct device_attribute dev_attr; + struct list_head l; + void *component; +}; + +static int counter_attribute_create( + struct counter_device_attr_group *const group, + const char *const prefix, + const char *const name, + ssize_t (*show)(struct device *dev, struct device_attribute *attr, + char *buf), + ssize_t (*store)(struct device *dev, struct device_attribute *attr, + const char *buf, size_t len), + void *const component) +{ + struct counter_device_attr *counter_attr; + struct device_attribute *dev_attr; + int err; + struct list_head *const attr_list = &group->attr_list; + + /* Allocate a Counter device attribute */ + counter_attr = kzalloc(sizeof(*counter_attr), GFP_KERNEL); + if (!counter_attr) + return -ENOMEM; + dev_attr = &counter_attr->dev_attr; + + sysfs_attr_init(&dev_attr->attr); + + /* Configure device attribute */ + dev_attr->attr.name = kasprintf(GFP_KERNEL, "%s%s", prefix, name); + if (!dev_attr->attr.name) { + err = -ENOMEM; + goto err_free_counter_attr; + } + if (show) { + dev_attr->attr.mode |= 0444; + dev_attr->show = show; + } + if (store) { + dev_attr->attr.mode |= 0200; + dev_attr->store = store; + } + + /* Store associated Counter component with attribute */ + counter_attr->component = component; + + /* Keep track of the attribute for later cleanup */ + list_add(&counter_attr->l, attr_list); + group->num_attr++; + + return 0; + +err_free_counter_attr: + kfree(counter_attr); + return err; +} + +#define to_counter_attr(_dev_attr) \ + container_of(_dev_attr, struct counter_device_attr, dev_attr) + +struct signal_comp_t { + struct counter_signal *signal; +}; + +static ssize_t counter_signal_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct counter_device *const counter = dev_get_drvdata(dev); + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct signal_comp_t *const component = devattr->component; + struct counter_signal *const signal = component->signal; + int err; + struct signal_read_value val = { .buf = buf }; + + err = counter->signal_read(counter, signal, &val); + if (err) + return err; + + return val.len; +} + +struct name_comp_t { + const char *name; +}; + +static ssize_t counter_device_attr_name_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + const struct name_comp_t *const comp = to_counter_attr(attr)->component; + + return scnprintf(buf, PAGE_SIZE, "%s\n", comp->name); +} + +struct signal_ext_comp_t { + struct counter_signal *signal; + const struct counter_signal_ext *ext; +}; + +static ssize_t counter_signal_ext_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct signal_ext_comp_t *const component = devattr->component; + const struct counter_signal_ext *const ext = component->ext; + struct counter_device *const counter = dev_get_drvdata(dev); + struct counter_signal *const signal = component->signal; + + return ext->read(counter, signal, ext->priv, buf); +} + +static ssize_t counter_signal_ext_store(struct device *dev, + struct device_attribute *attr, const char *buf, size_t len) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct signal_ext_comp_t *const component = devattr->component; + const struct counter_signal_ext *const ext = component->ext; + struct counter_device *const counter = dev_get_drvdata(dev); + struct counter_signal *const signal = component->signal; + + return ext->write(counter, signal, ext->priv, buf, len); +} + +static int counter_signal_ext_register( + struct counter_device_attr_group *const group, + struct counter_signal *const signal) +{ + const size_t num_ext = signal->num_ext; + size_t i; + const struct counter_signal_ext *ext; + struct signal_ext_comp_t *signal_ext_comp; + int err; + + /* Return early if no extensions */ + if (!signal->ext || !num_ext) + return 0; + + /* Create an attribute for each extension */ + for (i = 0 ; i < num_ext; i++) { + ext = signal->ext + i; + + /* Allocate signal_ext attribute component */ + signal_ext_comp = kmalloc(sizeof(*signal_ext_comp), GFP_KERNEL); + if (!signal_ext_comp) + return -ENOMEM; + signal_ext_comp->signal = signal; + signal_ext_comp->ext = ext; + + /* Allocate a Counter device attribute */ + err = counter_attribute_create(group, "", ext->name, + (ext->read) ? counter_signal_ext_show : NULL, + (ext->write) ? counter_signal_ext_store : NULL, + signal_ext_comp); + if (err) { + kfree(signal_ext_comp); + return err; + } + } + + return 0; +} + +static int counter_signal_attributes_create( + struct counter_device_attr_group *const group, + const struct counter_device *const counter, + struct counter_signal *const signal) +{ + struct signal_comp_t *signal_comp; + int err; + struct name_comp_t *name_comp; + + /* Allocate Signal attribute component */ + signal_comp = kmalloc(sizeof(*signal_comp), GFP_KERNEL); + if (!signal_comp) + return -ENOMEM; + signal_comp->signal = signal; + + /* Create main Signal attribute */ + err = counter_attribute_create(group, "", "signal", + (counter->signal_read) ? counter_signal_show : NULL, NULL, + signal_comp); + if (err) { + kfree(signal_comp); + return err; + } + + /* Create Signal name attribute */ + if (signal->name) { + /* Allocate name attribute component */ + name_comp = kmalloc(sizeof(*name_comp), GFP_KERNEL); + if (!name_comp) + return -ENOMEM; + name_comp->name = signal->name; + + /* Allocate Signal name attribute */ + err = counter_attribute_create(group, "", "name", + counter_device_attr_name_show, NULL, name_comp); + if (err) { + kfree(name_comp); + return err; + } + } + + /* Register Signal extension attributes */ + return counter_signal_ext_register(group, signal); +} + +static int counter_signals_register( + struct counter_device_attr_group *const groups_list, + const struct counter_device *const counter) +{ + const size_t num_signals = counter->num_signals; + struct counter_device_state *const device_state = counter->device_state; + struct device *const dev = &device_state->dev; + size_t i; + struct counter_signal *signal; + const char *name; + int err; + + /* At least one Signal must be defined */ + if (!counter->signals || !num_signals) { + dev_err(dev, "Signals undefined\n"); + return -EINVAL; + } + + /* Register each Signal */ + for (i = 0; i < num_signals; i++) { + signal = counter->signals + i; + + /* Generate Signal attribute directory name */ + name = kasprintf(GFP_KERNEL, "signal%d", signal->id); + if (!name) + return -ENOMEM; + + groups_list[i].attr_group.name = name; + + /* Create all attributes associated with Signal */ + err = counter_signal_attributes_create(groups_list + i, counter, + signal); + if (err) + return err; + } + + return 0; +} + +static const char *const synapse_action_str[] = { + [SYNAPSE_ACTION_NONE] = "none", + [SYNAPSE_ACTION_RISING_EDGE] = "rising edge", + [SYNAPSE_ACTION_FALLING_EDGE] = "falling edge", + [SYNAPSE_ACTION_BOTH_EDGES] = "both edges" +}; + +struct action_comp_t { + struct counter_synapse *synapse; + struct counter_count *count; +}; + +static ssize_t counter_action_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + int err; + struct counter_device *const counter = dev_get_drvdata(dev); + const struct action_comp_t *const component = devattr->component; + struct counter_count *const count = component->count; + struct counter_synapse *const synapse = component->synapse; + size_t action_index; + enum synapse_action action; + + err = counter->action_get(counter, count, synapse, &action_index); + if (err) + return err; + + synapse->action = action_index; + + action = synapse->actions_list[action_index]; + return scnprintf(buf, PAGE_SIZE, "%s\n", synapse_action_str[action]); +} + +static ssize_t counter_action_store(struct device *dev, + struct device_attribute *attr, const char *buf, size_t len) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct action_comp_t *const component = devattr->component; + struct counter_synapse *const synapse = component->synapse; + size_t action_index; + const size_t num_actions = synapse->num_actions; + enum synapse_action action; + int err; + struct counter_device *const counter = dev_get_drvdata(dev); + struct counter_count *const count = component->count; + + /* Find requested action mode */ + for (action_index = 0; action_index < num_actions; action_index++) { + action = synapse->actions_list[action_index]; + if (sysfs_streq(buf, synapse_action_str[action])) + break; + } + /* If requested action mode not found */ + if (action_index >= num_actions) + return -EINVAL; + + err = counter->action_set(counter, count, synapse, action_index); + if (err) + return err; + + synapse->action = action_index; + + return len; +} + +struct action_avail_comp_t { + const enum synapse_action *actions_list; + size_t num_actions; +}; + +static ssize_t counter_synapse_action_available_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct action_avail_comp_t *const component = devattr->component; + const enum synapse_action *const actions_list = component->actions_list; + const size_t num_actions = component->num_actions; + size_t i; + enum synapse_action action; + ssize_t len = 0; + + for (i = 0; i < num_actions; i++) { + action = actions_list[i]; + len += scnprintf(buf + len, PAGE_SIZE - len, "%s\n", + synapse_action_str[action]); + } + + return len; +} + +static int counter_synapses_register( + struct counter_device_attr_group *const group, + const struct counter_device *const counter, + struct counter_count *const count, const char *const count_attr_name) +{ + const size_t num_synapses = count->num_synapses; + struct device *const dev = &counter->device_state->dev; + size_t i; + struct counter_synapse *synapse; + const char *prefix; + struct action_comp_t *action_comp; + int err; + struct action_avail_comp_t *avail_comp; + + /* At least one Synapse must be defined */ + if (!count->synapses || !num_synapses) { + dev_err(dev, "Count '%d' Synapses undefined\n", count->id); + return -EINVAL; + } + + /* Register each Synapse */ + for (i = 0; i < num_synapses; i++) { + synapse = count->synapses + i; + + /* Ensure all Synapses have a defined Signal */ + if (!synapse->signal) { + dev_err(dev, + "Count '%d' Synapse '%zu' Signal undefined\n", + count->id, i); + return -EINVAL; + } + + /* At least one action mode must be defined for each Synapse */ + if (!synapse->actions_list || !synapse->num_actions) { + dev_err(dev, + "Count '%d' Signal '%d' action modes undefined\n", + count->id, synapse->signal->id); + return -EINVAL; + } + + /* Generate attribute prefix */ + prefix = kasprintf(GFP_KERNEL, "signal%d_", + synapse->signal->id); + if (!prefix) + return -ENOMEM; + + /* Allocate action attribute component */ + action_comp = kmalloc(sizeof(*action_comp), GFP_KERNEL); + if (!action_comp) { + err = -ENOMEM; + goto err_free_prefix; + } + action_comp->synapse = synapse; + action_comp->count = count; + + /* Create action attribute */ + err = counter_attribute_create(group, prefix, "action", + (counter->action_get) ? counter_action_show : NULL, + (counter->action_set) ? counter_action_store : NULL, + action_comp); + if (err) { + kfree(action_comp); + goto err_free_prefix; + } + + /* Allocate action available attribute component */ + avail_comp = kmalloc(sizeof(*avail_comp), GFP_KERNEL); + if (!avail_comp) { + err = -ENOMEM; + goto err_free_prefix; + } + avail_comp->actions_list = synapse->actions_list; + avail_comp->num_actions = synapse->num_actions; + + /* Create action_available attribute */ + err = counter_attribute_create(group, prefix, + "action_available", + counter_synapse_action_available_show, NULL, + avail_comp); + if (err) { + kfree(avail_comp); + goto err_free_prefix; + } + + kfree(prefix); + } + + return 0; + +err_free_prefix: + kfree(prefix); + return err; +} + +struct count_comp_t { + struct counter_count *count; +}; + +static ssize_t counter_count_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct counter_device *const counter = dev_get_drvdata(dev); + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct count_comp_t *const component = devattr->component; + struct counter_count *const count = component->count; + int err; + struct count_read_value val = { .buf = buf }; + + err = counter->count_read(counter, count, &val); + if (err) + return err; + + return val.len; +} + +static ssize_t counter_count_store(struct device *dev, + struct device_attribute *attr, const char *buf, size_t len) +{ + struct counter_device *const counter = dev_get_drvdata(dev); + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct count_comp_t *const component = devattr->component; + struct counter_count *const count = component->count; + int err; + struct count_write_value val = { .buf = buf }; + + err = counter->count_write(counter, count, &val); + if (err) + return err; + + return len; +} + +static const char *const count_function_str[] = { + [COUNT_FUNCTION_INCREASE] = "increase", + [COUNT_FUNCTION_DECREASE] = "decrease", + [COUNT_FUNCTION_PULSE_DIRECTION] = "pulse-direction", + [COUNT_FUNCTION_QUADRATURE_X1] = "quadrature x1", + [COUNT_FUNCTION_QUADRATURE_X2] = "quadrature x2", + [COUNT_FUNCTION_QUADRATURE_X4] = "quadrature x4" +}; + +static ssize_t counter_function_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + int err; + struct counter_device *const counter = dev_get_drvdata(dev); + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct count_comp_t *const component = devattr->component; + struct counter_count *const count = component->count; + size_t func_index; + enum count_function function; + + err = counter->function_get(counter, count, &func_index); + if (err) + return err; + + count->function = func_index; + + function = count->functions_list[func_index]; + return scnprintf(buf, PAGE_SIZE, "%s\n", count_function_str[function]); +} + +static ssize_t counter_function_store(struct device *dev, + struct device_attribute *attr, const char *buf, size_t len) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct count_comp_t *const component = devattr->component; + struct counter_count *const count = component->count; + const size_t num_functions = count->num_functions; + size_t func_index; + enum count_function function; + int err; + struct counter_device *const counter = dev_get_drvdata(dev); + + /* Find requested Count function mode */ + for (func_index = 0; func_index < num_functions; func_index++) { + function = count->functions_list[func_index]; + if (sysfs_streq(buf, count_function_str[function])) + break; + } + /* Return error if requested Count function mode not found */ + if (func_index >= num_functions) + return -EINVAL; + + err = counter->function_set(counter, count, func_index); + if (err) + return err; + + count->function = func_index; + + return len; +} + +struct count_ext_comp_t { + struct counter_count *count; + const struct counter_count_ext *ext; +}; + +static ssize_t counter_count_ext_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct count_ext_comp_t *const comp = devattr->component; + const struct counter_count_ext *const ext = comp->ext; + struct counter_device *const counter = dev_get_drvdata(dev); + struct counter_count *const count = comp->count; + + return ext->read(counter, count, ext->priv, buf); +} + +static ssize_t counter_count_ext_store(struct device *dev, + struct device_attribute *attr, const char *buf, size_t len) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct count_ext_comp_t *const comp = devattr->component; + const struct counter_count_ext *const ext = comp->ext; + struct counter_device *const counter = dev_get_drvdata(dev); + struct counter_count *const count = comp->count; + + return ext->write(counter, count, ext->priv, buf, len); +} + +static int counter_count_ext_register( + struct counter_device_attr_group *const group, + struct counter_count *const count) +{ + const size_t num_ext = count->num_ext; + size_t i; + const struct counter_count_ext *ext; + struct count_ext_comp_t *count_ext_comp; + int err; + + /* Return early if no extensions */ + if (!count->ext || !num_ext) + return 0; + + /* Create an attribute for each extension */ + for (i = 0 ; i < num_ext; i++) { + ext = count->ext + i; + + /* Allocate count_ext attribute component */ + count_ext_comp = kmalloc(sizeof(*count_ext_comp), GFP_KERNEL); + if (!count_ext_comp) + return -ENOMEM; + count_ext_comp->count = count; + count_ext_comp->ext = ext; + + /* Allocate count_ext attribute */ + err = counter_attribute_create(group, "", ext->name, + (ext->read) ? counter_count_ext_show : NULL, + (ext->write) ? counter_count_ext_store : NULL, + count_ext_comp); + if (err) { + kfree(count_ext_comp); + return err; + } + } + + return 0; +} + +struct func_avail_comp_t { + const enum count_function *functions_list; + size_t num_functions; +}; + +static ssize_t counter_count_function_available_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct func_avail_comp_t *const component = devattr->component; + const enum count_function *const func_list = component->functions_list; + const size_t num_functions = component->num_functions; + size_t i; + enum count_function function; + ssize_t len = 0; + + for (i = 0; i < num_functions; i++) { + function = func_list[i]; + len += scnprintf(buf + len, PAGE_SIZE - len, "%s\n", + count_function_str[function]); + } + + return len; +} + +static int counter_count_attributes_create( + struct counter_device_attr_group *const group, + const struct counter_device *const counter, + struct counter_count *const count) +{ + struct count_comp_t *count_comp; + int err; + struct count_comp_t *func_comp; + struct func_avail_comp_t *avail_comp; + struct name_comp_t *name_comp; + + /* Allocate count attribute component */ + count_comp = kmalloc(sizeof(*count_comp), GFP_KERNEL); + if (!count_comp) + return -ENOMEM; + count_comp->count = count; + + /* Create main Count attribute */ + err = counter_attribute_create(group, "", "count", + (counter->count_read) ? counter_count_show : NULL, + (counter->count_write) ? counter_count_store : NULL, + count_comp); + if (err) { + kfree(count_comp); + return err; + } + + /* Allocate function attribute component */ + func_comp = kmalloc(sizeof(*func_comp), GFP_KERNEL); + if (!func_comp) + return -ENOMEM; + func_comp->count = count; + + /* Create Count function attribute */ + err = counter_attribute_create(group, "", "function", + (counter->function_get) ? counter_function_show : NULL, + (counter->function_set) ? counter_function_store : NULL, + func_comp); + if (err) { + kfree(func_comp); + return err; + } + + /* Allocate function available attribute component */ + avail_comp = kmalloc(sizeof(*avail_comp), GFP_KERNEL); + if (!avail_comp) + return -ENOMEM; + avail_comp->functions_list = count->functions_list; + avail_comp->num_functions = count->num_functions; + + /* Create Count function_available attribute */ + err = counter_attribute_create(group, "", "function_available", + counter_count_function_available_show, NULL, avail_comp); + if (err) { + kfree(avail_comp); + return err; + } + + /* Create Count name attribute */ + if (count->name) { + /* Allocate name attribute component */ + name_comp = kmalloc(sizeof(*name_comp), GFP_KERNEL); + if (!name_comp) + return -ENOMEM; + name_comp->name = count->name; + + err = counter_attribute_create(group, "", "name", + counter_device_attr_name_show, NULL, name_comp); + if (err) { + kfree(name_comp); + return err; + } + } + + /* Register Count extension attributes */ + return counter_count_ext_register(group, count); +} + +static int counter_counts_register( + struct counter_device_attr_group *const groups_list, + const struct counter_device *const counter) +{ + const size_t num_counts = counter->num_counts; + struct device *const dev = &counter->device_state->dev; + size_t i; + struct counter_count *count; + const char *name; + int err; + + /* At least one Count must be defined */ + if (!counter->counts || !num_counts) { + dev_err(dev, "Counts undefined\n"); + return -EINVAL; + } + + /* Register each Count */ + for (i = 0; i < num_counts; i++) { + count = counter->counts + i; + + /* At least one function mode must be defined for each Count */ + if (!count->functions_list || !count->num_functions) { + dev_err(dev, "Count '%d' function modes undefined\n", + count->id); + return -EINVAL; + } + + /* Generate Count attribute directory name */ + name = kasprintf(GFP_KERNEL, "count%d", count->id); + if (!name) + return -ENOMEM; + groups_list[i].attr_group.name = name; + + /* Register the Synapses associated with each Count */ + err = counter_synapses_register(groups_list + i, counter, count, + name); + if (err) + return err; + + /* Create all attributes associated with Count */ + err = counter_count_attributes_create(groups_list + i, counter, + count); + if (err) + return err; + } + + return 0; +} + +static struct bus_type counter_bus_type = { + .name = "counter" +}; + +static int __init counter_init(void) +{ + return bus_register(&counter_bus_type); +} + +static void __exit counter_exit(void) +{ + bus_unregister(&counter_bus_type); +} + +static void free_counter_device_attr_list(struct list_head *attr_list) +{ + struct counter_device_attr *p, *n; + + list_for_each_entry_safe(p, n, attr_list, l) { + kfree(p->dev_attr.attr.name); + kfree(p->component); + list_del(&p->l); + kfree(p); + } +} + +static void free_counter_device_groups_list( + struct counter_device_state *const device_state) +{ + struct counter_device_attr_group *group; + size_t i; + + for (i = 0; i < device_state->num_groups; i++) { + group = device_state->groups_list + i; + + kfree(group->attr_group.name); + kfree(group->attr_group.attrs); + free_counter_device_attr_list(&group->attr_list); + } + + kfree(device_state->groups_list); +} + +/* Provides a unique ID for each counter device */ +static DEFINE_IDA(counter_ida); + +static void counter_device_release(struct device *dev) +{ + struct counter_device *const counter = dev_get_drvdata(dev); + struct counter_device_state *const device_state = counter->device_state; + + kfree(device_state->groups); + free_counter_device_groups_list(device_state); + ida_simple_remove(&counter_ida, device_state->id); + kfree(device_state); +} + +static struct device_type counter_device_type = { + .name = "counter_device", + .release = counter_device_release +}; + +struct ext_comp_t { + const struct counter_device_ext *ext; +}; + +static ssize_t counter_device_ext_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct ext_comp_t *const component = devattr->component; + const struct counter_device_ext *const ext = component->ext; + struct counter_device *const counter = dev_get_drvdata(dev); + + return ext->read(counter, ext->priv, buf); +} + +static ssize_t counter_device_ext_store(struct device *dev, + struct device_attribute *attr, const char *buf, size_t len) +{ + const struct counter_device_attr *const devattr = to_counter_attr(attr); + const struct ext_comp_t *const component = devattr->component; + const struct counter_device_ext *const ext = component->ext; + struct counter_device *const counter = dev_get_drvdata(dev); + + return ext->write(counter, ext->priv, buf, len); +} + +static int counter_device_ext_register( + struct counter_device_attr_group *const group, + struct counter_device *const counter) +{ + const size_t num_ext = counter->num_ext; + struct ext_comp_t *ext_comp; + size_t i; + const struct counter_device_ext *ext; + int err; + + /* Return early if no extensions */ + if (!counter->ext || !num_ext) + return 0; + + /* Create an attribute for each extension */ + for (i = 0 ; i < num_ext; i++) { + ext = counter->ext + i; + + /* Allocate extension attribute component */ + ext_comp = kmalloc(sizeof(*ext_comp), GFP_KERNEL); + if (!ext_comp) + return -ENOMEM; + ext_comp->ext = ext; + + /* Allocate extension attribute */ + err = counter_attribute_create(group, "", ext->name, + (ext->read) ? counter_device_ext_show : NULL, + (ext->write) ? counter_device_ext_store : NULL, + ext_comp); + if (err) { + kfree(ext_comp); + return err; + } + } + + return 0; +} + +/** + * counter_register - register Counter to the system + * @counter: pointer to Counter to register + * + * This function registers a Counter to the system. A sysfs "counter" directory + * will be created and populated with sysfs attributes correlating with the + * Counter Signals, Synapses, and Counts respectively. + */ +int counter_register(struct counter_device *const counter) +{ + struct counter_device_state *device_state; + int err; + size_t i = 0; + size_t groups_offset = 0; + struct name_comp_t *name_comp; + struct counter_device_attr_group *group; + size_t j; + struct counter_device_attr *p; + + if (!counter) + return -EINVAL; + + /* Allocate internal state container for Counter device */ + device_state = kzalloc(sizeof(*device_state), GFP_KERNEL); + if (!device_state) + return -ENOMEM; + counter->device_state = device_state; + + /* Acquire unique ID */ + device_state->id = ida_simple_get(&counter_ida, 0, 0, GFP_KERNEL); + if (device_state->id < 0) { + err = device_state->id; + goto err_free_device_state; + } + + /* Configure device structure for Counter */ + device_state->dev.type = &counter_device_type; + device_state->dev.bus = &counter_bus_type; + if (counter->parent) { + device_state->dev.parent = counter->parent; + device_state->dev.of_node = counter->parent->of_node; + } + dev_set_name(&device_state->dev, "counter%d", device_state->id); + device_initialize(&device_state->dev); + dev_set_drvdata(&device_state->dev, counter); + + /* Allocate space for attribute groups (signals. counts, and ext) */ + device_state->num_groups = + counter->num_signals + counter->num_counts + 1; + device_state->groups_list = kcalloc(device_state->num_groups, + sizeof(*device_state->groups_list), GFP_KERNEL); + if (!device_state->groups_list) { + err = -ENOMEM; + goto err_free_id; + } + + /* Initialize attribute lists */ + for (i = 0; i < device_state->num_groups; i++) + INIT_LIST_HEAD(&device_state->groups_list[i].attr_list); + + /* Verify Signals are valid and register */ + err = counter_signals_register(device_state->groups_list, counter); + if (err) + goto err_free_groups_list; + groups_offset += counter->num_signals; + + /* Verify Counts and respective Synapses are valid and register */ + err = counter_counts_register(device_state->groups_list + groups_offset, + counter); + if (err) + goto err_free_groups_list; + groups_offset += counter->num_counts; + + /* Register Counter device extension attributes */ + err = counter_device_ext_register( + device_state->groups_list + groups_offset, counter); + if (err) + goto err_free_groups_list; + + /* Account for name attribute */ + if (counter->name) { + /* Allocate name attribute component */ + name_comp = kmalloc(sizeof(*name_comp), GFP_KERNEL); + if (!name_comp) { + err = -ENOMEM; + goto err_free_groups_list; + } + name_comp->name = counter->name; + + err = counter_attribute_create( + device_state->groups_list + groups_offset, "", "name", + counter_device_attr_name_show, NULL, name_comp); + if (err) { + kfree(name_comp); + goto err_free_groups_list; + } + } + + /* Allocate attribute groups for association with device */ + device_state->groups = kcalloc(device_state->num_groups + 1, + sizeof(*device_state->groups), GFP_KERNEL); + if (!device_state->groups) { + err = -ENOMEM; + goto err_free_groups_list; + } + /* Prepare each group of attributes for association */ + for (i = 0; i < device_state->num_groups; i++) { + group = device_state->groups_list + i; + + /* Allocate space for attribute pointers in attribute group */ + group->attr_group.attrs = kcalloc(group->num_attr + 1, + sizeof(*group->attr_group.attrs), GFP_KERNEL); + if (!group->attr_group.attrs) { + err = -ENOMEM; + goto err_free_groups; + } + + /* Add attribute pointers to attribute group */ + j = 0; + list_for_each_entry(p, &group->attr_list, l) + group->attr_group.attrs[j++] = &p->dev_attr.attr; + + /* Group attributes in attribute group */ + device_state->groups[i] = &group->attr_group; + } + /* Associate attributes with device */ + device_state->dev.groups = device_state->groups; + + /* Add device to system */ + err = device_add(&device_state->dev); + if (err) + goto err_free_groups; + + return 0; + +err_free_groups: + kfree(counter->device_state->groups); +err_free_groups_list: + free_counter_device_groups_list(counter->device_state); +err_free_id: + ida_simple_remove(&counter_ida, counter->device_state->id); +err_free_device_state: + kfree(counter->device_state); + return err; +} +EXPORT_SYMBOL(counter_register); + +/** + * counter_unregister - unregister Counter from the system + * @counter: pointer to Counter to unregister + * + * The Counter is unregistered from the system; all allocated memory is freed. + */ +void counter_unregister(struct counter_device *const counter) +{ + if (counter) + device_del(&counter->device_state->dev); +} +EXPORT_SYMBOL(counter_unregister); + +static void devm_counter_unreg(struct device *dev, void *res) +{ + counter_unregister(*(struct counter_device **)res); +} + +/** + * devm_counter_register - Resource-managed counter_register + * @dev: device to allocate counter_device for + * @counter: pointer to Counter to register + * + * Managed counter_register. The Counter registered with this function is + * automatically unregistered on driver detach. This function calls + * counter_register internally. Refer to that function for more information. + * + * If an Counter registered with this function needs to be unregistered + * separately, devm_counter_unregister must be used. + * + * RETURNS: + * 0 on success, negative error number on failure. + */ +int devm_counter_register(struct device *dev, + struct counter_device *const counter) +{ + struct counter_device **ptr; + int ret; + + ptr = devres_alloc(devm_counter_unreg, sizeof(*ptr), GFP_KERNEL); + if (!ptr) + return -ENOMEM; + + ret = counter_register(counter); + if (!ret) { + *ptr = counter; + devres_add(dev, ptr); + } else + devres_free(ptr); + + return ret; +} +EXPORT_SYMBOL(devm_counter_register); + +static int devm_counter_match(struct device *dev, void *res, void *data) +{ + struct counter_device **r = res; + + if (!r || !*r) { + WARN_ON(!r || !*r); + return 0; + } + + return *r == data; +} + +/** + * devm_counter_unregister - Resource-managed counter_unregister + * @dev: device this counter_device belongs to + * @counter: pointer to Counter associated with the device + * + * Unregister Counter registered with devm_counter_register. + */ +void devm_counter_unregister(struct device *dev, + struct counter_device *const counter) +{ + int rc; + + rc = devres_release(dev, devm_counter_unreg, + devm_counter_match, counter); + WARN_ON(rc); +} +EXPORT_SYMBOL(devm_counter_unregister); + +subsys_initcall(counter_init); +module_exit(counter_exit); + +MODULE_AUTHOR("William Breathitt Gray "); +MODULE_DESCRIPTION("Generic Counter interface"); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/iio/counter/stm32-lptimer-cnt.c b/drivers/counter/stm32-lptimer-cnt.c similarity index 100% rename from drivers/iio/counter/stm32-lptimer-cnt.c rename to drivers/counter/stm32-lptimer-cnt.c diff --git a/drivers/iio/Kconfig b/drivers/iio/Kconfig index b3c8c6ef0dff..423d86e368ea 100644 --- a/drivers/iio/Kconfig +++ b/drivers/iio/Kconfig @@ -73,7 +73,6 @@ source "drivers/iio/adc/Kconfig" source "drivers/iio/amplifiers/Kconfig" source "drivers/iio/chemical/Kconfig" source "drivers/iio/common/Kconfig" -source "drivers/iio/counter/Kconfig" source "drivers/iio/dac/Kconfig" source "drivers/iio/dummy/Kconfig" source "drivers/iio/frequency/Kconfig" diff --git a/drivers/iio/Makefile b/drivers/iio/Makefile index b16b2e9ddc40..6a80ebddb54c 100644 --- a/drivers/iio/Makefile +++ b/drivers/iio/Makefile @@ -19,7 +19,6 @@ obj-y += amplifiers/ obj-y += buffer/ obj-y += chemical/ obj-y += common/ -obj-y += counter/ obj-y += dac/ obj-y += dummy/ obj-y += gyro/ diff --git a/include/linux/counter.h b/include/linux/counter.h new file mode 100644 index 000000000000..aefca382624e --- /dev/null +++ b/include/linux/counter.h @@ -0,0 +1,524 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Counter interface + * Copyright (C) 2017 William Breathitt Gray + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License, version 2, as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but + * WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * General Public License for more details. + */ +#ifndef _COUNTER_H_ +#define _COUNTER_H_ + +#include +#include + +struct counter_device; +struct counter_signal; + +/** + * struct counter_signal_ext - Counter Signal extensions + * @name: attribute name + * @read: read callback for this attribute; may be NULL + * @write: write callback for this attribute; may be NULL + * @priv: data private to the driver + */ +struct counter_signal_ext { + const char *name; + ssize_t (*read)(struct counter_device *counter, + struct counter_signal *signal, void *priv, + char *buf); + ssize_t (*write)(struct counter_device *counter, + struct counter_signal *signal, void *priv, + const char *buf, size_t len); + void *priv; +}; + +/** + * struct counter_signal - Counter Signal node + * @id: unique ID used to identify signal + * @name: device-specific Signal name; ideally, this should match the name + * as it appears in the datasheet documentation + * @ext: optional array of Counter Signal extensions + * @num_ext: number of Counter Signal extensions specified in @ext + * @priv: optional private data supplied by driver + */ +struct counter_signal { + int id; + const char *name; + + const struct counter_signal_ext *ext; + size_t num_ext; + + void *priv; +}; + +/** + * struct counter_signal_enum_ext - Signal enum extension attribute + * @items: Array of strings + * @num_items: Number of items specified in @items + * @set: Set callback function; may be NULL + * @get: Get callback function; may be NULL + * + * The counter_signal_enum_ext structure can be used to implement enum style + * Signal extension attributes. Enum style attributes are those which have a set + * of strings that map to unsigned integer values. The Generic Counter Signal + * enum extension helper code takes care of mapping between value and string, as + * well as generating a "_available" file which contains a list of all available + * items. The get callback is used to query the currently active item; the index + * of the item within the respective items array is returned via the 'item' + * parameter. The set callback is called when the attribute is updated; the + * 'item' parameter contains the index of the newly activated item within the + * respective items array. + */ +struct counter_signal_enum_ext { + const char * const *items; + size_t num_items; + int (*get)(struct counter_device *counter, + struct counter_signal *signal, + size_t *item); + int (*set)(struct counter_device *counter, + struct counter_signal *signal, + size_t item); +}; + +extern ssize_t counter_signal_enum_read(struct counter_device *counter, + struct counter_signal *signal, void *priv, char *buf); +extern ssize_t counter_signal_enum_write(struct counter_device *counter, + struct counter_signal *signal, void *priv, const char *buf, size_t len); + +/** + * COUNTER_SIGNAL_ENUM() - Initialize Signal enum extension + * @_name: Attribute name + * @_e: Pointer to a counter_count_enum structure + * + * This should usually be used together with COUNTER_SIGNAL_ENUM_AVAILABLE() + */ +#define COUNTER_SIGNAL_ENUM(_name, _e) \ +{ \ + .name = (_name), \ + .read = counter_signal_enum_read, \ + .write = counter_signal_enum_write, \ + .priv = (_e) \ +} + +extern ssize_t counter_signal_enum_available_read( + struct counter_device *counter, struct counter_signal *signal, + void *priv, char *buf); + +/** + * COUNTER_SIGNAL_ENUM_AVAILABLE() - Initialize Signal enum available extension + * @_name: Attribute name ("_available" will be appended to the name) + * @_e: Pointer to a counter_signal_enum structure + * + * Creates a read only attribute that lists all the available enum items in a + * newline separated list. This should usually be used together with + * COUNTER_SIGNAL_ENUM() + */ +#define COUNTER_SIGNAL_ENUM_AVAILABLE(_name, _e) \ +{ \ + .name = (_name "_available"), \ + .read = counter_signal_enum_available_read, \ + .priv = (_e) \ +} + +enum synapse_action { + SYNAPSE_ACTION_NONE = 0, + SYNAPSE_ACTION_RISING_EDGE, + SYNAPSE_ACTION_FALLING_EDGE, + SYNAPSE_ACTION_BOTH_EDGES +}; + +/** + * struct counter_synapse - Counter Synapse node + * @action: index of current action mode + * @actions_list: array of available action modes + * @num_actions: number of action modes specified in @actions_list + * @signal: pointer to associated signal + */ +struct counter_synapse { + size_t action; + const enum synapse_action *actions_list; + size_t num_actions; + + struct counter_signal *signal; +}; + +struct counter_count; + +/** + * struct counter_count_ext - Counter Count extension + * @name: attribute name + * @read: read callback for this attribute; may be NULL + * @write: write callback for this attribute; may be NULL + * @priv: data private to the driver + */ +struct counter_count_ext { + const char *name; + ssize_t (*read)(struct counter_device *counter, + struct counter_count *count, void *priv, + char *buf); + ssize_t (*write)(struct counter_device *counter, + struct counter_count *count, void *priv, + const char *buf, size_t len); + void *priv; +}; + +enum count_function { + COUNT_FUNCTION_INCREASE = 0, + COUNT_FUNCTION_DECREASE, + COUNT_FUNCTION_PULSE_DIRECTION, + COUNT_FUNCTION_QUADRATURE_X1, + COUNT_FUNCTION_QUADRATURE_X2, + COUNT_FUNCTION_QUADRATURE_X4 +}; + +/** + * struct counter_count - Counter Count node + * @id: unique ID used to identify Count + * @name: device-specific Count name; ideally, this should match + * the name as it appears in the datasheet documentation + * @function: index of current function mode + * @functions_list: array available function modes + * @num_functions: number of function modes specified in @functions_list + * @synapses: array of synapses for initialization + * @num_synapses: number of synapses specified in @synapses + * @ext: optional array of Counter Count extensions + * @num_ext: number of Counter Count extensions specified in @ext + * @priv: optional private data supplied by driver + */ +struct counter_count { + int id; + const char *name; + + size_t function; + const enum count_function *functions_list; + size_t num_functions; + + struct counter_synapse *synapses; + size_t num_synapses; + + const struct counter_count_ext *ext; + size_t num_ext; + + void *priv; +}; + +/** + * struct counter_count_enum_ext - Count enum extension attribute + * @items: Array of strings + * @num_items: Number of items specified in @items + * @set: Set callback function; may be NULL + * @get: Get callback function; may be NULL + * + * The counter_count_enum_ext structure can be used to implement enum style + * Count extension attributes. Enum style attributes are those which have a set + * of strings that map to unsigned integer values. The Generic Counter Count + * enum extension helper code takes care of mapping between value and string, as + * well as generating a "_available" file which contains a list of all available + * items. The get callback is used to query the currently active item; the index + * of the item within the respective items array is returned via the 'item' + * parameter. The set callback is called when the attribute is updated; the + * 'item' parameter contains the index of the newly activated item within the + * respective items array. + */ +struct counter_count_enum_ext { + const char * const *items; + size_t num_items; + int (*get)(struct counter_device *counter, + struct counter_count *count, + size_t *item); + int (*set)(struct counter_device *counter, + struct counter_count *count, + size_t item); +}; + +extern ssize_t counter_count_enum_read(struct counter_device *counter, + struct counter_count *count, void *priv, char *buf); +extern ssize_t counter_count_enum_write(struct counter_device *counter, + struct counter_count *count, void *priv, const char *buf, size_t len); + +/** + * COUNTER_COUNT_ENUM() - Initialize Count enum extension + * @_name: Attribute name + * @_e: Pointer to a counter_count_enum structure + * + * This should usually be used together with COUNTER_COUNT_ENUM_AVAILABLE() + */ +#define COUNTER_COUNT_ENUM(_name, _e) \ +{ \ + .name = (_name), \ + .read = counter_count_enum_read, \ + .write = counter_count_enum_write, \ + .priv = (_e) \ +} + +extern ssize_t counter_count_enum_available_read(struct counter_device *counter, + struct counter_count *count, void *priv, char *buf); + +/** + * COUNTER_COUNT_ENUM_AVAILABLE() - Initialize Count enum available extension + * @_name: Attribute name ("_available" will be appended to the name) + * @_e: Pointer to a counter_count_enum structure + * + * Creates a read only attribute that lists all the available enum items in a + * newline separated list. This should usually be used together with + * COUNTER_COUNT_ENUM() + */ +#define COUNTER_COUNT_ENUM_AVAILABLE(_name, _e) \ +{ \ + .name = (_name "_available"), \ + .read = counter_count_enum_available_read, \ + .priv = (_e) \ +} + +/** + * struct counter_device_attr_group - internal container for attribute group + * @attr_group: Counter sysfs attributes group + * @attr_list: list to keep track of created Counter sysfs attributes + * @num_attr: number of Counter sysfs attributes + */ +struct counter_device_attr_group { + struct attribute_group attr_group; + struct list_head attr_list; + size_t num_attr; +}; + +/** + * struct counter_device_state - internal state container for a Counter device + * @id: unique ID used to identify the Counter + * @dev: internal device structure + * @groups_list attribute groups list (groups for Signals, Counts, and ext) + * @num_groups number of attribute groups containers + * @groups: Counter sysfs attribute groups (used to populate @dev.groups) + */ +struct counter_device_state { + int id; + struct device dev; + struct counter_device_attr_group *groups_list; + size_t num_groups; + const struct attribute_group **groups; +}; + +/** + * struct signal_read_value - Opaque Signal read value + * @buf: string representation of Signal read value + * @len: length of string in @buf + */ +struct signal_read_value { + char *buf; + size_t len; +}; + +/** + * struct count_read_value - Opaque Count read value + * @buf: string representation of Count read value + * @len: length of string in @buf + */ +struct count_read_value { + char *buf; + size_t len; +}; + +/** + * struct count_write_value - Opaque Count write value + * @buf: string representation of Count write value + */ +struct count_write_value { + const char *buf; +}; + +/** + * struct counter_device_ext - Counter device extension + * @name: attribute name + * @read: read callback for this attribute; may be NULL + * @write: write callback for this attribute; may be NULL + * @priv: data private to the driver + */ +struct counter_device_ext { + const char *name; + ssize_t (*read)(struct counter_device *counter, void *priv, + char *buf); + ssize_t (*write)(struct counter_device *counter, void *priv, + const char *buf, size_t len); + void *priv; +}; + +/** + * struct counter_device_enum_ext - Counter enum extension attribute + * @items: Array of strings + * @num_items: Number of items specified in @items + * @set: Set callback function; may be NULL + * @get: Get callback function; may be NULL + * + * The counter_device_enum_ext structure can be used to implement enum style + * Counter extension attributes. Enum style attributes are those which have a + * set of strings that map to unsigned integer values. The Generic Counter enum + * extension helper code takes care of mapping between value and string, as well + * as generating a "_available" file which contains a list of all available + * items. The get callback is used to query the currently active item; the index + * of the item within the respective items array is returned via the 'item' + * parameter. The set callback is called when the attribute is updated; the + * 'item' parameter contains the index of the newly activated item within the + * respective items array. + */ +struct counter_device_enum_ext { + const char * const *items; + size_t num_items; + int (*get)(struct counter_device *counter, + size_t *item); + int (*set)(struct counter_device *counter, + size_t item); +}; + +extern ssize_t counter_device_enum_read(struct counter_device *counter, + void *priv, char *buf); +extern ssize_t counter_device_enum_write(struct counter_device *counter, + void *priv, const char *buf, size_t len); + +/** + * COUNTER_DEVICE_ENUM() - Initialize Counter enum extension + * @_name: Attribute name + * @_e: Pointer to a counter_device_enum structure + * + * This should usually be used together with COUNTER_DEVICE_ENUM_AVAILABLE() + */ +#define COUNTER_DEVICE_ENUM(_name, _e) \ +{ \ + .name = (_name), \ + .read = counter_device_enum_read, \ + .write = counter_device_enum_write, \ + .priv = (_e) \ +} + +extern ssize_t counter_device_enum_available_read( + struct counter_device *counter, void *priv, char *buf); + +/** + * COUNTER_DEVICE_ENUM_AVAILABLE() - Initialize Counter enum available extension + * @_name: Attribute name ("_available" will be appended to the name) + * @_e: Pointer to a counter_device_enum structure + * + * Creates a read only attribute that lists all the available enum items in a + * newline separated list. This should usually be used together with + * COUNTER_DEVICE_ENUM() + */ +#define COUNTER_DEVICE_ENUM_AVAILABLE(_name, _e) \ +{ \ + .name = (_name "_available"), \ + .read = counter_device_enum_available_read, \ + .priv = (_e) \ +} + +/** + * struct counter_device - Counter data structure + * @name: name of the device as it appears in the datasheet + * @parent: optional parent device providing the counters + * @device_state: internal device state container + * @signal_read: optional read callback for Signal attribute. The read + * value of the respective Signal should be passed back via + * the val parameter. val points to an opaque type which + * should be set only via the set_signal_read_value + * function. + * @count_read: optional read callback for Count attribute. The read + * value of the respective Count should be passed back via + * the val parameter. val points to an opaque type which + * should be set only via the set_count_read_value + * function. + * @count_write: optional write callback for Count attribute. The write + * value for the respective Count is passed in via the val + * parameter. val points to an opaque type which should be + * access only via the get_count_write_value function. + * @function_get: function to get the current count function mode. Returns + * 0 on success and negative error code on error. The index + * of the respective Count's returned function mode should + * be passed back via the function parameter. + * @function_set: function to set the count function mode. function is the + * index of the requested function mode from the respective + * Count's functions_list array. + * @action_get: function to get the current action mode. Returns 0 on + * success and negative error code on error. The index of + * the respective Signal's returned action mode should be + * passed back via the action parameter. + * @action_set: function to set the action mode. action is the index of + * the requested action mode from the respective Synapse's + * actions_list array. + * @signals: array of Signals + * @num_signals: number of Signals specified in @signals + * @counts: array of Counts + * @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 + * @priv: optional private data supplied by driver + */ +struct counter_device { + const char *name; + struct device *parent; + struct counter_device_state *device_state; + + int (*signal_read)(struct counter_device *counter, + struct counter_signal *signal, + struct signal_read_value *val); + int (*count_read)(struct counter_device *counter, + struct counter_count *count, + struct count_read_value *val); + int (*count_write)(struct counter_device *counter, + struct counter_count *count, + struct count_write_value *val); + int (*function_get)(struct counter_device *counter, + struct counter_count *count, size_t *function); + int (*function_set)(struct counter_device *counter, + struct counter_count *count, size_t function); + int (*action_get)(struct counter_device *counter, + struct counter_count *count, + struct counter_synapse *synapse, size_t *action); + int (*action_set)(struct counter_device *counter, + struct counter_count *count, + struct counter_synapse *synapse, size_t action); + + struct counter_signal *signals; + size_t num_signals; + struct counter_count *counts; + size_t num_counts; + + const struct counter_device_ext *ext; + size_t num_ext; + + void *priv; +}; + +enum signal_level { + SIGNAL_LEVEL_LOW = 0, + SIGNAL_LEVEL_HIGH +}; + +enum signal_value_type { + SIGNAL_LEVEL = 0 +}; + +enum count_value_type { + COUNT_POSITION_UNSIGNED = 0, + COUNT_POSITION_SIGNED +}; + +extern void set_signal_read_value(struct signal_read_value *const val, + const enum signal_value_type type, void *const data); +extern void set_count_read_value(struct count_read_value *const val, + const enum count_value_type type, void *const data); +extern int get_count_write_value(void *const data, + const enum count_value_type type, + const struct count_write_value *const val); + +extern int counter_register(struct counter_device *const counter); +extern void counter_unregister(struct counter_device *const counter); +extern int devm_counter_register(struct device *dev, + struct counter_device *const counter); +extern void devm_counter_unregister(struct device *dev, + struct counter_device *const counter); + +#endif /* _COUNTER_H_ */ -- 2.16.2