entry.S 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762
  1. ;
  2. ; Port on Texas Instruments TMS320C6x architecture
  3. ;
  4. ; Copyright (C) 2004-2011 Texas Instruments Incorporated
  5. ; Author: Aurelien Jacquiot (aurelien.jacquiot@virtuallogix.com)
  6. ; Updated for 2.6.34: Mark Salter <msalter@redhat.com>
  7. ;
  8. ; This program is free software; you can redistribute it and/or modify
  9. ; it under the terms of the GNU General Public License version 2 as
  10. ; published by the Free Software Foundation.
  11. ;
  12. #include <linux/sys.h>
  13. #include <linux/linkage.h>
  14. #include <asm/thread_info.h>
  15. #include <asm/asm-offsets.h>
  16. #include <asm/unistd.h>
  17. #include <asm/errno.h>
  18. ; Registers naming
  19. #define DP B14
  20. #define SP B15
  21. #ifndef CONFIG_PREEMPT
  22. #define resume_kernel restore_all
  23. #endif
  24. .altmacro
  25. .macro MASK_INT reg
  26. MVC .S2 CSR,reg
  27. CLR .S2 reg,0,0,reg
  28. MVC .S2 reg,CSR
  29. .endm
  30. .macro UNMASK_INT reg
  31. MVC .S2 CSR,reg
  32. SET .S2 reg,0,0,reg
  33. MVC .S2 reg,CSR
  34. .endm
  35. .macro GET_THREAD_INFO reg
  36. SHR .S1X SP,THREAD_SHIFT,reg
  37. SHL .S1 reg,THREAD_SHIFT,reg
  38. .endm
  39. ;;
  40. ;; This defines the normal kernel pt_regs layout.
  41. ;;
  42. .macro SAVE_ALL __rp __tsr
  43. STW .D2T2 B0,*SP--[2] ; save original B0
  44. MVKL .S2 current_ksp,B0
  45. MVKH .S2 current_ksp,B0
  46. LDW .D2T2 *B0,B1 ; KSP
  47. NOP 3
  48. STW .D2T2 B1,*+SP[1] ; save original B1
  49. XOR .D2 SP,B1,B0 ; (SP ^ KSP)
  50. LDW .D2T2 *+SP[1],B1 ; restore B0/B1
  51. LDW .D2T2 *++SP[2],B0
  52. SHR .S2 B0,THREAD_SHIFT,B0 ; 0 if already using kstack
  53. [B0] STDW .D2T2 SP:DP,*--B1[1] ; user: save user sp/dp kstack
  54. [B0] MV .S2 B1,SP ; and switch to kstack
  55. ||[!B0] STDW .D2T2 SP:DP,*--SP[1] ; kernel: save on current stack
  56. SUBAW .D2 SP,2,SP
  57. ADD .D1X SP,-8,A15
  58. || STDW .D2T1 A15:A14,*SP--[16] ; save A15:A14
  59. STDW .D2T2 B13:B12,*SP--[1]
  60. || STDW .D1T1 A13:A12,*A15--[1]
  61. || MVC .S2 __rp,B13
  62. STDW .D2T2 B11:B10,*SP--[1]
  63. || STDW .D1T1 A11:A10,*A15--[1]
  64. || MVC .S2 CSR,B12
  65. STDW .D2T2 B9:B8,*SP--[1]
  66. || STDW .D1T1 A9:A8,*A15--[1]
  67. || MVC .S2 RILC,B11
  68. STDW .D2T2 B7:B6,*SP--[1]
  69. || STDW .D1T1 A7:A6,*A15--[1]
  70. || MVC .S2 ILC,B10
  71. STDW .D2T2 B5:B4,*SP--[1]
  72. || STDW .D1T1 A5:A4,*A15--[1]
  73. STDW .D2T2 B3:B2,*SP--[1]
  74. || STDW .D1T1 A3:A2,*A15--[1]
  75. || MVC .S2 __tsr,B5
  76. STDW .D2T2 B1:B0,*SP--[1]
  77. || STDW .D1T1 A1:A0,*A15--[1]
  78. || MV .S1X B5,A5
  79. STDW .D2T2 B31:B30,*SP--[1]
  80. || STDW .D1T1 A31:A30,*A15--[1]
  81. STDW .D2T2 B29:B28,*SP--[1]
  82. || STDW .D1T1 A29:A28,*A15--[1]
  83. STDW .D2T2 B27:B26,*SP--[1]
  84. || STDW .D1T1 A27:A26,*A15--[1]
  85. STDW .D2T2 B25:B24,*SP--[1]
  86. || STDW .D1T1 A25:A24,*A15--[1]
  87. STDW .D2T2 B23:B22,*SP--[1]
  88. || STDW .D1T1 A23:A22,*A15--[1]
  89. STDW .D2T2 B21:B20,*SP--[1]
  90. || STDW .D1T1 A21:A20,*A15--[1]
  91. STDW .D2T2 B19:B18,*SP--[1]
  92. || STDW .D1T1 A19:A18,*A15--[1]
  93. STDW .D2T2 B17:B16,*SP--[1]
  94. || STDW .D1T1 A17:A16,*A15--[1]
  95. STDW .D2T2 B13:B12,*SP--[1] ; save PC and CSR
  96. STDW .D2T2 B11:B10,*SP--[1] ; save RILC and ILC
  97. STDW .D2T1 A5:A4,*SP--[1] ; save TSR and orig A4
  98. ;; We left an unused word on the stack just above pt_regs.
  99. ;; It is used to save whether or not this frame is due to
  100. ;; a syscall. It is cleared here, but the syscall handler
  101. ;; sets it to a non-zero value.
  102. MVK .L2 0,B1
  103. STW .D2T2 B1,*+SP(REGS__END+8) ; clear syscall flag
  104. .endm
  105. .macro RESTORE_ALL __rp __tsr
  106. LDDW .D2T2 *++SP[1],B9:B8 ; get TSR (B9)
  107. LDDW .D2T2 *++SP[1],B11:B10 ; get RILC (B11) and ILC (B10)
  108. LDDW .D2T2 *++SP[1],B13:B12 ; get PC (B13) and CSR (B12)
  109. ADDAW .D1X SP,30,A15
  110. LDDW .D1T1 *++A15[1],A17:A16
  111. || LDDW .D2T2 *++SP[1],B17:B16
  112. LDDW .D1T1 *++A15[1],A19:A18
  113. || LDDW .D2T2 *++SP[1],B19:B18
  114. LDDW .D1T1 *++A15[1],A21:A20
  115. || LDDW .D2T2 *++SP[1],B21:B20
  116. LDDW .D1T1 *++A15[1],A23:A22
  117. || LDDW .D2T2 *++SP[1],B23:B22
  118. LDDW .D1T1 *++A15[1],A25:A24
  119. || LDDW .D2T2 *++SP[1],B25:B24
  120. LDDW .D1T1 *++A15[1],A27:A26
  121. || LDDW .D2T2 *++SP[1],B27:B26
  122. LDDW .D1T1 *++A15[1],A29:A28
  123. || LDDW .D2T2 *++SP[1],B29:B28
  124. LDDW .D1T1 *++A15[1],A31:A30
  125. || LDDW .D2T2 *++SP[1],B31:B30
  126. LDDW .D1T1 *++A15[1],A1:A0
  127. || LDDW .D2T2 *++SP[1],B1:B0
  128. LDDW .D1T1 *++A15[1],A3:A2
  129. || LDDW .D2T2 *++SP[1],B3:B2
  130. || MVC .S2 B9,__tsr
  131. LDDW .D1T1 *++A15[1],A5:A4
  132. || LDDW .D2T2 *++SP[1],B5:B4
  133. || MVC .S2 B11,RILC
  134. LDDW .D1T1 *++A15[1],A7:A6
  135. || LDDW .D2T2 *++SP[1],B7:B6
  136. || MVC .S2 B10,ILC
  137. LDDW .D1T1 *++A15[1],A9:A8
  138. || LDDW .D2T2 *++SP[1],B9:B8
  139. || MVC .S2 B13,__rp
  140. LDDW .D1T1 *++A15[1],A11:A10
  141. || LDDW .D2T2 *++SP[1],B11:B10
  142. || MVC .S2 B12,CSR
  143. LDDW .D1T1 *++A15[1],A13:A12
  144. || LDDW .D2T2 *++SP[1],B13:B12
  145. MV .D2X A15,SP
  146. || MVKL .S1 current_ksp,A15
  147. MVKH .S1 current_ksp,A15
  148. || ADDAW .D1X SP,6,A14
  149. STW .D1T1 A14,*A15 ; save kernel stack pointer
  150. LDDW .D2T1 *++SP[1],A15:A14
  151. B .S2 __rp ; return from interruption
  152. LDDW .D2T2 *+SP[1],SP:DP
  153. NOP 4
  154. .endm
  155. .section .text
  156. ;;
  157. ;; Jump to schedule() then return to ret_from_exception
  158. ;;
  159. _reschedule:
  160. #ifdef CONFIG_C6X_BIG_KERNEL
  161. MVKL .S1 schedule,A0
  162. MVKH .S1 schedule,A0
  163. B .S2X A0
  164. #else
  165. B .S1 schedule
  166. #endif
  167. ADDKPC .S2 ret_from_exception,B3,4
  168. ;;
  169. ;; Called before syscall handler when process is being debugged
  170. ;;
  171. tracesys_on:
  172. #ifdef CONFIG_C6X_BIG_KERNEL
  173. MVKL .S1 syscall_trace_entry,A0
  174. MVKH .S1 syscall_trace_entry,A0
  175. B .S2X A0
  176. #else
  177. B .S1 syscall_trace_entry
  178. #endif
  179. ADDKPC .S2 ret_from_syscall_trace,B3,3
  180. ADD .S1X 8,SP,A4
  181. ret_from_syscall_trace:
  182. ;; tracing returns (possibly new) syscall number
  183. MV .D2X A4,B0
  184. || MVK .S2 __NR_syscalls,B1
  185. CMPLTU .L2 B0,B1,B1
  186. [!B1] BNOP .S2 ret_from_syscall_function,5
  187. || MVK .S1 -ENOSYS,A4
  188. ;; reload syscall args from (possibly modified) stack frame
  189. ;; and get syscall handler addr from sys_call_table:
  190. LDW .D2T2 *+SP(REGS_B4+8),B4
  191. || MVKL .S2 sys_call_table,B1
  192. LDW .D2T1 *+SP(REGS_A6+8),A6
  193. || MVKH .S2 sys_call_table,B1
  194. LDW .D2T2 *+B1[B0],B0
  195. || MVKL .S2 ret_from_syscall_function,B3
  196. LDW .D2T2 *+SP(REGS_B6+8),B6
  197. || MVKH .S2 ret_from_syscall_function,B3
  198. LDW .D2T1 *+SP(REGS_A8+8),A8
  199. LDW .D2T2 *+SP(REGS_B8+8),B8
  200. NOP
  201. ; B0 = sys_call_table[__NR_*]
  202. BNOP .S2 B0,5 ; branch to syscall handler
  203. || LDW .D2T1 *+SP(REGS_ORIG_A4+8),A4
  204. syscall_exit_work:
  205. AND .D1 _TIF_SYSCALL_TRACE,A2,A0
  206. [!A0] BNOP .S1 work_pending,5
  207. [A0] B .S2 syscall_trace_exit
  208. ADDKPC .S2 resume_userspace,B3,1
  209. MVC .S2 CSR,B1
  210. SET .S2 B1,0,0,B1
  211. MVC .S2 B1,CSR ; enable ints
  212. work_pending:
  213. AND .D1 _TIF_NEED_RESCHED,A2,A0
  214. [!A0] BNOP .S1 work_notifysig,5
  215. work_resched:
  216. #ifdef CONFIG_C6X_BIG_KERNEL
  217. MVKL .S1 schedule,A1
  218. MVKH .S1 schedule,A1
  219. B .S2X A1
  220. #else
  221. B .S2 schedule
  222. #endif
  223. ADDKPC .S2 work_rescheduled,B3,4
  224. work_rescheduled:
  225. ;; make sure we don't miss an interrupt setting need_resched or
  226. ;; sigpending between sampling and the rti
  227. MASK_INT B2
  228. GET_THREAD_INFO A12
  229. LDW .D1T1 *+A12(THREAD_INFO_FLAGS),A2
  230. MVK .S1 _TIF_WORK_MASK,A1
  231. MVK .S1 _TIF_NEED_RESCHED,A3
  232. NOP 2
  233. AND .D1 A1,A2,A0
  234. || AND .S1 A3,A2,A1
  235. [!A0] BNOP .S1 restore_all,5
  236. [A1] BNOP .S1 work_resched,5
  237. work_notifysig:
  238. B .S2 do_notify_resume
  239. LDW .D2T1 *+SP(REGS__END+8),A6 ; syscall flag
  240. ADDKPC .S2 resume_userspace,B3,1
  241. ADD .S1X 8,SP,A4 ; pt_regs pointer is first arg
  242. MV .D2X A2,B4 ; thread_info flags is second arg
  243. ;;
  244. ;; On C64x+, the return way from exception and interrupt
  245. ;; is a little bit different
  246. ;;
  247. ENTRY(ret_from_exception)
  248. #ifdef CONFIG_PREEMPT
  249. MASK_INT B2
  250. #endif
  251. ENTRY(ret_from_interrupt)
  252. ;;
  253. ;; Check if we are comming from user mode.
  254. ;;
  255. LDW .D2T2 *+SP(REGS_TSR+8),B0
  256. MVK .S2 0x40,B1
  257. NOP 3
  258. AND .D2 B0,B1,B0
  259. [!B0] BNOP .S2 resume_kernel,5
  260. resume_userspace:
  261. ;; make sure we don't miss an interrupt setting need_resched or
  262. ;; sigpending between sampling and the rti
  263. MASK_INT B2
  264. GET_THREAD_INFO A12
  265. LDW .D1T1 *+A12(THREAD_INFO_FLAGS),A2
  266. MVK .S1 _TIF_WORK_MASK,A1
  267. MVK .S1 _TIF_NEED_RESCHED,A3
  268. NOP 2
  269. AND .D1 A1,A2,A0
  270. [A0] BNOP .S1 work_pending,5
  271. BNOP .S1 restore_all,5
  272. ;;
  273. ;; System call handling
  274. ;; B0 = syscall number (in sys_call_table)
  275. ;; A4,B4,A6,B6,A8,B8 = arguments of the syscall function
  276. ;; A4 is the return value register
  277. ;;
  278. system_call_saved:
  279. MVK .L2 1,B2
  280. STW .D2T2 B2,*+SP(REGS__END+8) ; set syscall flag
  281. MVC .S2 B2,ECR ; ack the software exception
  282. UNMASK_INT B2 ; re-enable global IT
  283. system_call_saved_noack:
  284. ;; Check system call number
  285. MVK .S2 __NR_syscalls,B1
  286. #ifdef CONFIG_C6X_BIG_KERNEL
  287. || MVKL .S1 sys_ni_syscall,A0
  288. #endif
  289. CMPLTU .L2 B0,B1,B1
  290. #ifdef CONFIG_C6X_BIG_KERNEL
  291. || MVKH .S1 sys_ni_syscall,A0
  292. #endif
  293. ;; Check for ptrace
  294. GET_THREAD_INFO A12
  295. #ifdef CONFIG_C6X_BIG_KERNEL
  296. [!B1] B .S2X A0
  297. #else
  298. [!B1] B .S2 sys_ni_syscall
  299. #endif
  300. [!B1] ADDKPC .S2 ret_from_syscall_function,B3,4
  301. ;; Get syscall handler addr from sys_call_table
  302. ;; call tracesys_on or call syscall handler
  303. LDW .D1T1 *+A12(THREAD_INFO_FLAGS),A2
  304. || MVKL .S2 sys_call_table,B1
  305. MVKH .S2 sys_call_table,B1
  306. LDW .D2T2 *+B1[B0],B0
  307. NOP 2
  308. ; A2 = thread_info flags
  309. AND .D1 _TIF_SYSCALL_TRACE,A2,A2
  310. [A2] BNOP .S1 tracesys_on,5
  311. ;; B0 = _sys_call_table[__NR_*]
  312. B .S2 B0
  313. ADDKPC .S2 ret_from_syscall_function,B3,4
  314. ret_from_syscall_function:
  315. STW .D2T1 A4,*+SP(REGS_A4+8) ; save return value in A4
  316. ; original A4 is in orig_A4
  317. syscall_exit:
  318. ;; make sure we don't miss an interrupt setting need_resched or
  319. ;; sigpending between sampling and the rti
  320. MASK_INT B2
  321. LDW .D1T1 *+A12(THREAD_INFO_FLAGS),A2
  322. MVK .S1 _TIF_ALLWORK_MASK,A1
  323. NOP 3
  324. AND .D1 A1,A2,A2 ; check for work to do
  325. [A2] BNOP .S1 syscall_exit_work,5
  326. restore_all:
  327. RESTORE_ALL NRP,NTSR
  328. ;;
  329. ;; After a fork we jump here directly from resume,
  330. ;; so that A4 contains the previous task structure.
  331. ;;
  332. ENTRY(ret_from_fork)
  333. #ifdef CONFIG_C6X_BIG_KERNEL
  334. MVKL .S1 schedule_tail,A0
  335. MVKH .S1 schedule_tail,A0
  336. B .S2X A0
  337. #else
  338. B .S2 schedule_tail
  339. #endif
  340. ADDKPC .S2 ret_from_fork_2,B3,4
  341. ret_from_fork_2:
  342. ;; return 0 in A4 for child process
  343. GET_THREAD_INFO A12
  344. BNOP .S2 syscall_exit,3
  345. MVK .L2 0,B0
  346. STW .D2T2 B0,*+SP(REGS_A4+8)
  347. ENDPROC(ret_from_fork)
  348. ENTRY(ret_from_kernel_thread)
  349. #ifdef CONFIG_C6X_BIG_KERNEL
  350. MVKL .S1 schedule_tail,A0
  351. MVKH .S1 schedule_tail,A0
  352. B .S2X A0
  353. #else
  354. B .S2 schedule_tail
  355. #endif
  356. LDW .D2T2 *+SP(REGS_A0+8),B10 /* get fn */
  357. ADDKPC .S2 0f,B3,3
  358. 0:
  359. B .S2 B10 /* call fn */
  360. LDW .D2T1 *+SP(REGS_A1+8),A4 /* get arg */
  361. ADDKPC .S2 ret_from_fork_2,B3,3
  362. ENDPROC(ret_from_kernel_thread)
  363. ;;
  364. ;; These are the interrupt handlers, responsible for calling __do_IRQ()
  365. ;; int6 is used for syscalls (see _system_call entry)
  366. ;;
  367. .macro SAVE_ALL_INT
  368. SAVE_ALL IRP,ITSR
  369. .endm
  370. .macro CALL_INT int
  371. #ifdef CONFIG_C6X_BIG_KERNEL
  372. MVKL .S1 c6x_do_IRQ,A0
  373. MVKH .S1 c6x_do_IRQ,A0
  374. BNOP .S2X A0,1
  375. MVK .S1 int,A4
  376. ADDAW .D2 SP,2,B4
  377. MVKL .S2 ret_from_interrupt,B3
  378. MVKH .S2 ret_from_interrupt,B3
  379. #else
  380. CALLP .S2 c6x_do_IRQ,B3
  381. || MVK .S1 int,A4
  382. || ADDAW .D2 SP,2,B4
  383. B .S1 ret_from_interrupt
  384. NOP 5
  385. #endif
  386. .endm
  387. ENTRY(_int4_handler)
  388. SAVE_ALL_INT
  389. CALL_INT 4
  390. ENDPROC(_int4_handler)
  391. ENTRY(_int5_handler)
  392. SAVE_ALL_INT
  393. CALL_INT 5
  394. ENDPROC(_int5_handler)
  395. ENTRY(_int6_handler)
  396. SAVE_ALL_INT
  397. CALL_INT 6
  398. ENDPROC(_int6_handler)
  399. ENTRY(_int7_handler)
  400. SAVE_ALL_INT
  401. CALL_INT 7
  402. ENDPROC(_int7_handler)
  403. ENTRY(_int8_handler)
  404. SAVE_ALL_INT
  405. CALL_INT 8
  406. ENDPROC(_int8_handler)
  407. ENTRY(_int9_handler)
  408. SAVE_ALL_INT
  409. CALL_INT 9
  410. ENDPROC(_int9_handler)
  411. ENTRY(_int10_handler)
  412. SAVE_ALL_INT
  413. CALL_INT 10
  414. ENDPROC(_int10_handler)
  415. ENTRY(_int11_handler)
  416. SAVE_ALL_INT
  417. CALL_INT 11
  418. ENDPROC(_int11_handler)
  419. ENTRY(_int12_handler)
  420. SAVE_ALL_INT
  421. CALL_INT 12
  422. ENDPROC(_int12_handler)
  423. ENTRY(_int13_handler)
  424. SAVE_ALL_INT
  425. CALL_INT 13
  426. ENDPROC(_int13_handler)
  427. ENTRY(_int14_handler)
  428. SAVE_ALL_INT
  429. CALL_INT 14
  430. ENDPROC(_int14_handler)
  431. ENTRY(_int15_handler)
  432. SAVE_ALL_INT
  433. CALL_INT 15
  434. ENDPROC(_int15_handler)
  435. ;;
  436. ;; Handler for uninitialized and spurious interrupts
  437. ;;
  438. ENTRY(_bad_interrupt)
  439. B .S2 IRP
  440. NOP 5
  441. ENDPROC(_bad_interrupt)
  442. ;;
  443. ;; Entry for NMI/exceptions/syscall
  444. ;;
  445. ENTRY(_nmi_handler)
  446. SAVE_ALL NRP,NTSR
  447. MVC .S2 EFR,B2
  448. CMPEQ .L2 1,B2,B2
  449. || MVC .S2 TSR,B1
  450. CLR .S2 B1,10,10,B1
  451. MVC .S2 B1,TSR
  452. #ifdef CONFIG_C6X_BIG_KERNEL
  453. [!B2] MVKL .S1 process_exception,A0
  454. [!B2] MVKH .S1 process_exception,A0
  455. [!B2] B .S2X A0
  456. #else
  457. [!B2] B .S2 process_exception
  458. #endif
  459. [B2] B .S2 system_call_saved
  460. [!B2] ADDAW .D2 SP,2,B1
  461. [!B2] MV .D1X B1,A4
  462. ADDKPC .S2 ret_from_trap,B3,2
  463. ret_from_trap:
  464. MV .D2X A4,B0
  465. [!B0] BNOP .S2 ret_from_exception,5
  466. #ifdef CONFIG_C6X_BIG_KERNEL
  467. MVKL .S2 system_call_saved_noack,B3
  468. MVKH .S2 system_call_saved_noack,B3
  469. #endif
  470. LDW .D2T2 *+SP(REGS_B0+8),B0
  471. LDW .D2T1 *+SP(REGS_A4+8),A4
  472. LDW .D2T2 *+SP(REGS_B4+8),B4
  473. LDW .D2T1 *+SP(REGS_A6+8),A6
  474. LDW .D2T2 *+SP(REGS_B6+8),B6
  475. LDW .D2T1 *+SP(REGS_A8+8),A8
  476. #ifdef CONFIG_C6X_BIG_KERNEL
  477. || B .S2 B3
  478. #else
  479. || B .S2 system_call_saved_noack
  480. #endif
  481. LDW .D2T2 *+SP(REGS_B8+8),B8
  482. NOP 4
  483. ENDPROC(_nmi_handler)
  484. ;;
  485. ;; Jump to schedule() then return to ret_from_isr
  486. ;;
  487. #ifdef CONFIG_PREEMPT
  488. resume_kernel:
  489. GET_THREAD_INFO A12
  490. LDW .D1T1 *+A12(THREAD_INFO_PREEMPT_COUNT),A1
  491. NOP 4
  492. [A1] BNOP .S2 restore_all,5
  493. preempt_schedule:
  494. GET_THREAD_INFO A2
  495. LDW .D1T1 *+A2(THREAD_INFO_FLAGS),A1
  496. #ifdef CONFIG_C6X_BIG_KERNEL
  497. MVKL .S2 preempt_schedule_irq,B0
  498. MVKH .S2 preempt_schedule_irq,B0
  499. NOP 2
  500. #else
  501. NOP 4
  502. #endif
  503. AND .D1 _TIF_NEED_RESCHED,A1,A1
  504. [!A1] BNOP .S2 restore_all,5
  505. #ifdef CONFIG_C6X_BIG_KERNEL
  506. B .S2 B0
  507. #else
  508. B .S2 preempt_schedule_irq
  509. #endif
  510. ADDKPC .S2 preempt_schedule,B3,4
  511. #endif /* CONFIG_PREEMPT */
  512. ENTRY(enable_exception)
  513. DINT
  514. MVC .S2 TSR,B0
  515. MVC .S2 B3,NRP
  516. MVK .L2 0xc,B1
  517. OR .D2 B0,B1,B0
  518. MVC .S2 B0,TSR ; Set GEE and XEN in TSR
  519. B .S2 NRP
  520. NOP 5
  521. ENDPROC(enable_exception)
  522. ENTRY(sys_sigaltstack)
  523. #ifdef CONFIG_C6X_BIG_KERNEL
  524. MVKL .S1 do_sigaltstack,A0 ; branch to do_sigaltstack
  525. MVKH .S1 do_sigaltstack,A0
  526. B .S2X A0
  527. #else
  528. B .S2 do_sigaltstack
  529. #endif
  530. LDW .D2T1 *+SP(REGS_SP+8),A6
  531. NOP 4
  532. ENDPROC(sys_sigaltstack)
  533. ;;
  534. ;; Special system calls
  535. ;; return address is in B3
  536. ;;
  537. ENTRY(sys_clone)
  538. ADD .D1X SP,8,A4
  539. #ifdef CONFIG_C6X_BIG_KERNEL
  540. || MVKL .S1 sys_c6x_clone,A0
  541. MVKH .S1 sys_c6x_clone,A0
  542. BNOP .S2X A0,5
  543. #else
  544. || B .S2 sys_c6x_clone
  545. NOP 5
  546. #endif
  547. ENDPROC(sys_clone)
  548. ENTRY(sys_rt_sigreturn)
  549. ADD .D1X SP,8,A4
  550. #ifdef CONFIG_C6X_BIG_KERNEL
  551. || MVKL .S1 do_rt_sigreturn,A0
  552. MVKH .S1 do_rt_sigreturn,A0
  553. BNOP .S2X A0,5
  554. #else
  555. || B .S2 do_rt_sigreturn
  556. NOP 5
  557. #endif
  558. ENDPROC(sys_rt_sigreturn)
  559. ENTRY(sys_pread_c6x)
  560. MV .D2X A8,B7
  561. #ifdef CONFIG_C6X_BIG_KERNEL
  562. || MVKL .S1 sys_pread64,A0
  563. MVKH .S1 sys_pread64,A0
  564. BNOP .S2X A0,5
  565. #else
  566. || B .S2 sys_pread64
  567. NOP 5
  568. #endif
  569. ENDPROC(sys_pread_c6x)
  570. ENTRY(sys_pwrite_c6x)
  571. MV .D2X A8,B7
  572. #ifdef CONFIG_C6X_BIG_KERNEL
  573. || MVKL .S1 sys_pwrite64,A0
  574. MVKH .S1 sys_pwrite64,A0
  575. BNOP .S2X A0,5
  576. #else
  577. || B .S2 sys_pwrite64
  578. NOP 5
  579. #endif
  580. ENDPROC(sys_pwrite_c6x)
  581. ;; On Entry
  582. ;; A4 - path
  583. ;; B4 - offset_lo (LE), offset_hi (BE)
  584. ;; A6 - offset_lo (BE), offset_hi (LE)
  585. ENTRY(sys_truncate64_c6x)
  586. #ifdef CONFIG_CPU_BIG_ENDIAN
  587. MV .S2 B4,B5
  588. MV .D2X A6,B4
  589. #else
  590. MV .D2X A6,B5
  591. #endif
  592. #ifdef CONFIG_C6X_BIG_KERNEL
  593. || MVKL .S1 sys_truncate64,A0
  594. MVKH .S1 sys_truncate64,A0
  595. BNOP .S2X A0,5
  596. #else
  597. || B .S2 sys_truncate64
  598. NOP 5
  599. #endif
  600. ENDPROC(sys_truncate64_c6x)
  601. ;; On Entry
  602. ;; A4 - fd
  603. ;; B4 - offset_lo (LE), offset_hi (BE)
  604. ;; A6 - offset_lo (BE), offset_hi (LE)
  605. ENTRY(sys_ftruncate64_c6x)
  606. #ifdef CONFIG_CPU_BIG_ENDIAN
  607. MV .S2 B4,B5
  608. MV .D2X A6,B4
  609. #else
  610. MV .D2X A6,B5
  611. #endif
  612. #ifdef CONFIG_C6X_BIG_KERNEL
  613. || MVKL .S1 sys_ftruncate64,A0
  614. MVKH .S1 sys_ftruncate64,A0
  615. BNOP .S2X A0,5
  616. #else
  617. || B .S2 sys_ftruncate64
  618. NOP 5
  619. #endif
  620. ENDPROC(sys_ftruncate64_c6x)
  621. ;; On Entry
  622. ;; A4 - fd
  623. ;; B4 - offset_lo (LE), offset_hi (BE)
  624. ;; A6 - offset_lo (BE), offset_hi (LE)
  625. ;; B6 - len_lo (LE), len_hi (BE)
  626. ;; A8 - len_lo (BE), len_hi (LE)
  627. ;; B8 - advice
  628. ENTRY(sys_fadvise64_64_c6x)
  629. #ifdef CONFIG_C6X_BIG_KERNEL
  630. MVKL .S1 sys_fadvise64_64,A0
  631. MVKH .S1 sys_fadvise64_64,A0
  632. BNOP .S2X A0,2
  633. #else
  634. B .S2 sys_fadvise64_64
  635. NOP 2
  636. #endif
  637. #ifdef CONFIG_CPU_BIG_ENDIAN
  638. MV .L2 B4,B5
  639. || MV .D2X A6,B4
  640. MV .L1 A8,A6
  641. || MV .D1X B6,A7
  642. #else
  643. MV .D2X A6,B5
  644. MV .L1 A8,A7
  645. || MV .D1X B6,A6
  646. #endif
  647. MV .L2 B8,B6
  648. ENDPROC(sys_fadvise64_64_c6x)
  649. ;; On Entry
  650. ;; A4 - fd
  651. ;; B4 - mode
  652. ;; A6 - offset_hi
  653. ;; B6 - offset_lo
  654. ;; A8 - len_hi
  655. ;; B8 - len_lo
  656. ENTRY(sys_fallocate_c6x)
  657. #ifdef CONFIG_C6X_BIG_KERNEL
  658. MVKL .S1 sys_fallocate,A0
  659. MVKH .S1 sys_fallocate,A0
  660. BNOP .S2X A0,1
  661. #else
  662. B .S2 sys_fallocate
  663. NOP
  664. #endif
  665. MV .D1 A6,A7
  666. MV .D1X B6,A6
  667. MV .D2X A8,B7
  668. MV .D2 B8,B6
  669. ENDPROC(sys_fallocate_c6x)
  670. ;; put this in .neardata for faster access when using DSBT mode
  671. .section .neardata,"aw",@progbits
  672. .global current_ksp
  673. .hidden current_ksp
  674. current_ksp:
  675. .word init_thread_union + THREAD_START_SP