entry.S 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822
  1. /* $Id: entry.S,v 1.37 2004/06/11 13:02:46 doyu Exp $
  2. *
  3. * linux/arch/sh/entry.S
  4. *
  5. * Copyright (C) 1999, 2000, 2002 Niibe Yutaka
  6. * Copyright (C) 2003 Paul Mundt
  7. *
  8. * This file is subject to the terms and conditions of the GNU General Public
  9. * License. See the file "COPYING" in the main directory of this archive
  10. * for more details.
  11. *
  12. */
  13. #include <linux/sys.h>
  14. #include <linux/linkage.h>
  15. #include <asm/asm-offsets.h>
  16. #include <asm/thread_info.h>
  17. #include <asm/cpu/mmu_context.h>
  18. #include <asm/unistd.h>
  19. ! NOTE:
  20. ! GNU as (as of 2.9.1) changes bf/s into bt/s and bra, when the address
  21. ! to be jumped is too far, but it causes illegal slot exception.
  22. /*
  23. * entry.S contains the system-call and fault low-level handling routines.
  24. * This also contains the timer-interrupt handler, as well as all interrupts
  25. * and faults that can result in a task-switch.
  26. *
  27. * NOTE: This code handles signal-recognition, which happens every time
  28. * after a timer-interrupt and after each system call.
  29. *
  30. * NOTE: This code uses a convention that instructions in the delay slot
  31. * of a transfer-control instruction are indented by an extra space, thus:
  32. *
  33. * jmp @k0 ! control-transfer instruction
  34. * ldc k1, ssr ! delay slot
  35. *
  36. * Stack layout in 'ret_from_syscall':
  37. * ptrace needs to have all regs on the stack.
  38. * if the order here is changed, it needs to be
  39. * updated in ptrace.c and ptrace.h
  40. *
  41. * r0
  42. * ...
  43. * r15 = stack pointer
  44. * spc
  45. * pr
  46. * ssr
  47. * gbr
  48. * mach
  49. * macl
  50. * syscall #
  51. *
  52. */
  53. ENOSYS = 38
  54. EINVAL = 22
  55. #if defined(CONFIG_KGDB_NMI)
  56. NMI_VEC = 0x1c0 ! Must catch early for debounce
  57. #endif
  58. /* Offsets to the stack */
  59. OFF_R0 = 0 /* Return value. New ABI also arg4 */
  60. OFF_R1 = 4 /* New ABI: arg5 */
  61. OFF_R2 = 8 /* New ABI: arg6 */
  62. OFF_R3 = 12 /* New ABI: syscall_nr */
  63. OFF_R4 = 16 /* New ABI: arg0 */
  64. OFF_R5 = 20 /* New ABI: arg1 */
  65. OFF_R6 = 24 /* New ABI: arg2 */
  66. OFF_R7 = 28 /* New ABI: arg3 */
  67. OFF_SP = (15*4)
  68. OFF_PC = (16*4)
  69. OFF_SR = (16*4+8)
  70. OFF_TRA = (16*4+6*4)
  71. #define k0 r0
  72. #define k1 r1
  73. #define k2 r2
  74. #define k3 r3
  75. #define k4 r4
  76. #define k_ex_code r2_bank /* r2_bank1 */
  77. #define g_imask r6 /* r6_bank1 */
  78. #define k_g_imask r6_bank /* r6_bank1 */
  79. #define current r7 /* r7_bank1 */
  80. /*
  81. * Kernel mode register usage:
  82. * k0 scratch
  83. * k1 scratch
  84. * k2 scratch (Exception code)
  85. * k3 scratch (Return address)
  86. * k4 scratch
  87. * k5 reserved
  88. * k6 Global Interrupt Mask (0--15 << 4)
  89. * k7 CURRENT_THREAD_INFO (pointer to current thread info)
  90. */
  91. !
  92. ! TLB Miss / Initial Page write exception handling
  93. ! _and_
  94. ! TLB hits, but the access violate the protection.
  95. ! It can be valid access, such as stack grow and/or C-O-W.
  96. !
  97. !
  98. ! Find the pmd/pte entry and loadtlb
  99. ! If it's not found, cause address error (SEGV)
  100. !
  101. ! Although this could be written in assembly language (and it'd be faster),
  102. ! this first version depends *much* on C implementation.
  103. !
  104. #define CLI() \
  105. stc sr, r0; \
  106. or #0xf0, r0; \
  107. ldc r0, sr
  108. #define STI() \
  109. mov.l __INV_IMASK, r11; \
  110. stc sr, r10; \
  111. and r11, r10; \
  112. stc k_g_imask, r11; \
  113. or r11, r10; \
  114. ldc r10, sr
  115. #if defined(CONFIG_PREEMPT)
  116. # define preempt_stop() CLI()
  117. #else
  118. # define preempt_stop()
  119. # define resume_kernel restore_all
  120. #endif
  121. #if defined(CONFIG_MMU)
  122. .align 2
  123. ENTRY(tlb_miss_load)
  124. bra call_dpf
  125. mov #0, r5
  126. .align 2
  127. ENTRY(tlb_miss_store)
  128. bra call_dpf
  129. mov #1, r5
  130. .align 2
  131. ENTRY(initial_page_write)
  132. bra call_dpf
  133. mov #1, r5
  134. .align 2
  135. ENTRY(tlb_protection_violation_load)
  136. bra call_dpf
  137. mov #0, r5
  138. .align 2
  139. ENTRY(tlb_protection_violation_store)
  140. bra call_dpf
  141. mov #1, r5
  142. call_dpf:
  143. mov.l 1f, r0
  144. mov r5, r8
  145. mov.l @r0, r6
  146. mov r6, r9
  147. mov.l 2f, r0
  148. sts pr, r10
  149. jsr @r0
  150. mov r15, r4
  151. !
  152. tst r0, r0
  153. bf/s 0f
  154. lds r10, pr
  155. rts
  156. nop
  157. 0: STI()
  158. mov.l 3f, r0
  159. mov r9, r6
  160. mov r8, r5
  161. jmp @r0
  162. mov r15, r4
  163. .align 2
  164. 1: .long MMU_TEA
  165. 2: .long __do_page_fault
  166. 3: .long do_page_fault
  167. .align 2
  168. ENTRY(address_error_load)
  169. bra call_dae
  170. mov #0,r5 ! writeaccess = 0
  171. .align 2
  172. ENTRY(address_error_store)
  173. bra call_dae
  174. mov #1,r5 ! writeaccess = 1
  175. .align 2
  176. call_dae:
  177. mov.l 1f, r0
  178. mov.l @r0, r6 ! address
  179. mov.l 2f, r0
  180. jmp @r0
  181. mov r15, r4 ! regs
  182. .align 2
  183. 1: .long MMU_TEA
  184. 2: .long do_address_error
  185. #endif /* CONFIG_MMU */
  186. #if defined(CONFIG_SH_STANDARD_BIOS) || defined(CONFIG_SH_KGDB)
  187. ! Handle kernel debug if either kgdb (SW) or gdb-stub (FW) is present.
  188. ! If both are configured, handle the debug traps (breakpoints) in SW,
  189. ! but still allow BIOS traps to FW.
  190. .align 2
  191. debug_kernel:
  192. #if defined(CONFIG_SH_STANDARD_BIOS) && defined(CONFIG_SH_KGDB)
  193. /* Force BIOS call to FW (debug_trap put TRA in r8) */
  194. mov r8,r0
  195. shlr2 r0
  196. cmp/eq #0x3f,r0
  197. bt debug_kernel_fw
  198. #endif /* CONFIG_SH_STANDARD_BIOS && CONFIG_SH_KGDB */
  199. debug_enter:
  200. #if defined(CONFIG_SH_KGDB)
  201. /* Jump to kgdb, pass stacked regs as arg */
  202. debug_kernel_sw:
  203. mov.l 3f, r0
  204. jmp @r0
  205. mov r15, r4
  206. .align 2
  207. 3: .long kgdb_handle_exception
  208. #endif /* CONFIG_SH_KGDB */
  209. #if defined(CONFIG_SH_STANDARD_BIOS)
  210. /* Unwind the stack and jmp to the debug entry */
  211. debug_kernel_fw:
  212. mov.l @r15+, r0
  213. mov.l @r15+, r1
  214. mov.l @r15+, r2
  215. mov.l @r15+, r3
  216. mov.l @r15+, r4
  217. mov.l @r15+, r5
  218. mov.l @r15+, r6
  219. mov.l @r15+, r7
  220. stc sr, r8
  221. mov.l 1f, r9 ! BL =1, RB=1, IMASK=0x0F
  222. or r9, r8
  223. ldc r8, sr ! here, change the register bank
  224. mov.l @r15+, r8
  225. mov.l @r15+, r9
  226. mov.l @r15+, r10
  227. mov.l @r15+, r11
  228. mov.l @r15+, r12
  229. mov.l @r15+, r13
  230. mov.l @r15+, r14
  231. mov.l @r15+, k0
  232. ldc.l @r15+, spc
  233. lds.l @r15+, pr
  234. mov.l @r15+, k1
  235. ldc.l @r15+, gbr
  236. lds.l @r15+, mach
  237. lds.l @r15+, macl
  238. mov k0, r15
  239. !
  240. mov.l 2f, k0
  241. mov.l @k0, k0
  242. jmp @k0
  243. ldc k1, ssr
  244. .align 2
  245. 1: .long 0x300000f0
  246. 2: .long gdb_vbr_vector
  247. #endif /* CONFIG_SH_STANDARD_BIOS */
  248. #endif /* CONFIG_SH_STANDARD_BIOS || CONFIG_SH_KGDB */
  249. .align 2
  250. debug_trap:
  251. #if defined(CONFIG_SH_STANDARD_BIOS) || defined(CONFIG_SH_KGDB)
  252. mov #OFF_SR, r0
  253. mov.l @(r0,r15), r0 ! get status register
  254. shll r0
  255. shll r0 ! kernel space?
  256. bt/s debug_kernel
  257. #endif
  258. mov.l @r15, r0 ! Restore R0 value
  259. mov.l 1f, r8
  260. jmp @r8
  261. nop
  262. .align 2
  263. ENTRY(exception_error)
  264. !
  265. STI()
  266. mov.l 2f, r0
  267. jmp @r0
  268. nop
  269. !
  270. .align 2
  271. 1: .long break_point_trap_software
  272. 2: .long do_exception_error
  273. .align 2
  274. ret_from_exception:
  275. preempt_stop()
  276. ret_from_irq:
  277. !
  278. mov #OFF_SR, r0
  279. mov.l @(r0,r15), r0 ! get status register
  280. shll r0
  281. shll r0 ! kernel space?
  282. bt/s resume_kernel ! Yes, it's from kernel, go back soon
  283. GET_THREAD_INFO(r8)
  284. #ifdef CONFIG_PREEMPT
  285. bra resume_userspace
  286. nop
  287. ENTRY(resume_kernel)
  288. mov.l @(TI_PRE_COUNT,r8), r0 ! current_thread_info->preempt_count
  289. tst r0, r0
  290. bf noresched
  291. need_resched:
  292. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  293. tst #_TIF_NEED_RESCHED, r0 ! need_resched set?
  294. bt noresched
  295. mov #OFF_SR, r0
  296. mov.l @(r0,r15), r0 ! get status register
  297. and #0xf0, r0 ! interrupts off (exception path)?
  298. cmp/eq #0xf0, r0
  299. bt noresched
  300. mov.l 1f, r0
  301. mov.l r0, @(TI_PRE_COUNT,r8)
  302. STI()
  303. mov.l 2f, r0
  304. jsr @r0
  305. nop
  306. mov #0, r0
  307. mov.l r0, @(TI_PRE_COUNT,r8)
  308. CLI()
  309. bra need_resched
  310. nop
  311. noresched:
  312. bra restore_all
  313. nop
  314. .align 2
  315. 1: .long PREEMPT_ACTIVE
  316. 2: .long schedule
  317. #endif
  318. ENTRY(resume_userspace)
  319. ! r8: current_thread_info
  320. CLI()
  321. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  322. tst #_TIF_WORK_MASK, r0
  323. bt/s restore_all
  324. tst #_TIF_NEED_RESCHED, r0
  325. .align 2
  326. work_pending:
  327. ! r0: current_thread_info->flags
  328. ! r8: current_thread_info
  329. ! t: result of "tst #_TIF_NEED_RESCHED, r0"
  330. bf/s work_resched
  331. tst #_TIF_SIGPENDING, r0
  332. work_notifysig:
  333. bt/s restore_all
  334. mov r15, r4
  335. mov #0, r5
  336. mov.l 2f, r1
  337. mova restore_all, r0
  338. jmp @r1
  339. lds r0, pr
  340. work_resched:
  341. #ifndef CONFIG_PREEMPT
  342. ! gUSA handling
  343. mov.l @(OFF_SP,r15), r0 ! get user space stack pointer
  344. mov r0, r1
  345. shll r0
  346. bf/s 1f
  347. shll r0
  348. bf/s 1f
  349. mov #OFF_PC, r0
  350. ! SP >= 0xc0000000 : gUSA mark
  351. mov.l @(r0,r15), r2 ! get user space PC (program counter)
  352. mov.l @(OFF_R0,r15), r3 ! end point
  353. cmp/hs r3, r2 ! r2 >= r3?
  354. bt 1f
  355. add r3, r1 ! rewind point #2
  356. mov.l r1, @(r0,r15) ! reset PC to rewind point #2
  357. !
  358. 1:
  359. #endif
  360. mov.l 1f, r1
  361. jsr @r1 ! schedule
  362. nop
  363. CLI()
  364. !
  365. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  366. tst #_TIF_WORK_MASK, r0
  367. bt restore_all
  368. bra work_pending
  369. tst #_TIF_NEED_RESCHED, r0
  370. .align 2
  371. 1: .long schedule
  372. 2: .long do_signal
  373. .align 2
  374. syscall_exit_work:
  375. ! r0: current_thread_info->flags
  376. ! r8: current_thread_info
  377. tst #_TIF_SYSCALL_TRACE, r0
  378. bt/s work_pending
  379. tst #_TIF_NEED_RESCHED, r0
  380. STI()
  381. ! XXX setup arguments...
  382. mov.l 4f, r0 ! do_syscall_trace
  383. jsr @r0
  384. nop
  385. bra resume_userspace
  386. nop
  387. .align 2
  388. syscall_trace_entry:
  389. ! Yes it is traced.
  390. ! XXX setup arguments...
  391. mov.l 4f, r11 ! Call do_syscall_trace which notifies
  392. jsr @r11 ! superior (will chomp R[0-7])
  393. nop
  394. ! Reload R0-R4 from kernel stack, where the
  395. ! parent may have modified them using
  396. ! ptrace(POKEUSR). (Note that R0-R2 are
  397. ! used by the system call handler directly
  398. ! from the kernel stack anyway, so don't need
  399. ! to be reloaded here.) This allows the parent
  400. ! to rewrite system calls and args on the fly.
  401. mov.l @(OFF_R4,r15), r4 ! arg0
  402. mov.l @(OFF_R5,r15), r5
  403. mov.l @(OFF_R6,r15), r6
  404. mov.l @(OFF_R7,r15), r7 ! arg3
  405. mov.l @(OFF_R3,r15), r3 ! syscall_nr
  406. ! Arrange for do_syscall_trace to be called
  407. ! again as the system call returns.
  408. mov.l 2f, r10 ! Number of syscalls
  409. cmp/hs r10, r3
  410. bf syscall_call
  411. mov #-ENOSYS, r0
  412. bra syscall_exit
  413. mov.l r0, @(OFF_R0,r15) ! Return value
  414. /*
  415. * Syscall interface:
  416. *
  417. * Syscall #: R3
  418. * Arguments #0 to #3: R4--R7
  419. * Arguments #4 to #6: R0, R1, R2
  420. * TRA: (number of arguments + 0x10) x 4
  421. *
  422. * This code also handles delegating other traps to the BIOS/gdb stub
  423. * according to:
  424. *
  425. * Trap number
  426. * (TRA>>2) Purpose
  427. * -------- -------
  428. * 0x0-0xf old syscall ABI
  429. * 0x10-0x1f new syscall ABI
  430. * 0x20-0xff delegated through debug_trap to BIOS/gdb stub.
  431. *
  432. * Note: When we're first called, the TRA value must be shifted
  433. * right 2 bits in order to get the value that was used as the "trapa"
  434. * argument.
  435. */
  436. .align 2
  437. .globl ret_from_fork
  438. ret_from_fork:
  439. mov.l 1f, r8
  440. jsr @r8
  441. mov r0, r4
  442. bra syscall_exit
  443. nop
  444. .align 2
  445. 1: .long schedule_tail
  446. !
  447. ENTRY(system_call)
  448. mov.l 1f, r9
  449. mov.l @r9, r8 ! Read from TRA (Trap Address) Register
  450. !
  451. ! Is the trap argument >= 0x20? (TRA will be >= 0x80)
  452. mov #0x7f, r9
  453. cmp/hi r9, r8
  454. bt/s 0f
  455. mov #OFF_TRA, r9
  456. add r15, r9
  457. !
  458. mov.l r8, @r9 ! set TRA value to tra
  459. STI()
  460. ! Call the system call handler through the table.
  461. ! First check for bad syscall number
  462. mov r3, r9
  463. mov.l 2f, r8 ! Number of syscalls
  464. cmp/hs r8, r9
  465. bf/s good_system_call
  466. GET_THREAD_INFO(r8)
  467. syscall_badsys: ! Bad syscall number
  468. mov #-ENOSYS, r0
  469. bra resume_userspace
  470. mov.l r0, @(OFF_R0,r15) ! Return value
  471. !
  472. 0:
  473. bra debug_trap
  474. nop
  475. !
  476. good_system_call: ! Good syscall number
  477. mov.l @(TI_FLAGS,r8), r8
  478. mov #_TIF_SYSCALL_TRACE, r10
  479. tst r10, r8
  480. bf syscall_trace_entry
  481. !
  482. syscall_call:
  483. shll2 r9 ! x4
  484. mov.l 3f, r8 ! Load the address of sys_call_table
  485. add r8, r9
  486. mov.l @r9, r8
  487. jsr @r8 ! jump to specific syscall handler
  488. nop
  489. mov.l r0, @(OFF_R0,r15) ! save the return value
  490. !
  491. syscall_exit:
  492. CLI()
  493. !
  494. GET_THREAD_INFO(r8)
  495. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  496. tst #_TIF_ALLWORK_MASK, r0
  497. bf syscall_exit_work
  498. restore_all:
  499. mov.l @r15+, r0
  500. mov.l @r15+, r1
  501. mov.l @r15+, r2
  502. mov.l @r15+, r3
  503. mov.l @r15+, r4
  504. mov.l @r15+, r5
  505. mov.l @r15+, r6
  506. mov.l @r15+, r7
  507. !
  508. stc sr, r8
  509. mov.l 7f, r9
  510. or r9, r8 ! BL =1, RB=1
  511. ldc r8, sr ! here, change the register bank
  512. !
  513. mov.l @r15+, r8
  514. mov.l @r15+, r9
  515. mov.l @r15+, r10
  516. mov.l @r15+, r11
  517. mov.l @r15+, r12
  518. mov.l @r15+, r13
  519. mov.l @r15+, r14
  520. mov.l @r15+, k4 ! original stack pointer
  521. ldc.l @r15+, spc
  522. lds.l @r15+, pr
  523. mov.l @r15+, k3 ! original SR
  524. ldc.l @r15+, gbr
  525. lds.l @r15+, mach
  526. lds.l @r15+, macl
  527. add #4, r15 ! Skip syscall number
  528. !
  529. #ifdef CONFIG_SH_DSP
  530. mov.l @r15+, k0 ! DSP mode marker
  531. mov.l 5f, k1
  532. cmp/eq k0, k1 ! Do we have a DSP stack frame?
  533. bf skip_restore
  534. stc sr, k0 ! Enable CPU DSP mode
  535. or k1, k0 ! (within kernel it may be disabled)
  536. ldc k0, sr
  537. mov r2, k0 ! Backup r2
  538. ! Restore DSP registers from stack
  539. mov r15, r2
  540. movs.l @r2+, a1
  541. movs.l @r2+, a0g
  542. movs.l @r2+, a1g
  543. movs.l @r2+, m0
  544. movs.l @r2+, m1
  545. mov r2, r15
  546. lds.l @r15+, a0
  547. lds.l @r15+, x0
  548. lds.l @r15+, x1
  549. lds.l @r15+, y0
  550. lds.l @r15+, y1
  551. lds.l @r15+, dsr
  552. ldc.l @r15+, rs
  553. ldc.l @r15+, re
  554. ldc.l @r15+, mod
  555. mov k0, r2 ! Restore r2
  556. skip_restore:
  557. #endif
  558. !
  559. ! Calculate new SR value
  560. mov k3, k2 ! original SR value
  561. mov.l 9f, k1
  562. and k1, k2 ! Mask orignal SR value
  563. !
  564. mov k3, k0 ! Calculate IMASK-bits
  565. shlr2 k0
  566. and #0x3c, k0
  567. cmp/eq #0x3c, k0
  568. bt/s 6f
  569. shll2 k0
  570. mov g_imask, k0
  571. !
  572. 6: or k0, k2 ! Set the IMASK-bits
  573. ldc k2, ssr
  574. !
  575. #if defined(CONFIG_KGDB_NMI)
  576. ! Clear in_nmi
  577. mov.l 6f, k0
  578. mov #0, k1
  579. mov.b k1, @k0
  580. #endif
  581. mov.l @r15+, k2 ! restore EXPEVT
  582. mov k4, r15
  583. rte
  584. nop
  585. .align 2
  586. 1: .long TRA
  587. 2: .long NR_syscalls
  588. 3: .long sys_call_table
  589. 4: .long do_syscall_trace
  590. 5: .long 0x00001000 ! DSP
  591. 7: .long 0x30000000
  592. 9:
  593. __INV_IMASK:
  594. .long 0xffffff0f ! ~(IMASK)
  595. ! Exception Vector Base
  596. !
  597. ! Should be aligned page boundary.
  598. !
  599. .balign 4096,0,4096
  600. ENTRY(vbr_base)
  601. .long 0
  602. !
  603. .balign 256,0,256
  604. general_exception:
  605. mov.l 1f, k2
  606. mov.l 2f, k3
  607. bra handle_exception
  608. mov.l @k2, k2
  609. .align 2
  610. 1: .long EXPEVT
  611. 2: .long ret_from_exception
  612. !
  613. !
  614. .balign 1024,0,1024
  615. tlb_miss:
  616. mov.l 1f, k2
  617. mov.l 4f, k3
  618. bra handle_exception
  619. mov.l @k2, k2
  620. !
  621. .balign 512,0,512
  622. interrupt:
  623. mov.l 2f, k2
  624. mov.l 3f, k3
  625. #if defined(CONFIG_KGDB_NMI)
  626. ! Debounce (filter nested NMI)
  627. mov.l @k2, k0
  628. mov.l 5f, k1
  629. cmp/eq k1, k0
  630. bf 0f
  631. mov.l 6f, k1
  632. tas.b @k1
  633. bt 0f
  634. rte
  635. nop
  636. .align 2
  637. 5: .long NMI_VEC
  638. 6: .long in_nmi
  639. 0:
  640. #endif /* defined(CONFIG_KGDB_NMI) */
  641. bra handle_exception
  642. mov.l @k2, k2
  643. .align 2
  644. 1: .long EXPEVT
  645. 2: .long INTEVT
  646. 3: .long ret_from_irq
  647. 4: .long ret_from_exception
  648. !
  649. !
  650. .align 2
  651. handle_exception:
  652. ! Using k0, k1 for scratch registers (r0_bank1, r1_bank),
  653. ! save all registers onto stack.
  654. !
  655. stc ssr, k0 ! Is it from kernel space?
  656. shll k0 ! Check MD bit (bit30) by shifting it into...
  657. shll k0 ! ...the T bit
  658. bt/s 1f ! It's a kernel to kernel transition.
  659. mov r15, k0 ! save original stack to k0
  660. /* User space to kernel */
  661. mov #0x20, k1
  662. shll8 k1 ! k1 := 8192 (== THREAD_SIZE)
  663. add current, k1
  664. mov k1, r15 ! change to kernel stack
  665. !
  666. 1: mov #-1, k4
  667. mov.l 2f, k1
  668. !
  669. #ifdef CONFIG_SH_DSP
  670. mov.l r2, @-r15 ! Save r2, we need another reg
  671. stc sr, k4
  672. mov.l 1f, r2
  673. tst r2, k4 ! Check if in DSP mode
  674. mov.l @r15+, r2 ! Restore r2 now
  675. bt/s skip_save
  676. mov #0, k4 ! Set marker for no stack frame
  677. mov r2, k4 ! Backup r2 (in k4) for later
  678. ! Save DSP registers on stack
  679. stc.l mod, @-r15
  680. stc.l re, @-r15
  681. stc.l rs, @-r15
  682. sts.l dsr, @-r15
  683. sts.l y1, @-r15
  684. sts.l y0, @-r15
  685. sts.l x1, @-r15
  686. sts.l x0, @-r15
  687. sts.l a0, @-r15
  688. ! GAS is broken, does not generate correct "movs.l Ds,@-As" instr.
  689. ! FIXME: Make sure that this is still the case with newer toolchains,
  690. ! as we're not at all interested in supporting ancient toolchains at
  691. ! this point. -- PFM.
  692. mov r15, r2
  693. .word 0xf653 ! movs.l a1, @-r2
  694. .word 0xf6f3 ! movs.l a0g, @-r2
  695. .word 0xf6d3 ! movs.l a1g, @-r2
  696. .word 0xf6c3 ! movs.l m0, @-r2
  697. .word 0xf6e3 ! movs.l m1, @-r2
  698. mov r2, r15
  699. mov k4, r2 ! Restore r2
  700. mov.l 1f, k4 ! Force DSP stack frame
  701. skip_save:
  702. mov.l k4, @-r15 ! Push DSP mode marker onto stack
  703. #endif
  704. ! Save the user registers on the stack.
  705. mov.l k2, @-r15 ! EXPEVT
  706. mov.l k4, @-r15 ! set TRA (default: -1)
  707. !
  708. sts.l macl, @-r15
  709. sts.l mach, @-r15
  710. stc.l gbr, @-r15
  711. stc.l ssr, @-r15
  712. sts.l pr, @-r15
  713. stc.l spc, @-r15
  714. !
  715. lds k3, pr ! Set the return address to pr
  716. !
  717. mov.l k0, @-r15 ! save orignal stack
  718. mov.l r14, @-r15
  719. mov.l r13, @-r15
  720. mov.l r12, @-r15
  721. mov.l r11, @-r15
  722. mov.l r10, @-r15
  723. mov.l r9, @-r15
  724. mov.l r8, @-r15
  725. !
  726. stc sr, r8 ! Back to normal register bank, and
  727. or k1, r8 ! Block all interrupts
  728. mov.l 3f, k1
  729. and k1, r8 ! ...
  730. ldc r8, sr ! ...changed here.
  731. !
  732. mov.l r7, @-r15
  733. mov.l r6, @-r15
  734. mov.l r5, @-r15
  735. mov.l r4, @-r15
  736. mov.l r3, @-r15
  737. mov.l r2, @-r15
  738. mov.l r1, @-r15
  739. mov.l r0, @-r15
  740. ! Then, dispatch to the handler, according to the exception code.
  741. stc k_ex_code, r8
  742. shlr2 r8
  743. shlr r8
  744. mov.l 4f, r9
  745. add r8, r9
  746. mov.l @r9, r9
  747. jmp @r9
  748. nop
  749. .align 2
  750. 1: .long 0x00001000 ! DSP=1
  751. 2: .long 0x000080f0 ! FD=1, IMASK=15
  752. 3: .long 0xcfffffff ! RB=0, BL=0
  753. 4: .long exception_handling_table
  754. .align 2
  755. ENTRY(exception_none)
  756. rts
  757. nop