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