Blackfin: fix bugs in GPIO resume code
[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 <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_entry_trace
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 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
114 work_pending:
115         btst    _TIF_NEED_RESCHED,d2
116         beq     work_notifysig
117
118 work_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
133 work_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
140 syscall_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
150 syscall_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
158 ret_from_exception:
159         preempt_stop
160 ret_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
167 ENTRY(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
179 ENTRY(resume_kernel)
180         __cli
181         mov     (TI_preempt_count,a2),d0        # non-zero preempt_count ?
182         cmp     0,d0
183         bne     restore_all
184
185 need_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 ###############################################################################
203 ENTRY(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 ###############################################################################
221 ENTRY(monitor_signal)
222         movbu   (0xae000001),d1
223         cmp     1,d1
224         beq     monsignal
225         ret     [],0
226
227 monsignal:
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
239 here:   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
253 ENTRY(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
266 double_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 ###############################################################################
275 ENTRY(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 ###############################################################################
300 ENTRY(nmi_handler)
301         add     -4,sp
302         mov     d0,(sp)
303         mov     (TBR),d0
304         bra     __common_exception_nonmi
305
306 ENTRY(__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
340 2:
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
351 1:      pi                              # BUG() equivalent
352
353 ###############################################################################
354 #
355 # Exception handler functions table
356 #
357 ###############################################################################
358         .data
359 ENTRY(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 ###############################################################################
371 ENTRY(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
388 ENTRY(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 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_mmap2
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_counter_open
727
728
729 nr_syscalls=(.-sys_call_table)/4