[deliverable/linux.git] / arch / m68knommu / platform / 68328 / entry.S

/*
 *  linux/arch/m68knommu/platform/68328/entry.S
 *
 *  Copyright (C) 1991, 1992  Linus Torvalds
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file README.legal in the main directory of this archive
 * for more details.
 *
 * Linux/m68k support by Hamish Macdonald
 */

#include <linux/sys.h>
#include <linux/linkage.h>
#include <asm/thread_info.h>
#include <asm/unistd.h>
#include <asm/errno.h>
#include <asm/setup.h>
#include <asm/segment.h>
#include <asm/traps.h>
#include <asm/asm-offsets.h>
#include <asm/entry.h>

.text

.globl system_call
.globl resume
.globl ret_from_exception
.globl ret_from_signal
.globl sys_call_table
.globl ret_from_interrupt
.globl bad_interrupt
.globl inthandler1
.globl inthandler2
.globl inthandler3
.globl inthandler4
.globl inthandler5
.globl inthandler6
.globl inthandler7

badsys:
	movel	#-ENOSYS,%sp@(PT_OFF_D0)
	jra	ret_from_exception

do_trace:
	movel	#-ENOSYS,%sp@(PT_OFF_D0) /* needed for strace*/
	subql	#4,%sp
	SAVE_SWITCH_STACK
	jbsr	syscall_trace_enter
	RESTORE_SWITCH_STACK
	addql	#4,%sp
	movel	%sp@(PT_OFF_ORIG_D0),%d1
	movel	#-ENOSYS,%d0
	cmpl	#NR_syscalls,%d1
	jcc	1f
	lsl	#2,%d1
	lea	sys_call_table, %a0
	jbsr	%a0@(%d1)

1:	movel	%d0,%sp@(PT_OFF_D0)	/* save the return value */
	subql	#4,%sp			/* dummy return address */
	SAVE_SWITCH_STACK
	jbsr	syscall_trace_leave

ret_from_signal:
	RESTORE_SWITCH_STACK
	addql	#4,%sp
	jra	ret_from_exception

ENTRY(system_call)
	SAVE_ALL

	/* save top of frame*/
	pea	%sp@
	jbsr	set_esp0
	addql	#4,%sp

	movel	%sp@(PT_OFF_ORIG_D0),%d0

	movel	%sp,%d1			/* get thread_info pointer */
	andl	#-THREAD_SIZE,%d1
	movel	%d1,%a2
	btst	#(TIF_SYSCALL_TRACE%8),%a2@(TI_FLAGS+(31-TIF_SYSCALL_TRACE)/8)
	jne	do_trace
	cmpl	#NR_syscalls,%d0
	jcc	badsys
	lsl	#2,%d0
	lea	sys_call_table,%a0
	movel	%a0@(%d0), %a0
	jbsr	%a0@
	movel	%d0,%sp@(PT_OFF_D0)	/* save the return value*/

ret_from_exception:
	btst	#5,%sp@(PT_OFF_SR)	/* check if returning to kernel*/
	jeq	Luser_return		/* if so, skip resched, signals*/

Lkernel_return:
	RESTORE_ALL

Luser_return:
	/* only allow interrupts when we are really the last one on the*/
	/* kernel stack, otherwise stack overflow can occur during*/
	/* heavy interrupt load*/
	andw	#ALLOWINT,%sr

	movel	%sp,%d1			/* get thread_info pointer */
	andl	#-THREAD_SIZE,%d1
	movel	%d1,%a2
1:
	move	%a2@(TI_FLAGS),%d1	/* thread_info->flags */
	jne	Lwork_to_do
	RESTORE_ALL

Lwork_to_do:
	movel	%a2@(TI_FLAGS),%d1	/* thread_info->flags */
	btst	#TIF_NEED_RESCHED,%d1
	jne	reschedule

Lsignal_return:
	subql	#4,%sp			/* dummy return address*/
	SAVE_SWITCH_STACK
	pea	%sp@(SWITCH_STACK_SIZE)
	bsrw	do_signal
	addql	#4,%sp
	RESTORE_SWITCH_STACK
	addql	#4,%sp
	jra	1b

/*
 * This is the main interrupt handler, responsible for calling process_int()
 */
inthandler1:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	#65,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

inthandler2:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	#66,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

inthandler3:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	#67,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

inthandler4:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	#68,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

inthandler5:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	#69,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

inthandler6:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	#70,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

inthandler7:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	#71,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

inthandler:
	SAVE_ALL
	movew	%sp@(PT_OFF_FORMATVEC), %d0
	and	#0x3ff, %d0

	movel	%sp,%sp@-
	movel	%d0,%sp@- 		/*  put vector # on stack*/
	jbsr	process_int		/*  process the IRQ*/
3:     	addql	#8,%sp			/*  pop parameters off stack*/
	bra	ret_from_interrupt

ret_from_interrupt:
	jeq	1f
2:
	RESTORE_ALL
1:
	moveb	%sp@(PT_OFF_SR), %d0
	and	#7, %d0
	jhi	2b

	/* check if we need to do software interrupts */
	jeq	ret_from_exception

	pea	ret_from_exception
	jra	do_softirq


/*
 * Handler for uninitialized and spurious interrupts.
 */
ENTRY(bad_interrupt)
	addql	#1,num_spurious
	rte

/*
 * Beware - when entering resume, prev (the current task) is
 * in a0, next (the new task) is in a1,so don't change these
 * registers until their contents are no longer needed.
 */
ENTRY(resume)
	movel	%a0,%d1				/* save prev thread in d1 */
	movew	%sr,%a0@(TASK_THREAD+THREAD_SR)	/* save sr */
	movel	%usp,%a2			/* save usp */
	movel	%a2,%a0@(TASK_THREAD+THREAD_USP)

	SAVE_SWITCH_STACK
	movel	%sp,%a0@(TASK_THREAD+THREAD_KSP) /* save kernel stack */
	movel	%a1@(TASK_THREAD+THREAD_KSP),%sp /* restore new thread stack */
	RESTORE_SWITCH_STACK

	movel	%a1@(TASK_THREAD+THREAD_USP),%a0 /* restore user stack */
	movel	%a0,%usp
	movew	%a1@(TASK_THREAD+THREAD_SR),%sr	/* restore thread status reg */
	rts
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/arch/m68knommu/platform/68328/entry.S
	3	*
	4	* Copyright (C) 1991, 1992 Linus Torvalds
	5	*
	6	* This file is subject to the terms and conditions of the GNU General Public
	7	* License. See the file README.legal in the main directory of this archive
	8	* for more details.
	9	*
	10	* Linux/m68k support by Hamish Macdonald
	11	*/
	12
1da177e4 LT	13	#include <linux/sys.h>
	14	#include <linux/linkage.h>
	15	#include <asm/thread_info.h>
	16	#include <asm/unistd.h>
	17	#include <asm/errno.h>
	18	#include <asm/setup.h>
	19	#include <asm/segment.h>
	20	#include <asm/traps.h>
	21	#include <asm/asm-offsets.h>
	22	#include <asm/entry.h>
	23
	24	.text
	25
	26	.globl system_call
	27	.globl resume
	28	.globl ret_from_exception
	29	.globl ret_from_signal
	30	.globl sys_call_table
	31	.globl ret_from_interrupt
	32	.globl bad_interrupt
	33	.globl inthandler1
	34	.globl inthandler2
	35	.globl inthandler3
	36	.globl inthandler4
	37	.globl inthandler5
	38	.globl inthandler6
	39	.globl inthandler7
	40
	41	badsys:
c84b564e	42	movel #-ENOSYS,%sp@(PT_OFF_D0)
1da177e4 LT	43	jra ret_from_exception
	44
	45	do_trace:
5061ea2c	46	movel #-ENOSYS,%sp@(PT_OFF_D0) /* needed for strace*/
1da177e4 LT	47	subql #4,%sp
1da177e4 LT	48	SAVE_SWITCH_STACK
55f411de	49	jbsr syscall_trace_enter
1da177e4 LT	50	RESTORE_SWITCH_STACK
1da177e4 LT	51	addql #4,%sp
c84b564e	52	movel %sp@(PT_OFF_ORIG_D0),%d1
1da177e4 LT	53	movel #-ENOSYS,%d0
	54	cmpl #NR_syscalls,%d1
	55	jcc 1f
	56	lsl #2,%d1
	57	lea sys_call_table, %a0
	58	jbsr %a0@(%d1)
	59
5061ea2c	60	1: movel %d0,%sp@(PT_OFF_D0) /* save the return value */
1da177e4 LT	61	subql #4,%sp /* dummy return address */
1da177e4 LT	62	SAVE_SWITCH_STACK
55f411de	63	jbsr syscall_trace_leave
1da177e4 LT	64
	65	ret_from_signal:
	66	RESTORE_SWITCH_STACK
	67	addql #4,%sp
	68	jra ret_from_exception
	69
	70	ENTRY(system_call)
	71	SAVE_ALL
	72
	73	/* save top of frame*/
5061ea2c PDM	74	pea %sp@
	75	jbsr set_esp0
	76	addql #4,%sp
1da177e4	77
c84b564e	78	movel %sp@(PT_OFF_ORIG_D0),%d0
1da177e4 LT	79
1da177e4 LT	80	movel %sp,%d1 /* get thread_info pointer */
8410a546	81	andl #-THREAD_SIZE,%d1
1da177e4	82	movel %d1,%a2
c8a2786b	83	btst #(TIF_SYSCALL_TRACE%8),%a2@(TI_FLAGS+(31-TIF_SYSCALL_TRACE)/8)
1da177e4 LT	84	jne do_trace
	85	cmpl #NR_syscalls,%d0
	86	jcc badsys
	87	lsl #2,%d0
	88	lea sys_call_table,%a0
	89	movel %a0@(%d0), %a0
	90	jbsr %a0@
5061ea2c	91	movel %d0,%sp@(PT_OFF_D0) /* save the return value*/
1da177e4 LT	92
1da177e4 LT	93	ret_from_exception:
5061ea2c	94	btst #5,%sp@(PT_OFF_SR) /* check if returning to kernel*/
1da177e4 LT	95	jeq Luser_return /* if so, skip resched, signals*/
	96
	97	Lkernel_return:
	98	RESTORE_ALL
	99
	100	Luser_return:
	101	/* only allow interrupts when we are really the last one on the*/
	102	/* kernel stack, otherwise stack overflow can occur during*/
	103	/* heavy interrupt load*/
	104	andw #ALLOWINT,%sr
	105
	106	movel %sp,%d1 /* get thread_info pointer */
8410a546	107	andl #-THREAD_SIZE,%d1
1da177e4	108	movel %d1,%a2
d1574df7	109	1:
1da177e4	110	move %a2@(TI_FLAGS),%d1 /* thread_info->flags */
1da177e4 LT	111	jne Lwork_to_do
	112	RESTORE_ALL
	113
	114	Lwork_to_do:
	115	movel %a2@(TI_FLAGS),%d1 /* thread_info->flags */
	116	btst #TIF_NEED_RESCHED,%d1
	117	jne reschedule
	118
	119	Lsignal_return:
	120	subql #4,%sp /* dummy return address*/
	121	SAVE_SWITCH_STACK
	122	pea %sp@(SWITCH_STACK_SIZE)
1da177e4	123	bsrw do_signal
710e91e4	124	addql #4,%sp
1da177e4 LT	125	RESTORE_SWITCH_STACK
1da177e4 LT	126	addql #4,%sp
d1574df7	127	jra 1b
1da177e4 LT	128
	129	/*
	130	* This is the main interrupt handler, responsible for calling process_int()
	131	*/
	132	inthandler1:
	133	SAVE_ALL
eb497e7b	134	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	135	and #0x3ff, %d0
	136
	137	movel %sp,%sp@-
	138	movel #65,%sp@- /* put vector # on stack*/
	139	jbsr process_int /* process the IRQ*/
	140	3: addql #8,%sp /* pop parameters off stack*/
	141	bra ret_from_interrupt
	142
	143	inthandler2:
	144	SAVE_ALL
eb497e7b	145	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	146	and #0x3ff, %d0
	147
	148	movel %sp,%sp@-
	149	movel #66,%sp@- /* put vector # on stack*/
	150	jbsr process_int /* process the IRQ*/
	151	3: addql #8,%sp /* pop parameters off stack*/
	152	bra ret_from_interrupt
	153
	154	inthandler3:
	155	SAVE_ALL
eb497e7b	156	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	157	and #0x3ff, %d0
	158
	159	movel %sp,%sp@-
	160	movel #67,%sp@- /* put vector # on stack*/
	161	jbsr process_int /* process the IRQ*/
	162	3: addql #8,%sp /* pop parameters off stack*/
	163	bra ret_from_interrupt
	164
	165	inthandler4:
	166	SAVE_ALL
eb497e7b	167	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	168	and #0x3ff, %d0
	169
	170	movel %sp,%sp@-
	171	movel #68,%sp@- /* put vector # on stack*/
	172	jbsr process_int /* process the IRQ*/
	173	3: addql #8,%sp /* pop parameters off stack*/
	174	bra ret_from_interrupt
	175
	176	inthandler5:
	177	SAVE_ALL
eb497e7b	178	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	179	and #0x3ff, %d0
	180
	181	movel %sp,%sp@-
	182	movel #69,%sp@- /* put vector # on stack*/
	183	jbsr process_int /* process the IRQ*/
	184	3: addql #8,%sp /* pop parameters off stack*/
	185	bra ret_from_interrupt
	186
	187	inthandler6:
	188	SAVE_ALL
eb497e7b	189	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	190	and #0x3ff, %d0
	191
	192	movel %sp,%sp@-
	193	movel #70,%sp@- /* put vector # on stack*/
	194	jbsr process_int /* process the IRQ*/
	195	3: addql #8,%sp /* pop parameters off stack*/
	196	bra ret_from_interrupt
	197
	198	inthandler7:
	199	SAVE_ALL
eb497e7b	200	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	201	and #0x3ff, %d0
	202
	203	movel %sp,%sp@-
	204	movel #71,%sp@- /* put vector # on stack*/
	205	jbsr process_int /* process the IRQ*/
	206	3: addql #8,%sp /* pop parameters off stack*/
	207	bra ret_from_interrupt
	208
	209	inthandler:
	210	SAVE_ALL
eb497e7b	211	movew %sp@(PT_OFF_FORMATVEC), %d0
1da177e4 LT	212	and #0x3ff, %d0
	213
	214	movel %sp,%sp@-
	215	movel %d0,%sp@- /* put vector # on stack*/
	216	jbsr process_int /* process the IRQ*/
	217	3: addql #8,%sp /* pop parameters off stack*/
	218	bra ret_from_interrupt
	219
	220	ret_from_interrupt:
1da177e4 LT	221	jeq 1f
	222	2:
	223	RESTORE_ALL
	224	1:
c84b564e	225	moveb %sp@(PT_OFF_SR), %d0
1da177e4 LT	226	and #7, %d0
	227	jhi 2b
	228
	229	/* check if we need to do software interrupts */
1da177e4 LT	230	jeq ret_from_exception
	231
	232	pea ret_from_exception
	233	jra do_softirq
	234
	235
	236	/*
	237	* Handler for uninitialized and spurious interrupts.
	238	*/
	239	ENTRY(bad_interrupt)
	240	addql #1,num_spurious
	241	rte
	242
	243	/*
	244	* Beware - when entering resume, prev (the current task) is
	245	* in a0, next (the new task) is in a1,so don't change these
	246	* registers until their contents are no longer needed.
	247	*/
	248	ENTRY(resume)
	249	movel %a0,%d1 /* save prev thread in d1 */
	250	movew %sr,%a0@(TASK_THREAD+THREAD_SR) /* save sr */
	251	movel %usp,%a2 /* save usp */
	252	movel %a2,%a0@(TASK_THREAD+THREAD_USP)
	253
	254	SAVE_SWITCH_STACK
	255	movel %sp,%a0@(TASK_THREAD+THREAD_KSP) /* save kernel stack */
	256	movel %a1@(TASK_THREAD+THREAD_KSP),%sp /* restore new thread stack */
	257	RESTORE_SWITCH_STACK
	258
	259	movel %a1@(TASK_THREAD+THREAD_USP),%a0 /* restore user stack */
	260	movel %a0,%usp
	261	movew %a1@(TASK_THREAD+THREAD_SR),%sr /* restore thread status reg */
	262	rts
	263