~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/arch/mips/kernel/rtlx-mt.c

Version: ~ [ linux-5.15-rc7 ] ~ [ linux-5.14.14 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.75 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.155 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.213 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.252 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.287 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.289 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.18.140 ] ~ [ linux-3.16.85 ] ~ [ linux-3.14.79 ] ~ [ linux-3.12.74 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 /*
  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
  4  * for more details.
  5  *
  6  * Copyright (C) 2005 MIPS Technologies, Inc.  All rights reserved.
  7  * Copyright (C) 2013 Imagination Technologies Ltd.
  8  */
  9 #include <linux/device.h>
 10 #include <linux/fs.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>
 16 
 17 #include <asm/mips_mt.h>
 18 #include <asm/vpe.h>
 19 #include <asm/rtlx.h>
 20 
 21 static int major;
 22 
 23 static void rtlx_dispatch(void)
 24 {
 25         if (read_c0_cause() & read_c0_status() & C_SW0)
 26                 do_IRQ(MIPS_CPU_IRQ_BASE + MIPS_CPU_RTLX_IRQ);
 27 }
 28 
 29 /*
 30  * Interrupt handler may be called before rtlx_init has otherwise had
 31  * a chance to run.
 32  */
 33 static irqreturn_t rtlx_interrupt(int irq, void *dev_id)
 34 {
 35         unsigned int vpeflags;
 36         unsigned long flags;
 37         int i;
 38 
 39         local_irq_save(flags);
 40         vpeflags = dvpe();
 41         set_c0_status(0x100 << MIPS_CPU_RTLX_IRQ);
 42         irq_enable_hazard();
 43         evpe(vpeflags);
 44         local_irq_restore(flags);
 45 
 46         for (i = 0; i < RTLX_CHANNELS; i++) {
 47                 wake_up(&channel_wqs[i].lx_queue);
 48                 wake_up(&channel_wqs[i].rt_queue);
 49         }
 50 
 51         return IRQ_HANDLED;
 52 }
 53 
 54 static struct irqaction rtlx_irq = {
 55         .handler        = rtlx_interrupt,
 56         .name           = "RTLX",
 57 };
 58 
 59 static int rtlx_irq_num = MIPS_CPU_IRQ_BASE + MIPS_CPU_RTLX_IRQ;
 60 
 61 void _interrupt_sp(void)
 62 {
 63         unsigned long flags;
 64 
 65         local_irq_save(flags);
 66         dvpe();
 67         settc(1);
 68         write_vpe_c0_cause(read_vpe_c0_cause() | C_SW0);
 69         evpe(EVPE_ENABLE);
 70         local_irq_restore(flags);
 71 }
 72 
 73 int __init rtlx_module_init(void)
 74 {
 75         struct device *dev;
 76         int i, err;
 77 
 78         if (!cpu_has_mipsmt) {
 79                 pr_warn("VPE loader: not a MIPS MT capable processor\n");
 80                 return -ENODEV;
 81         }
 82 
 83         if (aprp_cpu_index() == 0) {
 84                 pr_warn("No TCs reserved for AP/SP, not initializing RTLX.\n"
 85                         "Pass maxtcs=<n> argument as kernel argument\n");
 86 
 87                 return -ENODEV;
 88         }
 89 
 90         major = register_chrdev(0, RTLX_MODULE_NAME, &rtlx_fops);
 91         if (major < 0) {
 92                 pr_err("rtlx_module_init: unable to register device\n");
 93                 return major;
 94         }
 95 
 96         /* initialise the wait queues */
 97         for (i = 0; i < RTLX_CHANNELS; i++) {
 98                 init_waitqueue_head(&channel_wqs[i].rt_queue);
 99                 init_waitqueue_head(&channel_wqs[i].lx_queue);
100                 atomic_set(&channel_wqs[i].in_open, 0);
101                 mutex_init(&channel_wqs[i].mutex);
102 
103                 dev = device_create(mt_class, NULL, MKDEV(major, i), NULL,
104                                     "%s%d", RTLX_MODULE_NAME, i);
105                 if (IS_ERR(dev)) {
106                         while (i--)
107                                 device_destroy(mt_class, MKDEV(major, i));
108 
109                         err = PTR_ERR(dev);
110                         goto out_chrdev;
111                 }
112         }
113 
114         /* set up notifiers */
115         rtlx_notify.start = rtlx_starting;
116         rtlx_notify.stop = rtlx_stopping;
117         vpe_notify(aprp_cpu_index(), &rtlx_notify);
118 
119         if (cpu_has_vint) {
120                 aprp_hook = rtlx_dispatch;
121         } else {
122                 pr_err("APRP RTLX init on non-vectored-interrupt processor\n");
123                 err = -ENODEV;
124                 goto out_class;
125         }
126 
127         rtlx_irq.dev_id = rtlx;
128         err = setup_irq(rtlx_irq_num, &rtlx_irq);
129         if (err)
130                 goto out_class;
131 
132         return 0;
133 
134 out_class:
135         for (i = 0; i < RTLX_CHANNELS; i++)
136                 device_destroy(mt_class, MKDEV(major, i));
137 out_chrdev:
138         unregister_chrdev(major, RTLX_MODULE_NAME);
139 
140         return err;
141 }
142 
143 void __exit rtlx_module_exit(void)
144 {
145         int i;
146 
147         for (i = 0; i < RTLX_CHANNELS; i++)
148                 device_destroy(mt_class, MKDEV(major, i));
149 
150         unregister_chrdev(major, RTLX_MODULE_NAME);
151 
152         aprp_hook = NULL;
153 }
154 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp