| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  *  icu.c, Interrupt Control Unit routines for the NEC VR4100 series. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  Copyright (C) 2001-2002  MontaVista Software Inc. | 
					
						
							| 
									
										
										
										
											2009-07-03 00:39:38 +09:00
										 |  |  |  *    Author: Yoichi Yuasa <source@mvista.com> | 
					
						
							|  |  |  |  *  Copyright (C) 2003-2006  Yoichi Yuasa <yuasa@linux-mips.org> | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  * | 
					
						
							|  |  |  |  *  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. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  This program is distributed in the hope that it will be useful, | 
					
						
							|  |  |  |  *  but WITHOUT ANY WARRANTY; without even the implied warranty of | 
					
						
							|  |  |  |  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
					
						
							|  |  |  |  *  GNU General Public License for more details. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  You should have received a copy of the GNU General Public License | 
					
						
							|  |  |  |  *  along with this program; if not, write to the Free Software | 
					
						
							|  |  |  |  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * Changes: | 
					
						
							| 
									
										
										
										
											2009-07-03 00:39:38 +09:00
										 |  |  |  *  MontaVista Software Inc. <source@mvista.com> | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  *  - New creation, NEC VR4122 and VR4131 are supported. | 
					
						
							|  |  |  |  *  - Added support for NEC VR4111 and VR4121. | 
					
						
							|  |  |  |  * | 
					
						
							| 
									
										
										
										
											2009-07-03 00:39:38 +09:00
										 |  |  |  *  Yoichi Yuasa <yuasa@linux-mips.org> | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  *  - Coped with INTASSIGN of NEC VR4133. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | #include <linux/errno.h>
 | 
					
						
							|  |  |  | #include <linux/init.h>
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | #include <linux/ioport.h>
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <linux/irq.h>
 | 
					
						
							|  |  |  | #include <linux/module.h>
 | 
					
						
							|  |  |  | #include <linux/smp.h>
 | 
					
						
							|  |  |  | #include <linux/types.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <asm/cpu.h>
 | 
					
						
							|  |  |  | #include <asm/io.h>
 | 
					
						
							| 
									
										
										
										
											2006-07-13 17:33:03 +09:00
										 |  |  | #include <asm/vr41xx/irq.h>
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <asm/vr41xx/vr41xx.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | static void __iomem *icu1_base; | 
					
						
							|  |  |  | static void __iomem *icu2_base; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | static unsigned char sysint1_assign[16] = { | 
					
						
							|  |  |  | 	0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }; | 
					
						
							|  |  |  | static unsigned char sysint2_assign[16] = { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | #define ICU1_TYPE1_BASE	0x0b000080UL
 | 
					
						
							|  |  |  | #define ICU2_TYPE1_BASE	0x0b000200UL
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | #define ICU1_TYPE2_BASE	0x0f000080UL
 | 
					
						
							|  |  |  | #define ICU2_TYPE2_BASE	0x0f0000a0UL
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define ICU1_SIZE	0x20
 | 
					
						
							|  |  |  | #define ICU2_SIZE	0x1c
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | #define SYSINT1REG	0x00
 | 
					
						
							|  |  |  | #define PIUINTREG	0x02
 | 
					
						
							|  |  |  | #define INTASSIGN0	0x04
 | 
					
						
							|  |  |  | #define INTASSIGN1	0x06
 | 
					
						
							|  |  |  | #define GIUINTLREG	0x08
 | 
					
						
							|  |  |  | #define DSIUINTREG	0x0a
 | 
					
						
							|  |  |  | #define MSYSINT1REG	0x0c
 | 
					
						
							|  |  |  | #define MPIUINTREG	0x0e
 | 
					
						
							|  |  |  | #define MAIUINTREG	0x10
 | 
					
						
							|  |  |  | #define MKIUINTREG	0x12
 | 
					
						
							| 
									
										
										
										
											2007-01-11 23:53:18 +09:00
										 |  |  | #define MMACINTREG	0x12
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define MGIUINTLREG	0x14
 | 
					
						
							|  |  |  | #define MDSIUINTREG	0x16
 | 
					
						
							|  |  |  | #define NMIREG		0x18
 | 
					
						
							|  |  |  | #define SOFTREG		0x1a
 | 
					
						
							|  |  |  | #define INTASSIGN2	0x1c
 | 
					
						
							|  |  |  | #define INTASSIGN3	0x1e
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define SYSINT2REG	0x00
 | 
					
						
							|  |  |  | #define GIUINTHREG	0x02
 | 
					
						
							|  |  |  | #define FIRINTREG	0x04
 | 
					
						
							|  |  |  | #define MSYSINT2REG	0x06
 | 
					
						
							|  |  |  | #define MGIUINTHREG	0x08
 | 
					
						
							|  |  |  | #define MFIRINTREG	0x0a
 | 
					
						
							|  |  |  | #define PCIINTREG	0x0c
 | 
					
						
							|  |  |  |  #define PCIINT0	0x0001
 | 
					
						
							|  |  |  | #define SCUINTREG	0x0e
 | 
					
						
							|  |  |  |  #define SCUINT0	0x0001
 | 
					
						
							|  |  |  | #define CSIINTREG	0x10
 | 
					
						
							|  |  |  | #define MPCIINTREG	0x12
 | 
					
						
							|  |  |  | #define MSCUINTREG	0x14
 | 
					
						
							|  |  |  | #define MCSIINTREG	0x16
 | 
					
						
							|  |  |  | #define BCUINTREG	0x18
 | 
					
						
							|  |  |  |  #define BCUINTR	0x0001
 | 
					
						
							|  |  |  | #define MBCUINTREG	0x1a
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define SYSINT1_IRQ_TO_PIN(x)	((x) - SYSINT1_IRQ_BASE)	/* Pin 0-15 */
 | 
					
						
							|  |  |  | #define SYSINT2_IRQ_TO_PIN(x)	((x) - SYSINT2_IRQ_BASE)	/* Pin 0-15 */
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | #define INT_TO_IRQ(x)		((x) + 2)	/* Int0-4 -> IRQ2-6 */
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define icu1_read(offset)		readw(icu1_base + (offset))
 | 
					
						
							|  |  |  | #define icu1_write(offset, value)	writew((value), icu1_base + (offset))
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | #define icu2_read(offset)		readw(icu2_base + (offset))
 | 
					
						
							|  |  |  | #define icu2_write(offset, value)	writew((value), icu2_base + (offset))
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | #define INTASSIGN_MAX	4
 | 
					
						
							|  |  |  | #define INTASSIGN_MASK	0x0007
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | static inline uint16_t icu1_set(uint8_t offset, uint16_t set) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	uint16_t data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	data = icu1_read(offset); | 
					
						
							|  |  |  | 	data |= set; | 
					
						
							|  |  |  | 	icu1_write(offset, data); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	return data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | static inline uint16_t icu1_clear(uint8_t offset, uint16_t clear) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	uint16_t data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	data = icu1_read(offset); | 
					
						
							|  |  |  | 	data &= ~clear; | 
					
						
							|  |  |  | 	icu1_write(offset, data); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	return data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | static inline uint16_t icu2_set(uint8_t offset, uint16_t set) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	uint16_t data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	data = icu2_read(offset); | 
					
						
							|  |  |  | 	data |= set; | 
					
						
							|  |  |  | 	icu2_write(offset, data); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	return data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | static inline uint16_t icu2_clear(uint8_t offset, uint16_t clear) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	uint16_t data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	data = icu2_read(offset); | 
					
						
							|  |  |  | 	data &= ~clear; | 
					
						
							|  |  |  | 	icu2_write(offset, data); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	return data; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_piuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + PIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4111 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4121) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_set(MPIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_piuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_piuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + PIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4111 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4121) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_clear(MPIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_piuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_aiuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + AIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4111 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4121) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_set(MAIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_aiuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_aiuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + AIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4111 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4121) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_clear(MAIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_aiuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_kiuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + KIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4111 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4121) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_set(MKIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_kiuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_kiuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + KIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4111 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4121) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_clear(MKIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_kiuint); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-01-11 23:53:18 +09:00
										 |  |  | void vr41xx_enable_macint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct irq_desc *desc = irq_desc + ETHERNET_IRQ; | 
					
						
							|  |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2007-01-11 23:53:18 +09:00
										 |  |  | 	icu1_set(MMACINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2007-01-11 23:53:18 +09:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_macint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_macint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct irq_desc *desc = irq_desc + ETHERNET_IRQ; | 
					
						
							|  |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2007-01-11 23:53:18 +09:00
										 |  |  | 	icu1_clear(MMACINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2007-01-11 23:53:18 +09:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_macint); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | void vr41xx_enable_dsiuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + DSIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_set(MDSIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_dsiuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_dsiuint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + DSIU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_clear(MDSIUINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_dsiuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_firint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + FIR_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu2_set(MFIRINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_firint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_firint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + FIR_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu2_clear(MFIRINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_firint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_pciint(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + PCI_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_write(MPCIINTREG, PCIINT0); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_pciint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_pciint(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + PCI_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_write(MPCIINTREG, 0); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_pciint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_scuint(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + SCU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_write(MSCUINTREG, SCUINT0); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_scuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_scuint(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + SCU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_write(MSCUINTREG, 0); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_scuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_csiint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + CSI_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_set(MCSIINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_csiint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_csiint(uint16_t mask) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + CSI_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_clear(MCSIINTREG, mask); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_csiint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_enable_bcuint(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + BCU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_write(MBCUINTREG, BCUINTR); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_enable_bcuint); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void vr41xx_disable_bcuint(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + BCU_IRQ; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() == CPU_VR4122 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4131 || | 
					
						
							|  |  |  | 	    current_cpu_type() == CPU_VR4133) { | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_lock_irqsave(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu2_write(MBCUINTREG, 0); | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irqrestore(&desc->lock, flags); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_disable_bcuint); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-11-02 02:08:36 +09:00
										 |  |  | static void disable_sysint1_irq(unsigned int irq) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_clear(MSYSINT1REG, 1 << SYSINT1_IRQ_TO_PIN(irq)); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void enable_sysint1_irq(unsigned int irq) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_set(MSYSINT1REG, 1 << SYSINT1_IRQ_TO_PIN(irq)); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | static struct irq_chip sysint1_irq_type = { | 
					
						
							| 
									
										
										
										
											2007-01-15 00:07:25 +09:00
										 |  |  | 	.name		= "SYSINT1", | 
					
						
							| 
									
										
										
										
											2006-11-02 02:08:36 +09:00
										 |  |  | 	.ack		= disable_sysint1_irq, | 
					
						
							|  |  |  | 	.mask		= disable_sysint1_irq, | 
					
						
							|  |  |  | 	.mask_ack	= disable_sysint1_irq, | 
					
						
							|  |  |  | 	.unmask		= enable_sysint1_irq, | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-11-02 02:08:36 +09:00
										 |  |  | static void disable_sysint2_irq(unsigned int irq) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu2_clear(MSYSINT2REG, 1 << SYSINT2_IRQ_TO_PIN(irq)); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void enable_sysint2_irq(unsigned int irq) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu2_set(MSYSINT2REG, 1 << SYSINT2_IRQ_TO_PIN(irq)); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | static struct irq_chip sysint2_irq_type = { | 
					
						
							| 
									
										
										
										
											2007-01-15 00:07:25 +09:00
										 |  |  | 	.name		= "SYSINT2", | 
					
						
							| 
									
										
										
										
											2006-11-02 02:08:36 +09:00
										 |  |  | 	.ack		= disable_sysint2_irq, | 
					
						
							|  |  |  | 	.mask		= disable_sysint2_irq, | 
					
						
							|  |  |  | 	.mask_ack	= disable_sysint2_irq, | 
					
						
							|  |  |  | 	.unmask		= enable_sysint2_irq, | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static inline int set_sysint1_assign(unsigned int irq, unsigned char assign) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + irq; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	uint16_t intassign0, intassign1; | 
					
						
							|  |  |  | 	unsigned int pin; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pin = SYSINT1_IRQ_TO_PIN(irq); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irq(&desc->lock); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	intassign0 = icu1_read(INTASSIGN0); | 
					
						
							|  |  |  | 	intassign1 = icu1_read(INTASSIGN1); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	switch (pin) { | 
					
						
							|  |  |  | 	case 0: | 
					
						
							|  |  |  | 		intassign0 &= ~INTASSIGN_MASK; | 
					
						
							|  |  |  | 		intassign0 |= (uint16_t)assign; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 1: | 
					
						
							|  |  |  | 		intassign0 &= ~(INTASSIGN_MASK << 3); | 
					
						
							|  |  |  | 		intassign0 |= (uint16_t)assign << 3; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 2: | 
					
						
							|  |  |  | 		intassign0 &= ~(INTASSIGN_MASK << 6); | 
					
						
							|  |  |  | 		intassign0 |= (uint16_t)assign << 6; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 3: | 
					
						
							|  |  |  | 		intassign0 &= ~(INTASSIGN_MASK << 9); | 
					
						
							|  |  |  | 		intassign0 |= (uint16_t)assign << 9; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 8: | 
					
						
							|  |  |  | 		intassign0 &= ~(INTASSIGN_MASK << 12); | 
					
						
							|  |  |  | 		intassign0 |= (uint16_t)assign << 12; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 9: | 
					
						
							|  |  |  | 		intassign1 &= ~INTASSIGN_MASK; | 
					
						
							|  |  |  | 		intassign1 |= (uint16_t)assign; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 11: | 
					
						
							|  |  |  | 		intassign1 &= ~(INTASSIGN_MASK << 6); | 
					
						
							|  |  |  | 		intassign1 |= (uint16_t)assign << 6; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 12: | 
					
						
							|  |  |  | 		intassign1 &= ~(INTASSIGN_MASK << 9); | 
					
						
							|  |  |  | 		intassign1 |= (uint16_t)assign << 9; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irq(&desc->lock); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	sysint1_assign[pin] = assign; | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_write(INTASSIGN0, intassign0); | 
					
						
							|  |  |  | 	icu1_write(INTASSIGN1, intassign1); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irq(&desc->lock); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static inline int set_sysint2_assign(unsigned int irq, unsigned char assign) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2006-07-02 14:41:42 +01:00
										 |  |  | 	struct irq_desc *desc = irq_desc + irq; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	uint16_t intassign2, intassign3; | 
					
						
							|  |  |  | 	unsigned int pin; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pin = SYSINT2_IRQ_TO_PIN(irq); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_lock_irq(&desc->lock); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	intassign2 = icu1_read(INTASSIGN2); | 
					
						
							|  |  |  | 	intassign3 = icu1_read(INTASSIGN3); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	switch (pin) { | 
					
						
							|  |  |  | 	case 0: | 
					
						
							|  |  |  | 		intassign2 &= ~INTASSIGN_MASK; | 
					
						
							|  |  |  | 		intassign2 |= (uint16_t)assign; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 1: | 
					
						
							|  |  |  | 		intassign2 &= ~(INTASSIGN_MASK << 3); | 
					
						
							|  |  |  | 		intassign2 |= (uint16_t)assign << 3; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 3: | 
					
						
							|  |  |  | 		intassign2 &= ~(INTASSIGN_MASK << 6); | 
					
						
							|  |  |  | 		intassign2 |= (uint16_t)assign << 6; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 4: | 
					
						
							|  |  |  | 		intassign2 &= ~(INTASSIGN_MASK << 9); | 
					
						
							|  |  |  | 		intassign2 |= (uint16_t)assign << 9; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 5: | 
					
						
							|  |  |  | 		intassign2 &= ~(INTASSIGN_MASK << 12); | 
					
						
							|  |  |  | 		intassign2 |= (uint16_t)assign << 12; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 6: | 
					
						
							|  |  |  | 		intassign3 &= ~INTASSIGN_MASK; | 
					
						
							|  |  |  | 		intassign3 |= (uint16_t)assign; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 7: | 
					
						
							|  |  |  | 		intassign3 &= ~(INTASSIGN_MASK << 3); | 
					
						
							|  |  |  | 		intassign3 |= (uint16_t)assign << 3; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 8: | 
					
						
							|  |  |  | 		intassign3 &= ~(INTASSIGN_MASK << 6); | 
					
						
							|  |  |  | 		intassign3 |= (uint16_t)assign << 6; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 9: | 
					
						
							|  |  |  | 		intassign3 &= ~(INTASSIGN_MASK << 9); | 
					
						
							|  |  |  | 		intassign3 |= (uint16_t)assign << 9; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case 10: | 
					
						
							|  |  |  | 		intassign3 &= ~(INTASSIGN_MASK << 12); | 
					
						
							|  |  |  | 		intassign3 |= (uint16_t)assign << 12; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 		raw_spin_unlock_irq(&desc->lock); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	sysint2_assign[pin] = assign; | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_write(INTASSIGN2, intassign2); | 
					
						
							|  |  |  | 	icu1_write(INTASSIGN3, intassign3); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-17 16:46:45 +01:00
										 |  |  | 	raw_spin_unlock_irq(&desc->lock); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int vr41xx_set_intassign(unsigned int irq, unsigned char intassign) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int retval = -EINVAL; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	if (current_cpu_type() != CPU_VR4133) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (intassign > INTASSIGN_MAX) | 
					
						
							|  |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (irq >= SYSINT1_IRQ_BASE && irq <= SYSINT1_IRQ_LAST) | 
					
						
							|  |  |  | 		retval = set_sysint1_assign(irq, intassign); | 
					
						
							|  |  |  | 	else if (irq >= SYSINT2_IRQ_BASE && irq <= SYSINT2_IRQ_LAST) | 
					
						
							|  |  |  | 		retval = set_sysint2_assign(irq, intassign); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return retval; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | EXPORT_SYMBOL(vr41xx_set_intassign); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-10-07 19:44:33 +01:00
										 |  |  | static int icu_get_irq(unsigned int irq) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | { | 
					
						
							|  |  |  | 	uint16_t pend1, pend2; | 
					
						
							|  |  |  | 	uint16_t mask1, mask2; | 
					
						
							|  |  |  | 	int i; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	pend1 = icu1_read(SYSINT1REG); | 
					
						
							|  |  |  | 	mask1 = icu1_read(MSYSINT1REG); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	pend2 = icu2_read(SYSINT2REG); | 
					
						
							|  |  |  | 	mask2 = icu2_read(MSYSINT2REG); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	mask1 &= pend1; | 
					
						
							|  |  |  | 	mask2 &= pend2; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (mask1) { | 
					
						
							|  |  |  | 		for (i = 0; i < 16; i++) { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 			if (irq == INT_TO_IRQ(sysint1_assign[i]) && (mask1 & (1 << i))) | 
					
						
							|  |  |  | 				return SYSINT1_IRQ(i); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (mask2) { | 
					
						
							|  |  |  | 		for (i = 0; i < 16; i++) { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 			if (irq == INT_TO_IRQ(sysint2_assign[i]) && (mask2 & (1 << i))) | 
					
						
							|  |  |  | 				return SYSINT2_IRQ(i); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	printk(KERN_ERR "spurious ICU interrupt: %04x,%04x\n", pend1, pend2); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	atomic_inc(&irq_err_count); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	return -1; | 
					
						
							|  |  |  | } | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | static int __init vr41xx_icu_init(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	unsigned long icu1_start, icu2_start; | 
					
						
							|  |  |  | 	int i; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-11 23:46:15 +01:00
										 |  |  | 	switch (current_cpu_type()) { | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	case CPU_VR4111: | 
					
						
							|  |  |  | 	case CPU_VR4121: | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_start = ICU1_TYPE1_BASE; | 
					
						
							|  |  |  | 		icu2_start = ICU2_TYPE1_BASE; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		break; | 
					
						
							|  |  |  | 	case CPU_VR4122: | 
					
						
							|  |  |  | 	case CPU_VR4131: | 
					
						
							|  |  |  | 	case CPU_VR4133: | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		icu1_start = ICU1_TYPE2_BASE; | 
					
						
							|  |  |  | 		icu2_start = ICU2_TYPE2_BASE; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							|  |  |  | 		printk(KERN_ERR "ICU: Unexpected CPU of NEC VR4100 series\n"); | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 		return -ENODEV; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	if (request_mem_region(icu1_start, ICU1_SIZE, "ICU") == NULL) | 
					
						
							|  |  |  | 		return -EBUSY; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	if (request_mem_region(icu2_start, ICU2_SIZE, "ICU") == NULL) { | 
					
						
							|  |  |  | 		release_mem_region(icu1_start, ICU1_SIZE); | 
					
						
							|  |  |  | 		return -EBUSY; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_base = ioremap(icu1_start, ICU1_SIZE); | 
					
						
							|  |  |  | 	if (icu1_base == NULL) { | 
					
						
							|  |  |  | 		release_mem_region(icu1_start, ICU1_SIZE); | 
					
						
							|  |  |  | 		release_mem_region(icu2_start, ICU2_SIZE); | 
					
						
							|  |  |  | 		return -ENOMEM; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu2_base = ioremap(icu2_start, ICU2_SIZE); | 
					
						
							|  |  |  | 	if (icu2_base == NULL) { | 
					
						
							|  |  |  | 		iounmap(icu1_base); | 
					
						
							|  |  |  | 		release_mem_region(icu1_start, ICU1_SIZE); | 
					
						
							|  |  |  | 		release_mem_region(icu2_start, ICU2_SIZE); | 
					
						
							|  |  |  | 		return -ENOMEM; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu1_write(MSYSINT1REG, 0); | 
					
						
							|  |  |  | 	icu1_write(MGIUINTLREG, 0xffff); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	icu2_write(MSYSINT2REG, 0); | 
					
						
							|  |  |  | 	icu2_write(MGIUINTHREG, 0xffff); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	for (i = SYSINT1_IRQ_BASE; i <= SYSINT1_IRQ_LAST; i++) | 
					
						
							| 
									
										
										
										
											2006-11-14 01:13:18 +09:00
										 |  |  | 		set_irq_chip_and_handler(i, &sysint1_irq_type, | 
					
						
							|  |  |  | 					 handle_level_irq); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	for (i = SYSINT2_IRQ_BASE; i <= SYSINT2_IRQ_LAST; i++) | 
					
						
							| 
									
										
										
										
											2006-11-14 01:13:18 +09:00
										 |  |  | 		set_irq_chip_and_handler(i, &sysint2_irq_type, | 
					
						
							|  |  |  | 					 handle_level_irq); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	cascade_irq(INT0_IRQ, icu_get_irq); | 
					
						
							|  |  |  | 	cascade_irq(INT1_IRQ, icu_get_irq); | 
					
						
							|  |  |  | 	cascade_irq(INT2_IRQ, icu_get_irq); | 
					
						
							|  |  |  | 	cascade_irq(INT3_IRQ, icu_get_irq); | 
					
						
							|  |  |  | 	cascade_irq(INT4_IRQ, icu_get_irq); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 	return 0; | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:04 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | core_initcall(vr41xx_icu_init); |