[deliverable/linux.git] / arch / mips / kernel / genex.S

/*
 * 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) 1994 - 2000, 2001, 2003 Ralf Baechle
 * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
 * Copyright (C) 2002, 2007  Maciej W. Rozycki
 * Copyright (C) 2001, 2012 MIPS Technologies, Inc.  All rights reserved.
 */
#include <linux/init.h>

#include <asm/asm.h>
#include <asm/asmmacro.h>
#include <asm/cacheops.h>
#include <asm/irqflags.h>
#include <asm/regdef.h>
#include <asm/fpregdef.h>
#include <asm/mipsregs.h>
#include <asm/stackframe.h>
#include <asm/war.h>
#include <asm/thread_info.h>

	__INIT

/*
 * General exception vector for all other CPUs.
 *
 * Be careful when changing this, it has to be at most 128 bytes
 * to fit into space reserved for the exception handler.
 */
NESTED(except_vec3_generic, 0, sp)
	.set	push
	.set	noat
#if R5432_CP0_INTERRUPT_WAR
	mfc0	k0, CP0_INDEX
#endif
	mfc0	k1, CP0_CAUSE
	andi	k1, k1, 0x7c
#ifdef CONFIG_64BIT
	dsll	k1, k1, 1
#endif
	PTR_L	k0, exception_handlers(k1)
	jr	k0
	.set	pop
	END(except_vec3_generic)

/*
 * General exception handler for CPUs with virtual coherency exception.
 *
 * Be careful when changing this, it has to be at most 256 (as a special
 * exception) bytes to fit into space reserved for the exception handler.
 */
NESTED(except_vec3_r4000, 0, sp)
	.set	push
	.set	arch=r4000
	.set	noat
	mfc0	k1, CP0_CAUSE
	li	k0, 31<<2
	andi	k1, k1, 0x7c
	.set	push
	.set	noreorder
	.set	nomacro
	beq	k1, k0, handle_vced
	 li	k0, 14<<2
	beq	k1, k0, handle_vcei
#ifdef CONFIG_64BIT
	 dsll	k1, k1, 1
#endif
	.set	pop
	PTR_L	k0, exception_handlers(k1)
	jr	k0

	/*
	 * Big shit, we now may have two dirty primary cache lines for the same
	 * physical address.  We can safely invalidate the line pointed to by
	 * c0_badvaddr because after return from this exception handler the
	 * load / store will be re-executed.
	 */
handle_vced:
	MFC0	k0, CP0_BADVADDR
	li	k1, -4					# Is this ...
	and	k0, k1					# ... really needed?
	mtc0	zero, CP0_TAGLO
	cache	Index_Store_Tag_D, (k0)
	cache	Hit_Writeback_Inv_SD, (k0)
#ifdef CONFIG_PROC_FS
	PTR_LA	k0, vced_count
	lw	k1, (k0)
	addiu	k1, 1
	sw	k1, (k0)
#endif
	eret

handle_vcei:
	MFC0	k0, CP0_BADVADDR
	cache	Hit_Writeback_Inv_SD, (k0)		# also cleans pi
#ifdef CONFIG_PROC_FS
	PTR_LA	k0, vcei_count
	lw	k1, (k0)
	addiu	k1, 1
	sw	k1, (k0)
#endif
	eret
	.set	pop
	END(except_vec3_r4000)

	__FINIT

	.align	5	/* 32 byte rollback region */
LEAF(__r4k_wait)
	.set	push
	.set	noreorder
	/* start of rollback region */
	LONG_L	t0, TI_FLAGS($28)
	nop
	andi	t0, _TIF_NEED_RESCHED
	bnez	t0, 1f
	 nop
	nop
	nop
#ifdef CONFIG_CPU_MICROMIPS
	nop
	nop
	nop
	nop
#endif
	.set	arch=r4000
	wait
	/* end of rollback region (the region size must be power of two) */
1:
	jr	ra
	nop
	.set	pop
	END(__r4k_wait)

	.macro	BUILD_ROLLBACK_PROLOGUE handler
	FEXPORT(rollback_\handler)
	.set	push
	.set	noat
	MFC0	k0, CP0_EPC
	PTR_LA	k1, __r4k_wait
	ori	k0, 0x1f	/* 32 byte rollback region */
	xori	k0, 0x1f
	bne	k0, k1, 9f
	MTC0	k0, CP0_EPC
9:
	.set pop
	.endm

	.align	5
BUILD_ROLLBACK_PROLOGUE handle_int
NESTED(handle_int, PT_SIZE, sp)
#ifdef CONFIG_TRACE_IRQFLAGS
	/*
	 * Check to see if the interrupted code has just disabled
	 * interrupts and ignore this interrupt for now if so.
	 *
	 * local_irq_disable() disables interrupts and then calls
	 * trace_hardirqs_off() to track the state. If an interrupt is taken
	 * after interrupts are disabled but before the state is updated
	 * it will appear to restore_all that it is incorrectly returning with
	 * interrupts disabled
	 */
	.set	push
	.set	noat
	mfc0	k0, CP0_STATUS
#if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
	and	k0, ST0_IEP
	bnez	k0, 1f

	mfc0	k0, CP0_EPC
	.set	noreorder
	j	k0
	rfe
#else
	and	k0, ST0_IE
	bnez	k0, 1f

	eret
#endif
1:
	.set pop
#endif
	SAVE_ALL
	CLI
	TRACE_IRQS_OFF

	LONG_L	s0, TI_REGS($28)
	LONG_S	sp, TI_REGS($28)
	PTR_LA	ra, ret_from_irq
	PTR_LA  v0, plat_irq_dispatch
	jr	v0
#ifdef CONFIG_CPU_MICROMIPS
	nop
#endif
	END(handle_int)

	__INIT

/*
 * Special interrupt vector for MIPS64 ISA & embedded MIPS processors.
 * This is a dedicated interrupt exception vector which reduces the
 * interrupt processing overhead.  The jump instruction will be replaced
 * at the initialization time.
 *
 * Be careful when changing this, it has to be at most 128 bytes
 * to fit into space reserved for the exception handler.
 */
NESTED(except_vec4, 0, sp)
1:	j	1b			/* Dummy, will be replaced */
	END(except_vec4)

/*
 * EJTAG debug exception handler.
 * The EJTAG debug exception entry point is 0xbfc00480, which
 * normally is in the boot PROM, so the boot PROM must do an
 * unconditional jump to this vector.
 */
NESTED(except_vec_ejtag_debug, 0, sp)
	j	ejtag_debug_handler
#ifdef CONFIG_CPU_MICROMIPS
	 nop
#endif
	END(except_vec_ejtag_debug)

	__FINIT

/*
 * Vectored interrupt handler.
 * This prototype is copied to ebase + n*IntCtl.VS and patched
 * to invoke the handler
 */
BUILD_ROLLBACK_PROLOGUE except_vec_vi
NESTED(except_vec_vi, 0, sp)
	SAVE_SOME
	SAVE_AT
	.set	push
	.set	noreorder
	PTR_LA	v1, except_vec_vi_handler
FEXPORT(except_vec_vi_lui)
	lui	v0, 0		/* Patched */
	jr	v1
FEXPORT(except_vec_vi_ori)
	 ori	v0, 0		/* Patched */
	.set	pop
	END(except_vec_vi)
EXPORT(except_vec_vi_end)

/*
 * Common Vectored Interrupt code
 * Complete the register saves and invoke the handler which is passed in $v0
 */
NESTED(except_vec_vi_handler, 0, sp)
	SAVE_TEMP
	SAVE_STATIC
	CLI
#ifdef CONFIG_TRACE_IRQFLAGS
	move	s0, v0
	TRACE_IRQS_OFF
	move	v0, s0
#endif

	LONG_L	s0, TI_REGS($28)
	LONG_S	sp, TI_REGS($28)
	PTR_LA	ra, ret_from_irq
	jr	v0
	END(except_vec_vi_handler)

/*
 * EJTAG debug exception handler.
 */
NESTED(ejtag_debug_handler, PT_SIZE, sp)
	.set	push
	.set	noat
	MTC0	k0, CP0_DESAVE
	mfc0	k0, CP0_DEBUG

	sll	k0, k0, 30	# Check for SDBBP.
	bgez	k0, ejtag_return

	PTR_LA	k0, ejtag_debug_buffer
	LONG_S	k1, 0(k0)
	SAVE_ALL
	move	a0, sp
	jal	ejtag_exception_handler
	RESTORE_ALL
	PTR_LA	k0, ejtag_debug_buffer
	LONG_L	k1, 0(k0)

ejtag_return:
	MFC0	k0, CP0_DESAVE
	.set	mips32
	deret
	.set pop
	END(ejtag_debug_handler)

/*
 * This buffer is reserved for the use of the EJTAG debug
 * handler.
 */
	.data
EXPORT(ejtag_debug_buffer)
	.fill	LONGSIZE
	.previous

	__INIT

/*
 * NMI debug exception handler for MIPS reference boards.
 * The NMI debug exception entry point is 0xbfc00000, which
 * normally is in the boot PROM, so the boot PROM must do a
 * unconditional jump to this vector.
 */
NESTED(except_vec_nmi, 0, sp)
	j	nmi_handler
#ifdef CONFIG_CPU_MICROMIPS
	 nop
#endif
	END(except_vec_nmi)

	__FINIT

NESTED(nmi_handler, PT_SIZE, sp)
	.set	push
	.set	noat
	/*
	 * Clear ERL - restore segment mapping
	 * Clear BEV - required for page fault exception handler to work
	 */
	mfc0	k0, CP0_STATUS
	ori     k0, k0, ST0_EXL
	li	k1, ~(ST0_BEV | ST0_ERL)
	and     k0, k0, k1
	mtc0    k0, CP0_STATUS
	_ehb
	SAVE_ALL
	move	a0, sp
	jal	nmi_exception_handler
	/* nmi_exception_handler never returns */
	.set	pop
	END(nmi_handler)

	.macro	__build_clear_none
	.endm

	.macro	__build_clear_sti
	TRACE_IRQS_ON
	STI
	.endm

	.macro	__build_clear_cli
	CLI
	TRACE_IRQS_OFF
	.endm

	.macro	__build_clear_fpe
	.set	push
	/* gas fails to assemble cfc1 for some archs (octeon).*/ \
	.set	mips1
	SET_HARDFLOAT
	cfc1	a1, fcr31
	li	a2, ~(0x3f << 12)
	and	a2, a1
	ctc1	a2, fcr31
	.set	pop
	TRACE_IRQS_ON
	STI
	.endm

	.macro	__build_clear_ade
	MFC0	t0, CP0_BADVADDR
	PTR_S	t0, PT_BVADDR(sp)
	KMODE
	.endm

	.macro	__BUILD_silent exception
	.endm

	/* Gas tries to parse the PRINT argument as a string containing
	   string escapes and emits bogus warnings if it believes to
	   recognize an unknown escape code.  So make the arguments
	   start with an n and gas will believe \n is ok ...  */
	.macro	__BUILD_verbose nexception
	LONG_L	a1, PT_EPC(sp)
#ifdef CONFIG_32BIT
	PRINT("Got \nexception at %08lx\012")
#endif
#ifdef CONFIG_64BIT
	PRINT("Got \nexception at %016lx\012")
#endif
	.endm

	.macro	__BUILD_count exception
	LONG_L	t0,exception_count_\exception
	LONG_ADDIU t0, 1
	LONG_S	t0,exception_count_\exception
	.comm	exception_count\exception, 8, 8
	.endm

	.macro	__BUILD_HANDLER exception handler clear verbose ext
	.align	5
	NESTED(handle_\exception, PT_SIZE, sp)
	.set	noat
	SAVE_ALL
	FEXPORT(handle_\exception\ext)
	__BUILD_clear_\clear
	.set	at
	__BUILD_\verbose \exception
	move	a0, sp
	PTR_LA	ra, ret_from_exception
	j	do_\handler
	END(handle_\exception)
	.endm

	.macro	BUILD_HANDLER exception handler clear verbose
	__BUILD_HANDLER \exception \handler \clear \verbose _int
	.endm

	BUILD_HANDLER adel ade ade silent		/* #4  */
	BUILD_HANDLER ades ade ade silent		/* #5  */
	BUILD_HANDLER ibe be cli silent			/* #6  */
	BUILD_HANDLER dbe be cli silent			/* #7  */
	BUILD_HANDLER bp bp sti silent			/* #9  */
	BUILD_HANDLER ri ri sti silent			/* #10 */
	BUILD_HANDLER cpu cpu sti silent		/* #11 */
	BUILD_HANDLER ov ov sti silent			/* #12 */
	BUILD_HANDLER tr tr sti silent			/* #13 */
	BUILD_HANDLER msa_fpe msa_fpe sti silent	/* #14 */
	BUILD_HANDLER fpe fpe fpe silent		/* #15 */
	BUILD_HANDLER ftlb ftlb none silent		/* #16 */
	BUILD_HANDLER msa msa sti silent		/* #21 */
	BUILD_HANDLER mdmx mdmx sti silent		/* #22 */
#ifdef	CONFIG_HARDWARE_WATCHPOINTS
	/*
	 * For watch, interrupts will be enabled after the watch
	 * registers are read.
	 */
	BUILD_HANDLER watch watch cli silent		/* #23 */
#else
	BUILD_HANDLER watch watch sti verbose		/* #23 */
#endif
	BUILD_HANDLER mcheck mcheck cli verbose		/* #24 */
	BUILD_HANDLER mt mt sti silent			/* #25 */
	BUILD_HANDLER dsp dsp sti silent		/* #26 */
	BUILD_HANDLER reserved reserved sti verbose	/* others */

	.align	5
	LEAF(handle_ri_rdhwr_vivt)
	.set	push
	.set	noat
	.set	noreorder
	/* check if TLB contains a entry for EPC */
	MFC0	k1, CP0_ENTRYHI
	andi	k1, 0xff	/* ASID_MASK */
	MFC0	k0, CP0_EPC
	PTR_SRL k0, _PAGE_SHIFT + 1
	PTR_SLL k0, _PAGE_SHIFT + 1
	or	k1, k0
	MTC0	k1, CP0_ENTRYHI
	mtc0_tlbw_hazard
	tlbp
	tlb_probe_hazard
	mfc0	k1, CP0_INDEX
	.set	pop
	bltz	k1, handle_ri	/* slow path */
	/* fall thru */
	END(handle_ri_rdhwr_vivt)

	LEAF(handle_ri_rdhwr)
	.set	push
	.set	noat
	.set	noreorder
	/* MIPS32:    0x7c03e83b: rdhwr v1,$29 */
	/* microMIPS: 0x007d6b3c: rdhwr v1,$29 */
	MFC0	k1, CP0_EPC
#if defined(CONFIG_CPU_MICROMIPS) || defined(CONFIG_CPU_MIPS32_R2) || defined(CONFIG_CPU_MIPS64_R2)
	and     k0, k1, 1
	beqz    k0, 1f
	xor     k1, k0
	lhu     k0, (k1)
	lhu     k1, 2(k1)
	ins     k1, k0, 16, 16
	lui     k0, 0x007d
	b       docheck
	ori     k0, 0x6b3c
1:
	lui     k0, 0x7c03
	lw      k1, (k1)
	ori     k0, 0xe83b
#else
	andi    k0, k1, 1
	bnez    k0, handle_ri
	lui     k0, 0x7c03
	lw      k1, (k1)
	ori     k0, 0xe83b
#endif
	.set    reorder
docheck:
	bne	k0, k1, handle_ri	/* if not ours */

isrdhwr:
	/* The insn is rdhwr.  No need to check CAUSE.BD here. */
	get_saved_sp	/* k1 := current_thread_info */
	.set	noreorder
	MFC0	k0, CP0_EPC
#if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
	ori	k1, _THREAD_MASK
	xori	k1, _THREAD_MASK
	LONG_L	v1, TI_TP_VALUE(k1)
	LONG_ADDIU	k0, 4
	jr	k0
	 rfe
#else
#ifndef CONFIG_CPU_DADDI_WORKAROUNDS
	LONG_ADDIU	k0, 4		/* stall on $k0 */
#else
	.set	at=v1
	LONG_ADDIU	k0, 4
	.set	noat
#endif
	MTC0	k0, CP0_EPC
	/* I hope three instructions between MTC0 and ERET are enough... */
	ori	k1, _THREAD_MASK
	xori	k1, _THREAD_MASK
	LONG_L	v1, TI_TP_VALUE(k1)
	.set	arch=r4000
	eret
	.set	mips0
#endif
	.set	pop
	END(handle_ri_rdhwr)

#ifdef CONFIG_64BIT
/* A temporary overflow handler used by check_daddi(). */

	__INIT

	BUILD_HANDLER  daddi_ov daddi_ov none silent	/* #12 */
#endif
Commit	Line	Data
1da177e4 LT	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) 1994 - 2000, 2001, 2003 Ralf Baechle
	7	* Copyright (C) 1999, 2000 Silicon Graphics, Inc.
619b6e18	8	* Copyright (C) 2002, 2007 Maciej W. Rozycki
2a0b24f5	9	* Copyright (C) 2001, 2012 MIPS Technologies, Inc. All rights reserved.
1da177e4	10	*/
1da177e4 LT	11	#include <linux/init.h>
	12
	13	#include <asm/asm.h>
41c594ab	14	#include <asm/asmmacro.h>
1da177e4	15	#include <asm/cacheops.h>
192ef366	16	#include <asm/irqflags.h>
1da177e4 LT	17	#include <asm/regdef.h>
	18	#include <asm/fpregdef.h>
	19	#include <asm/mipsregs.h>
	20	#include <asm/stackframe.h>
	21	#include <asm/war.h>
c65a5480	22	#include <asm/thread_info.h>
1da177e4	23
1da177e4 LT	24	__INIT
1da177e4 LT	25
1da177e4 LT	26	/*
	27	* General exception vector for all other CPUs.
	28	*
	29	* Be careful when changing this, it has to be at most 128 bytes
	30	* to fit into space reserved for the exception handler.
	31	*/
	32	NESTED(except_vec3_generic, 0, sp)
	33	.set push
	34	.set noat
	35	#if R5432_CP0_INTERRUPT_WAR
	36	mfc0 k0, CP0_INDEX
	37	#endif
	38	mfc0 k1, CP0_CAUSE
	39	andi k1, k1, 0x7c
875d43e7	40	#ifdef CONFIG_64BIT
1da177e4 LT	41	dsll k1, k1, 1
	42	#endif
	43	PTR_L k0, exception_handlers(k1)
	44	jr k0
	45	.set pop
	46	END(except_vec3_generic)
	47
	48	/*
	49	* General exception handler for CPUs with virtual coherency exception.
	50	*
	51	* Be careful when changing this, it has to be at most 256 (as a special
	52	* exception) bytes to fit into space reserved for the exception handler.
	53	*/
	54	NESTED(except_vec3_r4000, 0, sp)
	55	.set push
a809d460	56	.set arch=r4000
1da177e4 LT	57	.set noat
	58	mfc0 k1, CP0_CAUSE
	59	li k0, 31<<2
	60	andi k1, k1, 0x7c
	61	.set push
	62	.set noreorder
	63	.set nomacro
	64	beq k1, k0, handle_vced
	65	li k0, 14<<2
	66	beq k1, k0, handle_vcei
875d43e7	67	#ifdef CONFIG_64BIT
69903d65	68	dsll k1, k1, 1
1da177e4 LT	69	#endif
	70	.set pop
	71	PTR_L k0, exception_handlers(k1)
	72	jr k0
	73
	74	/*
	75	* Big shit, we now may have two dirty primary cache lines for the same
69903d65	76	* physical address. We can safely invalidate the line pointed to by
1da177e4 LT	77	* c0_badvaddr because after return from this exception handler the
	78	* load / store will be re-executed.
	79	*/
	80	handle_vced:
69903d65	81	MFC0 k0, CP0_BADVADDR
1da177e4 LT	82	li k1, -4 # Is this ...
	83	and k0, k1 # ... really needed?
	84	mtc0 zero, CP0_TAGLO
69903d65 TS	85	cache Index_Store_Tag_D, (k0)
69903d65 TS	86	cache Hit_Writeback_Inv_SD, (k0)
1da177e4 LT	87	#ifdef CONFIG_PROC_FS
	88	PTR_LA k0, vced_count
	89	lw k1, (k0)
	90	addiu k1, 1
	91	sw k1, (k0)
	92	#endif
	93	eret
	94
	95	handle_vcei:
	96	MFC0 k0, CP0_BADVADDR
	97	cache Hit_Writeback_Inv_SD, (k0) # also cleans pi
	98	#ifdef CONFIG_PROC_FS
	99	PTR_LA k0, vcei_count
	100	lw k1, (k0)
	101	addiu k1, 1
	102	sw k1, (k0)
	103	#endif
	104	eret
	105	.set pop
	106	END(except_vec3_r4000)
	107
e4ac58af RB	108	__FINIT
e4ac58af RB	109
c65a5480	110	.align 5 /* 32 byte rollback region */
087d990b	111	LEAF(__r4k_wait)
c65a5480 AN	112	.set push
	113	.set noreorder
	114	/* start of rollback region */
	115	LONG_L t0, TI_FLAGS($28)
	116	nop
	117	andi t0, _TIF_NEED_RESCHED
	118	bnez t0, 1f
	119	nop
	120	nop
	121	nop
2a0b24f5 SH	122	#ifdef CONFIG_CPU_MICROMIPS
	123	nop
	124	nop
	125	nop
	126	nop
	127	#endif
a809d460	128	.set arch=r4000
c65a5480 AN	129	wait
c65a5480 AN	130	/* end of rollback region (the region size must be power of two) */
c65a5480 AN	131	1:
c65a5480 AN	132	jr ra
2a0b24f5 SH	133	nop
2a0b24f5 SH	134	.set pop
087d990b	135	END(__r4k_wait)
c65a5480 AN	136
	137	.macro BUILD_ROLLBACK_PROLOGUE handler
	138	FEXPORT(rollback_\handler)
	139	.set push
	140	.set noat
	141	MFC0 k0, CP0_EPC
087d990b	142	PTR_LA k1, __r4k_wait
c65a5480 AN	143	ori k0, 0x1f /* 32 byte rollback region */
	144	xori k0, 0x1f
	145	bne k0, k1, 9f
	146	MTC0 k0, CP0_EPC
	147	9:
	148	.set pop
	149	.endm
	150
70342287	151	.align 5
c65a5480	152	BUILD_ROLLBACK_PROLOGUE handle_int
e4ac58af	153	NESTED(handle_int, PT_SIZE, sp)
fe99f1b1 CD	154	#ifdef CONFIG_TRACE_IRQFLAGS
	155	/*
	156	* Check to see if the interrupted code has just disabled
	157	* interrupts and ignore this interrupt for now if so.
	158	*
	159	* local_irq_disable() disables interrupts and then calls
	160	* trace_hardirqs_off() to track the state. If an interrupt is taken
	161	* after interrupts are disabled but before the state is updated
	162	* it will appear to restore_all that it is incorrectly returning with
	163	* interrupts disabled
	164	*/
	165	.set push
	166	.set noat
	167	mfc0 k0, CP0_STATUS
	168	#if defined(CONFIG_CPU_R3000) \|\| defined(CONFIG_CPU_TX39XX)
	169	and k0, ST0_IEP
	170	bnez k0, 1f
	171
c6563e85	172	mfc0 k0, CP0_EPC
fe99f1b1 CD	173	.set noreorder
	174	j k0
	175	rfe
	176	#else
	177	and k0, ST0_IE
	178	bnez k0, 1f
	179
	180	eret
	181	#endif
	182	1:
	183	.set pop
	184	#endif
e4ac58af RB	185	SAVE_ALL
e4ac58af RB	186	CLI
192ef366	187	TRACE_IRQS_OFF
e4ac58af	188
937a8015 RB	189	LONG_L s0, TI_REGS($28)
937a8015 RB	190	LONG_S sp, TI_REGS($28)
f431baa5	191	PTR_LA ra, ret_from_irq
2a0b24f5 SH	192	PTR_LA v0, plat_irq_dispatch
	193	jr v0
	194	#ifdef CONFIG_CPU_MICROMIPS
	195	nop
	196	#endif
e4ac58af RB	197	END(handle_int)
	198
	199	__INIT
	200
1da177e4 LT	201	/*
	202	* Special interrupt vector for MIPS64 ISA & embedded MIPS processors.
	203	* This is a dedicated interrupt exception vector which reduces the
	204	* interrupt processing overhead. The jump instruction will be replaced
	205	* at the initialization time.
	206	*
	207	* Be careful when changing this, it has to be at most 128 bytes
	208	* to fit into space reserved for the exception handler.
	209	*/
	210	NESTED(except_vec4, 0, sp)
	211	1: j 1b /* Dummy, will be replaced */
	212	END(except_vec4)
	213
	214	/*
	215	* EJTAG debug exception handler.
	216	* The EJTAG debug exception entry point is 0xbfc00480, which
2a0b24f5	217	* normally is in the boot PROM, so the boot PROM must do an
1da177e4 LT	218	* unconditional jump to this vector.
	219	*/
	220	NESTED(except_vec_ejtag_debug, 0, sp)
	221	j ejtag_debug_handler
2a0b24f5 SH	222	#ifdef CONFIG_CPU_MICROMIPS
	223	nop
	224	#endif
1da177e4 LT	225	END(except_vec_ejtag_debug)
	226
	227	__FINIT
	228
e01402b1 RB	229	/*
	230	* Vectored interrupt handler.
	231	* This prototype is copied to ebase + n*IntCtl.VS and patched
	232	* to invoke the handler
	233	*/
c65a5480	234	BUILD_ROLLBACK_PROLOGUE except_vec_vi
e01402b1 RB	235	NESTED(except_vec_vi, 0, sp)
	236	SAVE_SOME
	237	SAVE_AT
	238	.set push
	239	.set noreorder
2a0b24f5	240	PTR_LA v1, except_vec_vi_handler
7df42461	241	FEXPORT(except_vec_vi_lui)
e01402b1	242	lui v0, 0 /* Patched */
2a0b24f5	243	jr v1
7df42461	244	FEXPORT(except_vec_vi_ori)
e01402b1 RB	245	ori v0, 0 /* Patched */
	246	.set pop
	247	END(except_vec_vi)
	248	EXPORT(except_vec_vi_end)
	249
	250	/*
	251	* Common Vectored Interrupt code
	252	* Complete the register saves and invoke the handler which is passed in $v0
	253	*/
	254	NESTED(except_vec_vi_handler, 0, sp)
	255	SAVE_TEMP
	256	SAVE_STATIC
	257	CLI
8c364435 RB	258	#ifdef CONFIG_TRACE_IRQFLAGS
8c364435 RB	259	move s0, v0
192ef366	260	TRACE_IRQS_OFF
8c364435 RB	261	move v0, s0
8c364435 RB	262	#endif
937a8015 RB	263
	264	LONG_L s0, TI_REGS($28)
	265	LONG_S sp, TI_REGS($28)
23126692	266	PTR_LA ra, ret_from_irq
f431baa5	267	jr v0
e01402b1 RB	268	END(except_vec_vi_handler)
e01402b1 RB	269
1da177e4 LT	270	/*
	271	* EJTAG debug exception handler.
	272	*/
	273	NESTED(ejtag_debug_handler, PT_SIZE, sp)
	274	.set push
	275	.set noat
	276	MTC0 k0, CP0_DESAVE
	277	mfc0 k0, CP0_DEBUG
	278
	279	sll k0, k0, 30 # Check for SDBBP.
	280	bgez k0, ejtag_return
	281
	282	PTR_LA k0, ejtag_debug_buffer
	283	LONG_S k1, 0(k0)
	284	SAVE_ALL
	285	move a0, sp
	286	jal ejtag_exception_handler
	287	RESTORE_ALL
	288	PTR_LA k0, ejtag_debug_buffer
	289	LONG_L k1, 0(k0)
	290
	291	ejtag_return:
	292	MFC0 k0, CP0_DESAVE
	293	.set mips32
	294	deret
	295	.set pop
	296	END(ejtag_debug_handler)
	297
	298	/*
	299	* This buffer is reserved for the use of the EJTAG debug
	300	* handler.
	301	*/
	302	.data
	303	EXPORT(ejtag_debug_buffer)
	304	.fill LONGSIZE
	305	.previous
	306
	307	__INIT
	308
	309	/*
	310	* NMI debug exception handler for MIPS reference boards.
	311	* The NMI debug exception entry point is 0xbfc00000, which
	312	* normally is in the boot PROM, so the boot PROM must do a
	313	* unconditional jump to this vector.
	314	*/
	315	NESTED(except_vec_nmi, 0, sp)
	316	j nmi_handler
2a0b24f5 SH	317	#ifdef CONFIG_CPU_MICROMIPS
	318	nop
	319	#endif
1da177e4 LT	320	END(except_vec_nmi)
	321
	322	__FINIT
	323
	324	NESTED(nmi_handler, PT_SIZE, sp)
	325	.set push
	326	.set noat
83e4da1e LY	327	/*
	328	* Clear ERL - restore segment mapping
	329	* Clear BEV - required for page fault exception handler to work
	330	*/
	331	mfc0 k0, CP0_STATUS
	332	ori k0, k0, ST0_EXL
	333	li k1, ~(ST0_BEV \| ST0_ERL)
	334	and k0, k0, k1
	335	mtc0 k0, CP0_STATUS
	336	_ehb
1da177e4	337	SAVE_ALL
70342287	338	move a0, sp
1da177e4	339	jal nmi_exception_handler
83e4da1e	340	/* nmi_exception_handler never returns */
1da177e4 LT	341	.set pop
	342	END(nmi_handler)
	343
	344	.macro __build_clear_none
	345	.endm
	346
	347	.macro __build_clear_sti
192ef366	348	TRACE_IRQS_ON
1da177e4 LT	349	STI
	350	.endm
	351
	352	.macro __build_clear_cli
	353	CLI
192ef366	354	TRACE_IRQS_OFF
1da177e4 LT	355	.endm
	356
	357	.macro __build_clear_fpe
25c30003 DD	358	.set push
	359	/* gas fails to assemble cfc1 for some archs (octeon).*/ \
	360	.set mips1
842dfc11	361	SET_HARDFLOAT
1da177e4 LT	362	cfc1 a1, fcr31
	363	li a2, ~(0x3f << 12)
	364	and a2, a1
	365	ctc1 a2, fcr31
25c30003	366	.set pop
192ef366	367	TRACE_IRQS_ON
1da177e4 LT	368	STI
	369	.endm
	370
	371	.macro __build_clear_ade
	372	MFC0 t0, CP0_BADVADDR
	373	PTR_S t0, PT_BVADDR(sp)
	374	KMODE
	375	.endm
	376
	377	.macro __BUILD_silent exception
	378	.endm
	379
	380	/* Gas tries to parse the PRINT argument as a string containing
	381	string escapes and emits bogus warnings if it believes to
	382	recognize an unknown escape code. So make the arguments
	383	start with an n and gas will believe \n is ok ... */
70342287	384	.macro __BUILD_verbose nexception
1da177e4	385	LONG_L a1, PT_EPC(sp)
766160c2	386	#ifdef CONFIG_32BIT
1da177e4	387	PRINT("Got \nexception at %08lx\012")
42a3b4f2	388	#endif
766160c2	389	#ifdef CONFIG_64BIT
1da177e4	390	PRINT("Got \nexception at %016lx\012")
42a3b4f2	391	#endif
1da177e4 LT	392	.endm
	393
	394	.macro __BUILD_count exception
	395	LONG_L t0,exception_count_\exception
	396	LONG_ADDIU t0, 1
	397	LONG_S t0,exception_count_\exception
	398	.comm exception_count\exception, 8, 8
	399	.endm
	400
	401	.macro __BUILD_HANDLER exception handler clear verbose ext
	402	.align 5
	403	NESTED(handle_\exception, PT_SIZE, sp)
	404	.set noat
	405	SAVE_ALL
	406	FEXPORT(handle_\exception\ext)
	407	__BUILD_clear_\clear
	408	.set at
	409	__BUILD_\verbose \exception
	410	move a0, sp
23126692 AN	411	PTR_LA ra, ret_from_exception
23126692 AN	412	j do_\handler
1da177e4 LT	413	END(handle_\exception)
	414	.endm
	415
	416	.macro BUILD_HANDLER exception handler clear verbose
70342287	417	__BUILD_HANDLER \exception \handler \clear \verbose _int
1da177e4 LT	418	.endm
	419
	420	BUILD_HANDLER adel ade ade silent /* #4 */
	421	BUILD_HANDLER ades ade ade silent /* #5 */
	422	BUILD_HANDLER ibe be cli silent /* #6 */
	423	BUILD_HANDLER dbe be cli silent /* #7 */
	424	BUILD_HANDLER bp bp sti silent /* #9 */
	425	BUILD_HANDLER ri ri sti silent /* #10 */
	426	BUILD_HANDLER cpu cpu sti silent /* #11 */
	427	BUILD_HANDLER ov ov sti silent /* #12 */
	428	BUILD_HANDLER tr tr sti silent /* #13 */
2bcb3fbc	429	BUILD_HANDLER msa_fpe msa_fpe sti silent /* #14 */
1da177e4	430	BUILD_HANDLER fpe fpe fpe silent /* #15 */
75b5b5e0	431	BUILD_HANDLER ftlb ftlb none silent /* #16 */
1db1af84	432	BUILD_HANDLER msa msa sti silent /* #21 */
1da177e4	433	BUILD_HANDLER mdmx mdmx sti silent /* #22 */
70342287	434	#ifdef CONFIG_HARDWARE_WATCHPOINTS
8bc6d05b DD	435	/*
	436	* For watch, interrupts will be enabled after the watch
	437	* registers are read.
	438	*/
	439	BUILD_HANDLER watch watch cli silent /* #23 */
b67b2b70	440	#else
1da177e4	441	BUILD_HANDLER watch watch sti verbose /* #23 */
b67b2b70	442	#endif
1da177e4	443	BUILD_HANDLER mcheck mcheck cli verbose /* #24 */
e35a5e35	444	BUILD_HANDLER mt mt sti silent /* #25 */
e50c0a8f	445	BUILD_HANDLER dsp dsp sti silent /* #26 */
1da177e4 LT	446	BUILD_HANDLER reserved reserved sti verbose /* others */
1da177e4 LT	447
5b10496b AN	448	.align 5
5b10496b AN	449	LEAF(handle_ri_rdhwr_vivt)
5b10496b AN	450	.set push
	451	.set noat
	452	.set noreorder
	453	/* check if TLB contains a entry for EPC */
	454	MFC0 k1, CP0_ENTRYHI
48c4ac97	455	andi k1, 0xff /* ASID_MASK */
5b10496b	456	MFC0 k0, CP0_EPC
70342287 RB	457	PTR_SRL k0, _PAGE_SHIFT + 1
70342287 RB	458	PTR_SLL k0, _PAGE_SHIFT + 1
5b10496b AN	459	or k1, k0
	460	MTC0 k1, CP0_ENTRYHI
	461	mtc0_tlbw_hazard
	462	tlbp
	463	tlb_probe_hazard
	464	mfc0 k1, CP0_INDEX
	465	.set pop
	466	bltz k1, handle_ri /* slow path */
	467	/* fall thru */
5b10496b AN	468	END(handle_ri_rdhwr_vivt)
	469
	470	LEAF(handle_ri_rdhwr)
	471	.set push
	472	.set noat
	473	.set noreorder
2a0b24f5 SH	474	/* MIPS32: 0x7c03e83b: rdhwr v1,$29 */
2a0b24f5 SH	475	/* microMIPS: 0x007d6b3c: rdhwr v1,$29 */
5b10496b	476	MFC0 k1, CP0_EPC
2a0b24f5 SH	477	#if defined(CONFIG_CPU_MICROMIPS) \|\| defined(CONFIG_CPU_MIPS32_R2) \|\| defined(CONFIG_CPU_MIPS64_R2)
	478	and k0, k1, 1
	479	beqz k0, 1f
	480	xor k1, k0
	481	lhu k0, (k1)
	482	lhu k1, 2(k1)
	483	ins k1, k0, 16, 16
	484	lui k0, 0x007d
	485	b docheck
	486	ori k0, 0x6b3c
	487	1:
	488	lui k0, 0x7c03
	489	lw k1, (k1)
	490	ori k0, 0xe83b
	491	#else
	492	andi k0, k1, 1
	493	bnez k0, handle_ri
	494	lui k0, 0x7c03
	495	lw k1, (k1)
	496	ori k0, 0xe83b
	497	#endif
	498	.set reorder
	499	docheck:
5b10496b	500	bne k0, k1, handle_ri /* if not ours */
2a0b24f5 SH	501
2a0b24f5 SH	502	isrdhwr:
5b10496b AN	503	/* The insn is rdhwr. No need to check CAUSE.BD here. */
	504	get_saved_sp /* k1 := current_thread_info */
	505	.set noreorder
	506	MFC0 k0, CP0_EPC
	507	#if defined(CONFIG_CPU_R3000) \|\| defined(CONFIG_CPU_TX39XX)
	508	ori k1, _THREAD_MASK
	509	xori k1, _THREAD_MASK
	510	LONG_L v1, TI_TP_VALUE(k1)
	511	LONG_ADDIU k0, 4
	512	jr k0
	513	rfe
	514	#else
619b6e18	515	#ifndef CONFIG_CPU_DADDI_WORKAROUNDS
5b10496b	516	LONG_ADDIU k0, 4 /* stall on $k0 */
619b6e18 MR	517	#else
	518	.set at=v1
	519	LONG_ADDIU k0, 4
	520	.set noat
	521	#endif
5b10496b AN	522	MTC0 k0, CP0_EPC
	523	/* I hope three instructions between MTC0 and ERET are enough... */
	524	ori k1, _THREAD_MASK
	525	xori k1, _THREAD_MASK
	526	LONG_L v1, TI_TP_VALUE(k1)
a809d460	527	.set arch=r4000
5b10496b AN	528	eret
	529	.set mips0
	530	#endif
	531	.set pop
	532	END(handle_ri_rdhwr)
	533
875d43e7	534	#ifdef CONFIG_64BIT
1da177e4 LT	535	/* A temporary overflow handler used by check_daddi(). */
	536
	537	__INIT
	538
	539	BUILD_HANDLER daddi_ov daddi_ov none silent /* #12 */
	540	#endif