dpaa_eth: add sysfs exports

Export Frame Queue and Buffer Pool IDs through sysfs.

Signed-off-by: Madalin Bucur <madalin.bucur@nxp.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

4 files changed, 174 insertions, 1 deletions

diff --git a/drivers/net/ethernet/freescale/dpaa/Makefile b/drivers/net/ethernet/freescale/dpaa/Makefile
index 43a4cfdd2e78..bfb03d4b6ab0 100644
--- a/drivers/net/ethernet/freescale/dpaa/Makefile
+++ b/drivers/net/ethernet/freescale/dpaa/Makefile
@@ -8,4 +8,4 @@ ccflags-y += -I$(FMAN)
 
 obj-$(CONFIG_FSL_DPAA_ETH) += fsl_dpa.o
 
-fsl_dpa-objs += dpaa_eth.o dpaa_ethtool.o
+fsl_dpa-objs += dpaa_eth.o dpaa_ethtool.o dpaa_eth_sysfs.o
diff --git a/drivers/net/ethernet/freescale/dpaa/dpaa_eth.c b/drivers/net/ethernet/freescale/dpaa/dpaa_eth.c
index fcb9cac6257a..07ec2fe7c353 100644
--- a/drivers/net/ethernet/freescale/dpaa/dpaa_eth.c
+++ b/drivers/net/ethernet/freescale/dpaa/dpaa_eth.c
@@ -2619,6 +2619,8 @@ static int dpaa_eth_probe(struct platform_device *pdev)
         if (err < 0)
                 goto netdev_init_failed;
 
+        dpaa_eth_sysfs_init(&net_dev->dev);
+
         netif_info(priv, probe, net_dev, "Probed interface %s\n",
                    net_dev->name);
 
@@ -2664,6 +2666,8 @@ static int dpaa_remove(struct platform_device *pdev)
 
         priv = netdev_priv(net_dev);
 
+        dpaa_eth_sysfs_remove(dev);
+
         dev_set_drvdata(dev, NULL);
         unregister_netdev(net_dev);
 
diff --git a/drivers/net/ethernet/freescale/dpaa/dpaa_eth.h b/drivers/net/ethernet/freescale/dpaa/dpaa_eth.h
index 711fb06200b7..44323e2db436 100644
--- a/drivers/net/ethernet/freescale/dpaa/dpaa_eth.h
+++ b/drivers/net/ethernet/freescale/dpaa/dpaa_eth.h
@@ -177,4 +177,8 @@ struct dpaa_priv {
 
 /* from dpaa_ethtool.c */
 extern const struct ethtool_ops dpaa_ethtool_ops;
+
+/* from dpaa_eth_sysfs.c */
+void dpaa_eth_sysfs_remove(struct device *dev);
+void dpaa_eth_sysfs_init(struct device *dev);
 #endif  /* __DPAA_H */
diff --git a/drivers/net/ethernet/freescale/dpaa/dpaa_eth_sysfs.c b/drivers/net/ethernet/freescale/dpaa/dpaa_eth_sysfs.c
new file mode 100644
index 000000000000..ec75d1c6fa89
--- /dev/null
+++ b/drivers/net/ethernet/freescale/dpaa/dpaa_eth_sysfs.c
@@ -0,0 +1,165 @@
+/* Copyright 2008-2016 Freescale Semiconductor Inc.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above copyright
+ *       notice, this list of conditions and the following disclaimer in the
+ *       documentation and/or other materials provided with the distribution.
+ *     * Neither the name of Freescale Semiconductor nor the
+ *       names of its contributors may be used to endorse or promote products
+ *       derived from this software without specific prior written permission.
+ *
+ *
+ * ALTERNATIVELY, this software may be distributed under the terms of the
+ * GNU General Public License ("GPL") as published by the Free Software
+ * Foundation, either version 2 of that License or (at your option) any
+ * later version.
+ *
+ * THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY
+ * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
+ * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY
+ * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
+ * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
+ * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
+ * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
+ * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/io.h>
+#include <linux/of_net.h>
+#include "dpaa_eth.h"
+#include "mac.h"
+
+static ssize_t dpaa_eth_show_addr(struct device *dev,
+                                  struct device_attribute *attr, char *buf)
+{
+        struct dpaa_priv *priv = netdev_priv(to_net_dev(dev));
+        struct mac_device *mac_dev = priv->mac_dev;
+
+        if (mac_dev)
+                return sprintf(buf, "%llx",
+                                (unsigned long long)mac_dev->res->start);
+        else
+                return sprintf(buf, "none");
+}
+
+static ssize_t dpaa_eth_show_fqids(struct device *dev,
+                                   struct device_attribute *attr, char *buf)
+{
+        struct dpaa_priv *priv = netdev_priv(to_net_dev(dev));
+        struct dpaa_fq *prev = NULL;
+        char *prevstr = NULL;
+        struct dpaa_fq *tmp;
+        struct dpaa_fq *fq;
+        u32 first_fqid = 0;
+        u32 last_fqid = 0;
+        ssize_t bytes = 0;
+        char *str;
+        int i = 0;
+
+        list_for_each_entry_safe(fq, tmp, &priv->dpaa_fq_list, list) {
+                switch (fq->fq_type) {
+                case FQ_TYPE_RX_DEFAULT:
+                        str = "Rx default";
+                        break;
+                case FQ_TYPE_RX_ERROR:
+                        str = "Rx error";
+                        break;
+                case FQ_TYPE_TX_CONFIRM:
+                        str = "Tx default confirmation";
+                        break;
+                case FQ_TYPE_TX_CONF_MQ:
+                        str = "Tx confirmation (mq)";
+                        break;
+                case FQ_TYPE_TX_ERROR:
+                        str = "Tx error";
+                        break;
+                case FQ_TYPE_TX:
+                        str = "Tx";
+                        break;
+                default:
+                        str = "Unknown";
+                }
+
+                if (prev && (abs(fq->fqid - prev->fqid) != 1 ||
+                             str != prevstr)) {
+                        if (last_fqid == first_fqid)
+                                bytes += sprintf(buf + bytes,
+                                        "%s: %d\n", prevstr, prev->fqid);
+                        else
+                                bytes += sprintf(buf + bytes,
+                                        "%s: %d - %d\n", prevstr,
+                                        first_fqid, last_fqid);
+                }
+
+                if (prev && abs(fq->fqid - prev->fqid) == 1 &&
+                    str == prevstr) {
+                        last_fqid = fq->fqid;
+                } else {
+                        first_fqid = fq->fqid;
+                        last_fqid = fq->fqid;
+                }
+
+                prev = fq;
+                prevstr = str;
+                i++;
+        }
+
+        if (prev) {
+                if (last_fqid == first_fqid)
+                        bytes += sprintf(buf + bytes, "%s: %d\n", prevstr,
+                                        prev->fqid);
+                else
+                        bytes += sprintf(buf + bytes, "%s: %d - %d\n", prevstr,
+                                        first_fqid, last_fqid);
+        }
+
+        return bytes;
+}
+
+static ssize_t dpaa_eth_show_bpids(struct device *dev,
+                                   struct device_attribute *attr, char *buf)
+{
+        struct dpaa_priv *priv = netdev_priv(to_net_dev(dev));
+        ssize_t bytes = 0;
+        int i = 0;
+
+        for (i = 0; i < DPAA_BPS_NUM; i++)
+                bytes += snprintf(buf + bytes, PAGE_SIZE - bytes, "%u\n",
+                                  priv->dpaa_bps[i]->bpid);
+
+        return bytes;
+}
+
+static struct device_attribute dpaa_eth_attrs[] = {
+        __ATTR(device_addr, 0444, dpaa_eth_show_addr, NULL),
+        __ATTR(fqids, 0444, dpaa_eth_show_fqids, NULL),
+        __ATTR(bpids, 0444, dpaa_eth_show_bpids, NULL),
+};
+
+void dpaa_eth_sysfs_init(struct device *dev)
+{
+        int i;
+
+        for (i = 0; i < ARRAY_SIZE(dpaa_eth_attrs); i++)
+                if (device_create_file(dev, &dpaa_eth_attrs[i])) {
+                        dev_err(dev, "Error creating sysfs file\n");
+                        while (i > 0)
+                                device_remove_file(dev, &dpaa_eth_attrs[--i]);
+                        return;
+                }
+}
+
+void dpaa_eth_sysfs_remove(struct device *dev)
+{
+        int i;
+
+        for (i = 0; i < ARRAY_SIZE(dpaa_eth_attrs); i++)
+                device_remove_file(dev, &dpaa_eth_attrs[i]);
+}