entry.S 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820
  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/errno.h>
  15. #include <linux/linkage.h>
  16. #include <asm/asm-offsets.h>
  17. #include <asm/thread_info.h>
  18. #include <asm/cpu/mmu_context.h>
  19. #include <asm/unistd.h>
  20. ! NOTE:
  21. ! GNU as (as of 2.9.1) changes bf/s into bt/s and bra, when the address
  22. ! to be jumped is too far, but it causes illegal slot exception.
  23. /*
  24. * entry.S contains the system-call and fault low-level handling routines.
  25. * This also contains the timer-interrupt handler, as well as all interrupts
  26. * and faults that can result in a task-switch.
  27. *
  28. * NOTE: This code handles signal-recognition, which happens every time
  29. * after a timer-interrupt and after each system call.
  30. *
  31. * NOTE: This code uses a convention that instructions in the delay slot
  32. * of a transfer-control instruction are indented by an extra space, thus:
  33. *
  34. * jmp @k0 ! control-transfer instruction
  35. * ldc k1, ssr ! delay slot
  36. *
  37. * Stack layout in 'ret_from_syscall':
  38. * ptrace needs to have all regs on the stack.
  39. * if the order here is changed, it needs to be
  40. * updated in ptrace.c and ptrace.h
  41. *
  42. * r0
  43. * ...
  44. * r15 = stack pointer
  45. * spc
  46. * pr
  47. * ssr
  48. * gbr
  49. * mach
  50. * macl
  51. * syscall #
  52. *
  53. */
  54. #if defined(CONFIG_KGDB_NMI)
  55. NMI_VEC = 0x1c0 ! Must catch early for debounce
  56. #endif
  57. /* Offsets to the stack */
  58. OFF_R0 = 0 /* Return value. New ABI also arg4 */
  59. OFF_R1 = 4 /* New ABI: arg5 */
  60. OFF_R2 = 8 /* New ABI: arg6 */
  61. OFF_R3 = 12 /* New ABI: syscall_nr */
  62. OFF_R4 = 16 /* New ABI: arg0 */
  63. OFF_R5 = 20 /* New ABI: arg1 */
  64. OFF_R6 = 24 /* New ABI: arg2 */
  65. OFF_R7 = 28 /* New ABI: arg3 */
  66. OFF_SP = (15*4)
  67. OFF_PC = (16*4)
  68. OFF_SR = (16*4+8)
  69. OFF_TRA = (16*4+6*4)
  70. #define k0 r0
  71. #define k1 r1
  72. #define k2 r2
  73. #define k3 r3
  74. #define k4 r4
  75. #define k_ex_code r2_bank /* r2_bank1 */
  76. #define g_imask r6 /* r6_bank1 */
  77. #define k_g_imask r6_bank /* r6_bank1 */
  78. #define current r7 /* r7_bank1 */
  79. /*
  80. * Kernel mode register usage:
  81. * k0 scratch
  82. * k1 scratch
  83. * k2 scratch (Exception code)
  84. * k3 scratch (Return address)
  85. * k4 scratch
  86. * k5 reserved
  87. * k6 Global Interrupt Mask (0--15 << 4)
  88. * k7 CURRENT_THREAD_INFO (pointer to current thread info)
  89. */
  90. !
  91. ! TLB Miss / Initial Page write exception handling
  92. ! _and_
  93. ! TLB hits, but the access violate the protection.
  94. ! It can be valid access, such as stack grow and/or C-O-W.
  95. !
  96. !
  97. ! Find the pmd/pte entry and loadtlb
  98. ! If it's not found, cause address error (SEGV)
  99. !
  100. ! Although this could be written in assembly language (and it'd be faster),
  101. ! this first version depends *much* on C implementation.
  102. !
  103. #define CLI() \
  104. stc sr, r0; \
  105. or #0xf0, r0; \
  106. ldc r0, sr
  107. #define STI() \
  108. mov.l __INV_IMASK, r11; \
  109. stc sr, r10; \
  110. and r11, r10; \
  111. stc k_g_imask, r11; \
  112. or r11, r10; \
  113. ldc r10, sr
  114. #if defined(CONFIG_PREEMPT)
  115. # define preempt_stop() CLI()
  116. #else
  117. # define preempt_stop()
  118. # define resume_kernel restore_all
  119. #endif
  120. #if defined(CONFIG_MMU)
  121. .align 2
  122. ENTRY(tlb_miss_load)
  123. bra call_dpf
  124. mov #0, r5
  125. .align 2
  126. ENTRY(tlb_miss_store)
  127. bra call_dpf
  128. mov #1, r5
  129. .align 2
  130. ENTRY(initial_page_write)
  131. bra call_dpf
  132. mov #1, r5
  133. .align 2
  134. ENTRY(tlb_protection_violation_load)
  135. bra call_dpf
  136. mov #0, r5
  137. .align 2
  138. ENTRY(tlb_protection_violation_store)
  139. bra call_dpf
  140. mov #1, r5
  141. call_dpf:
  142. mov.l 1f, r0
  143. mov r5, r8
  144. mov.l @r0, r6
  145. mov r6, r9
  146. mov.l 2f, r0
  147. sts pr, r10
  148. jsr @r0
  149. mov r15, r4
  150. !
  151. tst r0, r0
  152. bf/s 0f
  153. lds r10, pr
  154. rts
  155. nop
  156. 0: STI()
  157. mov.l 3f, r0
  158. mov r9, r6
  159. mov r8, r5
  160. jmp @r0
  161. mov r15, r4
  162. .align 2
  163. 1: .long MMU_TEA
  164. 2: .long __do_page_fault
  165. 3: .long do_page_fault
  166. .align 2
  167. ENTRY(address_error_load)
  168. bra call_dae
  169. mov #0,r5 ! writeaccess = 0
  170. .align 2
  171. ENTRY(address_error_store)
  172. bra call_dae
  173. mov #1,r5 ! writeaccess = 1
  174. .align 2
  175. call_dae:
  176. mov.l 1f, r0
  177. mov.l @r0, r6 ! address
  178. mov.l 2f, r0
  179. jmp @r0
  180. mov r15, r4 ! regs
  181. .align 2
  182. 1: .long MMU_TEA
  183. 2: .long do_address_error
  184. #endif /* CONFIG_MMU */
  185. #if defined(CONFIG_SH_STANDARD_BIOS) || defined(CONFIG_SH_KGDB)
  186. ! Handle kernel debug if either kgdb (SW) or gdb-stub (FW) is present.
  187. ! If both are configured, handle the debug traps (breakpoints) in SW,
  188. ! but still allow BIOS traps to FW.
  189. .align 2
  190. debug_kernel:
  191. #if defined(CONFIG_SH_STANDARD_BIOS) && defined(CONFIG_SH_KGDB)
  192. /* Force BIOS call to FW (debug_trap put TRA in r8) */
  193. mov r8,r0
  194. shlr2 r0
  195. cmp/eq #0x3f,r0
  196. bt debug_kernel_fw
  197. #endif /* CONFIG_SH_STANDARD_BIOS && CONFIG_SH_KGDB */
  198. debug_enter:
  199. #if defined(CONFIG_SH_KGDB)
  200. /* Jump to kgdb, pass stacked regs as arg */
  201. debug_kernel_sw:
  202. mov.l 3f, r0
  203. jmp @r0
  204. mov r15, r4
  205. .align 2
  206. 3: .long kgdb_handle_exception
  207. #endif /* CONFIG_SH_KGDB */
  208. #if defined(CONFIG_SH_STANDARD_BIOS)
  209. /* Unwind the stack and jmp to the debug entry */
  210. debug_kernel_fw:
  211. mov.l @r15+, r0
  212. mov.l @r15+, r1
  213. mov.l @r15+, r2
  214. mov.l @r15+, r3
  215. mov.l @r15+, r4
  216. mov.l @r15+, r5
  217. mov.l @r15+, r6
  218. mov.l @r15+, r7
  219. stc sr, r8
  220. mov.l 1f, r9 ! BL =1, RB=1, IMASK=0x0F
  221. or r9, r8
  222. ldc r8, sr ! here, change the register bank
  223. mov.l @r15+, r8
  224. mov.l @r15+, r9
  225. mov.l @r15+, r10
  226. mov.l @r15+, r11
  227. mov.l @r15+, r12
  228. mov.l @r15+, r13
  229. mov.l @r15+, r14
  230. mov.l @r15+, k0
  231. ldc.l @r15+, spc
  232. lds.l @r15+, pr
  233. mov.l @r15+, k1
  234. ldc.l @r15+, gbr
  235. lds.l @r15+, mach
  236. lds.l @r15+, macl
  237. mov k0, r15
  238. !
  239. mov.l 2f, k0
  240. mov.l @k0, k0
  241. jmp @k0
  242. ldc k1, ssr
  243. .align 2
  244. 1: .long 0x300000f0
  245. 2: .long gdb_vbr_vector
  246. #endif /* CONFIG_SH_STANDARD_BIOS */
  247. #endif /* CONFIG_SH_STANDARD_BIOS || CONFIG_SH_KGDB */
  248. .align 2
  249. debug_trap:
  250. #if defined(CONFIG_SH_STANDARD_BIOS) || defined(CONFIG_SH_KGDB)
  251. mov #OFF_SR, r0
  252. mov.l @(r0,r15), r0 ! get status register
  253. shll r0
  254. shll r0 ! kernel space?
  255. bt/s debug_kernel
  256. #endif
  257. mov.l @r15, r0 ! Restore R0 value
  258. mov.l 1f, r8
  259. jmp @r8
  260. nop
  261. .align 2
  262. ENTRY(exception_error)
  263. !
  264. STI()
  265. mov.l 2f, r0
  266. jmp @r0
  267. nop
  268. !
  269. .align 2
  270. 1: .long break_point_trap_software
  271. 2: .long do_exception_error
  272. .align 2
  273. ret_from_exception:
  274. preempt_stop()
  275. ENTRY(ret_from_irq)
  276. !
  277. mov #OFF_SR, r0
  278. mov.l @(r0,r15), r0 ! get status register
  279. shll r0
  280. shll r0 ! kernel space?
  281. bt/s resume_kernel ! Yes, it's from kernel, go back soon
  282. GET_THREAD_INFO(r8)
  283. #ifdef CONFIG_PREEMPT
  284. bra resume_userspace
  285. nop
  286. ENTRY(resume_kernel)
  287. mov.l @(TI_PRE_COUNT,r8), r0 ! current_thread_info->preempt_count
  288. tst r0, r0
  289. bf noresched
  290. need_resched:
  291. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  292. tst #_TIF_NEED_RESCHED, r0 ! need_resched set?
  293. bt noresched
  294. mov #OFF_SR, r0
  295. mov.l @(r0,r15), r0 ! get status register
  296. and #0xf0, r0 ! interrupts off (exception path)?
  297. cmp/eq #0xf0, r0
  298. bt noresched
  299. mov.l 1f, r0
  300. mov.l r0, @(TI_PRE_COUNT,r8)
  301. STI()
  302. mov.l 2f, r0
  303. jsr @r0
  304. nop
  305. mov #0, r0
  306. mov.l r0, @(TI_PRE_COUNT,r8)
  307. CLI()
  308. bra need_resched
  309. nop
  310. noresched:
  311. bra restore_all
  312. nop
  313. .align 2
  314. 1: .long PREEMPT_ACTIVE
  315. 2: .long schedule
  316. #endif
  317. ENTRY(resume_userspace)
  318. ! r8: current_thread_info
  319. CLI()
  320. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  321. tst #_TIF_WORK_MASK, r0
  322. bt/s restore_all
  323. tst #_TIF_NEED_RESCHED, r0
  324. .align 2
  325. work_pending:
  326. ! r0: current_thread_info->flags
  327. ! r8: current_thread_info
  328. ! t: result of "tst #_TIF_NEED_RESCHED, r0"
  329. bf/s work_resched
  330. tst #(_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK), r0
  331. work_notifysig:
  332. bt/s restore_all
  333. mov r15, r4
  334. mov r12, r5 ! set arg1(save_r0)
  335. mov r0, r6
  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_notify_resume
  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 @(OFF_R0,r15), r12 ! save r0
  490. mov.l r0, @(OFF_R0,r15) ! save the return value
  491. !
  492. syscall_exit:
  493. CLI()
  494. !
  495. GET_THREAD_INFO(r8)
  496. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  497. tst #_TIF_ALLWORK_MASK, r0
  498. bf syscall_exit_work
  499. restore_all:
  500. mov.l @r15+, r0
  501. mov.l @r15+, r1
  502. mov.l @r15+, r2
  503. mov.l @r15+, r3
  504. mov.l @r15+, r4
  505. mov.l @r15+, r5
  506. mov.l @r15+, r6
  507. mov.l @r15+, r7
  508. !
  509. stc sr, r8
  510. mov.l 7f, r9
  511. or r9, r8 ! BL =1, RB=1
  512. ldc r8, sr ! here, change the register bank
  513. !
  514. mov.l @r15+, r8
  515. mov.l @r15+, r9
  516. mov.l @r15+, r10
  517. mov.l @r15+, r11
  518. mov.l @r15+, r12
  519. mov.l @r15+, r13
  520. mov.l @r15+, r14
  521. mov.l @r15+, k4 ! original stack pointer
  522. ldc.l @r15+, spc
  523. lds.l @r15+, pr
  524. mov.l @r15+, k3 ! original SR
  525. ldc.l @r15+, gbr
  526. lds.l @r15+, mach
  527. lds.l @r15+, macl
  528. add #4, r15 ! Skip syscall number
  529. !
  530. #ifdef CONFIG_SH_DSP
  531. mov.l @r15+, k0 ! DSP mode marker
  532. mov.l 5f, k1
  533. cmp/eq k0, k1 ! Do we have a DSP stack frame?
  534. bf skip_restore
  535. stc sr, k0 ! Enable CPU DSP mode
  536. or k1, k0 ! (within kernel it may be disabled)
  537. ldc k0, sr
  538. mov r2, k0 ! Backup r2
  539. ! Restore DSP registers from stack
  540. mov r15, r2
  541. movs.l @r2+, a1
  542. movs.l @r2+, a0g
  543. movs.l @r2+, a1g
  544. movs.l @r2+, m0
  545. movs.l @r2+, m1
  546. mov r2, r15
  547. lds.l @r15+, a0
  548. lds.l @r15+, x0
  549. lds.l @r15+, x1
  550. lds.l @r15+, y0
  551. lds.l @r15+, y1
  552. lds.l @r15+, dsr
  553. ldc.l @r15+, rs
  554. ldc.l @r15+, re
  555. ldc.l @r15+, mod
  556. mov k0, r2 ! Restore r2
  557. skip_restore:
  558. #endif
  559. !
  560. ! Calculate new SR value
  561. mov k3, k2 ! original SR value
  562. mov.l 9f, k1
  563. and k1, k2 ! Mask orignal SR value
  564. !
  565. mov k3, k0 ! Calculate IMASK-bits
  566. shlr2 k0
  567. and #0x3c, k0
  568. cmp/eq #0x3c, k0
  569. bt/s 6f
  570. shll2 k0
  571. mov g_imask, k0
  572. !
  573. 6: or k0, k2 ! Set the IMASK-bits
  574. ldc k2, ssr
  575. !
  576. #if defined(CONFIG_KGDB_NMI)
  577. ! Clear in_nmi
  578. mov.l 6f, k0
  579. mov #0, k1
  580. mov.b k1, @k0
  581. #endif
  582. mov.l @r15+, k2 ! restore EXPEVT
  583. mov k4, r15
  584. rte
  585. nop
  586. .align 2
  587. 1: .long TRA
  588. 2: .long NR_syscalls
  589. 3: .long sys_call_table
  590. 4: .long do_syscall_trace
  591. 5: .long 0x00001000 ! DSP
  592. 7: .long 0x30000000
  593. 9:
  594. __INV_IMASK:
  595. .long 0xffffff0f ! ~(IMASK)
  596. ! Exception Vector Base
  597. !
  598. ! Should be aligned page boundary.
  599. !
  600. .balign 4096,0,4096
  601. ENTRY(vbr_base)
  602. .long 0
  603. !
  604. .balign 256,0,256
  605. general_exception:
  606. mov.l 1f, k2
  607. mov.l 2f, k3
  608. bra handle_exception
  609. mov.l @k2, k2
  610. .align 2
  611. 1: .long EXPEVT
  612. 2: .long ret_from_exception
  613. !
  614. !
  615. .balign 1024,0,1024
  616. tlb_miss:
  617. mov.l 1f, k2
  618. mov.l 4f, k3
  619. bra handle_exception
  620. mov.l @k2, k2
  621. !
  622. .balign 512,0,512
  623. interrupt:
  624. mov.l 2f, k2
  625. mov.l 3f, k3
  626. #if defined(CONFIG_KGDB_NMI)
  627. ! Debounce (filter nested NMI)
  628. mov.l @k2, k0
  629. mov.l 5f, k1
  630. cmp/eq k1, k0
  631. bf 0f
  632. mov.l 6f, k1
  633. tas.b @k1
  634. bt 0f
  635. rte
  636. nop
  637. .align 2
  638. 5: .long NMI_VEC
  639. 6: .long in_nmi
  640. 0:
  641. #endif /* defined(CONFIG_KGDB_NMI) */
  642. bra handle_exception
  643. mov.l @k2, k2
  644. .align 2
  645. 1: .long EXPEVT
  646. 2: .long INTEVT
  647. 3: .long ret_from_irq
  648. 4: .long ret_from_exception
  649. !
  650. !
  651. .align 2
  652. ENTRY(handle_exception)
  653. ! Using k0, k1 for scratch registers (r0_bank1, r1_bank),
  654. ! save all registers onto stack.
  655. !
  656. stc ssr, k0 ! Is it from kernel space?
  657. shll k0 ! Check MD bit (bit30) by shifting it into...
  658. shll k0 ! ...the T bit
  659. bt/s 1f ! It's a kernel to kernel transition.
  660. mov r15, k0 ! save original stack to k0
  661. /* User space to kernel */
  662. mov #(THREAD_SIZE >> 8), k1
  663. shll8 k1 ! k1 := THREAD_SIZE
  664. add current, k1
  665. mov k1, r15 ! change to kernel stack
  666. !
  667. 1: mov #-1, k4
  668. mov.l 2f, k1
  669. !
  670. #ifdef CONFIG_SH_DSP
  671. mov.l r2, @-r15 ! Save r2, we need another reg
  672. stc sr, k4
  673. mov.l 1f, r2
  674. tst r2, k4 ! Check if in DSP mode
  675. mov.l @r15+, r2 ! Restore r2 now
  676. bt/s skip_save
  677. mov #0, k4 ! Set marker for no stack frame
  678. mov r2, k4 ! Backup r2 (in k4) for later
  679. ! Save DSP registers on stack
  680. stc.l mod, @-r15
  681. stc.l re, @-r15
  682. stc.l rs, @-r15
  683. sts.l dsr, @-r15
  684. sts.l y1, @-r15
  685. sts.l y0, @-r15
  686. sts.l x1, @-r15
  687. sts.l x0, @-r15
  688. sts.l a0, @-r15
  689. ! GAS is broken, does not generate correct "movs.l Ds,@-As" instr.
  690. ! FIXME: Make sure that this is still the case with newer toolchains,
  691. ! as we're not at all interested in supporting ancient toolchains at
  692. ! this point. -- PFM.
  693. mov r15, r2
  694. .word 0xf653 ! movs.l a1, @-r2
  695. .word 0xf6f3 ! movs.l a0g, @-r2
  696. .word 0xf6d3 ! movs.l a1g, @-r2
  697. .word 0xf6c3 ! movs.l m0, @-r2
  698. .word 0xf6e3 ! movs.l m1, @-r2
  699. mov r2, r15
  700. mov k4, r2 ! Restore r2
  701. mov.l 1f, k4 ! Force DSP stack frame
  702. skip_save:
  703. mov.l k4, @-r15 ! Push DSP mode marker onto stack
  704. #endif
  705. ! Save the user registers on the stack.
  706. mov.l k2, @-r15 ! EXPEVT
  707. mov.l k4, @-r15 ! set TRA (default: -1)
  708. !
  709. sts.l macl, @-r15
  710. sts.l mach, @-r15
  711. stc.l gbr, @-r15
  712. stc.l ssr, @-r15
  713. sts.l pr, @-r15
  714. stc.l spc, @-r15
  715. !
  716. lds k3, pr ! Set the return address to pr
  717. !
  718. mov.l k0, @-r15 ! save orignal stack
  719. mov.l r14, @-r15
  720. mov.l r13, @-r15
  721. mov.l r12, @-r15
  722. mov.l r11, @-r15
  723. mov.l r10, @-r15
  724. mov.l r9, @-r15
  725. mov.l r8, @-r15
  726. !
  727. stc sr, r8 ! Back to normal register bank, and
  728. or k1, r8 ! Block all interrupts
  729. mov.l 3f, k1
  730. and k1, r8 ! ...
  731. ldc r8, sr ! ...changed here.
  732. !
  733. mov.l r7, @-r15
  734. mov.l r6, @-r15
  735. mov.l r5, @-r15
  736. mov.l r4, @-r15
  737. mov.l r3, @-r15
  738. mov.l r2, @-r15
  739. mov.l r1, @-r15
  740. mov.l r0, @-r15
  741. ! Then, dispatch to the handler, according to the exception code.
  742. stc k_ex_code, r8
  743. shlr2 r8
  744. shlr r8
  745. mov.l 4f, r9
  746. add r8, r9
  747. mov.l @r9, r9
  748. jmp @r9
  749. nop
  750. .align 2
  751. 1: .long 0x00001000 ! DSP=1
  752. 2: .long 0x000080f0 ! FD=1, IMASK=15
  753. 3: .long 0xcfffffff ! RB=0, BL=0
  754. 4: .long exception_handling_table
  755. .align 2
  756. ENTRY(exception_none)
  757. rts
  758. nop