entry.S 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824
  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. ENTRY(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 | _TIF_RESTORE_SIGMASK), r0
  332. work_notifysig:
  333. bt/s restore_all
  334. mov r15, r4
  335. mov r12, r5 ! set arg1(save_r0)
  336. mov r0, r6
  337. mov.l 2f, r1
  338. mova restore_all, r0
  339. jmp @r1
  340. lds r0, pr
  341. work_resched:
  342. #ifndef CONFIG_PREEMPT
  343. ! gUSA handling
  344. mov.l @(OFF_SP,r15), r0 ! get user space stack pointer
  345. mov r0, r1
  346. shll r0
  347. bf/s 1f
  348. shll r0
  349. bf/s 1f
  350. mov #OFF_PC, r0
  351. ! SP >= 0xc0000000 : gUSA mark
  352. mov.l @(r0,r15), r2 ! get user space PC (program counter)
  353. mov.l @(OFF_R0,r15), r3 ! end point
  354. cmp/hs r3, r2 ! r2 >= r3?
  355. bt 1f
  356. add r3, r1 ! rewind point #2
  357. mov.l r1, @(r0,r15) ! reset PC to rewind point #2
  358. !
  359. 1:
  360. #endif
  361. mov.l 1f, r1
  362. jsr @r1 ! schedule
  363. nop
  364. CLI()
  365. !
  366. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  367. tst #_TIF_WORK_MASK, r0
  368. bt restore_all
  369. bra work_pending
  370. tst #_TIF_NEED_RESCHED, r0
  371. .align 2
  372. 1: .long schedule
  373. 2: .long do_notify_resume
  374. .align 2
  375. syscall_exit_work:
  376. ! r0: current_thread_info->flags
  377. ! r8: current_thread_info
  378. tst #_TIF_SYSCALL_TRACE, r0
  379. bt/s work_pending
  380. tst #_TIF_NEED_RESCHED, r0
  381. STI()
  382. ! XXX setup arguments...
  383. mov.l 4f, r0 ! do_syscall_trace
  384. jsr @r0
  385. nop
  386. bra resume_userspace
  387. nop
  388. .align 2
  389. syscall_trace_entry:
  390. ! Yes it is traced.
  391. ! XXX setup arguments...
  392. mov.l 4f, r11 ! Call do_syscall_trace which notifies
  393. jsr @r11 ! superior (will chomp R[0-7])
  394. nop
  395. ! Reload R0-R4 from kernel stack, where the
  396. ! parent may have modified them using
  397. ! ptrace(POKEUSR). (Note that R0-R2 are
  398. ! used by the system call handler directly
  399. ! from the kernel stack anyway, so don't need
  400. ! to be reloaded here.) This allows the parent
  401. ! to rewrite system calls and args on the fly.
  402. mov.l @(OFF_R4,r15), r4 ! arg0
  403. mov.l @(OFF_R5,r15), r5
  404. mov.l @(OFF_R6,r15), r6
  405. mov.l @(OFF_R7,r15), r7 ! arg3
  406. mov.l @(OFF_R3,r15), r3 ! syscall_nr
  407. ! Arrange for do_syscall_trace to be called
  408. ! again as the system call returns.
  409. mov.l 2f, r10 ! Number of syscalls
  410. cmp/hs r10, r3
  411. bf syscall_call
  412. mov #-ENOSYS, r0
  413. bra syscall_exit
  414. mov.l r0, @(OFF_R0,r15) ! Return value
  415. /*
  416. * Syscall interface:
  417. *
  418. * Syscall #: R3
  419. * Arguments #0 to #3: R4--R7
  420. * Arguments #4 to #6: R0, R1, R2
  421. * TRA: (number of arguments + 0x10) x 4
  422. *
  423. * This code also handles delegating other traps to the BIOS/gdb stub
  424. * according to:
  425. *
  426. * Trap number
  427. * (TRA>>2) Purpose
  428. * -------- -------
  429. * 0x0-0xf old syscall ABI
  430. * 0x10-0x1f new syscall ABI
  431. * 0x20-0xff delegated through debug_trap to BIOS/gdb stub.
  432. *
  433. * Note: When we're first called, the TRA value must be shifted
  434. * right 2 bits in order to get the value that was used as the "trapa"
  435. * argument.
  436. */
  437. .align 2
  438. .globl ret_from_fork
  439. ret_from_fork:
  440. mov.l 1f, r8
  441. jsr @r8
  442. mov r0, r4
  443. bra syscall_exit
  444. nop
  445. .align 2
  446. 1: .long schedule_tail
  447. !
  448. ENTRY(system_call)
  449. mov.l 1f, r9
  450. mov.l @r9, r8 ! Read from TRA (Trap Address) Register
  451. !
  452. ! Is the trap argument >= 0x20? (TRA will be >= 0x80)
  453. mov #0x7f, r9
  454. cmp/hi r9, r8
  455. bt/s 0f
  456. mov #OFF_TRA, r9
  457. add r15, r9
  458. !
  459. mov.l r8, @r9 ! set TRA value to tra
  460. STI()
  461. ! Call the system call handler through the table.
  462. ! First check for bad syscall number
  463. mov r3, r9
  464. mov.l 2f, r8 ! Number of syscalls
  465. cmp/hs r8, r9
  466. bf/s good_system_call
  467. GET_THREAD_INFO(r8)
  468. syscall_badsys: ! Bad syscall number
  469. mov #-ENOSYS, r0
  470. bra resume_userspace
  471. mov.l r0, @(OFF_R0,r15) ! Return value
  472. !
  473. 0:
  474. bra debug_trap
  475. nop
  476. !
  477. good_system_call: ! Good syscall number
  478. mov.l @(TI_FLAGS,r8), r8
  479. mov #_TIF_SYSCALL_TRACE, r10
  480. tst r10, r8
  481. bf syscall_trace_entry
  482. !
  483. syscall_call:
  484. shll2 r9 ! x4
  485. mov.l 3f, r8 ! Load the address of sys_call_table
  486. add r8, r9
  487. mov.l @r9, r8
  488. jsr @r8 ! jump to specific syscall handler
  489. nop
  490. mov.l @(OFF_R0,r15), r12 ! save r0
  491. mov.l r0, @(OFF_R0,r15) ! save the return value
  492. !
  493. syscall_exit:
  494. CLI()
  495. !
  496. GET_THREAD_INFO(r8)
  497. mov.l @(TI_FLAGS,r8), r0 ! current_thread_info->flags
  498. tst #_TIF_ALLWORK_MASK, r0
  499. bf syscall_exit_work
  500. restore_all:
  501. mov.l @r15+, r0
  502. mov.l @r15+, r1
  503. mov.l @r15+, r2
  504. mov.l @r15+, r3
  505. mov.l @r15+, r4
  506. mov.l @r15+, r5
  507. mov.l @r15+, r6
  508. mov.l @r15+, r7
  509. !
  510. stc sr, r8
  511. mov.l 7f, r9
  512. or r9, r8 ! BL =1, RB=1
  513. ldc r8, sr ! here, change the register bank
  514. !
  515. mov.l @r15+, r8
  516. mov.l @r15+, r9
  517. mov.l @r15+, r10
  518. mov.l @r15+, r11
  519. mov.l @r15+, r12
  520. mov.l @r15+, r13
  521. mov.l @r15+, r14
  522. mov.l @r15+, k4 ! original stack pointer
  523. ldc.l @r15+, spc
  524. lds.l @r15+, pr
  525. mov.l @r15+, k3 ! original SR
  526. ldc.l @r15+, gbr
  527. lds.l @r15+, mach
  528. lds.l @r15+, macl
  529. add #4, r15 ! Skip syscall number
  530. !
  531. #ifdef CONFIG_SH_DSP
  532. mov.l @r15+, k0 ! DSP mode marker
  533. mov.l 5f, k1
  534. cmp/eq k0, k1 ! Do we have a DSP stack frame?
  535. bf skip_restore
  536. stc sr, k0 ! Enable CPU DSP mode
  537. or k1, k0 ! (within kernel it may be disabled)
  538. ldc k0, sr
  539. mov r2, k0 ! Backup r2
  540. ! Restore DSP registers from stack
  541. mov r15, r2
  542. movs.l @r2+, a1
  543. movs.l @r2+, a0g
  544. movs.l @r2+, a1g
  545. movs.l @r2+, m0
  546. movs.l @r2+, m1
  547. mov r2, r15
  548. lds.l @r15+, a0
  549. lds.l @r15+, x0
  550. lds.l @r15+, x1
  551. lds.l @r15+, y0
  552. lds.l @r15+, y1
  553. lds.l @r15+, dsr
  554. ldc.l @r15+, rs
  555. ldc.l @r15+, re
  556. ldc.l @r15+, mod
  557. mov k0, r2 ! Restore r2
  558. skip_restore:
  559. #endif
  560. !
  561. ! Calculate new SR value
  562. mov k3, k2 ! original SR value
  563. mov.l 9f, k1
  564. and k1, k2 ! Mask orignal SR value
  565. !
  566. mov k3, k0 ! Calculate IMASK-bits
  567. shlr2 k0
  568. and #0x3c, k0
  569. cmp/eq #0x3c, k0
  570. bt/s 6f
  571. shll2 k0
  572. mov g_imask, k0
  573. !
  574. 6: or k0, k2 ! Set the IMASK-bits
  575. ldc k2, ssr
  576. !
  577. #if defined(CONFIG_KGDB_NMI)
  578. ! Clear in_nmi
  579. mov.l 6f, k0
  580. mov #0, k1
  581. mov.b k1, @k0
  582. #endif
  583. mov.l @r15+, k2 ! restore EXPEVT
  584. mov k4, r15
  585. rte
  586. nop
  587. .align 2
  588. 1: .long TRA
  589. 2: .long NR_syscalls
  590. 3: .long sys_call_table
  591. 4: .long do_syscall_trace
  592. 5: .long 0x00001000 ! DSP
  593. 7: .long 0x30000000
  594. 9:
  595. __INV_IMASK:
  596. .long 0xffffff0f ! ~(IMASK)
  597. ! Exception Vector Base
  598. !
  599. ! Should be aligned page boundary.
  600. !
  601. .balign 4096,0,4096
  602. ENTRY(vbr_base)
  603. .long 0
  604. !
  605. .balign 256,0,256
  606. general_exception:
  607. mov.l 1f, k2
  608. mov.l 2f, k3
  609. bra handle_exception
  610. mov.l @k2, k2
  611. .align 2
  612. 1: .long EXPEVT
  613. 2: .long ret_from_exception
  614. !
  615. !
  616. .balign 1024,0,1024
  617. tlb_miss:
  618. mov.l 1f, k2
  619. mov.l 4f, k3
  620. bra handle_exception
  621. mov.l @k2, k2
  622. !
  623. .balign 512,0,512
  624. interrupt:
  625. mov.l 2f, k2
  626. mov.l 3f, k3
  627. #if defined(CONFIG_KGDB_NMI)
  628. ! Debounce (filter nested NMI)
  629. mov.l @k2, k0
  630. mov.l 5f, k1
  631. cmp/eq k1, k0
  632. bf 0f
  633. mov.l 6f, k1
  634. tas.b @k1
  635. bt 0f
  636. rte
  637. nop
  638. .align 2
  639. 5: .long NMI_VEC
  640. 6: .long in_nmi
  641. 0:
  642. #endif /* defined(CONFIG_KGDB_NMI) */
  643. bra handle_exception
  644. mov.l @k2, k2
  645. .align 2
  646. 1: .long EXPEVT
  647. 2: .long INTEVT
  648. 3: .long ret_from_irq
  649. 4: .long ret_from_exception
  650. !
  651. !
  652. .align 2
  653. ENTRY(handle_exception)
  654. ! Using k0, k1 for scratch registers (r0_bank1, r1_bank),
  655. ! save all registers onto stack.
  656. !
  657. stc ssr, k0 ! Is it from kernel space?
  658. shll k0 ! Check MD bit (bit30) by shifting it into...
  659. shll k0 ! ...the T bit
  660. bt/s 1f ! It's a kernel to kernel transition.
  661. mov r15, k0 ! save original stack to k0
  662. /* User space to kernel */
  663. mov #(THREAD_SIZE >> 8), k1
  664. shll8 k1 ! k1 := THREAD_SIZE
  665. add current, k1
  666. mov k1, r15 ! change to kernel stack
  667. !
  668. 1: mov #-1, k4
  669. mov.l 2f, k1
  670. !
  671. #ifdef CONFIG_SH_DSP
  672. mov.l r2, @-r15 ! Save r2, we need another reg
  673. stc sr, k4
  674. mov.l 1f, r2
  675. tst r2, k4 ! Check if in DSP mode
  676. mov.l @r15+, r2 ! Restore r2 now
  677. bt/s skip_save
  678. mov #0, k4 ! Set marker for no stack frame
  679. mov r2, k4 ! Backup r2 (in k4) for later
  680. ! Save DSP registers on stack
  681. stc.l mod, @-r15
  682. stc.l re, @-r15
  683. stc.l rs, @-r15
  684. sts.l dsr, @-r15
  685. sts.l y1, @-r15
  686. sts.l y0, @-r15
  687. sts.l x1, @-r15
  688. sts.l x0, @-r15
  689. sts.l a0, @-r15
  690. ! GAS is broken, does not generate correct "movs.l Ds,@-As" instr.
  691. ! FIXME: Make sure that this is still the case with newer toolchains,
  692. ! as we're not at all interested in supporting ancient toolchains at
  693. ! this point. -- PFM.
  694. mov r15, r2
  695. .word 0xf653 ! movs.l a1, @-r2
  696. .word 0xf6f3 ! movs.l a0g, @-r2
  697. .word 0xf6d3 ! movs.l a1g, @-r2
  698. .word 0xf6c3 ! movs.l m0, @-r2
  699. .word 0xf6e3 ! movs.l m1, @-r2
  700. mov r2, r15
  701. mov k4, r2 ! Restore r2
  702. mov.l 1f, k4 ! Force DSP stack frame
  703. skip_save:
  704. mov.l k4, @-r15 ! Push DSP mode marker onto stack
  705. #endif
  706. ! Save the user registers on the stack.
  707. mov.l k2, @-r15 ! EXPEVT
  708. mov.l k4, @-r15 ! set TRA (default: -1)
  709. !
  710. sts.l macl, @-r15
  711. sts.l mach, @-r15
  712. stc.l gbr, @-r15
  713. stc.l ssr, @-r15
  714. sts.l pr, @-r15
  715. stc.l spc, @-r15
  716. !
  717. lds k3, pr ! Set the return address to pr
  718. !
  719. mov.l k0, @-r15 ! save orignal stack
  720. mov.l r14, @-r15
  721. mov.l r13, @-r15
  722. mov.l r12, @-r15
  723. mov.l r11, @-r15
  724. mov.l r10, @-r15
  725. mov.l r9, @-r15
  726. mov.l r8, @-r15
  727. !
  728. stc sr, r8 ! Back to normal register bank, and
  729. or k1, r8 ! Block all interrupts
  730. mov.l 3f, k1
  731. and k1, r8 ! ...
  732. ldc r8, sr ! ...changed here.
  733. !
  734. mov.l r7, @-r15
  735. mov.l r6, @-r15
  736. mov.l r5, @-r15
  737. mov.l r4, @-r15
  738. mov.l r3, @-r15
  739. mov.l r2, @-r15
  740. mov.l r1, @-r15
  741. mov.l r0, @-r15
  742. ! Then, dispatch to the handler, according to the exception code.
  743. stc k_ex_code, r8
  744. shlr2 r8
  745. shlr r8
  746. mov.l 4f, r9
  747. add r8, r9
  748. mov.l @r9, r9
  749. jmp @r9
  750. nop
  751. .align 2
  752. 1: .long 0x00001000 ! DSP=1
  753. 2: .long 0x000080f0 ! FD=1, IMASK=15
  754. 3: .long 0xcfffffff ! RB=0, BL=0
  755. 4: .long exception_handling_table
  756. .align 2
  757. ENTRY(exception_none)
  758. rts
  759. nop