2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
6 * Copyright (C) 2005 MIPS Technologies, Inc. All rights reserved.
7 * Copyright (C) 2013 Imagination Technologies Ltd.
9 #include <linux/device.h>
11 #include <linux/err.h>
12 #include <linux/wait.h>
13 #include <linux/sched.h>
14 #include <linux/interrupt.h>
15 #include <linux/irq.h>
17 #include <asm/mips_mt.h>
23 static void rtlx_dispatch(void)
25 if (read_c0_cause() & read_c0_status() & C_SW0)
26 do_IRQ(MIPS_CPU_IRQ_BASE + MIPS_CPU_RTLX_IRQ);
30 * Interrupt handler may be called before rtlx_init has otherwise had
33 static irqreturn_t rtlx_interrupt(int irq, void *dev_id)
35 unsigned int vpeflags;
39 /* Ought not to be strictly necessary for SMTC builds */
40 local_irq_save(flags);
42 set_c0_status(0x100 << MIPS_CPU_RTLX_IRQ);
45 local_irq_restore(flags);
47 for (i = 0; i < RTLX_CHANNELS; i++) {
48 wake_up(&channel_wqs[i].lx_queue);
49 wake_up(&channel_wqs[i].rt_queue);
55 static struct irqaction rtlx_irq = {
56 .handler = rtlx_interrupt,
60 static int rtlx_irq_num = MIPS_CPU_IRQ_BASE + MIPS_CPU_RTLX_IRQ;
62 void _interrupt_sp(void)
66 local_irq_save(flags);
69 write_vpe_c0_cause(read_vpe_c0_cause() | C_SW0);
71 local_irq_restore(flags);
74 int __init rtlx_module_init(void)
79 if (!cpu_has_mipsmt) {
80 pr_warn("VPE loader: not a MIPS MT capable processor\n");
84 if (aprp_cpu_index() == 0) {
85 pr_warn("No TCs reserved for AP/SP, not initializing RTLX.\n"
86 "Pass maxtcs=<n> argument as kernel argument\n");
91 major = register_chrdev(0, RTLX_MODULE_NAME, &rtlx_fops);
93 pr_err("rtlx_module_init: unable to register device\n");
97 /* initialise the wait queues */
98 for (i = 0; i < RTLX_CHANNELS; i++) {
99 init_waitqueue_head(&channel_wqs[i].rt_queue);
100 init_waitqueue_head(&channel_wqs[i].lx_queue);
101 atomic_set(&channel_wqs[i].in_open, 0);
102 mutex_init(&channel_wqs[i].mutex);
104 dev = device_create(mt_class, NULL, MKDEV(major, i), NULL,
105 "%s%d", RTLX_MODULE_NAME, i);
112 /* set up notifiers */
113 rtlx_notify.start = rtlx_starting;
114 rtlx_notify.stop = rtlx_stopping;
115 vpe_notify(aprp_cpu_index(), &rtlx_notify);
118 aprp_hook = rtlx_dispatch;
120 pr_err("APRP RTLX init on non-vectored-interrupt processor\n");
125 rtlx_irq.dev_id = rtlx;
126 err = setup_irq(rtlx_irq_num, &rtlx_irq);
133 for (i = 0; i < RTLX_CHANNELS; i++)
134 device_destroy(mt_class, MKDEV(major, i));
136 unregister_chrdev(major, RTLX_MODULE_NAME);
141 void __exit rtlx_module_exit(void)
145 for (i = 0; i < RTLX_CHANNELS; i++)
146 device_destroy(mt_class, MKDEV(major, i));
147 unregister_chrdev(major, RTLX_MODULE_NAME);