New upstream version 17.11-rc3

[deb_dpdk.git] / drivers / bus / dpaa / base / qbman / dpaa_sys.c

diff --git a/drivers/bus/dpaa/base/qbman/dpaa_sys.c b/drivers/bus/dpaa/base/qbman/dpaa_sys.c
new file mode 100644 (file)
index 0000000..0017da5
--- /dev/null
+++ b/drivers/bus/dpaa/base/qbman/dpaa_sys.c
@@ -0,0 +1,136 @@
+/*-
+ * This file is provided under a dual BSD/GPLv2 license. When using or
+ * redistributing this file, you may do so under either license.
+ *
+ *   BSD LICENSE
+ *
+ * Copyright 2013-2016 Freescale Semiconductor Inc.
+ * Copyright 2017 NXP.
+ *
+ * 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 the above-listed copyright holders nor the
+ * names of any contributors may be used to endorse or promote products
+ * derived from this software without specific prior written permission.
+ *
+ *   GPL LICENSE SUMMARY
+ *
+ * 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 THE COPYRIGHT HOLDERS AND CONTRIBUTORS "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 THE COPYRIGHT HOLDERS OR CONTRIBUTORS 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 <process.h>
+#include "dpaa_sys.h"
+
+struct process_interrupt {
+       int irq;
+       irqreturn_t (*isr)(int irq, void *arg);
+       unsigned long flags;
+       const char *name;
+       void *arg;
+       struct list_head node;
+};
+
+static COMPAT_LIST_HEAD(process_irq_list);
+static pthread_mutex_t process_irq_lock = PTHREAD_MUTEX_INITIALIZER;
+
+static void process_interrupt_install(struct process_interrupt *irq)
+{
+       int ret;
+       /* Add the irq to the end of the list */
+       ret = pthread_mutex_lock(&process_irq_lock);
+       assert(!ret);
+       list_add_tail(&irq->node, &process_irq_list);
+       ret = pthread_mutex_unlock(&process_irq_lock);
+       assert(!ret);
+}
+
+static void process_interrupt_remove(struct process_interrupt *irq)
+{
+       int ret;
+
+       ret = pthread_mutex_lock(&process_irq_lock);
+       assert(!ret);
+       list_del(&irq->node);
+       ret = pthread_mutex_unlock(&process_irq_lock);
+       assert(!ret);
+}
+
+static struct process_interrupt *process_interrupt_find(int irq_num)
+{
+       int ret;
+       struct process_interrupt *i = NULL;
+
+       ret = pthread_mutex_lock(&process_irq_lock);
+       assert(!ret);
+       list_for_each_entry(i, &process_irq_list, node) {
+               if (i->irq == irq_num)
+                       goto done;
+       }
+done:
+       ret = pthread_mutex_unlock(&process_irq_lock);
+       assert(!ret);
+       return i;
+}
+
+/* This is the interface from the platform-agnostic driver code to (de)register
+ * interrupt handlers. We simply create/destroy corresponding structs.
+ */
+int qbman_request_irq(int irq, irqreturn_t (*isr)(int irq, void *arg),
+                     unsigned long flags, const char *name,
+                     void *arg __maybe_unused)
+{
+       struct process_interrupt *irq_node =
+               kmalloc(sizeof(*irq_node), GFP_KERNEL);
+
+       if (!irq_node)
+               return -ENOMEM;
+       irq_node->irq = irq;
+       irq_node->isr = isr;
+       irq_node->flags = flags;
+       irq_node->name = name;
+       irq_node->arg = arg;
+       process_interrupt_install(irq_node);
+       return 0;
+}
+
+int qbman_free_irq(int irq, __maybe_unused void *arg)
+{
+       struct process_interrupt *irq_node = process_interrupt_find(irq);
+
+       if (!irq_node)
+               return -EINVAL;
+       process_interrupt_remove(irq_node);
+       kfree(irq_node);
+       return 0;
+}
+
+/* This is the interface from the platform-specific driver code to obtain
+ * interrupt handlers that have been registered.
+ */
+void qbman_invoke_irq(int irq)
+{
+       struct process_interrupt *irq_node = process_interrupt_find(irq);
+
+       if (irq_node)
+               irq_node->isr(irq, irq_node->arg);
+}