entry.S
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:33k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

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