PageRenderTime 64ms CodeModel.GetById 9ms app.highlight 48ms RepoModel.GetById 1ms app.codeStats 0ms

/arch/mn10300/kernel/entry.S

https://bitbucket.org/thekraven/iscream_thunderc-2.6.35
Assembly | 730 lines | 710 code | 20 blank | 0 comment | 2 complexity | 95c9696b6aed5a9aa8bc1a6a38a19749 MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
  1###############################################################################
  2#
  3# MN10300 Exception and interrupt entry points
  4#
  5# Copyright (C) 2007 Matsushita Electric Industrial Co., Ltd.
  6# Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
  7# Modified by David Howells (dhowells@redhat.com)
  8#
  9# This program is free software; you can redistribute it and/or
 10# modify it under the terms of the GNU General Public Licence
 11# as published by the Free Software Foundation; either version
 12# 2 of the Licence, or (at your option) any later version.
 13#
 14###############################################################################
 15#include <linux/sys.h>
 16#include <linux/linkage.h>
 17#include <asm/smp.h>
 18#include <asm/system.h>
 19#include <asm/thread_info.h>
 20#include <asm/intctl-regs.h>
 21#include <asm/busctl-regs.h>
 22#include <asm/timer-regs.h>
 23#include <unit/leds.h>
 24#include <asm/page.h>
 25#include <asm/pgtable.h>
 26#include <asm/errno.h>
 27#include <asm/asm-offsets.h>
 28#include <asm/frame.inc>
 29
 30#ifdef CONFIG_PREEMPT
 31#define preempt_stop		__cli
 32#else
 33#define preempt_stop
 34#define resume_kernel		restore_all
 35#endif
 36
 37	.macro __cli
 38	and	~EPSW_IM,epsw
 39	or	EPSW_IE|MN10300_CLI_LEVEL,epsw
 40	nop
 41	nop
 42	nop
 43	.endm
 44	.macro __sti
 45	or	EPSW_IE|EPSW_IM_7,epsw
 46	.endm
 47
 48
 49	.am33_2
 50
 51###############################################################################
 52#
 53# the return path for a forked child
 54# - on entry, D0 holds the address of the previous task to run
 55#
 56###############################################################################
 57ENTRY(ret_from_fork)
 58	call	schedule_tail[],0
 59	GET_THREAD_INFO a2
 60
 61	# return 0 to indicate child process
 62	clr	d0
 63	mov	d0,(REG_D0,fp)
 64	jmp	syscall_exit
 65
 66###############################################################################
 67#
 68# system call handler
 69#
 70###############################################################################
 71ENTRY(system_call)
 72	add	-4,sp
 73	SAVE_ALL
 74	mov	d0,(REG_ORIG_D0,fp)
 75	GET_THREAD_INFO a2
 76	cmp	nr_syscalls,d0
 77	bcc	syscall_badsys
 78	btst	_TIF_SYSCALL_TRACE,(TI_flags,a2)
 79	bne	syscall_entry_trace
 80syscall_call:
 81	add	d0,d0,a1
 82	add	a1,a1
 83	mov	(REG_A0,fp),d0
 84	mov	(sys_call_table,a1),a0
 85	calls	(a0)
 86	mov	d0,(REG_D0,fp)
 87syscall_exit:
 88	# make sure we don't miss an interrupt setting need_resched or
 89	# sigpending between sampling and the rti
 90	__cli
 91	mov	(TI_flags,a2),d2
 92	btst	_TIF_ALLWORK_MASK,d2
 93	bne	syscall_exit_work
 94restore_all:
 95	RESTORE_ALL
 96
 97###############################################################################
 98#
 99# perform work that needs to be done immediately before resumption and syscall
100# tracing
101#
102###############################################################################
103	ALIGN
104syscall_exit_work:
105	btst	_TIF_SYSCALL_TRACE,d2
106	beq	work_pending
107	__sti				# could let syscall_trace_exit() call
108					# schedule() instead
109	mov	fp,d0
110	call	syscall_trace_exit[],0	# do_syscall_trace(regs)
111	jmp	resume_userspace
112
113	ALIGN
114work_pending:
115	btst	_TIF_NEED_RESCHED,d2
116	beq	work_notifysig
117
118work_resched:
119	call	schedule[],0
120
121	# make sure we don't miss an interrupt setting need_resched or
122	# sigpending between sampling and the rti
123	__cli
124
125	# is there any work to be done other than syscall tracing?
126	mov	(TI_flags,a2),d2
127	btst	_TIF_WORK_MASK,d2
128	beq	restore_all
129	btst	_TIF_NEED_RESCHED,d2
130	bne	work_resched
131
132	# deal with pending signals and notify-resume requests
133work_notifysig:
134	mov	fp,d0
135	mov	d2,d1
136	call	do_notify_resume[],0
137	jmp	resume_userspace
138
139	# perform syscall entry tracing
140syscall_entry_trace:
141	mov	-ENOSYS,d0
142	mov	d0,(REG_D0,fp)
143	mov	fp,d0
144	call	syscall_trace_entry[],0	# returns the syscall number to actually use
145	mov	(REG_D1,fp),d1
146	cmp	nr_syscalls,d0
147	bcs	syscall_call
148	jmp	syscall_exit
149
150syscall_badsys:
151	mov	-ENOSYS,d0
152	mov	d0,(REG_D0,fp)
153	jmp	resume_userspace
154
155	# userspace resumption stub bypassing syscall exit tracing
156	.globl	ret_from_exception, ret_from_intr
157	ALIGN
158ret_from_exception:
159	preempt_stop
160ret_from_intr:
161	GET_THREAD_INFO a2
162	mov	(REG_EPSW,fp),d0	# need to deliver signals before
163					# returning to userspace
164	and	EPSW_nSL,d0
165	beq	resume_kernel		# returning to supervisor mode
166
167ENTRY(resume_userspace)
168	# make sure we don't miss an interrupt setting need_resched or
169	# sigpending between sampling and the rti
170	__cli
171
172	# is there any work to be done on int/exception return?
173	mov	(TI_flags,a2),d2
174	btst	_TIF_WORK_MASK,d2
175	bne	work_pending
176	jmp	restore_all
177
178#ifdef CONFIG_PREEMPT
179ENTRY(resume_kernel)
180	__cli
181	mov	(TI_preempt_count,a2),d0	# non-zero preempt_count ?
182	cmp	0,d0
183	bne	restore_all
184
185need_resched:
186	btst	_TIF_NEED_RESCHED,(TI_flags,a2)
187	beq	restore_all
188	mov	(REG_EPSW,fp),d0
189	and	EPSW_IM,d0
190	cmp	EPSW_IM_7,d0		# interrupts off (exception path) ?
191	bne	restore_all
192	call	preempt_schedule_irq[],0
193	jmp	need_resched
194#endif
195
196
197###############################################################################
198#
199# IRQ handler entry point
200# - intended to be entered at multiple priorities
201#
202###############################################################################
203ENTRY(irq_handler)
204	add	-4,sp
205	SAVE_ALL
206
207	# it's not a syscall
208	mov	0xffffffff,d0
209	mov	d0,(REG_ORIG_D0,fp)
210
211	mov	fp,d0
212	call	do_IRQ[],0			# do_IRQ(regs)
213
214	jmp	ret_from_intr
215
216###############################################################################
217#
218# Monitor Signal handler entry point
219#
220###############################################################################
221ENTRY(monitor_signal)
222	movbu	(0xae000001),d1
223	cmp	1,d1
224	beq	monsignal
225	ret	[],0
226
227monsignal:
228	or	EPSW_NMID,epsw
229	mov	d0,a0
230	mov	a0,sp
231	mov	(REG_EPSW,fp),d1
232	and	~EPSW_nSL,d1
233	mov	d1,(REG_EPSW,fp)
234	movm	(sp),[d2,d3,a2,a3,exreg0,exreg1,exother]
235	mov	(sp),a1
236	mov	a1,usp
237	movm	(sp),[other]
238	add	4,sp
239here:	jmp	0x8e000008-here+0x8e000008
240
241###############################################################################
242#
243# Double Fault handler entry point
244# - note that there will not be a stack, D0/A0 will hold EPSW/PC as were
245#
246###############################################################################
247	.section .bss
248	.balign	THREAD_SIZE
249	.space	THREAD_SIZE
250__df_stack:
251	.previous
252
253ENTRY(double_fault)
254	mov	a0,(__df_stack-4)	# PC as was
255	mov	d0,(__df_stack-8)	# EPSW as was
256	mn10300_set_dbfleds		# display 'db-f' on the LEDs
257	mov	0xaa55aa55,d0
258	mov	d0,(__df_stack-12)	# no ORIG_D0
259	mov	sp,a0			# save corrupted SP
260	mov	__df_stack-12,sp	# emergency supervisor stack
261	SAVE_ALL
262	mov	a0,(REG_A0,fp)		# save corrupted SP as A0 (which got
263					# clobbered by the CPU)
264	mov	fp,d0
265	calls	do_double_fault
266double_fault_loop:
267	bra	double_fault_loop
268
269###############################################################################
270#
271# Bus Error handler entry point
272# - handle external (async) bus errors separately
273#
274###############################################################################
275ENTRY(raw_bus_error)
276	add	-4,sp
277	mov	d0,(sp)
278	mov	(BCBERR),d0		# what
279	btst	BCBERR_BEMR_DMA,d0	# see if it was an external bus error
280	beq	__common_exception_aux	# it wasn't
281
282	SAVE_ALL
283	mov	(BCBEAR),d1		# destination of erroneous access
284
285	mov	(REG_ORIG_D0,fp),d2
286	mov	d2,(REG_D0,fp)
287	mov	-1,d2
288	mov	d2,(REG_ORIG_D0,fp)
289
290	add	-4,sp
291	mov	fp,(12,sp)		# frame pointer
292	call	io_bus_error[],0
293	jmp	restore_all
294
295###############################################################################
296#
297# Miscellaneous exception entry points
298#
299###############################################################################
300ENTRY(nmi_handler)
301	add	-4,sp
302	mov	d0,(sp)
303	mov	(TBR),d0
304	bra	__common_exception_nonmi
305
306ENTRY(__common_exception)
307	add	-4,sp
308	mov	d0,(sp)
309
310__common_exception_aux:
311	mov	(TBR),d0
312	and	~EPSW_NMID,epsw		# turn NMIs back on if not NMI
313	or	EPSW_IE,epsw
314
315__common_exception_nonmi:
316	and	0x0000FFFF,d0		# turn the exception code into a vector
317					# table index
318
319	btst	0x00000007,d0
320	bne	1f
321	cmp	0x00000400,d0
322	bge	1f
323
324	SAVE_ALL			# build the stack frame
325
326	mov	(REG_D0,fp),a2		# get the exception number
327	mov	(REG_ORIG_D0,fp),d0
328	mov	d0,(REG_D0,fp)
329	mov	-1,d0
330	mov	d0,(REG_ORIG_D0,fp)
331
332#ifdef CONFIG_GDBSTUB
333	btst	0x01,(gdbstub_busy)
334	beq	2f
335	and	~EPSW_IE,epsw
336	mov	fp,d0
337	mov	a2,d1
338	call	gdbstub_exception[],0	# gdbstub itself caused an exception
339	bra	restore_all
3402:
341#endif
342
343	mov	fp,d0			# arg 0: stacked register file
344	mov	a2,d1			# arg 1: exception number
345	lsr	1,a2
346
347	mov	(exception_table,a2),a2
348	calls	(a2)
349	jmp	ret_from_exception
350
3511:	pi				# BUG() equivalent
352
353###############################################################################
354#
355# Exception handler functions table
356#
357###############################################################################
358	.data
359ENTRY(exception_table)
360	.rept	0x400>>1
361	 .long	uninitialised_exception
362	.endr
363	.previous
364
365###############################################################################
366#
367# Change an entry in the exception table
368# - D0 exception code, D1 handler
369#
370###############################################################################
371ENTRY(set_excp_vector)
372	lsr	1,d0
373	add	exception_table,d0
374	mov	d1,(d0)
375	mov	4,d1
376#if defined(CONFIG_MN10300_CACHE_WBACK)
377	jmp	mn10300_dcache_flush_inv_range2
378#else
379	ret	[],0
380#endif
381
382###############################################################################
383#
384# System call table
385#
386###############################################################################
387	.data
388ENTRY(sys_call_table)
389	.long sys_restart_syscall	/* 0 */
390	.long sys_exit
391	.long sys_fork
392	.long sys_read
393	.long sys_write
394	.long sys_open		/* 5 */
395	.long sys_close
396	.long sys_waitpid
397	.long sys_creat
398	.long sys_link
399	.long sys_unlink	/* 10 */
400	.long sys_execve
401	.long sys_chdir
402	.long sys_time
403	.long sys_mknod
404	.long sys_chmod		/* 15 */
405	.long sys_lchown16
406	.long sys_ni_syscall	/* old break syscall holder */
407	.long sys_stat
408	.long sys_lseek
409	.long sys_getpid	/* 20 */
410	.long sys_mount
411	.long sys_oldumount
412	.long sys_setuid16
413	.long sys_getuid16
414	.long sys_stime		/* 25 */
415	.long sys_ptrace
416	.long sys_alarm
417	.long sys_fstat
418	.long sys_pause
419	.long sys_utime		/* 30 */
420	.long sys_ni_syscall	/* old stty syscall holder */
421	.long sys_ni_syscall	/* old gtty syscall holder */
422	.long sys_access
423	.long sys_nice
424	.long sys_ni_syscall	/* 35 - old ftime syscall holder */
425	.long sys_sync
426	.long sys_kill
427	.long sys_rename
428	.long sys_mkdir
429	.long sys_rmdir		/* 40 */
430	.long sys_dup
431	.long sys_pipe
432	.long sys_times
433	.long sys_ni_syscall	/* old prof syscall holder */
434	.long sys_brk		/* 45 */
435	.long sys_setgid16
436	.long sys_getgid16
437	.long sys_signal
438	.long sys_geteuid16
439	.long sys_getegid16	/* 50 */
440	.long sys_acct
441	.long sys_umount	/* recycled never used phys() */
442	.long sys_ni_syscall	/* old lock syscall holder */
443	.long sys_ioctl
444	.long sys_fcntl		/* 55 */
445	.long sys_ni_syscall	/* old mpx syscall holder */
446	.long sys_setpgid
447	.long sys_ni_syscall	/* old ulimit syscall holder */
448	.long sys_ni_syscall	/* old sys_olduname */
449	.long sys_umask		/* 60 */
450	.long sys_chroot
451	.long sys_ustat
452	.long sys_dup2
453	.long sys_getppid
454	.long sys_getpgrp	/* 65 */
455	.long sys_setsid
456	.long sys_sigaction
457	.long sys_sgetmask
458	.long sys_ssetmask
459	.long sys_setreuid16	/* 70 */
460	.long sys_setregid16
461	.long sys_sigsuspend
462	.long sys_sigpending
463	.long sys_sethostname
464	.long sys_setrlimit	/* 75 */
465	.long sys_old_getrlimit
466	.long sys_getrusage
467	.long sys_gettimeofday
468	.long sys_settimeofday
469	.long sys_getgroups16	/* 80 */
470	.long sys_setgroups16
471	.long sys_old_select
472	.long sys_symlink
473	.long sys_lstat
474	.long sys_readlink	/* 85 */
475	.long sys_uselib
476	.long sys_swapon
477	.long sys_reboot
478	.long sys_old_readdir
479	.long old_mmap		/* 90 */
480	.long sys_munmap
481	.long sys_truncate
482	.long sys_ftruncate
483	.long sys_fchmod
484	.long sys_fchown16	/* 95 */
485	.long sys_getpriority
486	.long sys_setpriority
487	.long sys_ni_syscall	/* old profil syscall holder */
488	.long sys_statfs
489	.long sys_fstatfs	/* 100 */
490	.long sys_ni_syscall	/* ioperm */
491	.long sys_socketcall
492	.long sys_syslog
493	.long sys_setitimer
494	.long sys_getitimer	/* 105 */
495	.long sys_newstat
496	.long sys_newlstat
497	.long sys_newfstat
498	.long sys_ni_syscall	/* old sys_uname */
499	.long sys_ni_syscall	/* 110 - iopl */
500	.long sys_vhangup
501	.long sys_ni_syscall	/* old "idle" system call */
502	.long sys_ni_syscall	/* vm86old */
503	.long sys_wait4
504	.long sys_swapoff	/* 115 */
505	.long sys_sysinfo
506	.long sys_ipc
507	.long sys_fsync
508	.long sys_sigreturn
509	.long sys_clone		/* 120 */
510	.long sys_setdomainname
511	.long sys_newuname
512	.long sys_ni_syscall	/* modify_ldt */
513	.long sys_adjtimex
514	.long sys_mprotect	/* 125 */
515	.long sys_sigprocmask
516	.long sys_ni_syscall	/* old "create_module" */
517	.long sys_init_module
518	.long sys_delete_module
519	.long sys_ni_syscall	/* 130:	old "get_kernel_syms" */
520	.long sys_quotactl
521	.long sys_getpgid
522	.long sys_fchdir
523	.long sys_bdflush
524	.long sys_sysfs		/* 135 */
525	.long sys_personality
526	.long sys_ni_syscall	/* reserved for afs_syscall */
527	.long sys_setfsuid16
528	.long sys_setfsgid16
529	.long sys_llseek	/* 140 */
530	.long sys_getdents
531	.long sys_select
532	.long sys_flock
533	.long sys_msync
534	.long sys_readv		/* 145 */
535	.long sys_writev
536	.long sys_getsid
537	.long sys_fdatasync
538	.long sys_sysctl
539	.long sys_mlock		/* 150 */
540	.long sys_munlock
541	.long sys_mlockall
542	.long sys_munlockall
543	.long sys_sched_setparam
544	.long sys_sched_getparam   /* 155 */
545	.long sys_sched_setscheduler
546	.long sys_sched_getscheduler
547	.long sys_sched_yield
548	.long sys_sched_get_priority_max
549	.long sys_sched_get_priority_min  /* 160 */
550	.long sys_sched_rr_get_interval
551	.long sys_nanosleep
552	.long sys_mremap
553	.long sys_setresuid16
554	.long sys_getresuid16	/* 165 */
555	.long sys_ni_syscall	/* vm86 */
556	.long sys_ni_syscall	/* Old sys_query_module */
557	.long sys_poll
558	.long sys_nfsservctl
559	.long sys_setresgid16	/* 170 */
560	.long sys_getresgid16
561	.long sys_prctl
562	.long sys_rt_sigreturn
563	.long sys_rt_sigaction
564	.long sys_rt_sigprocmask	/* 175 */
565	.long sys_rt_sigpending
566	.long sys_rt_sigtimedwait
567	.long sys_rt_sigqueueinfo
568	.long sys_rt_sigsuspend
569	.long sys_pread64	/* 180 */
570	.long sys_pwrite64
571	.long sys_chown16
572	.long sys_getcwd
573	.long sys_capget
574	.long sys_capset	/* 185 */
575	.long sys_sigaltstack
576	.long sys_sendfile
577	.long sys_ni_syscall	/* reserved for streams1 */
578	.long sys_ni_syscall	/* reserved for streams2 */
579	.long sys_vfork		/* 190 */
580	.long sys_getrlimit
581	.long sys_mmap_pgoff
582	.long sys_truncate64
583	.long sys_ftruncate64
584	.long sys_stat64	/* 195 */
585	.long sys_lstat64
586	.long sys_fstat64
587	.long sys_lchown
588	.long sys_getuid
589	.long sys_getgid	/* 200 */
590	.long sys_geteuid
591	.long sys_getegid
592	.long sys_setreuid
593	.long sys_setregid
594	.long sys_getgroups	/* 205 */
595	.long sys_setgroups
596	.long sys_fchown
597	.long sys_setresuid
598	.long sys_getresuid
599	.long sys_setresgid	/* 210 */
600	.long sys_getresgid
601	.long sys_chown
602	.long sys_setuid
603	.long sys_setgid
604	.long sys_setfsuid	/* 215 */
605	.long sys_setfsgid
606	.long sys_pivot_root
607	.long sys_mincore
608	.long sys_madvise
609	.long sys_getdents64	/* 220 */
610	.long sys_fcntl64
611	.long sys_ni_syscall	/* reserved for TUX */
612	.long sys_ni_syscall
613	.long sys_gettid
614	.long sys_readahead	/* 225 */
615	.long sys_setxattr
616	.long sys_lsetxattr
617	.long sys_fsetxattr
618	.long sys_getxattr
619	.long sys_lgetxattr	/* 230 */
620	.long sys_fgetxattr
621	.long sys_listxattr
622	.long sys_llistxattr
623	.long sys_flistxattr
624	.long sys_removexattr	/* 235 */
625	.long sys_lremovexattr
626	.long sys_fremovexattr
627	.long sys_tkill
628	.long sys_sendfile64
629	.long sys_futex		/* 240 */
630	.long sys_sched_setaffinity
631	.long sys_sched_getaffinity
632	.long sys_ni_syscall	/* sys_set_thread_area */
633	.long sys_ni_syscall	/* sys_get_thread_area */
634	.long sys_io_setup	/* 245 */
635	.long sys_io_destroy
636	.long sys_io_getevents
637	.long sys_io_submit
638	.long sys_io_cancel
639	.long sys_fadvise64	/* 250 */
640	.long sys_ni_syscall
641	.long sys_exit_group
642	.long sys_lookup_dcookie
643	.long sys_epoll_create
644	.long sys_epoll_ctl	/* 255 */
645	.long sys_epoll_wait
646 	.long sys_remap_file_pages
647 	.long sys_set_tid_address
648 	.long sys_timer_create
649 	.long sys_timer_settime		/* 260 */
650 	.long sys_timer_gettime
651 	.long sys_timer_getoverrun
652 	.long sys_timer_delete
653 	.long sys_clock_settime
654 	.long sys_clock_gettime		/* 265 */
655 	.long sys_clock_getres
656 	.long sys_clock_nanosleep
657	.long sys_statfs64
658	.long sys_fstatfs64
659	.long sys_tgkill		/* 270 */
660	.long sys_utimes
661 	.long sys_fadvise64_64
662	.long sys_ni_syscall	/* sys_vserver */
663	.long sys_mbind
664	.long sys_get_mempolicy		/* 275 */
665	.long sys_set_mempolicy
666	.long sys_mq_open
667	.long sys_mq_unlink
668	.long sys_mq_timedsend
669	.long sys_mq_timedreceive	/* 280 */
670	.long sys_mq_notify
671	.long sys_mq_getsetattr
672	.long sys_kexec_load
673	.long sys_waitid
674	.long sys_ni_syscall		/* 285 */ /* available */
675	.long sys_add_key
676	.long sys_request_key
677	.long sys_keyctl
678	.long sys_cacheflush
679	.long sys_ioprio_set		/* 290 */
680	.long sys_ioprio_get
681	.long sys_inotify_init
682	.long sys_inotify_add_watch
683	.long sys_inotify_rm_watch
684	.long sys_migrate_pages		/* 295 */
685	.long sys_openat
686	.long sys_mkdirat
687	.long sys_mknodat
688	.long sys_fchownat
689	.long sys_futimesat		/* 300 */
690	.long sys_fstatat64
691	.long sys_unlinkat
692	.long sys_renameat
693	.long sys_linkat
694	.long sys_symlinkat		/* 305 */
695	.long sys_readlinkat
696	.long sys_fchmodat
697	.long sys_faccessat
698	.long sys_pselect6
699	.long sys_ppoll			/* 310 */
700	.long sys_unshare
701	.long sys_set_robust_list
702	.long sys_get_robust_list
703	.long sys_splice
704	.long sys_sync_file_range	/* 315 */
705	.long sys_tee
706	.long sys_vmsplice
707	.long sys_move_pages
708	.long sys_getcpu
709	.long sys_epoll_pwait		/* 320 */
710	.long sys_utimensat
711	.long sys_signalfd
712	.long sys_timerfd_create
713	.long sys_eventfd
714	.long sys_fallocate		/* 325 */
715	.long sys_timerfd_settime
716	.long sys_timerfd_gettime
717	.long sys_signalfd4
718	.long sys_eventfd2
719	.long sys_epoll_create1		/* 330 */
720	.long sys_dup3
721	.long sys_pipe2
722	.long sys_inotify_init1
723	.long sys_preadv
724	.long sys_pwritev		/* 335 */
725	.long sys_rt_tgsigqueueinfo
726	.long sys_perf_event_open
727	.long sys_recvmmsg
728
729
730nr_syscalls=(.-sys_call_table)/4