entry.S
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:33k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: entry.S,v 1.38 2002/01/16 15:15:30 bjornw Exp $
  2.  *
  3.  *  linux/arch/cris/entry.S
  4.  *
  5.  *  Copyright (C) 2000, 2001 Axis Communications AB
  6.  *
  7.  *  Authors: Bjorn Wesen (bjornw@axis.com)
  8.  *
  9.  *  $Log: entry.S,v $
  10.  *  Revision 1.38  2002/01/16 15:15:30  bjornw
  11.  *  Use a C-code compatible watchdog reset when NICE_DOGGY is enabled
  12.  *
  13.  *  Revision 1.37  2001/12/07 17:03:55  bjornw
  14.  *  Call a c-hook called watchdog_bite_hook instead of show_registers directly
  15.  *
  16.  *  Revision 1.36  2001/11/22 13:36:36  bjornw
  17.  *  * In ret_from_intr, check regs->dccr for usermode reentrance instead of
  18.  *    DCCR explicitely (because the latter might not reflect current reality)
  19.  *  * In mmu_bus_fault, set $r9 _after_ calling the C-code instead of before
  20.  *    since $r9 is call-clobbered and is potentially needed afterwards
  21.  *
  22.  *  Revision 1.35  2001/10/30 17:10:15  bjornw
  23.  *  Add some syscalls
  24.  *
  25.  *  Revision 1.34  2001/10/01 14:45:03  bjornw
  26.  *  Removed underscores and added register prefixes
  27.  *
  28.  *  Revision 1.33  2001/08/21 13:48:01  jonashg
  29.  *  Added fix by HP to avoid oops when doing a hard_reset_now.
  30.  *
  31.  *  Revision 1.32  2001/08/14 04:32:02  hp
  32.  *  In _resume, add comment why R9 is saved; don't sound like it's call-saved.
  33.  *
  34.  *  Revision 1.31  2001/07/25 16:07:42  bjornw
  35.  *  softirq_active/mask -> softirq_pending only
  36.  *
  37.  *  Revision 1.30  2001/07/05 01:03:32  hp
  38.  *  - include asm/errno.h to get ENOSYS.
  39.  *  - Use ENOSYS, not local constant LENOSYS; tweak comments.
  40.  *  - Explain why .include, not #include is used.
  41.  *  - Make oops-register-dump if watchdog bits and it's not expected.
  42.  *  - Don't jsr, use jump _hard_reset_now, and skip spurious nop.
  43.  *  - Use correct section attribute for section .rodata.
  44.  *  - Adjust sys_ni_syscall fill number.
  45.  *
  46.  *  Revision 1.29  2001/06/25 14:07:00  hp
  47.  *   Fix review comment.
  48.  *   * head.S: Use IO_STATE, IO_FIELD and IO_MASK constructs instead of
  49.  *   magic numbers.  Add comment that -traditional must not be used.
  50.  *   * entry.S (SYMBOL_NAME): Change redefinition to use ## concatenation.
  51.  *   Correct and update comment.
  52.  *   * Makefile (.S.o): Don't use -traditional.  Add comment why the
  53.  *   toplevel rule can't be used (now that there's a reason).
  54.  *
  55.  *  Revision 1.28  2001/06/21 02:00:40  hp
  56.  *   * entry.S: Include asm/unistd.h.
  57.  *   (_sys_call_table): Use section .rodata, not .data.
  58.  *   (_kernel_thread): Move from...
  59.  *   * process.c: ... here.
  60.  *   * entryoffsets.c (VAL): Break out from...
  61.  *   (OF): Use VAL.
  62.  *   (LCLONE_VM): New asmified value from CLONE_VM.
  63.  *
  64.  *  Revision 1.27  2001/05/29 11:25:27  markusl
  65.  *  In case of "spurious_interrupt", do hard_reset instead of hanging system in a loop...
  66.  *
  67.  *  Revision 1.26  2001/05/15 15:46:03  bjornw
  68.  *  Include config.h now that we use some CONFIG_ options
  69.  *
  70.  *  Revision 1.25  2001/05/15 05:38:47  hp
  71.  *  Tweaked code in _ret_from_sys_call
  72.  *
  73.  *  Revision 1.24  2001/05/15 05:27:49  hp
  74.  *  Save r9 in r1 over function call rather than on stack.
  75.  *
  76.  *  Revision 1.23  2001/05/15 05:10:00  hp
  77.  *  Generate entry.S structure offsets from C
  78.  *
  79.  *  Revision 1.22  2001/04/17 13:58:39  orjanf
  80.  *  * Renamed CONFIG_KGDB to CONFIG_ETRAX_KGDB.
  81.  *
  82.  *  Revision 1.21  2001/04/17 11:33:29  orjanf
  83.  *  Updated according to review:
  84.  *  * Included asm/sv_addr_ag.h to get macro for internal register.
  85.  *  * Corrected comment regarding system call argument passing.
  86.  *  * Removed comment about instruction being in a delay slot.
  87.  *  * Added comment about SYMBOL_NAME macro.
  88.  *
  89.  *  Revision 1.20  2001/04/12 08:51:07  hp
  90.  *  - Add entry for sys_fcntl64.  In fact copy last piece from i386 including ...
  91.  *  - .rept to fill table to safe state with sys_ni_syscall.
  92.  *
  93.  *  Revision 1.19  2001/04/04 09:43:32  orjanf
  94.  *  * Moved do_sigtrap from traps.c to entry.S.
  95.  *  * LTASK_PID need not be global anymore.
  96.  *
  97.  *  Revision 1.18  2001/03/26 09:25:02  markusl
  98.  *  Updated after review, should now handle USB interrupts correctly.
  99.  *
  100.  *  Revision 1.17  2001/03/21 16:12:55  bjornw
  101.  *  * Always make room for the cpu status record in the frame, in order to
  102.  *    use the same framelength and layout for both mmu busfaults and normal
  103.  *    irqs. No need to check for the explicit CRIS_FRAME_FIXUP type anymore.
  104.  *  * Fixed bug with using addq for popping the stack in the epilogue - it
  105.  *    destroyed the flag register. Use instructions that don't affect the
  106.  *    flag register instead.
  107.  *  * Removed write to R_PORT_PA_DATA during spurious_interrupt
  108.  *
  109.  *  Revision 1.16  2001/03/20 19:43:02  bjornw
  110.  *  * Get rid of esp0 setting
  111.  *  * Give a 7th argument to a systemcall - the stackframe
  112.  *
  113.  *  Revision 1.15  2001/03/05 13:14:30  bjornw
  114.  *  Spelling fix
  115.  *
  116.  *  Revision 1.14  2001/02/23 08:36:36  perf
  117.  *  New ABI; syscallnr=r9, arg5=mof, arg6=srp.
  118.  *  Corrected tracesys call check.
  119.  *
  120.  *  Revision 1.13  2001/02/15 08:40:55  perf
  121.  *  H-P by way of perf;
  122.  *  - (_system_call): Don't read system call function address into r1.
  123.  *  - (RBFExit): There is no such thing as a null pop.  Adjust sp by addq.
  124.  *  - (_system_call): Don't use r10 and don't save and restore it.
  125.  *  - (THREAD_ESP0): New constant.
  126.  *  - (_system_call): Inline set_esp0.
  127.  *
  128.  *  Revision 1.12  2001/01/31 17:56:25  orjanf
  129.  *  Added definition of LTASK_PID and made it global.
  130.  *
  131.  *  Revision 1.11  2001/01/10 21:13:29  bjornw
  132.  *  SYMBOL_NAME is defined incorrectly for the compiler options we currently use
  133.  *
  134.  *  Revision 1.10  2000/12/18 23:47:56  bjornw
  135.  *  * Added syscall trace support (ptrace), completely untested of course
  136.  *  * Removed redundant check for NULL entries in syscall_table
  137.  *
  138.  *  Revision 1.9  2000/11/21 16:40:51  bjornw
  139.  *  * New frame type used when an SBFS frame needs to be popped without
  140.  *    actually restarting the instruction
  141.  *  * Enable interrupts in signal_return (they did so in x86, I hope it's a good
  142.  *    idea)
  143.  *
  144.  *  Revision 1.8  2000/11/17 16:53:35  bjornw
  145.  *  Added detection of frame-type in Rexit, so that mmu_bus_fault can
  146.  *  use ret_from_intr in the return-path to check for signals (like SEGV)
  147.  *  and other foul things that might have occurred during the fault.
  148.  *
  149.  *  Revision 1.7  2000/10/06 15:04:28  bjornw
  150.  *  Include mof in register savings
  151.  *
  152.  *  Revision 1.6  2000/09/12 16:02:44  bjornw
  153.  *  Linux-2.4.0-test7 derived updates
  154.  *
  155.  *  Revision 1.5  2000/08/17 15:35:15  bjornw
  156.  *  2.4.0-test6 changed local_irq_count and friends API
  157.  *
  158.  *  Revision 1.4  2000/08/02 13:59:30  bjornw
  159.  *  Removed olduname and uname from the syscall list
  160.  *
  161.  *  Revision 1.3  2000/07/31 13:32:58  bjornw
  162.  *  * Export ret_from_intr
  163.  *  * _resume updated (prev/last tjohejsan)
  164.  *  * timer_interrupt obsolete
  165.  *  * SIGSEGV detection in mmu_bus_fault temporarily disabled
  166.  *
  167.  *
  168.  */
  169. /*
  170.  * entry.S contains the system-call and fault low-level handling routines.
  171.  *
  172.  * NOTE: This code handles signal-recognition, which happens every time
  173.  * after a timer-interrupt and after each system call.
  174.  *
  175.  * Stack layout in 'ret_from_system_call':
  176.  *  ptrace needs to have all regs on the stack.
  177.  * if the order here is changed, it needs to be 
  178.  * updated in fork.c:copy_process, signal.c:do_signal,
  179.  * ptrace.c and ptrace.h
  180.  *
  181.  */
  182. #include <linux/config.h>
  183. #include <linux/linkage.h>
  184. #include <linux/sys.h>
  185. #include <asm/unistd.h>
  186. #include <asm/sv_addr_ag.h>
  187. #include <asm/errno.h>
  188. ;; functions exported from this file
  189. .globl system_call
  190. .globl ret_from_intr
  191. .globl ret_from_sys_call
  192. .globl resume
  193. .globl multiple_interrupt
  194. .globl hwbreakpoint
  195. .globl IRQ1_interrupt
  196. .globl timer_interrupt
  197. .globl timer_shortcut
  198. .globl spurious_interrupt
  199. .globl hw_bp_trigs
  200. .globl mmu_bus_fault
  201. .globl do_sigtrap
  202. .globl gdb_handle_breakpoint
  203. .globl sys_call_table
  204. ;; Get values and offsets into various structs.  The file isn't
  205. ;; suitable for consumption by the preprocessor, so don't use
  206. ;; #include.
  207. .include "entryoffsets.s"
  208. ;; process bits for ptrace.  FIXME: Should be in a header file.
  209. PT_TRACESYS_BIT   = 1
  210. ;; below are various parts of system_call which are not in the fast-path
  211. ;; handle software irqs
  212. _handle_softirq:
  213. move.d $r9, $r1
  214. jsr do_softirq ; call the C routine for softirq handling
  215. move.d $r1, $r9
  216. ;; fall-through
  217. ret_from_intr:
  218. ;; check for resched only if we're going back to user-mode
  219. ;; this test matches the user_regs(regs) macro
  220. ;; we cannot simply test $dccr, because that does not necessarily
  221. ;; reflect what mode we'll return into.
  222. move.d [$sp + LDCCR], $r0; regs->dccr
  223. btstq 8, $r0 ; U-flag
  224. bpl _Rexit ; go back directly
  225. nop
  226. ba _ret_with_reschedule  ; go back but check schedule and signals first 
  227. nop
  228. _reschedule:
  229. ;; keep r9 intact
  230. move.d $r9, $r1
  231. jsr schedule
  232. ba ret_from_sys_call
  233. move.d $r1, $r9
  234. ;; return but call do_signal first
  235. _signal_return:
  236. ei ; we can get here from an interrupt
  237. move.d $r9, $r10 ; do_signals syscall/irq param
  238. moveq 0, $r11 ; oldset param - 0 in this case
  239. move.d $sp, $r12 ; another argument to do_signal (the regs param)
  240. jsr do_signal ; arch/cris/kernel/signal.c
  241. ba _Rexit
  242. nop
  243. ;; The system_call is called by a BREAK instruction, which works like
  244. ;; an interrupt call but it stores the return PC in BRP instead of IRP.
  245. ;; Since we dont really want to have two epilogues (one for system calls
  246. ;; and one for interrupts) we push the contents of BRP instead of IRP in the
  247. ;; system call prologue, to make it look like an ordinary interrupt on the
  248. ;; stackframe.
  249. ;;
  250. ;; Since we can't have system calls inside interrupts, it should not matter
  251. ;; that we don't stack IRP.
  252. ;; 
  253. ;; In r9 we have the wanted syscall number. Arguments come in r10,r11,r12,r13,mof,srp
  254. ;;
  255. ;; This function looks on the _surface_ like spaghetti programming, but it's
  256. ;; really designed so that the fast-path does not force cache-loading of non-used
  257. ;; instructions. Only the non-common cases cause the outlined code to run..
  258. system_call:
  259. ;; stack-frame similar to the irq heads, which is reversed in ret_from_sys_call
  260. move $brp,[$sp=$sp-16]; instruction pointer and room for a fake SBFS frame
  261. push $srp
  262. push $dccr
  263. push $mof
  264. subq 14*4, $sp ; make room for r0-r13
  265. movem $r13, [$sp] ; push r0-r13
  266. push $r10 ; push orig_r10
  267. clear.d [$sp=$sp-4] ; frametype == 0, normal stackframe
  268. movs.w -ENOSYS, $r0
  269. move.d $r0, [$sp+LR10] ; put the default return value in r10 in the frame
  270. ;; check if this process is syscall-traced
  271. movs.w -8192, $r0 ; THREAD_SIZE == 8192
  272. and.d $sp, $r0
  273. move.d [$r0+LTASK_PTRACE], $r0
  274. btstq PT_TRACESYS_BIT, $r0
  275. bmi _tracesys
  276. nop
  277. ;; check for sanity in the requested syscall number
  278. cmpu.w NR_syscalls, $r9
  279. bcc ret_from_sys_call
  280. lslq 2, $r9 ;  multiply by 4, in the delay slot
  281. ;; as a bonus 7th parameter, we give the location on the stack
  282. ;; of the register structure itself. some syscalls need this.
  283. push $sp
  284. ;; the parameter carrying registers r10, r11, r12 and 13 are intact.
  285. ;; the fifth and sixth parameters (if any) was in mof and srp 
  286. ;; respectively, and we need to put them on the stack.
  287. push $srp
  288. push $mof
  289. jsr [$r9+sys_call_table] ; actually do the system call
  290. addq 3*4, $sp ; pop the mof, srp and regs parameters
  291. move.d $r10, [$sp+LR10] ; save the return value
  292. moveq 1, $r9 ; "parameter" to ret_from_sys_call to show it was a sys call
  293. ;; fall through into ret_from_sys_call to return
  294. ret_from_sys_call:
  295. ;; r9 is a parameter - if 1, we came from a syscall, if 0, from an irq
  296. ;; check if any bottom halves need service
  297. test.d [irq_stat]        ; softirq_pending
  298. bne _handle_softirq
  299. nop
  300. _ret_with_reschedule:
  301. ;; first get the current task-struct pointer (see top for defs)
  302. move.d $sp, $r0
  303. and.d -8192, $r0 ; THREAD_SIZE == 8192
  304. ;; see if we want to reschedule into another process
  305. test.d [$r0+LTASK_NEEDRESCHED]
  306. bne _reschedule
  307. nop
  308. ;; see if we need to run signal checks (important that r9 is intact here)
  309. test.d [$r0+LTASK_SIGPENDING]
  310. bne _signal_return
  311. nop
  312. _Rexit:
  313. ;; this epilogue MUST match the prologues in multiple_interrupt, irq.h and ptregs.h
  314. pop $r10 ; frametype
  315. bne _RBFexit ; was not CRIS_FRAME_NORMAL, handle otherwise
  316. addq 4, $sp ; skip orig_r10, in delayslot
  317. movem [$sp+], $r13 ; registers r0-r13
  318. pop $mof ; multiply overflow register 
  319. pop $dccr ; condition codes
  320. pop $srp ; subroutine return pointer
  321. ;; now we have a 4-word SBFS frame which we do not want to restore
  322. ;; using RBF since it was not stacked with SBFS. instead we would like to
  323. ;; just get the PC value to restart it with, and skip the rest of
  324. ;; the frame.
  325. ;; Also notice that it's important to use instructions here that
  326. ;; keep the interrupts disabled (since we've already popped DCCR)
  327. move [$sp=$sp+16], $p8; pop the SBFS frame from the sp
  328. jmpu [$sp-16] ; return through the irp field in the sbfs frame
  329. _RBFexit:
  330. movem [$sp+], $r13 ; registers r0-r13, in delay slot
  331. pop $mof ; multiply overflow register 
  332. pop $dccr ; condition codes
  333. pop $srp ; subroutine return pointer
  334. rbf [$sp+] ; return by popping the CPU status
  335. _tracesys:
  336. ;; this first invocation of syscall_trace _requires_ that
  337. ;; LR10 in the frame contains -ENOSYS (as is set in the beginning
  338. ;; of system_call).
  339. jsr syscall_trace
  340. ;; now we should more or less do the same things as in the system_call
  341. ;; but since our argument regs got clobbered during syscall_trace and
  342. ;; because syscall_trace might want to alter them, we need to reload them
  343. ;; from the stack-frame as we use them.
  344. ;; check for sanity in the requested syscall number
  345. move.d [$sp+LR9], $r9
  346. movs.w -ENOSYS, $r10
  347. cmpu.w NR_syscalls, $r9
  348. bcc 1f
  349. lslq 2, $r9 ;  multiply by 4, in the delay slot
  350. ;; read the system call vector entry into r9
  351. move.d [$r9+sys_call_table], $r9
  352. ;; restore r10, r11, r12, r13, mof and srp into the needed registers
  353. move.d [$sp+LORIG_R10], $r10  ; LR10 is already filled with -ENOSYS.
  354. move.d [$sp+LR11],      $r11
  355. move.d [$sp+LR12],      $r12
  356. move.d [$sp+LR13],      $r13
  357. move [$sp+LMOF],      $mof
  358. move [$sp+LSRP],      $srp
  359. ;; as a bonus 7th parameter, we give the location on the stack
  360. ;; of the register structure itself. some syscalls need this.
  361. push $sp
  362. ;; the fifth and sixth parameters needs to be put on the stack for
  363. ;; the system call to find them
  364. push $srp
  365. push $mof
  366. jsr $r9 ; actually call the system-call
  367. addq 3*4, $sp ; pop the srp, mof and regs parameters
  368. 1: move.d $r10, [$sp+LR10]; save the return value
  369. ;; second call of syscall_trace, to let it grab the results
  370. jsr syscall_trace
  371. moveq 1, $r9 ; "parameter" to ret_from_sys_call to show it was a sys call
  372. ba ret_from_sys_call
  373. nop
  374. ;; resume performs the actual task-switching, by switching stack pointers
  375. ;; input arguments: r10 = prev, r11 = next, r12 = thread offset in task struct
  376. ;; returns old current in r10
  377. ;;
  378. ;; TODO:  see the i386 version. The switch_to which calls resume in our version
  379. ;;        could really be an inline asm of this.
  380. resume:
  381. push $srp          ; we keep the old/new PC on the stack 
  382. add.d $r12, $r10  ; r10 = current tasks tss
  383. move $dccr, [$r10+LTHREAD_DCCR] ; save irq enable state
  384. di
  385. move $usp, [$r10+LTHREAD_USP] ; save user-mode stackpointer
  386. ;; See copy_thread for the reason why register R9 is saved.
  387. subq 10*4, $sp
  388. movem $r9, [$sp]  ; save non-scratch registers and R9.
  389. move.d $sp, [$r10+LTHREAD_KSP]  ; save the kernel stack pointer for the old task
  390. move.d $sp, $r10  ; return last running task in r10
  391. and.d   -8192, $r10          ; get task ptr from stackpointer
  392. add.d $r12, $r11  ; find the new tasks tss
  393. move.d [$r11+LTHREAD_KSP], $sp  ; switch into the new stackframe by restoring kernel sp
  394. movem [$sp+], $r9  ; restore non-scratch registers and R9.
  395. move [$r11+LTHREAD_USP], $usp ; restore user-mode stackpointer
  396. move [$r11+LTHREAD_DCCR], $dccr ; restore irq enable status
  397. jump [$sp+]          ; restore PC
  398. ;; This is the MMU bus fault handler.
  399. ;; It needs to stack the CPU status and overall is different
  400. ;; from the other interrupt handlers.
  401. mmu_bus_fault:
  402. sbfs [$sp=$sp-16] ; push the internal CPU status
  403. ;; the first longword in the sbfs frame was the interrupted PC
  404. ;; which fits nicely with the "IRP" slot in pt_regs normally used to
  405. ;; contain the return address. used by Oops to print kernel errors..
  406. push $srp ; make a stackframe similar to pt_regs
  407. push $dccr
  408. push $mof
  409. di
  410. subq 14*4, $sp
  411. movem $r13, [$sp]
  412. push $r10 ; dummy orig_r10
  413. moveq 1, $r10
  414. push $r10 ; frametype == 1, BUSFAULT frame type
  415. move.d $sp, $r10 ; pt_regs argument to handle_mmu_bus_fault
  416. jsr handle_mmu_bus_fault  ; in arch/cris/mm/fault.c
  417. ;; now we need to return through the normal path, we cannot just
  418. ;; do the RBFexit since we might have killed off the running
  419. ;; process due to a SEGV, scheduled due to a page blocking or
  420. ;; whatever.
  421. moveq 0, $r9 ; busfault is equivalent to an irq
  422. ba ret_from_intr
  423. nop
  424. ;; special handlers for breakpoint and NMI
  425. #if 0
  426. hwbreakpoint:
  427. push $dccr
  428. di
  429. push $r10
  430. push $r11
  431. push $r12
  432. push $r13
  433. clearf b
  434. move $brp,$r11
  435. move.d [hw_bp_msg],$r10
  436. jsr printk
  437. setf b
  438. pop $r13
  439. pop $r12
  440. pop $r11
  441. pop $r10
  442. pop $dccr
  443. retb
  444. nop
  445. #else
  446. hwbreakpoint:
  447. push $dccr
  448. di
  449. #if 1
  450. push $r10
  451. push $r11
  452. move.d [hw_bp_trig_ptr],$r10
  453. move.d [$r10],$r11
  454. cmp.d 42,$r11
  455. beq 1f
  456. nop
  457. move $brp,$r11
  458. move.d $r11,[$r10+]
  459. move.d $r10,[hw_bp_trig_ptr]
  460. 1: pop $r11
  461. pop $r10
  462. #endif
  463. pop $dccr
  464. retb
  465. nop
  466. #endif
  467. IRQ1_interrupt:
  468. #if defined(CONFIG_ETRAX_WATCHDOG) && !defined(CONFIG_SVINTO_SIM)
  469. ;; If we receive a watchdog interrupt while it is not expected, then set
  470. ;; up a canonical frame and dump register contents before dying.
  471. ;; this prologue MUST match the one in irq.h and the struct in ptregs.h!!!
  472. move $brp,[$sp=$sp-16]; instruction pointer and room for a fake SBFS frame
  473. push $srp
  474. push $dccr
  475. push $mof
  476. di
  477. subq 14*4, $sp
  478. movem $r13, [$sp]
  479. push $r10 ; push orig_r10
  480. clear.d [$sp=$sp-4] ; frametype == 0, normal frame
  481. ;; We don't check that we actually were bit by the watchdog as opposed to
  482. ;; an external NMI, since there is currently no handler for external NMI.
  483. ;; Check if we're waiting for reset to happen, as signalled by
  484. ;; hard_reset_now setting cause_of_death to a magic value.  If so, just
  485. ;; get stuck until reset happens.
  486. .comm cause_of_death, 4 ;; Don't declare this anywhere.
  487. move.d [cause_of_death], $r10
  488. cmp.d 0xbedead, $r10
  489. _killed_by_death:
  490. beq _killed_by_death
  491. nop
  492. ;; We'll see this in ksymoops dumps.
  493. Watchdog_bite:
  494. #ifdef CONFIG_ETRAX_WATCHDOG_NICE_DOGGY
  495. ;; We just restart the watchdog here to be sure we dont get
  496. ;; hit while printing the watchdogmsg below
  497. ;; This restart is compatible with the rest of the C-code, so
  498. ;; the C-code can keep restarting the watchdog after this point.
  499. ;; The non-NICE_DOGGY code below though, disables the possibility
  500. ;; to restart since it changes the watchdog key, to avoid any
  501. ;; buggy loops etc. keeping the watchdog alive after this.
  502. jsr reset_watchdog
  503. #else
  504. ;; We need to extend the 3.3ms after the NMI at watchdog bite, so we have
  505. ;; time for an oops-dump over a 115k2 serial wire.  Another 100ms should do.
  506. ;; Change the watchdog key to an arbitrary 3-bit value and restart the
  507. ;; watchdog.
  508. #define WD_INIT 2
  509. moveq   IO_FIELD (R_WATCHDOG, key, WD_INIT), $r10
  510. move.d R_WATCHDOG, $r11
  511. move.d $r10, [$r11]
  512. moveq   IO_FIELD (R_WATCHDOG, key,
  513.     IO_EXTRACT (R_WATCHDOG, key,
  514. IO_MASK (R_WATCHDOG, key))
  515.     ^ WD_INIT)
  516. | IO_STATE (R_WATCHDOG, enable, start), $r10
  517. move.d $r10, [$r11]
  518. #endif
  519. ;; Note that we don't do "setf m" here (or after two necessary NOPs),
  520. ;; since *not* doing that saves us from re-entrancy checks.  We don't want
  521. ;; to get here again due to possible subsequent NMIs; we want the watchdog
  522. ;; to reset us.
  523. move.d _watchdogmsg,$r10
  524. jsr printk
  525. move.d $sp, $r10
  526. jsr watchdog_bite_hook
  527. ;; This nop is here so we see the "Watchdog_bite" label in ksymoops dumps
  528. ;; rather than "spurious_interrupt".
  529. nop
  530. ;; At this point we drop down into spurious_interrupt, which will do a
  531. ;; hard reset.
  532. .section .rodata,"a"
  533. _watchdogmsg:
  534. .ascii "Oops: bitten by watchdogn"
  535. .previous
  536. #endif /* CONFIG_ETRAX_WATCHDOG and not CONFIG_SVINTO_SIM */
  537. spurious_interrupt:
  538. di
  539. jump hard_reset_now
  540. ;; this handles the case when multiple interrupts arrive at the same time
  541. ;; we jump to the first set interrupt bit in a priority fashion
  542. ;; the hardware will call the unserved interrupts after the handler finishes
  543. multiple_interrupt:
  544. ;; this prologue MUST match the one in irq.h and the struct in ptregs.h!!!
  545. move $irp,[$sp=$sp-16]; instruction pointer and room for a fake SBFS frame
  546. push $srp
  547. push $dccr
  548. push $mof
  549. di
  550. subq 14*4, $sp
  551. movem $r13, [$sp]
  552. push $r10 ; push orig_r10
  553. clear.d [$sp=$sp-4] ; frametype == 0, normal frame
  554. move.d irq_shortcuts + 8, $r1
  555. moveq 2, $r2 ; first bit we care about is the timer0 irq
  556. move.d [R_VECT_MASK_RD], $r0; read the irq bits that triggered the multiple irq
  557. 1:
  558. btst $r2, $r0 ; check for the irq given by bit r2
  559. bmi _do_shortcut ; actually do the shortcut
  560. nop
  561. addq 1, $r2 ; next vector bit
  562. addq 4, $r1 ; next vector
  563. cmp.b 32, $r2
  564. bne 1b ; process all irq's up to and including number 31
  565. nop
  566. ;; strange, we didn't get any set vector bits.. oh well, just return
  567. ba _Rexit
  568. nop
  569. _do_shortcut:
  570. test.d [$r1]
  571. beq _Rexit
  572. nop
  573. jump [$r1] ; jump to the irq handlers shortcut
  574. do_sigtrap:
  575. ;; 
  576. ;; SIGTRAP the process that executed the break instruction.
  577. ;; Make a frame that Rexit in entry.S expects.
  578. ;;
  579. move $brp, [$sp=$sp-16] ; Push BRP while faking a cpu status record.
  580. push $srp ; Push subroutine return pointer.
  581. push $dccr ; Push condition codes.
  582. push $mof ; Push multiply overflow reg.
  583. di ; Need to disable irq's at this point.
  584. subq 14*4, $sp ; Make room for r0-r13.
  585. movem $r13, [$sp] ; Push the r0-r13 registers.
  586. push $r10 ; Push orig_r10.
  587. clear.d [$sp=$sp-4] ; Frametype - this is a normal stackframe.
  588. movs.w -8192,$r9 ; THREAD_SIZE == 8192
  589. and.d $sp, $r9
  590. move.d [$r9+LTASK_PID], $r10 ; current->pid as arg1.
  591. moveq 5, $r11 ; SIGTRAP as arg2.
  592. jsr sys_kill       
  593. jump ret_from_intr ; Use the return routine for interrupts.
  594. gdb_handle_breakpoint:
  595. push $dccr
  596. push $r0
  597. #ifdef CONFIG_ETRAX_KGDB
  598. move $dccr, $r0 ; U-flag not affected by previous insns. 
  599. btstq 8, $r0 ; Test the U-flag.
  600. bmi _ugdb_handle_breakpoint ; Go to user mode debugging. 
  601. nop ; Empty delay slot (cannot pop r0 here). 
  602. pop $r0 ; Restore r0.
  603. ba kgdb_handle_breakpoint ; Go to kernel debugging. 
  604. pop $dccr ; Restore dccr in delay slot.
  605. #endif
  606. _ugdb_handle_breakpoint:
  607. move $brp, $r0 ; Use r0 temporarily for calculation.
  608. subq 2, $r0 ; Set to address of previous instruction.
  609. move $r0, $brp
  610. pop $r0 ; Restore r0. 
  611. ba do_sigtrap ; SIGTRAP the offending process. 
  612. pop $dccr ; Restore dccr in delay slot.
  613. .data
  614. hw_bp_trigs:
  615. .space 64*4
  616. hw_bp_trig_ptr:
  617. .dword hw_bp_trigs
  618. /*
  619.  * This is the mechanism for creating a new kernel thread.
  620.  *
  621.  * NOTE! Only a kernel-only process (i.e. the swapper or direct descendants
  622.  * who haven't done an "execve()") should use this: it will work within
  623.  * a system call from a "real" process, but the process memory space will
  624.  * not be free'd until both the parent and the child have exited.
  625.  *
  626.  * This *can* be done in C with an single-asm-wrapped-in-a-function, but you
  627.  * get more or less gross code.  The safer you make the asm-constraints,
  628.  * the grosser the code, at least with the gcc version in cris-dist-1.13.
  629.  */
  630. /* int kernel_thread(int (*fn)(void *), void * arg, unsigned long flags) */
  631. /*                   r10                r11         r12  */
  632. .text
  633. .global kernel_thread
  634. kernel_thread:
  635. /* Save ARG for later.  */
  636. move.d $r11, $r13
  637. /* r11 is argument 2 to clone, the flags */
  638. move.d  $r12, $r11
  639. or.w LCLONE_VM, $r11
  640. /* Save FN for later.  */
  641. move.d $r10, $r12
  642. /* r9 contains syscall number, to sys_clone */
  643. movu.w __NR_clone, $r9
  644. /* r10 is argument 1 to clone */
  645. clear.d $r10
  646. /* call sys_clone, this will fork */
  647. break 13
  648. /* parent or child? child returns 0 here. */
  649. test.d $r10
  650. /* jump if parent */
  651. bne 1f
  652. nop              /* delay slot */
  653. /* set argument to function to call */
  654. move.d $r13, $r10
  655. /* call specified function */
  656. jsr $r12
  657. /* If we ever return from the function, something bad has happened.  */
  658. /* r9 is sys_exit syscall number */
  659. movu.w __NR_exit, $r9
  660. /* Give a really bad exit-value */
  661. moveq -1, $r10
  662. /* call sys_exit, killing the child */
  663. break 13
  664. 1:
  665. ret
  666. nop              /* delay slot */
  667. .section .rodata,"a"
  668. sys_call_table:
  669. .long SYMBOL_NAME(sys_ni_syscall) /* 0  -  old "setup()" system call*/
  670. .long SYMBOL_NAME(sys_exit)
  671. .long SYMBOL_NAME(sys_fork)
  672. .long SYMBOL_NAME(sys_read)
  673. .long SYMBOL_NAME(sys_write)
  674. .long SYMBOL_NAME(sys_open) /* 5 */
  675. .long SYMBOL_NAME(sys_close)
  676. .long SYMBOL_NAME(sys_waitpid)
  677. .long SYMBOL_NAME(sys_creat)
  678. .long SYMBOL_NAME(sys_link)
  679. .long SYMBOL_NAME(sys_unlink) /* 10 */
  680. .long SYMBOL_NAME(sys_execve)
  681. .long SYMBOL_NAME(sys_chdir)
  682. .long SYMBOL_NAME(sys_time)
  683. .long SYMBOL_NAME(sys_mknod)
  684. .long SYMBOL_NAME(sys_chmod) /* 15 */
  685. .long SYMBOL_NAME(sys_lchown16)
  686. .long SYMBOL_NAME(sys_ni_syscall) /* old break syscall holder */
  687. .long SYMBOL_NAME(sys_stat)
  688. .long SYMBOL_NAME(sys_lseek)
  689. .long SYMBOL_NAME(sys_getpid) /* 20 */
  690. .long SYMBOL_NAME(sys_mount)
  691. .long SYMBOL_NAME(sys_oldumount)
  692. .long SYMBOL_NAME(sys_setuid16)
  693. .long SYMBOL_NAME(sys_getuid16)
  694. .long SYMBOL_NAME(sys_stime) /* 25 */
  695. .long SYMBOL_NAME(sys_ptrace)
  696. .long SYMBOL_NAME(sys_alarm)
  697. .long SYMBOL_NAME(sys_fstat)
  698. .long SYMBOL_NAME(sys_pause)
  699. .long SYMBOL_NAME(sys_utime) /* 30 */
  700. .long SYMBOL_NAME(sys_ni_syscall) /* old stty syscall holder */
  701. .long SYMBOL_NAME(sys_ni_syscall) /* old gtty syscall holder */
  702. .long SYMBOL_NAME(sys_access)
  703. .long SYMBOL_NAME(sys_nice)
  704. .long SYMBOL_NAME(sys_ni_syscall) /* 35  old ftime syscall holder */
  705. .long SYMBOL_NAME(sys_sync)
  706. .long SYMBOL_NAME(sys_kill)
  707. .long SYMBOL_NAME(sys_rename)
  708. .long SYMBOL_NAME(sys_mkdir)
  709. .long SYMBOL_NAME(sys_rmdir) /* 40 */
  710. .long SYMBOL_NAME(sys_dup)
  711. .long SYMBOL_NAME(sys_pipe)
  712. .long SYMBOL_NAME(sys_times)
  713. .long SYMBOL_NAME(sys_ni_syscall) /* old prof syscall holder */
  714. .long SYMBOL_NAME(sys_brk) /* 45 */
  715. .long SYMBOL_NAME(sys_setgid16)
  716. .long SYMBOL_NAME(sys_getgid16)
  717. .long SYMBOL_NAME(sys_signal)
  718. .long SYMBOL_NAME(sys_geteuid16)
  719. .long SYMBOL_NAME(sys_getegid16) /* 50 */
  720. .long SYMBOL_NAME(sys_acct)
  721. .long SYMBOL_NAME(sys_umount) /* recycled never used phys() */
  722. .long SYMBOL_NAME(sys_ni_syscall) /* old lock syscall holder */
  723. .long SYMBOL_NAME(sys_ioctl)
  724. .long SYMBOL_NAME(sys_fcntl) /* 55 */
  725. .long SYMBOL_NAME(sys_ni_syscall) /* old mpx syscall holder */
  726. .long SYMBOL_NAME(sys_setpgid)
  727. .long SYMBOL_NAME(sys_ni_syscall) /* old ulimit syscall holder */
  728. .long SYMBOL_NAME(sys_ni_syscall)       /* old sys_olduname holder */
  729. .long SYMBOL_NAME(sys_umask) /* 60 */
  730. .long SYMBOL_NAME(sys_chroot)
  731. .long SYMBOL_NAME(sys_ustat)
  732. .long SYMBOL_NAME(sys_dup2)
  733. .long SYMBOL_NAME(sys_getppid)
  734. .long SYMBOL_NAME(sys_getpgrp) /* 65 */
  735. .long SYMBOL_NAME(sys_setsid)
  736. .long SYMBOL_NAME(sys_sigaction)
  737. .long SYMBOL_NAME(sys_sgetmask)
  738. .long SYMBOL_NAME(sys_ssetmask)
  739. .long SYMBOL_NAME(sys_setreuid16) /* 70 */
  740. .long SYMBOL_NAME(sys_setregid16)
  741. .long SYMBOL_NAME(sys_sigsuspend)
  742. .long SYMBOL_NAME(sys_sigpending)
  743. .long SYMBOL_NAME(sys_sethostname)
  744. .long SYMBOL_NAME(sys_setrlimit) /* 75 */
  745. .long SYMBOL_NAME(sys_old_getrlimit)
  746. .long SYMBOL_NAME(sys_getrusage)
  747. .long SYMBOL_NAME(sys_gettimeofday)
  748. .long SYMBOL_NAME(sys_settimeofday)
  749. .long SYMBOL_NAME(sys_getgroups16) /* 80 */
  750. .long SYMBOL_NAME(sys_setgroups16)
  751. .long SYMBOL_NAME(sys_select)           /* was old_select in Linux/E100 */
  752. .long SYMBOL_NAME(sys_symlink)
  753. .long SYMBOL_NAME(sys_lstat)
  754. .long SYMBOL_NAME(sys_readlink) /* 85 */
  755. .long SYMBOL_NAME(sys_uselib)
  756. .long SYMBOL_NAME(sys_swapon)
  757. .long SYMBOL_NAME(sys_reboot)
  758. .long SYMBOL_NAME(old_readdir)
  759. .long SYMBOL_NAME(old_mmap) /* 90 */
  760. .long SYMBOL_NAME(sys_munmap)
  761. .long SYMBOL_NAME(sys_truncate)
  762. .long SYMBOL_NAME(sys_ftruncate)
  763. .long SYMBOL_NAME(sys_fchmod)
  764. .long SYMBOL_NAME(sys_fchown16) /* 95 */
  765. .long SYMBOL_NAME(sys_getpriority)
  766. .long SYMBOL_NAME(sys_setpriority)
  767. .long SYMBOL_NAME(sys_ni_syscall) /* old profil syscall holder */
  768. .long SYMBOL_NAME(sys_statfs)
  769. .long SYMBOL_NAME(sys_fstatfs) /* 100 */
  770. .long SYMBOL_NAME(sys_ni_syscall)       /* sys_ioperm in i386 */
  771. .long SYMBOL_NAME(sys_socketcall)
  772. .long SYMBOL_NAME(sys_syslog)
  773. .long SYMBOL_NAME(sys_setitimer)
  774. .long SYMBOL_NAME(sys_getitimer) /* 105 */
  775. .long SYMBOL_NAME(sys_newstat)
  776. .long SYMBOL_NAME(sys_newlstat)
  777. .long SYMBOL_NAME(sys_newfstat)
  778. .long SYMBOL_NAME(sys_ni_syscall) /* old sys_uname holder */
  779. .long SYMBOL_NAME(sys_ni_syscall) /* sys_iopl in i386 */
  780. .long SYMBOL_NAME(sys_vhangup)
  781. .long SYMBOL_NAME(sys_ni_syscall) /* old "idle" system call */
  782. .long SYMBOL_NAME(sys_ni_syscall) /* vm86old in i386 */
  783. .long SYMBOL_NAME(sys_wait4)
  784. .long SYMBOL_NAME(sys_swapoff) /* 115 */
  785. .long SYMBOL_NAME(sys_sysinfo)
  786. .long SYMBOL_NAME(sys_ipc)
  787. .long SYMBOL_NAME(sys_fsync)
  788. .long SYMBOL_NAME(sys_sigreturn)
  789. .long SYMBOL_NAME(sys_clone) /* 120 */
  790. .long SYMBOL_NAME(sys_setdomainname)
  791. .long SYMBOL_NAME(sys_newuname)
  792. .long SYMBOL_NAME(sys_ni_syscall) /* TODO sys_modify_ldt - do something ?*/
  793. .long SYMBOL_NAME(sys_adjtimex)
  794. .long SYMBOL_NAME(sys_mprotect) /* 125 */
  795. .long SYMBOL_NAME(sys_sigprocmask)
  796. .long SYMBOL_NAME(sys_create_module)
  797. .long SYMBOL_NAME(sys_init_module)
  798. .long SYMBOL_NAME(sys_delete_module)
  799. .long SYMBOL_NAME(sys_get_kernel_syms) /* 130 */
  800. .long SYMBOL_NAME(sys_quotactl)
  801. .long SYMBOL_NAME(sys_getpgid)
  802. .long SYMBOL_NAME(sys_fchdir)
  803. .long SYMBOL_NAME(sys_bdflush)
  804. .long SYMBOL_NAME(sys_sysfs) /* 135 */
  805. .long SYMBOL_NAME(sys_personality)
  806. .long SYMBOL_NAME(sys_ni_syscall) /* for afs_syscall */
  807. .long SYMBOL_NAME(sys_setfsuid16)
  808. .long SYMBOL_NAME(sys_setfsgid16)
  809. .long SYMBOL_NAME(sys_llseek) /* 140 */
  810. .long SYMBOL_NAME(sys_getdents)
  811. .long SYMBOL_NAME(sys_select)
  812. .long SYMBOL_NAME(sys_flock)
  813. .long SYMBOL_NAME(sys_msync)
  814. .long SYMBOL_NAME(sys_readv) /* 145 */
  815. .long SYMBOL_NAME(sys_writev)
  816. .long SYMBOL_NAME(sys_getsid)
  817. .long SYMBOL_NAME(sys_fdatasync)
  818. .long SYMBOL_NAME(sys_sysctl)
  819. .long SYMBOL_NAME(sys_mlock) /* 150 */
  820. .long SYMBOL_NAME(sys_munlock)
  821. .long SYMBOL_NAME(sys_mlockall)
  822. .long SYMBOL_NAME(sys_munlockall)
  823. .long SYMBOL_NAME(sys_sched_setparam)
  824. .long SYMBOL_NAME(sys_sched_getparam)   /* 155 */
  825. .long SYMBOL_NAME(sys_sched_setscheduler)
  826. .long SYMBOL_NAME(sys_sched_getscheduler)
  827. .long SYMBOL_NAME(sys_sched_yield)
  828. .long SYMBOL_NAME(sys_sched_get_priority_max)
  829. .long SYMBOL_NAME(sys_sched_get_priority_min)  /* 160 */
  830. .long SYMBOL_NAME(sys_sched_rr_get_interval)
  831. .long SYMBOL_NAME(sys_nanosleep)
  832. .long SYMBOL_NAME(sys_mremap)
  833. .long SYMBOL_NAME(sys_setresuid16)
  834. .long SYMBOL_NAME(sys_getresuid16) /* 165 */
  835. .long SYMBOL_NAME(sys_ni_syscall) /* sys_vm86 */
  836. .long SYMBOL_NAME(sys_query_module)
  837. .long SYMBOL_NAME(sys_poll)
  838. .long SYMBOL_NAME(sys_nfsservctl)
  839. .long SYMBOL_NAME(sys_setresgid16) /* 170 */
  840. .long SYMBOL_NAME(sys_getresgid16)
  841. .long SYMBOL_NAME(sys_prctl)
  842. .long SYMBOL_NAME(sys_rt_sigreturn)
  843. .long SYMBOL_NAME(sys_rt_sigaction)
  844. .long SYMBOL_NAME(sys_rt_sigprocmask) /* 175 */
  845. .long SYMBOL_NAME(sys_rt_sigpending)
  846. .long SYMBOL_NAME(sys_rt_sigtimedwait)
  847. .long SYMBOL_NAME(sys_rt_sigqueueinfo)
  848. .long SYMBOL_NAME(sys_rt_sigsuspend)
  849. .long SYMBOL_NAME(sys_pread) /* 180 */
  850. .long SYMBOL_NAME(sys_pwrite)
  851. .long SYMBOL_NAME(sys_chown16)
  852. .long SYMBOL_NAME(sys_getcwd)
  853. .long SYMBOL_NAME(sys_capget)
  854. .long SYMBOL_NAME(sys_capset)           /* 185 */
  855. .long SYMBOL_NAME(sys_sigaltstack)
  856. .long SYMBOL_NAME(sys_sendfile)
  857. .long SYMBOL_NAME(sys_ni_syscall) /* streams1 */
  858. .long SYMBOL_NAME(sys_ni_syscall) /* streams2 */
  859. .long SYMBOL_NAME(sys_vfork)            /* 190 */
  860. .long SYMBOL_NAME(sys_getrlimit)
  861. .long SYMBOL_NAME(sys_mmap2)
  862. .long SYMBOL_NAME(sys_truncate64)
  863. .long SYMBOL_NAME(sys_ftruncate64)
  864. .long SYMBOL_NAME(sys_stat64) /* 195 */
  865. .long SYMBOL_NAME(sys_lstat64)
  866. .long SYMBOL_NAME(sys_fstat64)
  867. .long SYMBOL_NAME(sys_lchown)
  868. .long SYMBOL_NAME(sys_getuid)
  869. .long SYMBOL_NAME(sys_getgid) /* 200 */
  870. .long SYMBOL_NAME(sys_geteuid)
  871. .long SYMBOL_NAME(sys_getegid)
  872. .long SYMBOL_NAME(sys_setreuid)
  873. .long SYMBOL_NAME(sys_setregid)
  874. .long SYMBOL_NAME(sys_getgroups) /* 205 */
  875. .long SYMBOL_NAME(sys_setgroups)
  876. .long SYMBOL_NAME(sys_fchown)
  877. .long SYMBOL_NAME(sys_setresuid)
  878. .long SYMBOL_NAME(sys_getresuid)
  879. .long SYMBOL_NAME(sys_setresgid) /* 210 */
  880. .long SYMBOL_NAME(sys_getresgid)
  881. .long SYMBOL_NAME(sys_chown)
  882. .long SYMBOL_NAME(sys_setuid)
  883. .long SYMBOL_NAME(sys_setgid)
  884. .long SYMBOL_NAME(sys_setfsuid) /* 215 */
  885. .long SYMBOL_NAME(sys_setfsgid)
  886. .long SYMBOL_NAME(sys_pivot_root)
  887. .long SYMBOL_NAME(sys_mincore)
  888. .long SYMBOL_NAME(sys_madvise)
  889. .long SYMBOL_NAME(sys_getdents64)       /* 220 */
  890. .long SYMBOL_NAME(sys_fcntl64)
  891. .long SYMBOL_NAME(sys_ni_syscall) /* reserved for TUX */
  892.         .long SYMBOL_NAME(sys_ni_syscall)       /* Reserved for Security */
  893.         .long SYMBOL_NAME(sys_gettid)
  894.         .long SYMBOL_NAME(sys_readahead)        /* 225 */
  895.         /*
  896.          * NOTE!! This doesn't have to be exact - we just have
  897.          * to make sure we have _enough_ of the "sys_ni_syscall"
  898.          * entries. Don't panic if you notice that this hasn't
  899.          * been shrunk every time we add a new system call.
  900.          */
  901. .rept NR_syscalls-(.-sys_call_table)/4
  902. .long SYMBOL_NAME(sys_ni_syscall)
  903. .endr