 f7777dcc75
			
		
	
	
	f7777dcc75
	
	
	
		
			
			Panic() is going to add a \n itself and it's annoying if a panic message rolls of the screen on a device with no scrollback. Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
		
			
				
	
	
		
			157 lines
		
	
	
	
		
			4.1 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			157 lines
		
	
	
	
		
			4.1 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright 2001 MontaVista Software Inc.
 | |
|  * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
 | |
|  *
 | |
|  * Copyright (C) 2001 Ralf Baechle
 | |
|  * Copyright (C) 2005  MIPS Technologies, Inc.	All rights reserved.
 | |
|  *	Author: Maciej W. Rozycki <macro@mips.com>
 | |
|  *
 | |
|  * This file define the irq handler for MIPS CPU interrupts.
 | |
|  *
 | |
|  * This program is free software; you can redistribute	it and/or modify it
 | |
|  * under  the terms of	the GNU General	 Public License as published by the
 | |
|  * Free Software Foundation;  either version 2 of the  License, or (at your
 | |
|  * option) any later version.
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * Almost all MIPS CPUs define 8 interrupt sources.  They are typically
 | |
|  * level triggered (i.e., cannot be cleared from CPU; must be cleared from
 | |
|  * device).  The first two are software interrupts which we don't really
 | |
|  * use or support.  The last one is usually the CPU timer interrupt if
 | |
|  * counter register is present or, for CPUs with an external FPU, by
 | |
|  * convention it's the FPU exception interrupt.
 | |
|  *
 | |
|  * Don't even think about using this on SMP.  You have been warned.
 | |
|  *
 | |
|  * This file exports one global function:
 | |
|  *	void mips_cpu_irq_init(void);
 | |
|  */
 | |
| #include <linux/init.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/irq.h>
 | |
| #include <linux/irqdomain.h>
 | |
| 
 | |
| #include <asm/irq_cpu.h>
 | |
| #include <asm/mipsregs.h>
 | |
| #include <asm/mipsmtregs.h>
 | |
| 
 | |
| static inline void unmask_mips_irq(struct irq_data *d)
 | |
| {
 | |
| 	set_c0_status(0x100 << (d->irq - MIPS_CPU_IRQ_BASE));
 | |
| 	irq_enable_hazard();
 | |
| }
 | |
| 
 | |
| static inline void mask_mips_irq(struct irq_data *d)
 | |
| {
 | |
| 	clear_c0_status(0x100 << (d->irq - MIPS_CPU_IRQ_BASE));
 | |
| 	irq_disable_hazard();
 | |
| }
 | |
| 
 | |
| static struct irq_chip mips_cpu_irq_controller = {
 | |
| 	.name		= "MIPS",
 | |
| 	.irq_ack	= mask_mips_irq,
 | |
| 	.irq_mask	= mask_mips_irq,
 | |
| 	.irq_mask_ack	= mask_mips_irq,
 | |
| 	.irq_unmask	= unmask_mips_irq,
 | |
| 	.irq_eoi	= unmask_mips_irq,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * Basically the same as above but taking care of all the MT stuff
 | |
|  */
 | |
| 
 | |
| static unsigned int mips_mt_cpu_irq_startup(struct irq_data *d)
 | |
| {
 | |
| 	unsigned int vpflags = dvpe();
 | |
| 
 | |
| 	clear_c0_cause(0x100 << (d->irq - MIPS_CPU_IRQ_BASE));
 | |
| 	evpe(vpflags);
 | |
| 	unmask_mips_irq(d);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * While we ack the interrupt interrupts are disabled and thus we don't need
 | |
|  * to deal with concurrency issues.  Same for mips_cpu_irq_end.
 | |
|  */
 | |
| static void mips_mt_cpu_irq_ack(struct irq_data *d)
 | |
| {
 | |
| 	unsigned int vpflags = dvpe();
 | |
| 	clear_c0_cause(0x100 << (d->irq - MIPS_CPU_IRQ_BASE));
 | |
| 	evpe(vpflags);
 | |
| 	mask_mips_irq(d);
 | |
| }
 | |
| 
 | |
| static struct irq_chip mips_mt_cpu_irq_controller = {
 | |
| 	.name		= "MIPS",
 | |
| 	.irq_startup	= mips_mt_cpu_irq_startup,
 | |
| 	.irq_ack	= mips_mt_cpu_irq_ack,
 | |
| 	.irq_mask	= mask_mips_irq,
 | |
| 	.irq_mask_ack	= mips_mt_cpu_irq_ack,
 | |
| 	.irq_unmask	= unmask_mips_irq,
 | |
| 	.irq_eoi	= unmask_mips_irq,
 | |
| };
 | |
| 
 | |
| void __init mips_cpu_irq_init(void)
 | |
| {
 | |
| 	int irq_base = MIPS_CPU_IRQ_BASE;
 | |
| 	int i;
 | |
| 
 | |
| 	/* Mask interrupts. */
 | |
| 	clear_c0_status(ST0_IM);
 | |
| 	clear_c0_cause(CAUSEF_IP);
 | |
| 
 | |
| 	/* Software interrupts are used for MT/CMT IPI */
 | |
| 	for (i = irq_base; i < irq_base + 2; i++)
 | |
| 		irq_set_chip_and_handler(i, cpu_has_mipsmt ?
 | |
| 					 &mips_mt_cpu_irq_controller :
 | |
| 					 &mips_cpu_irq_controller,
 | |
| 					 handle_percpu_irq);
 | |
| 
 | |
| 	for (i = irq_base + 2; i < irq_base + 8; i++)
 | |
| 		irq_set_chip_and_handler(i, &mips_cpu_irq_controller,
 | |
| 					 handle_percpu_irq);
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_IRQ_DOMAIN
 | |
| static int mips_cpu_intc_map(struct irq_domain *d, unsigned int irq,
 | |
| 			     irq_hw_number_t hw)
 | |
| {
 | |
| 	static struct irq_chip *chip;
 | |
| 
 | |
| 	if (hw < 2 && cpu_has_mipsmt) {
 | |
| 		/* Software interrupts are used for MT/CMT IPI */
 | |
| 		chip = &mips_mt_cpu_irq_controller;
 | |
| 	} else {
 | |
| 		chip = &mips_cpu_irq_controller;
 | |
| 	}
 | |
| 
 | |
| 	irq_set_chip_and_handler(irq, chip, handle_percpu_irq);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct irq_domain_ops mips_cpu_intc_irq_domain_ops = {
 | |
| 	.map = mips_cpu_intc_map,
 | |
| 	.xlate = irq_domain_xlate_onecell,
 | |
| };
 | |
| 
 | |
| int __init mips_cpu_intc_init(struct device_node *of_node,
 | |
| 			      struct device_node *parent)
 | |
| {
 | |
| 	struct irq_domain *domain;
 | |
| 
 | |
| 	/* Mask interrupts. */
 | |
| 	clear_c0_status(ST0_IM);
 | |
| 	clear_c0_cause(CAUSEF_IP);
 | |
| 
 | |
| 	domain = irq_domain_add_legacy(of_node, 8, MIPS_CPU_IRQ_BASE, 0,
 | |
| 				       &mips_cpu_intc_irq_domain_ops, NULL);
 | |
| 	if (!domain)
 | |
| 		panic("Failed to add irqdomain for MIPS CPU");
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| #endif /* CONFIG_IRQ_DOMAIN */
 |