Initial commit: OpenHarmony-v4.0-ReleaseOpenHarmony-v4.0-Release

1 files changed, 122 insertions, 0 deletions

diff --git a/arch/mips/kernel/rtlx-cmp.c b/arch/mips/kernel/rtlx-cmp.c
new file mode 100644
index 000000000..d26dcc4b4
--- /dev/null
+++ b/arch/mips/kernel/rtlx-cmp.c
@@ -0,0 +1,122 @@
+/*
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ *
+ * Copyright (C) 2005 MIPS Technologies, Inc.  All rights reserved.
+ * Copyright (C) 2013 Imagination Technologies Ltd.
+ */
+#include <linux/device.h>
+#include <linux/fs.h>
+#include <linux/err.h>
+#include <linux/wait.h>
+#include <linux/sched.h>
+#include <linux/smp.h>
+
+#include <asm/mips_mt.h>
+#include <asm/vpe.h>
+#include <asm/rtlx.h>
+
+static int major;
+
+static void rtlx_interrupt(void)
+{
+        int i;
+        struct rtlx_info *info;
+        struct rtlx_info **p = vpe_get_shared(aprp_cpu_index());
+
+        if (p == NULL || *p == NULL)
+                return;
+
+        info = *p;
+
+        if (info->ap_int_pending == 1 && smp_processor_id() == 0) {
+                for (i = 0; i < RTLX_CHANNELS; i++) {
+                        wake_up(&channel_wqs[i].lx_queue);
+                        wake_up(&channel_wqs[i].rt_queue);
+                }
+                info->ap_int_pending = 0;
+        }
+}
+
+void _interrupt_sp(void)
+{
+        smp_send_reschedule(aprp_cpu_index());
+}
+
+int __init rtlx_module_init(void)
+{
+        struct device *dev;
+        int i, err;
+
+        if (!cpu_has_mipsmt) {
+                pr_warn("VPE loader: not a MIPS MT capable processor\n");
+                return -ENODEV;
+        }
+
+        if (num_possible_cpus() - aprp_cpu_index() < 1) {
+                pr_warn("No TCs reserved for AP/SP, not initializing RTLX.\n"
+                        "Pass maxcpus=<n> argument as kernel argument\n");
+
+                return -ENODEV;
+        }
+
+        major = register_chrdev(0, RTLX_MODULE_NAME, &rtlx_fops);
+        if (major < 0) {
+                pr_err("rtlx_module_init: unable to register device\n");
+                return major;
+        }
+
+        /* initialise the wait queues */
+        for (i = 0; i < RTLX_CHANNELS; i++) {
+                init_waitqueue_head(&channel_wqs[i].rt_queue);
+                init_waitqueue_head(&channel_wqs[i].lx_queue);
+                atomic_set(&channel_wqs[i].in_open, 0);
+                mutex_init(&channel_wqs[i].mutex);
+
+                dev = device_create(mt_class, NULL, MKDEV(major, i), NULL,
+                                    "%s%d", RTLX_MODULE_NAME, i);
+                if (IS_ERR(dev)) {
+                        while (i--)
+                                device_destroy(mt_class, MKDEV(major, i));
+
+                        err = PTR_ERR(dev);
+                        goto out_chrdev;
+                }
+        }
+
+        /* set up notifiers */
+        rtlx_notify.start = rtlx_starting;
+        rtlx_notify.stop = rtlx_stopping;
+        vpe_notify(aprp_cpu_index(), &rtlx_notify);
+
+        if (cpu_has_vint) {
+                aprp_hook = rtlx_interrupt;
+        } else {
+                pr_err("APRP RTLX init on non-vectored-interrupt processor\n");
+                err = -ENODEV;
+                goto out_class;
+        }
+
+        return 0;
+
+out_class:
+        for (i = 0; i < RTLX_CHANNELS; i++)
+                device_destroy(mt_class, MKDEV(major, i));
+out_chrdev:
+        unregister_chrdev(major, RTLX_MODULE_NAME);
+
+        return err;
+}
+
+void __exit rtlx_module_exit(void)
+{
+        int i;
+
+        for (i = 0; i < RTLX_CHANNELS; i++)
+                device_destroy(mt_class, MKDEV(major, i));
+
+        unregister_chrdev(major, RTLX_MODULE_NAME);
+
+        aprp_hook = NULL;
+}