[linux-2.6-block.git] / arch / arc / kernel / entry-arcv2.S

/*
 * ARCv2 ISA based core Low Level Intr/Traps/Exceptions(non-TLB) Handling
 *
 * Copyright (C) 2013 Synopsys, Inc. (www.synopsys.com)
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/linkage.h>   /* ARC_{EXTRY,EXIT} */
#include <asm/entry.h>       /* SAVE_ALL_{INT1,INT2,TRAP...} */
#include <asm/errno.h>
#include <asm/arcregs.h>
#include <asm/irqflags.h>

	.cpu HS

#define VECTOR	.word

;############################ Vector Table #################################

	.section .vector,"a",@progbits
	.align 4

# Initial 16 slots are Exception Vectors
VECTOR	res_service		; Reset Vector
VECTOR	mem_service		; Mem exception
VECTOR	instr_service		; Instrn Error
VECTOR	EV_MachineCheck		; Fatal Machine check
VECTOR	EV_TLBMissI		; Intruction TLB miss
VECTOR	EV_TLBMissD		; Data TLB miss
VECTOR	EV_TLBProtV		; Protection Violation
VECTOR	EV_PrivilegeV		; Privilege Violation
VECTOR	EV_SWI			; Software Breakpoint
VECTOR	EV_Trap			; Trap exception
VECTOR	EV_Extension		; Extn Instruction Exception
VECTOR	EV_DivZero		; Divide by Zero
VECTOR	EV_DCError		; Data Cache Error
VECTOR	EV_Misaligned		; Misaligned Data Access
VECTOR	reserved		; Reserved slots
VECTOR	reserved		; Reserved slots

# Begin Interrupt Vectors
VECTOR	handle_interrupt	; (16) Timer0
VECTOR	handle_interrupt	; unused (Timer1)
VECTOR	handle_interrupt	; unused (WDT)
VECTOR	handle_interrupt	; (19) Inter core Interrupt (IPI)
VECTOR	handle_interrupt	; (20) perf Interrupt
VECTOR	handle_interrupt	; (21) Software Triggered Intr (Self IPI)
VECTOR	handle_interrupt	; unused
VECTOR	handle_interrupt	; (23) unused
# End of fixed IRQs

.rept CONFIG_ARC_NUMBER_OF_INTERRUPTS - 8
	VECTOR	handle_interrupt
.endr

	.section .text, "ax",@progbits

reserved:
	flag 1		; Unexpected event, halt

;##################### Interrupt Handling ##############################

ENTRY(handle_interrupt)

	INTERRUPT_PROLOGUE  irq

	clri		; To make status32.IE agree with CPU internal state

	lr  r0, [ICAUSE]

	mov   blink, ret_from_exception

	b.d  arch_do_IRQ
	mov r1, sp

END(handle_interrupt)

;################### Non TLB Exception Handling #############################

ENTRY(EV_SWI)
	flag 1
END(EV_SWI)

ENTRY(EV_DivZero)
	flag 1
END(EV_DivZero)

ENTRY(EV_DCError)
	flag 1
END(EV_DCError)

; ---------------------------------------------
; Memory Error Exception Handler
;   - Unlike ARCompact, handles Bus errors for both User/Kernel mode,
;     Instruction fetch or Data access, under a single Exception Vector
; ---------------------------------------------

ENTRY(mem_service)

	EXCEPTION_PROLOGUE

	lr  r0, [efa]
	mov r1, sp

	FAKE_RET_FROM_EXCPN

	bl  do_memory_error
	b   ret_from_exception
END(mem_service)

ENTRY(EV_Misaligned)

	EXCEPTION_PROLOGUE

	lr  r0, [efa]	; Faulting Data address
	mov r1, sp

	FAKE_RET_FROM_EXCPN

	SAVE_CALLEE_SAVED_USER
	mov r2, sp              ; callee_regs

	bl  do_misaligned_access

	; TBD: optimize - do this only if a callee reg was involved
	; either a dst of emulated LD/ST or src with address-writeback
	RESTORE_CALLEE_SAVED_USER

	b   ret_from_exception
END(EV_Misaligned)

; ---------------------------------------------
; Protection Violation Exception Handler
; ---------------------------------------------

ENTRY(EV_TLBProtV)

	EXCEPTION_PROLOGUE

	lr  r0, [efa]	; Faulting Data address
	mov r1, sp	; pt_regs

	FAKE_RET_FROM_EXCPN

	mov blink, ret_from_exception
	b   do_page_fault

END(EV_TLBProtV)

; From Linux standpoint Slow Path I/D TLB Miss is same a ProtV as they
; need to call do_page_fault().
; ECR in pt_regs provides whether access was R/W/X

.global        call_do_page_fault
.set call_do_page_fault, EV_TLBProtV

;############# Common Handlers for ARCompact and ARCv2 ##############

#include "entry.S"

;############# Return from Intr/Excp/Trap (ARCv2 ISA Specifics) ##############
;
; Restore the saved sys context (common exit-path for EXCPN/IRQ/Trap)
; IRQ shd definitely not happen between now and rtie
; All 2 entry points to here already disable interrupts

.Lrestore_regs:

	ld	r0, [sp, PT_status32]	; U/K mode at time of entry
	lr	r10, [AUX_IRQ_ACT]

	bmsk	r11, r10, 15	; AUX_IRQ_ACT.ACTIVE
	breq	r11, 0, .Lexcept_ret	; No intr active, ret from Exception

;####### Return from Intr #######

debug_marker_l1:
	bbit1.nt r0, STATUS_DE_BIT, .Lintr_ret_to_delay_slot

.Lisr_ret_fast_path:
	; Handle special case #1: (Entry via Exception, Return via IRQ)
	;
	; Exception in U mode, preempted in kernel, Intr taken (K mode), orig
	; task now returning to U mode (riding the Intr)
	; AUX_IRQ_ACTIVE won't have U bit set (since intr in K mode), hence SP
	; won't be switched to correct U mode value (from AUX_SP)
	; So force AUX_IRQ_ACT.U for such a case

	btst	r0, STATUS_U_BIT		; Z flag set if K (Z clear for U)
	bset.nz	r11, r11, AUX_IRQ_ACT_BIT_U	; NZ means U
	sr	r11, [AUX_IRQ_ACT]

	INTERRUPT_EPILOGUE  irq
	rtie

;####### Return from Exception / pure kernel mode #######

.Lexcept_ret:	; Expects r0 has PT_status32

debug_marker_syscall:
	EXCEPTION_EPILOGUE
	rtie

;####### Return from Intr to insn in delay slot #######

; Handle special case #2: (Entry via Exception in Delay Slot, Return via IRQ)
;
; Intr returning to a Delay Slot (DS) insn
; (since IRQ NOT allowed in DS in ARCv2, this can only happen if orig
; entry was via Exception in DS which got preempted in kernel).
;
; IRQ RTIE won't reliably restore DE bit and/or BTA, needs workaround
;
; Solution is return from Intr w/o any delay slot quirks into a kernel trampoline
; and from pure kernel mode return to delay slot which handles DS bit/BTA correctly

.Lintr_ret_to_delay_slot:
debug_marker_ds:

	ld	r2, [@intr_to_DE_cnt]
	add	r2, r2, 1
	st	r2, [@intr_to_DE_cnt]

	ld	r2, [sp, PT_ret]
	ld	r3, [sp, PT_status32]

	; STAT32 for Int return created from scratch
	; (No delay dlot, disable Further intr in trampoline)

	bic  	r0, r3, STATUS_U_MASK|STATUS_DE_MASK|STATUS_IE_MASK|STATUS_L_MASK
	st	r0, [sp, PT_status32]

	mov	r1, .Lintr_ret_to_delay_slot_2
	st	r1, [sp, PT_ret]

	; Orig exception PC/STAT32 safekept @orig_r0 and @event stack slots
	st	r2, [sp, 0]
	st	r3, [sp, 4]

	b	.Lisr_ret_fast_path

.Lintr_ret_to_delay_slot_2:
	; Trampoline to restore orig exception PC/STAT32/BTA/AUX_USER_SP
	sub	sp, sp, SZ_PT_REGS
	st	r9, [sp, -4]

	ld	r9, [sp, 0]
	sr	r9, [eret]

	ld	r9, [sp, 4]
	sr	r9, [erstatus]

	; restore AUX_USER_SP if returning to U mode
	bbit0	r9, STATUS_U_BIT, 1f
	ld	r9, [sp, PT_sp]
	sr	r9, [AUX_USER_SP]

1:
	ld	r9, [sp, 8]
	sr	r9, [erbta]

	ld	r9, [sp, -4]
	add	sp, sp, SZ_PT_REGS

	; return from pure kernel mode to delay slot
	rtie

END(ret_from_exception)
Commit	Line	Data
1f6ccfff VG	1	/*
	2	* ARCv2 ISA based core Low Level Intr/Traps/Exceptions(non-TLB) Handling
	3	*
	4	* Copyright (C) 2013 Synopsys, Inc. (www.synopsys.com)
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/linkage.h> /* ARC_{EXTRY,EXIT} */
	12	#include <asm/entry.h> /* SAVE_ALL_{INT1,INT2,TRAP...} */
	13	#include <asm/errno.h>
	14	#include <asm/arcregs.h>
	15	#include <asm/irqflags.h>
	16
	17	.cpu HS
	18
	19	#define VECTOR .word
	20
	21	;############################ Vector Table #################################
	22
	23	.section .vector,"a",@progbits
	24	.align 4
	25
	26	# Initial 16 slots are Exception Vectors
3971cdc2	27	VECTOR res_service ; Reset Vector
1f6ccfff VG	28	VECTOR mem_service ; Mem exception
	29	VECTOR instr_service ; Instrn Error
	30	VECTOR EV_MachineCheck ; Fatal Machine check
	31	VECTOR EV_TLBMissI ; Intruction TLB miss
	32	VECTOR EV_TLBMissD ; Data TLB miss
	33	VECTOR EV_TLBProtV ; Protection Violation
	34	VECTOR EV_PrivilegeV ; Privilege Violation
	35	VECTOR EV_SWI ; Software Breakpoint
	36	VECTOR EV_Trap ; Trap exception
	37	VECTOR EV_Extension ; Extn Instruction Exception
	38	VECTOR EV_DivZero ; Divide by Zero
	39	VECTOR EV_DCError ; Data Cache Error
	40	VECTOR EV_Misaligned ; Misaligned Data Access
	41	VECTOR reserved ; Reserved slots
	42	VECTOR reserved ; Reserved slots
	43
	44	# Begin Interrupt Vectors
	45	VECTOR handle_interrupt ; (16) Timer0
	46	VECTOR handle_interrupt ; unused (Timer1)
	47	VECTOR handle_interrupt ; unused (WDT)
bb143f81 VG	48	VECTOR handle_interrupt ; (19) Inter core Interrupt (IPI)
	49	VECTOR handle_interrupt ; (20) perf Interrupt
	50	VECTOR handle_interrupt ; (21) Software Triggered Intr (Self IPI)
	51	VECTOR handle_interrupt ; unused
	52	VECTOR handle_interrupt ; (23) unused
	53	# End of fixed IRQs
1f6ccfff VG	54
	55	.rept CONFIG_ARC_NUMBER_OF_INTERRUPTS - 8
	56	VECTOR handle_interrupt
	57	.endr
	58
	59	.section .text, "ax",@progbits
	60
3d592659 VG	61	reserved:
3d592659 VG	62	flag 1 ; Unexpected event, halt
1f6ccfff VG	63
	64	;##################### Interrupt Handling ##############################
	65
	66	ENTRY(handle_interrupt)
	67
	68	INTERRUPT_PROLOGUE irq
	69
	70	clri ; To make status32.IE agree with CPU internal state
	71
	72	lr r0, [ICAUSE]
	73
	74	mov blink, ret_from_exception
	75
	76	b.d arch_do_IRQ
	77	mov r1, sp
	78
	79	END(handle_interrupt)
	80
	81	;################### Non TLB Exception Handling #############################
	82
	83	ENTRY(EV_SWI)
	84	flag 1
	85	END(EV_SWI)
	86
	87	ENTRY(EV_DivZero)
	88	flag 1
	89	END(EV_DivZero)
	90
	91	ENTRY(EV_DCError)
	92	flag 1
	93	END(EV_DCError)
	94
541366da VG	95	; ---------------------------------------------
	96	; Memory Error Exception Handler
	97	; - Unlike ARCompact, handles Bus errors for both User/Kernel mode,
	98	; Instruction fetch or Data access, under a single Exception Vector
	99	; ---------------------------------------------
	100
	101	ENTRY(mem_service)
	102
	103	EXCEPTION_PROLOGUE
	104
	105	lr r0, [efa]
	106	mov r1, sp
	107
	108	FAKE_RET_FROM_EXCPN
	109
	110	bl do_memory_error
	111	b ret_from_exception
	112	END(mem_service)
	113
1f6ccfff VG	114	ENTRY(EV_Misaligned)
	115
	116	EXCEPTION_PROLOGUE
	117
	118	lr r0, [efa] ; Faulting Data address
	119	mov r1, sp
	120
	121	FAKE_RET_FROM_EXCPN
	122
	123	SAVE_CALLEE_SAVED_USER
	124	mov r2, sp ; callee_regs
	125
	126	bl do_misaligned_access
	127
	128	; TBD: optimize - do this only if a callee reg was involved
	129	; either a dst of emulated LD/ST or src with address-writeback
	130	RESTORE_CALLEE_SAVED_USER
	131
	132	b ret_from_exception
	133	END(EV_Misaligned)
	134
	135	; ---------------------------------------------
	136	; Protection Violation Exception Handler
	137	; ---------------------------------------------
	138
	139	ENTRY(EV_TLBProtV)
	140
	141	EXCEPTION_PROLOGUE
	142
	143	lr r0, [efa] ; Faulting Data address
	144	mov r1, sp ; pt_regs
	145
	146	FAKE_RET_FROM_EXCPN
	147
	148	mov blink, ret_from_exception
	149	b do_page_fault
	150
	151	END(EV_TLBProtV)
	152
	153	; From Linux standpoint Slow Path I/D TLB Miss is same a ProtV as they
	154	; need to call do_page_fault().
	155	; ECR in pt_regs provides whether access was R/W/X
	156
	157	.global call_do_page_fault
	158	.set call_do_page_fault, EV_TLBProtV
	159
	160	;############# Common Handlers for ARCompact and ARCv2 ##############
	161
	162	#include "entry.S"
	163
	164	;############# Return from Intr/Excp/Trap (ARCv2 ISA Specifics) ##############
	165	;
	166	; Restore the saved sys context (common exit-path for EXCPN/IRQ/Trap)
	167	; IRQ shd definitely not happen between now and rtie
	168	; All 2 entry points to here already disable interrupts
	169
	170	.Lrestore_regs:
	171
	172	ld r0, [sp, PT_status32] ; U/K mode at time of entry
	173	lr r10, [AUX_IRQ_ACT]
	174
	175	bmsk r11, r10, 15 ; AUX_IRQ_ACT.ACTIVE
	176	breq r11, 0, .Lexcept_ret ; No intr active, ret from Exception
	177
178	;####### Return from Intr #######
179
180	debug_marker_l1:
4255b07f VG	181	bbit1.nt r0, STATUS_DE_BIT, .Lintr_ret_to_delay_slot
	182
	183	.Lisr_ret_fast_path:
1f6ccfff VG	184	; Handle special case #1: (Entry via Exception, Return via IRQ)
	185	;
	186	; Exception in U mode, preempted in kernel, Intr taken (K mode), orig
	187	; task now returning to U mode (riding the Intr)
	188	; AUX_IRQ_ACTIVE won't have U bit set (since intr in K mode), hence SP
	189	; won't be switched to correct U mode value (from AUX_SP)
	190	; So force AUX_IRQ_ACT.U for such a case
	191
	192	btst r0, STATUS_U_BIT ; Z flag set if K (Z clear for U)
	193	bset.nz r11, r11, AUX_IRQ_ACT_BIT_U ; NZ means U
	194	sr r11, [AUX_IRQ_ACT]
	195
	196	INTERRUPT_EPILOGUE irq
	197	rtie
	198
	199	;####### Return from Exception / pure kernel mode #######
	200
	201	.Lexcept_ret: ; Expects r0 has PT_status32
	202
	203	debug_marker_syscall:
	204	EXCEPTION_EPILOGUE
	205	rtie
	206
4255b07f VG	207	;####### Return from Intr to insn in delay slot #######
	208
	209	; Handle special case #2: (Entry via Exception in Delay Slot, Return via IRQ)
	210	;
	211	; Intr returning to a Delay Slot (DS) insn
	212	; (since IRQ NOT allowed in DS in ARCv2, this can only happen if orig
	213	; entry was via Exception in DS which got preempted in kernel).
	214	;
cbfe74a7 VG	215	; IRQ RTIE won't reliably restore DE bit and/or BTA, needs workaround
	216	;
	217	; Solution is return from Intr w/o any delay slot quirks into a kernel trampoline
	218	; and from pure kernel mode return to delay slot which handles DS bit/BTA correctly
	219
4255b07f VG	220	.Lintr_ret_to_delay_slot:
	221	debug_marker_ds:
	222
	223	ld r2, [@intr_to_DE_cnt]
	224	add r2, r2, 1
	225	st r2, [@intr_to_DE_cnt]
	226
	227	ld r2, [sp, PT_ret]
	228	ld r3, [sp, PT_status32]
	229
cbfe74a7 VG	230	; STAT32 for Int return created from scratch
	231	; (No delay dlot, disable Further intr in trampoline)
	232
4255b07f VG	233	bic r0, r3, STATUS_U_MASK\|STATUS_DE_MASK\|STATUS_IE_MASK\|STATUS_L_MASK
	234	st r0, [sp, PT_status32]
	235
	236	mov r1, .Lintr_ret_to_delay_slot_2
	237	st r1, [sp, PT_ret]
	238
cbfe74a7	239	; Orig exception PC/STAT32 safekept @orig_r0 and @event stack slots
4255b07f VG	240	st r2, [sp, 0]
	241	st r3, [sp, 4]
	242
	243	b .Lisr_ret_fast_path
	244
	245	.Lintr_ret_to_delay_slot_2:
cbfe74a7	246	; Trampoline to restore orig exception PC/STAT32/BTA/AUX_USER_SP
4255b07f VG	247	sub sp, sp, SZ_PT_REGS
	248	st r9, [sp, -4]
	249
	250	ld r9, [sp, 0]
	251	sr r9, [eret]
	252
	253	ld r9, [sp, 4]
	254	sr r9, [erstatus]
	255
cbfe74a7 VG	256	; restore AUX_USER_SP if returning to U mode
	257	bbit0 r9, STATUS_U_BIT, 1f
	258	ld r9, [sp, PT_sp]
	259	sr r9, [AUX_USER_SP]
	260
	261	1:
4255b07f VG	262	ld r9, [sp, 8]
	263	sr r9, [erbta]
	264
	265	ld r9, [sp, -4]
	266	add sp, sp, SZ_PT_REGS
cbfe74a7 VG	267
cbfe74a7 VG	268	; return from pure kernel mode to delay slot
4255b07f VG	269	rtie
4255b07f VG	270
1f6ccfff	271	END(ret_from_exception)