head.S 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311
  1. /*
  2. * Here is where the ball gets rolling as far as the kernel is concerned.
  3. * When control is transferred to _start, the bootload has already
  4. * loaded us to the correct address. All that's left to do here is
  5. * to set up the kernel's global pointer and jump to the kernel
  6. * entry point.
  7. *
  8. * Copyright (C) 1998-2001, 2003, 2005 Hewlett-Packard Co
  9. * David Mosberger-Tang <davidm@hpl.hp.com>
  10. * Stephane Eranian <eranian@hpl.hp.com>
  11. * Copyright (C) 1999 VA Linux Systems
  12. * Copyright (C) 1999 Walt Drummond <drummond@valinux.com>
  13. * Copyright (C) 1999 Intel Corp.
  14. * Copyright (C) 1999 Asit Mallick <Asit.K.Mallick@intel.com>
  15. * Copyright (C) 1999 Don Dugger <Don.Dugger@intel.com>
  16. * Copyright (C) 2002 Fenghua Yu <fenghua.yu@intel.com>
  17. * -Optimize __ia64_save_fpu() and __ia64_load_fpu() for Itanium 2.
  18. * Copyright (C) 2004 Ashok Raj <ashok.raj@intel.com>
  19. * Support for CPU Hotplug
  20. */
  21. #include <asm/asmmacro.h>
  22. #include <asm/fpu.h>
  23. #include <asm/kregs.h>
  24. #include <asm/mmu_context.h>
  25. #include <asm/asm-offsets.h>
  26. #include <asm/pal.h>
  27. #include <asm/paravirt.h>
  28. #include <asm/pgtable.h>
  29. #include <asm/processor.h>
  30. #include <asm/ptrace.h>
  31. #include <asm/system.h>
  32. #include <asm/mca_asm.h>
  33. #include <linux/init.h>
  34. #include <linux/linkage.h>
  35. #ifdef CONFIG_HOTPLUG_CPU
  36. #define SAL_PSR_BITS_TO_SET \
  37. (IA64_PSR_AC | IA64_PSR_BN | IA64_PSR_MFH | IA64_PSR_MFL)
  38. #define SAVE_FROM_REG(src, ptr, dest) \
  39. mov dest=src;; \
  40. st8 [ptr]=dest,0x08
  41. #define RESTORE_REG(reg, ptr, _tmp) \
  42. ld8 _tmp=[ptr],0x08;; \
  43. mov reg=_tmp
  44. #define SAVE_BREAK_REGS(ptr, _idx, _breg, _dest)\
  45. mov ar.lc=IA64_NUM_DBG_REGS-1;; \
  46. mov _idx=0;; \
  47. 1: \
  48. SAVE_FROM_REG(_breg[_idx], ptr, _dest);; \
  49. add _idx=1,_idx;; \
  50. br.cloop.sptk.many 1b
  51. #define RESTORE_BREAK_REGS(ptr, _idx, _breg, _tmp, _lbl)\
  52. mov ar.lc=IA64_NUM_DBG_REGS-1;; \
  53. mov _idx=0;; \
  54. _lbl: RESTORE_REG(_breg[_idx], ptr, _tmp);; \
  55. add _idx=1, _idx;; \
  56. br.cloop.sptk.many _lbl
  57. #define SAVE_ONE_RR(num, _reg, _tmp) \
  58. movl _tmp=(num<<61);; \
  59. mov _reg=rr[_tmp]
  60. #define SAVE_REGION_REGS(_tmp, _r0, _r1, _r2, _r3, _r4, _r5, _r6, _r7) \
  61. SAVE_ONE_RR(0,_r0, _tmp);; \
  62. SAVE_ONE_RR(1,_r1, _tmp);; \
  63. SAVE_ONE_RR(2,_r2, _tmp);; \
  64. SAVE_ONE_RR(3,_r3, _tmp);; \
  65. SAVE_ONE_RR(4,_r4, _tmp);; \
  66. SAVE_ONE_RR(5,_r5, _tmp);; \
  67. SAVE_ONE_RR(6,_r6, _tmp);; \
  68. SAVE_ONE_RR(7,_r7, _tmp);;
  69. #define STORE_REGION_REGS(ptr, _r0, _r1, _r2, _r3, _r4, _r5, _r6, _r7) \
  70. st8 [ptr]=_r0, 8;; \
  71. st8 [ptr]=_r1, 8;; \
  72. st8 [ptr]=_r2, 8;; \
  73. st8 [ptr]=_r3, 8;; \
  74. st8 [ptr]=_r4, 8;; \
  75. st8 [ptr]=_r5, 8;; \
  76. st8 [ptr]=_r6, 8;; \
  77. st8 [ptr]=_r7, 8;;
  78. #define RESTORE_REGION_REGS(ptr, _idx1, _idx2, _tmp) \
  79. mov ar.lc=0x08-1;; \
  80. movl _idx1=0x00;; \
  81. RestRR: \
  82. dep.z _idx2=_idx1,61,3;; \
  83. ld8 _tmp=[ptr],8;; \
  84. mov rr[_idx2]=_tmp;; \
  85. srlz.d;; \
  86. add _idx1=1,_idx1;; \
  87. br.cloop.sptk.few RestRR
  88. #define SET_AREA_FOR_BOOTING_CPU(reg1, reg2) \
  89. movl reg1=sal_state_for_booting_cpu;; \
  90. ld8 reg2=[reg1];;
  91. /*
  92. * Adjust region registers saved before starting to save
  93. * break regs and rest of the states that need to be preserved.
  94. */
  95. #define SAL_TO_OS_BOOT_HANDOFF_STATE_SAVE(_reg1,_reg2,_pred) \
  96. SAVE_FROM_REG(b0,_reg1,_reg2);; \
  97. SAVE_FROM_REG(b1,_reg1,_reg2);; \
  98. SAVE_FROM_REG(b2,_reg1,_reg2);; \
  99. SAVE_FROM_REG(b3,_reg1,_reg2);; \
  100. SAVE_FROM_REG(b4,_reg1,_reg2);; \
  101. SAVE_FROM_REG(b5,_reg1,_reg2);; \
  102. st8 [_reg1]=r1,0x08;; \
  103. st8 [_reg1]=r12,0x08;; \
  104. st8 [_reg1]=r13,0x08;; \
  105. SAVE_FROM_REG(ar.fpsr,_reg1,_reg2);; \
  106. SAVE_FROM_REG(ar.pfs,_reg1,_reg2);; \
  107. SAVE_FROM_REG(ar.rnat,_reg1,_reg2);; \
  108. SAVE_FROM_REG(ar.unat,_reg1,_reg2);; \
  109. SAVE_FROM_REG(ar.bspstore,_reg1,_reg2);; \
  110. SAVE_FROM_REG(cr.dcr,_reg1,_reg2);; \
  111. SAVE_FROM_REG(cr.iva,_reg1,_reg2);; \
  112. SAVE_FROM_REG(cr.pta,_reg1,_reg2);; \
  113. SAVE_FROM_REG(cr.itv,_reg1,_reg2);; \
  114. SAVE_FROM_REG(cr.pmv,_reg1,_reg2);; \
  115. SAVE_FROM_REG(cr.cmcv,_reg1,_reg2);; \
  116. SAVE_FROM_REG(cr.lrr0,_reg1,_reg2);; \
  117. SAVE_FROM_REG(cr.lrr1,_reg1,_reg2);; \
  118. st8 [_reg1]=r4,0x08;; \
  119. st8 [_reg1]=r5,0x08;; \
  120. st8 [_reg1]=r6,0x08;; \
  121. st8 [_reg1]=r7,0x08;; \
  122. st8 [_reg1]=_pred,0x08;; \
  123. SAVE_FROM_REG(ar.lc, _reg1, _reg2);; \
  124. stf.spill.nta [_reg1]=f2,16;; \
  125. stf.spill.nta [_reg1]=f3,16;; \
  126. stf.spill.nta [_reg1]=f4,16;; \
  127. stf.spill.nta [_reg1]=f5,16;; \
  128. stf.spill.nta [_reg1]=f16,16;; \
  129. stf.spill.nta [_reg1]=f17,16;; \
  130. stf.spill.nta [_reg1]=f18,16;; \
  131. stf.spill.nta [_reg1]=f19,16;; \
  132. stf.spill.nta [_reg1]=f20,16;; \
  133. stf.spill.nta [_reg1]=f21,16;; \
  134. stf.spill.nta [_reg1]=f22,16;; \
  135. stf.spill.nta [_reg1]=f23,16;; \
  136. stf.spill.nta [_reg1]=f24,16;; \
  137. stf.spill.nta [_reg1]=f25,16;; \
  138. stf.spill.nta [_reg1]=f26,16;; \
  139. stf.spill.nta [_reg1]=f27,16;; \
  140. stf.spill.nta [_reg1]=f28,16;; \
  141. stf.spill.nta [_reg1]=f29,16;; \
  142. stf.spill.nta [_reg1]=f30,16;; \
  143. stf.spill.nta [_reg1]=f31,16;;
  144. #else
  145. #define SET_AREA_FOR_BOOTING_CPU(a1, a2)
  146. #define SAL_TO_OS_BOOT_HANDOFF_STATE_SAVE(a1,a2, a3)
  147. #define SAVE_REGION_REGS(_tmp, _r0, _r1, _r2, _r3, _r4, _r5, _r6, _r7)
  148. #define STORE_REGION_REGS(ptr, _r0, _r1, _r2, _r3, _r4, _r5, _r6, _r7)
  149. #endif
  150. #define SET_ONE_RR(num, pgsize, _tmp1, _tmp2, vhpt) \
  151. movl _tmp1=(num << 61);; \
  152. mov _tmp2=((ia64_rid(IA64_REGION_ID_KERNEL, (num<<61)) << 8) | (pgsize << 2) | vhpt);; \
  153. mov rr[_tmp1]=_tmp2
  154. .section __special_page_section,"ax"
  155. .global empty_zero_page
  156. empty_zero_page:
  157. .skip PAGE_SIZE
  158. .global swapper_pg_dir
  159. swapper_pg_dir:
  160. .skip PAGE_SIZE
  161. .rodata
  162. halt_msg:
  163. stringz "Halting kernel\n"
  164. .section .text.head,"ax"
  165. .global start_ap
  166. /*
  167. * Start the kernel. When the bootloader passes control to _start(), r28
  168. * points to the address of the boot parameter area. Execution reaches
  169. * here in physical mode.
  170. */
  171. GLOBAL_ENTRY(_start)
  172. start_ap:
  173. .prologue
  174. .save rp, r0 // terminate unwind chain with a NULL rp
  175. .body
  176. rsm psr.i | psr.ic
  177. ;;
  178. srlz.i
  179. ;;
  180. {
  181. flushrs // must be first insn in group
  182. srlz.i
  183. }
  184. ;;
  185. /*
  186. * Save the region registers, predicate before they get clobbered
  187. */
  188. SAVE_REGION_REGS(r2, r8,r9,r10,r11,r12,r13,r14,r15);
  189. mov r25=pr;;
  190. /*
  191. * Initialize kernel region registers:
  192. * rr[0]: VHPT enabled, page size = PAGE_SHIFT
  193. * rr[1]: VHPT enabled, page size = PAGE_SHIFT
  194. * rr[2]: VHPT enabled, page size = PAGE_SHIFT
  195. * rr[3]: VHPT enabled, page size = PAGE_SHIFT
  196. * rr[4]: VHPT enabled, page size = PAGE_SHIFT
  197. * rr[5]: VHPT enabled, page size = PAGE_SHIFT
  198. * rr[6]: VHPT disabled, page size = IA64_GRANULE_SHIFT
  199. * rr[7]: VHPT disabled, page size = IA64_GRANULE_SHIFT
  200. * We initialize all of them to prevent inadvertently assuming
  201. * something about the state of address translation early in boot.
  202. */
  203. SET_ONE_RR(0, PAGE_SHIFT, r2, r16, 1);;
  204. SET_ONE_RR(1, PAGE_SHIFT, r2, r16, 1);;
  205. SET_ONE_RR(2, PAGE_SHIFT, r2, r16, 1);;
  206. SET_ONE_RR(3, PAGE_SHIFT, r2, r16, 1);;
  207. SET_ONE_RR(4, PAGE_SHIFT, r2, r16, 1);;
  208. SET_ONE_RR(5, PAGE_SHIFT, r2, r16, 1);;
  209. SET_ONE_RR(6, IA64_GRANULE_SHIFT, r2, r16, 0);;
  210. SET_ONE_RR(7, IA64_GRANULE_SHIFT, r2, r16, 0);;
  211. /*
  212. * Now pin mappings into the TLB for kernel text and data
  213. */
  214. mov r18=KERNEL_TR_PAGE_SHIFT<<2
  215. movl r17=KERNEL_START
  216. ;;
  217. mov cr.itir=r18
  218. mov cr.ifa=r17
  219. mov r16=IA64_TR_KERNEL
  220. mov r3=ip
  221. movl r18=PAGE_KERNEL
  222. ;;
  223. dep r2=0,r3,0,KERNEL_TR_PAGE_SHIFT
  224. ;;
  225. or r18=r2,r18
  226. ;;
  227. srlz.i
  228. ;;
  229. itr.i itr[r16]=r18
  230. ;;
  231. itr.d dtr[r16]=r18
  232. ;;
  233. srlz.i
  234. /*
  235. * Switch into virtual mode:
  236. */
  237. movl r16=(IA64_PSR_IT|IA64_PSR_IC|IA64_PSR_DT|IA64_PSR_RT|IA64_PSR_DFH|IA64_PSR_BN \
  238. |IA64_PSR_DI)
  239. ;;
  240. mov cr.ipsr=r16
  241. movl r17=1f
  242. ;;
  243. mov cr.iip=r17
  244. mov cr.ifs=r0
  245. ;;
  246. rfi
  247. ;;
  248. 1: // now we are in virtual mode
  249. SET_AREA_FOR_BOOTING_CPU(r2, r16);
  250. STORE_REGION_REGS(r16, r8,r9,r10,r11,r12,r13,r14,r15);
  251. SAL_TO_OS_BOOT_HANDOFF_STATE_SAVE(r16,r17,r25)
  252. ;;
  253. // set IVT entry point---can't access I/O ports without it
  254. movl r3=ia64_ivt
  255. ;;
  256. mov cr.iva=r3
  257. movl r2=FPSR_DEFAULT
  258. ;;
  259. srlz.i
  260. movl gp=__gp
  261. mov ar.fpsr=r2
  262. ;;
  263. #define isAP p2 // are we an Application Processor?
  264. #define isBP p3 // are we the Bootstrap Processor?
  265. #ifdef CONFIG_SMP
  266. /*
  267. * Find the init_task for the currently booting CPU. At poweron, and in
  268. * UP mode, task_for_booting_cpu is NULL.
  269. */
  270. movl r3=task_for_booting_cpu
  271. ;;
  272. ld8 r3=[r3]
  273. movl r2=init_task
  274. ;;
  275. cmp.eq isBP,isAP=r3,r0
  276. ;;
  277. (isAP) mov r2=r3
  278. #else
  279. movl r2=init_task
  280. cmp.eq isBP,isAP=r0,r0
  281. #endif
  282. ;;
  283. tpa r3=r2 // r3 == phys addr of task struct
  284. mov r16=-1
  285. (isBP) br.cond.dpnt .load_current // BP stack is on region 5 --- no need to map it
  286. // load mapping for stack (virtaddr in r2, physaddr in r3)
  287. rsm psr.ic
  288. movl r17=PAGE_KERNEL
  289. ;;
  290. srlz.d
  291. dep r18=0,r3,0,12
  292. ;;
  293. or r18=r17,r18
  294. dep r2=-1,r3,61,3 // IMVA of task
  295. ;;
  296. mov r17=rr[r2]
  297. shr.u r16=r3,IA64_GRANULE_SHIFT
  298. ;;
  299. dep r17=0,r17,8,24
  300. ;;
  301. mov cr.itir=r17
  302. mov cr.ifa=r2
  303. mov r19=IA64_TR_CURRENT_STACK
  304. ;;
  305. itr.d dtr[r19]=r18
  306. ;;
  307. ssm psr.ic
  308. srlz.d
  309. ;;
  310. .load_current:
  311. // load the "current" pointer (r13) and ar.k6 with the current task
  312. mov IA64_KR(CURRENT)=r2 // virtual address
  313. mov IA64_KR(CURRENT_STACK)=r16
  314. mov r13=r2
  315. /*
  316. * Reserve space at the top of the stack for "struct pt_regs". Kernel
  317. * threads don't store interesting values in that structure, but the space
  318. * still needs to be there because time-critical stuff such as the context
  319. * switching can be implemented more efficiently (for example, __switch_to()
  320. * always sets the psr.dfh bit of the task it is switching to).
  321. */
  322. addl r12=IA64_STK_OFFSET-IA64_PT_REGS_SIZE-16,r2
  323. addl r2=IA64_RBS_OFFSET,r2 // initialize the RSE
  324. mov ar.rsc=0 // place RSE in enforced lazy mode
  325. ;;
  326. loadrs // clear the dirty partition
  327. movl r19=__phys_per_cpu_start
  328. mov r18=PERCPU_PAGE_SIZE
  329. ;;
  330. #ifndef CONFIG_SMP
  331. add r19=r19,r18
  332. ;;
  333. #else
  334. (isAP) br.few 2f
  335. mov r20=r19
  336. sub r19=r19,r18
  337. ;;
  338. shr.u r18=r18,3
  339. 1:
  340. ld8 r21=[r20],8;;
  341. st8[r19]=r21,8
  342. adds r18=-1,r18;;
  343. cmp4.lt p7,p6=0,r18
  344. (p7) br.cond.dptk.few 1b
  345. 2:
  346. #endif
  347. tpa r19=r19
  348. ;;
  349. .pred.rel.mutex isBP,isAP
  350. (isBP) mov IA64_KR(PER_CPU_DATA)=r19 // per-CPU base for cpu0
  351. (isAP) mov IA64_KR(PER_CPU_DATA)=r0 // clear physical per-CPU base
  352. ;;
  353. mov ar.bspstore=r2 // establish the new RSE stack
  354. ;;
  355. mov ar.rsc=0x3 // place RSE in eager mode
  356. (isBP) dep r28=-1,r28,61,3 // make address virtual
  357. (isBP) movl r2=ia64_boot_param
  358. ;;
  359. (isBP) st8 [r2]=r28 // save the address of the boot param area passed by the bootloader
  360. #ifdef CONFIG_PARAVIRT
  361. movl r14=hypervisor_setup_hooks
  362. movl r15=hypervisor_type
  363. mov r16=num_hypervisor_hooks
  364. ;;
  365. ld8 r2=[r15]
  366. ;;
  367. cmp.ltu p7,p0=r2,r16 // array size check
  368. shladd r8=r2,3,r14
  369. ;;
  370. (p7) ld8 r9=[r8]
  371. ;;
  372. (p7) mov b1=r9
  373. (p7) cmp.ne.unc p7,p0=r9,r0 // no actual branch to NULL
  374. ;;
  375. (p7) br.call.sptk.many rp=b1
  376. __INITDATA
  377. default_setup_hook = 0 // Currently nothing needs to be done.
  378. .weak xen_setup_hook
  379. .global hypervisor_type
  380. hypervisor_type:
  381. data8 PARAVIRT_HYPERVISOR_TYPE_DEFAULT
  382. // must have the same order with PARAVIRT_HYPERVISOR_TYPE_xxx
  383. hypervisor_setup_hooks:
  384. data8 default_setup_hook
  385. data8 xen_setup_hook
  386. num_hypervisor_hooks = (. - hypervisor_setup_hooks) / 8
  387. .previous
  388. #endif
  389. #ifdef CONFIG_SMP
  390. (isAP) br.call.sptk.many rp=start_secondary
  391. .ret0:
  392. (isAP) br.cond.sptk self
  393. #endif
  394. // This is executed by the bootstrap processor (bsp) only:
  395. #ifdef CONFIG_IA64_FW_EMU
  396. // initialize PAL & SAL emulator:
  397. br.call.sptk.many rp=sys_fw_init
  398. .ret1:
  399. #endif
  400. br.call.sptk.many rp=start_kernel
  401. .ret2: addl r3=@ltoff(halt_msg),gp
  402. ;;
  403. alloc r2=ar.pfs,8,0,2,0
  404. ;;
  405. ld8 out0=[r3]
  406. br.call.sptk.many b0=console_print
  407. self: hint @pause
  408. br.sptk.many self // endless loop
  409. END(_start)
  410. .text
  411. GLOBAL_ENTRY(ia64_save_debug_regs)
  412. alloc r16=ar.pfs,1,0,0,0
  413. mov r20=ar.lc // preserve ar.lc
  414. mov ar.lc=IA64_NUM_DBG_REGS-1
  415. mov r18=0
  416. add r19=IA64_NUM_DBG_REGS*8,in0
  417. ;;
  418. 1: mov r16=dbr[r18]
  419. #ifdef CONFIG_ITANIUM
  420. ;;
  421. srlz.d
  422. #endif
  423. mov r17=ibr[r18]
  424. add r18=1,r18
  425. ;;
  426. st8.nta [in0]=r16,8
  427. st8.nta [r19]=r17,8
  428. br.cloop.sptk.many 1b
  429. ;;
  430. mov ar.lc=r20 // restore ar.lc
  431. br.ret.sptk.many rp
  432. END(ia64_save_debug_regs)
  433. GLOBAL_ENTRY(ia64_load_debug_regs)
  434. alloc r16=ar.pfs,1,0,0,0
  435. lfetch.nta [in0]
  436. mov r20=ar.lc // preserve ar.lc
  437. add r19=IA64_NUM_DBG_REGS*8,in0
  438. mov ar.lc=IA64_NUM_DBG_REGS-1
  439. mov r18=-1
  440. ;;
  441. 1: ld8.nta r16=[in0],8
  442. ld8.nta r17=[r19],8
  443. add r18=1,r18
  444. ;;
  445. mov dbr[r18]=r16
  446. #ifdef CONFIG_ITANIUM
  447. ;;
  448. srlz.d // Errata 132 (NoFix status)
  449. #endif
  450. mov ibr[r18]=r17
  451. br.cloop.sptk.many 1b
  452. ;;
  453. mov ar.lc=r20 // restore ar.lc
  454. br.ret.sptk.many rp
  455. END(ia64_load_debug_regs)
  456. GLOBAL_ENTRY(__ia64_save_fpu)
  457. alloc r2=ar.pfs,1,4,0,0
  458. adds loc0=96*16-16,in0
  459. adds loc1=96*16-16-128,in0
  460. ;;
  461. stf.spill.nta [loc0]=f127,-256
  462. stf.spill.nta [loc1]=f119,-256
  463. ;;
  464. stf.spill.nta [loc0]=f111,-256
  465. stf.spill.nta [loc1]=f103,-256
  466. ;;
  467. stf.spill.nta [loc0]=f95,-256
  468. stf.spill.nta [loc1]=f87,-256
  469. ;;
  470. stf.spill.nta [loc0]=f79,-256
  471. stf.spill.nta [loc1]=f71,-256
  472. ;;
  473. stf.spill.nta [loc0]=f63,-256
  474. stf.spill.nta [loc1]=f55,-256
  475. adds loc2=96*16-32,in0
  476. ;;
  477. stf.spill.nta [loc0]=f47,-256
  478. stf.spill.nta [loc1]=f39,-256
  479. adds loc3=96*16-32-128,in0
  480. ;;
  481. stf.spill.nta [loc2]=f126,-256
  482. stf.spill.nta [loc3]=f118,-256
  483. ;;
  484. stf.spill.nta [loc2]=f110,-256
  485. stf.spill.nta [loc3]=f102,-256
  486. ;;
  487. stf.spill.nta [loc2]=f94,-256
  488. stf.spill.nta [loc3]=f86,-256
  489. ;;
  490. stf.spill.nta [loc2]=f78,-256
  491. stf.spill.nta [loc3]=f70,-256
  492. ;;
  493. stf.spill.nta [loc2]=f62,-256
  494. stf.spill.nta [loc3]=f54,-256
  495. adds loc0=96*16-48,in0
  496. ;;
  497. stf.spill.nta [loc2]=f46,-256
  498. stf.spill.nta [loc3]=f38,-256
  499. adds loc1=96*16-48-128,in0
  500. ;;
  501. stf.spill.nta [loc0]=f125,-256
  502. stf.spill.nta [loc1]=f117,-256
  503. ;;
  504. stf.spill.nta [loc0]=f109,-256
  505. stf.spill.nta [loc1]=f101,-256
  506. ;;
  507. stf.spill.nta [loc0]=f93,-256
  508. stf.spill.nta [loc1]=f85,-256
  509. ;;
  510. stf.spill.nta [loc0]=f77,-256
  511. stf.spill.nta [loc1]=f69,-256
  512. ;;
  513. stf.spill.nta [loc0]=f61,-256
  514. stf.spill.nta [loc1]=f53,-256
  515. adds loc2=96*16-64,in0
  516. ;;
  517. stf.spill.nta [loc0]=f45,-256
  518. stf.spill.nta [loc1]=f37,-256
  519. adds loc3=96*16-64-128,in0
  520. ;;
  521. stf.spill.nta [loc2]=f124,-256
  522. stf.spill.nta [loc3]=f116,-256
  523. ;;
  524. stf.spill.nta [loc2]=f108,-256
  525. stf.spill.nta [loc3]=f100,-256
  526. ;;
  527. stf.spill.nta [loc2]=f92,-256
  528. stf.spill.nta [loc3]=f84,-256
  529. ;;
  530. stf.spill.nta [loc2]=f76,-256
  531. stf.spill.nta [loc3]=f68,-256
  532. ;;
  533. stf.spill.nta [loc2]=f60,-256
  534. stf.spill.nta [loc3]=f52,-256
  535. adds loc0=96*16-80,in0
  536. ;;
  537. stf.spill.nta [loc2]=f44,-256
  538. stf.spill.nta [loc3]=f36,-256
  539. adds loc1=96*16-80-128,in0
  540. ;;
  541. stf.spill.nta [loc0]=f123,-256
  542. stf.spill.nta [loc1]=f115,-256
  543. ;;
  544. stf.spill.nta [loc0]=f107,-256
  545. stf.spill.nta [loc1]=f99,-256
  546. ;;
  547. stf.spill.nta [loc0]=f91,-256
  548. stf.spill.nta [loc1]=f83,-256
  549. ;;
  550. stf.spill.nta [loc0]=f75,-256
  551. stf.spill.nta [loc1]=f67,-256
  552. ;;
  553. stf.spill.nta [loc0]=f59,-256
  554. stf.spill.nta [loc1]=f51,-256
  555. adds loc2=96*16-96,in0
  556. ;;
  557. stf.spill.nta [loc0]=f43,-256
  558. stf.spill.nta [loc1]=f35,-256
  559. adds loc3=96*16-96-128,in0
  560. ;;
  561. stf.spill.nta [loc2]=f122,-256
  562. stf.spill.nta [loc3]=f114,-256
  563. ;;
  564. stf.spill.nta [loc2]=f106,-256
  565. stf.spill.nta [loc3]=f98,-256
  566. ;;
  567. stf.spill.nta [loc2]=f90,-256
  568. stf.spill.nta [loc3]=f82,-256
  569. ;;
  570. stf.spill.nta [loc2]=f74,-256
  571. stf.spill.nta [loc3]=f66,-256
  572. ;;
  573. stf.spill.nta [loc2]=f58,-256
  574. stf.spill.nta [loc3]=f50,-256
  575. adds loc0=96*16-112,in0
  576. ;;
  577. stf.spill.nta [loc2]=f42,-256
  578. stf.spill.nta [loc3]=f34,-256
  579. adds loc1=96*16-112-128,in0
  580. ;;
  581. stf.spill.nta [loc0]=f121,-256
  582. stf.spill.nta [loc1]=f113,-256
  583. ;;
  584. stf.spill.nta [loc0]=f105,-256
  585. stf.spill.nta [loc1]=f97,-256
  586. ;;
  587. stf.spill.nta [loc0]=f89,-256
  588. stf.spill.nta [loc1]=f81,-256
  589. ;;
  590. stf.spill.nta [loc0]=f73,-256
  591. stf.spill.nta [loc1]=f65,-256
  592. ;;
  593. stf.spill.nta [loc0]=f57,-256
  594. stf.spill.nta [loc1]=f49,-256
  595. adds loc2=96*16-128,in0
  596. ;;
  597. stf.spill.nta [loc0]=f41,-256
  598. stf.spill.nta [loc1]=f33,-256
  599. adds loc3=96*16-128-128,in0
  600. ;;
  601. stf.spill.nta [loc2]=f120,-256
  602. stf.spill.nta [loc3]=f112,-256
  603. ;;
  604. stf.spill.nta [loc2]=f104,-256
  605. stf.spill.nta [loc3]=f96,-256
  606. ;;
  607. stf.spill.nta [loc2]=f88,-256
  608. stf.spill.nta [loc3]=f80,-256
  609. ;;
  610. stf.spill.nta [loc2]=f72,-256
  611. stf.spill.nta [loc3]=f64,-256
  612. ;;
  613. stf.spill.nta [loc2]=f56,-256
  614. stf.spill.nta [loc3]=f48,-256
  615. ;;
  616. stf.spill.nta [loc2]=f40
  617. stf.spill.nta [loc3]=f32
  618. br.ret.sptk.many rp
  619. END(__ia64_save_fpu)
  620. GLOBAL_ENTRY(__ia64_load_fpu)
  621. alloc r2=ar.pfs,1,2,0,0
  622. adds r3=128,in0
  623. adds r14=256,in0
  624. adds r15=384,in0
  625. mov loc0=512
  626. mov loc1=-1024+16
  627. ;;
  628. ldf.fill.nta f32=[in0],loc0
  629. ldf.fill.nta f40=[ r3],loc0
  630. ldf.fill.nta f48=[r14],loc0
  631. ldf.fill.nta f56=[r15],loc0
  632. ;;
  633. ldf.fill.nta f64=[in0],loc0
  634. ldf.fill.nta f72=[ r3],loc0
  635. ldf.fill.nta f80=[r14],loc0
  636. ldf.fill.nta f88=[r15],loc0
  637. ;;
  638. ldf.fill.nta f96=[in0],loc1
  639. ldf.fill.nta f104=[ r3],loc1
  640. ldf.fill.nta f112=[r14],loc1
  641. ldf.fill.nta f120=[r15],loc1
  642. ;;
  643. ldf.fill.nta f33=[in0],loc0
  644. ldf.fill.nta f41=[ r3],loc0
  645. ldf.fill.nta f49=[r14],loc0
  646. ldf.fill.nta f57=[r15],loc0
  647. ;;
  648. ldf.fill.nta f65=[in0],loc0
  649. ldf.fill.nta f73=[ r3],loc0
  650. ldf.fill.nta f81=[r14],loc0
  651. ldf.fill.nta f89=[r15],loc0
  652. ;;
  653. ldf.fill.nta f97=[in0],loc1
  654. ldf.fill.nta f105=[ r3],loc1
  655. ldf.fill.nta f113=[r14],loc1
  656. ldf.fill.nta f121=[r15],loc1
  657. ;;
  658. ldf.fill.nta f34=[in0],loc0
  659. ldf.fill.nta f42=[ r3],loc0
  660. ldf.fill.nta f50=[r14],loc0
  661. ldf.fill.nta f58=[r15],loc0
  662. ;;
  663. ldf.fill.nta f66=[in0],loc0
  664. ldf.fill.nta f74=[ r3],loc0
  665. ldf.fill.nta f82=[r14],loc0
  666. ldf.fill.nta f90=[r15],loc0
  667. ;;
  668. ldf.fill.nta f98=[in0],loc1
  669. ldf.fill.nta f106=[ r3],loc1
  670. ldf.fill.nta f114=[r14],loc1
  671. ldf.fill.nta f122=[r15],loc1
  672. ;;
  673. ldf.fill.nta f35=[in0],loc0
  674. ldf.fill.nta f43=[ r3],loc0
  675. ldf.fill.nta f51=[r14],loc0
  676. ldf.fill.nta f59=[r15],loc0
  677. ;;
  678. ldf.fill.nta f67=[in0],loc0
  679. ldf.fill.nta f75=[ r3],loc0
  680. ldf.fill.nta f83=[r14],loc0
  681. ldf.fill.nta f91=[r15],loc0
  682. ;;
  683. ldf.fill.nta f99=[in0],loc1
  684. ldf.fill.nta f107=[ r3],loc1
  685. ldf.fill.nta f115=[r14],loc1
  686. ldf.fill.nta f123=[r15],loc1
  687. ;;
  688. ldf.fill.nta f36=[in0],loc0
  689. ldf.fill.nta f44=[ r3],loc0
  690. ldf.fill.nta f52=[r14],loc0
  691. ldf.fill.nta f60=[r15],loc0
  692. ;;
  693. ldf.fill.nta f68=[in0],loc0
  694. ldf.fill.nta f76=[ r3],loc0
  695. ldf.fill.nta f84=[r14],loc0
  696. ldf.fill.nta f92=[r15],loc0
  697. ;;
  698. ldf.fill.nta f100=[in0],loc1
  699. ldf.fill.nta f108=[ r3],loc1
  700. ldf.fill.nta f116=[r14],loc1
  701. ldf.fill.nta f124=[r15],loc1
  702. ;;
  703. ldf.fill.nta f37=[in0],loc0
  704. ldf.fill.nta f45=[ r3],loc0
  705. ldf.fill.nta f53=[r14],loc0
  706. ldf.fill.nta f61=[r15],loc0
  707. ;;
  708. ldf.fill.nta f69=[in0],loc0
  709. ldf.fill.nta f77=[ r3],loc0
  710. ldf.fill.nta f85=[r14],loc0
  711. ldf.fill.nta f93=[r15],loc0
  712. ;;
  713. ldf.fill.nta f101=[in0],loc1
  714. ldf.fill.nta f109=[ r3],loc1
  715. ldf.fill.nta f117=[r14],loc1
  716. ldf.fill.nta f125=[r15],loc1
  717. ;;
  718. ldf.fill.nta f38 =[in0],loc0
  719. ldf.fill.nta f46 =[ r3],loc0
  720. ldf.fill.nta f54 =[r14],loc0
  721. ldf.fill.nta f62 =[r15],loc0
  722. ;;
  723. ldf.fill.nta f70 =[in0],loc0
  724. ldf.fill.nta f78 =[ r3],loc0
  725. ldf.fill.nta f86 =[r14],loc0
  726. ldf.fill.nta f94 =[r15],loc0
  727. ;;
  728. ldf.fill.nta f102=[in0],loc1
  729. ldf.fill.nta f110=[ r3],loc1
  730. ldf.fill.nta f118=[r14],loc1
  731. ldf.fill.nta f126=[r15],loc1
  732. ;;
  733. ldf.fill.nta f39 =[in0],loc0
  734. ldf.fill.nta f47 =[ r3],loc0
  735. ldf.fill.nta f55 =[r14],loc0
  736. ldf.fill.nta f63 =[r15],loc0
  737. ;;
  738. ldf.fill.nta f71 =[in0],loc0
  739. ldf.fill.nta f79 =[ r3],loc0
  740. ldf.fill.nta f87 =[r14],loc0
  741. ldf.fill.nta f95 =[r15],loc0
  742. ;;
  743. ldf.fill.nta f103=[in0]
  744. ldf.fill.nta f111=[ r3]
  745. ldf.fill.nta f119=[r14]
  746. ldf.fill.nta f127=[r15]
  747. br.ret.sptk.many rp
  748. END(__ia64_load_fpu)
  749. GLOBAL_ENTRY(__ia64_init_fpu)
  750. stf.spill [sp]=f0 // M3
  751. mov f32=f0 // F
  752. nop.b 0
  753. ldfps f33,f34=[sp] // M0
  754. ldfps f35,f36=[sp] // M1
  755. mov f37=f0 // F
  756. ;;
  757. setf.s f38=r0 // M2
  758. setf.s f39=r0 // M3
  759. mov f40=f0 // F
  760. ldfps f41,f42=[sp] // M0
  761. ldfps f43,f44=[sp] // M1
  762. mov f45=f0 // F
  763. setf.s f46=r0 // M2
  764. setf.s f47=r0 // M3
  765. mov f48=f0 // F
  766. ldfps f49,f50=[sp] // M0
  767. ldfps f51,f52=[sp] // M1
  768. mov f53=f0 // F
  769. setf.s f54=r0 // M2
  770. setf.s f55=r0 // M3
  771. mov f56=f0 // F
  772. ldfps f57,f58=[sp] // M0
  773. ldfps f59,f60=[sp] // M1
  774. mov f61=f0 // F
  775. setf.s f62=r0 // M2
  776. setf.s f63=r0 // M3
  777. mov f64=f0 // F
  778. ldfps f65,f66=[sp] // M0
  779. ldfps f67,f68=[sp] // M1
  780. mov f69=f0 // F
  781. setf.s f70=r0 // M2
  782. setf.s f71=r0 // M3
  783. mov f72=f0 // F
  784. ldfps f73,f74=[sp] // M0
  785. ldfps f75,f76=[sp] // M1
  786. mov f77=f0 // F
  787. setf.s f78=r0 // M2
  788. setf.s f79=r0 // M3
  789. mov f80=f0 // F
  790. ldfps f81,f82=[sp] // M0
  791. ldfps f83,f84=[sp] // M1
  792. mov f85=f0 // F
  793. setf.s f86=r0 // M2
  794. setf.s f87=r0 // M3
  795. mov f88=f0 // F
  796. /*
  797. * When the instructions are cached, it would be faster to initialize
  798. * the remaining registers with simply mov instructions (F-unit).
  799. * This gets the time down to ~29 cycles. However, this would use up
  800. * 33 bundles, whereas continuing with the above pattern yields
  801. * 10 bundles and ~30 cycles.
  802. */
  803. ldfps f89,f90=[sp] // M0
  804. ldfps f91,f92=[sp] // M1
  805. mov f93=f0 // F
  806. setf.s f94=r0 // M2
  807. setf.s f95=r0 // M3
  808. mov f96=f0 // F
  809. ldfps f97,f98=[sp] // M0
  810. ldfps f99,f100=[sp] // M1
  811. mov f101=f0 // F
  812. setf.s f102=r0 // M2
  813. setf.s f103=r0 // M3
  814. mov f104=f0 // F
  815. ldfps f105,f106=[sp] // M0
  816. ldfps f107,f108=[sp] // M1
  817. mov f109=f0 // F
  818. setf.s f110=r0 // M2
  819. setf.s f111=r0 // M3
  820. mov f112=f0 // F
  821. ldfps f113,f114=[sp] // M0
  822. ldfps f115,f116=[sp] // M1
  823. mov f117=f0 // F
  824. setf.s f118=r0 // M2
  825. setf.s f119=r0 // M3
  826. mov f120=f0 // F
  827. ldfps f121,f122=[sp] // M0
  828. ldfps f123,f124=[sp] // M1
  829. mov f125=f0 // F
  830. setf.s f126=r0 // M2
  831. setf.s f127=r0 // M3
  832. br.ret.sptk.many rp // F
  833. END(__ia64_init_fpu)
  834. /*
  835. * Switch execution mode from virtual to physical
  836. *
  837. * Inputs:
  838. * r16 = new psr to establish
  839. * Output:
  840. * r19 = old virtual address of ar.bsp
  841. * r20 = old virtual address of sp
  842. *
  843. * Note: RSE must already be in enforced lazy mode
  844. */
  845. GLOBAL_ENTRY(ia64_switch_mode_phys)
  846. {
  847. rsm psr.i | psr.ic // disable interrupts and interrupt collection
  848. mov r15=ip
  849. }
  850. ;;
  851. {
  852. flushrs // must be first insn in group
  853. srlz.i
  854. }
  855. ;;
  856. mov cr.ipsr=r16 // set new PSR
  857. add r3=1f-ia64_switch_mode_phys,r15
  858. mov r19=ar.bsp
  859. mov r20=sp
  860. mov r14=rp // get return address into a general register
  861. ;;
  862. // going to physical mode, use tpa to translate virt->phys
  863. tpa r17=r19
  864. tpa r3=r3
  865. tpa sp=sp
  866. tpa r14=r14
  867. ;;
  868. mov r18=ar.rnat // save ar.rnat
  869. mov ar.bspstore=r17 // this steps on ar.rnat
  870. mov cr.iip=r3
  871. mov cr.ifs=r0
  872. ;;
  873. mov ar.rnat=r18 // restore ar.rnat
  874. rfi // must be last insn in group
  875. ;;
  876. 1: mov rp=r14
  877. br.ret.sptk.many rp
  878. END(ia64_switch_mode_phys)
  879. /*
  880. * Switch execution mode from physical to virtual
  881. *
  882. * Inputs:
  883. * r16 = new psr to establish
  884. * r19 = new bspstore to establish
  885. * r20 = new sp to establish
  886. *
  887. * Note: RSE must already be in enforced lazy mode
  888. */
  889. GLOBAL_ENTRY(ia64_switch_mode_virt)
  890. {
  891. rsm psr.i | psr.ic // disable interrupts and interrupt collection
  892. mov r15=ip
  893. }
  894. ;;
  895. {
  896. flushrs // must be first insn in group
  897. srlz.i
  898. }
  899. ;;
  900. mov cr.ipsr=r16 // set new PSR
  901. add r3=1f-ia64_switch_mode_virt,r15
  902. mov r14=rp // get return address into a general register
  903. ;;
  904. // going to virtual
  905. // - for code addresses, set upper bits of addr to KERNEL_START
  906. // - for stack addresses, copy from input argument
  907. movl r18=KERNEL_START
  908. dep r3=0,r3,KERNEL_TR_PAGE_SHIFT,64-KERNEL_TR_PAGE_SHIFT
  909. dep r14=0,r14,KERNEL_TR_PAGE_SHIFT,64-KERNEL_TR_PAGE_SHIFT
  910. mov sp=r20
  911. ;;
  912. or r3=r3,r18
  913. or r14=r14,r18
  914. ;;
  915. mov r18=ar.rnat // save ar.rnat
  916. mov ar.bspstore=r19 // this steps on ar.rnat
  917. mov cr.iip=r3
  918. mov cr.ifs=r0
  919. ;;
  920. mov ar.rnat=r18 // restore ar.rnat
  921. rfi // must be last insn in group
  922. ;;
  923. 1: mov rp=r14
  924. br.ret.sptk.many rp
  925. END(ia64_switch_mode_virt)
  926. GLOBAL_ENTRY(ia64_delay_loop)
  927. .prologue
  928. { nop 0 // work around GAS unwind info generation bug...
  929. .save ar.lc,r2
  930. mov r2=ar.lc
  931. .body
  932. ;;
  933. mov ar.lc=r32
  934. }
  935. ;;
  936. // force loop to be 32-byte aligned (GAS bug means we cannot use .align
  937. // inside function body without corrupting unwind info).
  938. { nop 0 }
  939. 1: br.cloop.sptk.few 1b
  940. ;;
  941. mov ar.lc=r2
  942. br.ret.sptk.many rp
  943. END(ia64_delay_loop)
  944. /*
  945. * Return a CPU-local timestamp in nano-seconds. This timestamp is
  946. * NOT synchronized across CPUs its return value must never be
  947. * compared against the values returned on another CPU. The usage in
  948. * kernel/sched.c ensures that.
  949. *
  950. * The return-value of sched_clock() is NOT supposed to wrap-around.
  951. * If it did, it would cause some scheduling hiccups (at the worst).
  952. * Fortunately, with a 64-bit cycle-counter ticking at 100GHz, even
  953. * that would happen only once every 5+ years.
  954. *
  955. * The code below basically calculates:
  956. *
  957. * (ia64_get_itc() * local_cpu_data->nsec_per_cyc) >> IA64_NSEC_PER_CYC_SHIFT
  958. *
  959. * except that the multiplication and the shift are done with 128-bit
  960. * intermediate precision so that we can produce a full 64-bit result.
  961. */
  962. GLOBAL_ENTRY(sched_clock)
  963. addl r8=THIS_CPU(cpu_info) + IA64_CPUINFO_NSEC_PER_CYC_OFFSET,r0
  964. mov.m r9=ar.itc // fetch cycle-counter (35 cyc)
  965. ;;
  966. ldf8 f8=[r8]
  967. ;;
  968. setf.sig f9=r9 // certain to stall, so issue it _after_ ldf8...
  969. ;;
  970. xmpy.lu f10=f9,f8 // calculate low 64 bits of 128-bit product (4 cyc)
  971. xmpy.hu f11=f9,f8 // calculate high 64 bits of 128-bit product
  972. ;;
  973. getf.sig r8=f10 // (5 cyc)
  974. getf.sig r9=f11
  975. ;;
  976. shrp r8=r9,r8,IA64_NSEC_PER_CYC_SHIFT
  977. br.ret.sptk.many rp
  978. END(sched_clock)
  979. #ifdef CONFIG_VIRT_CPU_ACCOUNTING
  980. GLOBAL_ENTRY(cycle_to_cputime)
  981. alloc r16=ar.pfs,1,0,0,0
  982. addl r8=THIS_CPU(cpu_info) + IA64_CPUINFO_NSEC_PER_CYC_OFFSET,r0
  983. ;;
  984. ldf8 f8=[r8]
  985. ;;
  986. setf.sig f9=r32
  987. ;;
  988. xmpy.lu f10=f9,f8 // calculate low 64 bits of 128-bit product (4 cyc)
  989. xmpy.hu f11=f9,f8 // calculate high 64 bits of 128-bit product
  990. ;;
  991. getf.sig r8=f10 // (5 cyc)
  992. getf.sig r9=f11
  993. ;;
  994. shrp r8=r9,r8,IA64_NSEC_PER_CYC_SHIFT
  995. br.ret.sptk.many rp
  996. END(cycle_to_cputime)
  997. #endif /* CONFIG_VIRT_CPU_ACCOUNTING */
  998. GLOBAL_ENTRY(start_kernel_thread)
  999. .prologue
  1000. .save rp, r0 // this is the end of the call-chain
  1001. .body
  1002. alloc r2 = ar.pfs, 0, 0, 2, 0
  1003. mov out0 = r9
  1004. mov out1 = r11;;
  1005. br.call.sptk.many rp = kernel_thread_helper;;
  1006. mov out0 = r8
  1007. br.call.sptk.many rp = sys_exit;;
  1008. 1: br.sptk.few 1b // not reached
  1009. END(start_kernel_thread)
  1010. #ifdef CONFIG_IA64_BRL_EMU
  1011. /*
  1012. * Assembly routines used by brl_emu.c to set preserved register state.
  1013. */
  1014. #define SET_REG(reg) \
  1015. GLOBAL_ENTRY(ia64_set_##reg); \
  1016. alloc r16=ar.pfs,1,0,0,0; \
  1017. mov reg=r32; \
  1018. ;; \
  1019. br.ret.sptk.many rp; \
  1020. END(ia64_set_##reg)
  1021. SET_REG(b1);
  1022. SET_REG(b2);
  1023. SET_REG(b3);
  1024. SET_REG(b4);
  1025. SET_REG(b5);
  1026. #endif /* CONFIG_IA64_BRL_EMU */
  1027. #ifdef CONFIG_SMP
  1028. /*
  1029. * This routine handles spinlock contention. It uses a non-standard calling
  1030. * convention to avoid converting leaf routines into interior routines. Because
  1031. * of this special convention, there are several restrictions:
  1032. *
  1033. * - do not use gp relative variables, this code is called from the kernel
  1034. * and from modules, r1 is undefined.
  1035. * - do not use stacked registers, the caller owns them.
  1036. * - do not use the scratch stack space, the caller owns it.
  1037. * - do not use any registers other than the ones listed below
  1038. *
  1039. * Inputs:
  1040. * ar.pfs - saved CFM of caller
  1041. * ar.ccv - 0 (and available for use)
  1042. * r27 - flags from spin_lock_irqsave or 0. Must be preserved.
  1043. * r28 - available for use.
  1044. * r29 - available for use.
  1045. * r30 - available for use.
  1046. * r31 - address of lock, available for use.
  1047. * b6 - return address
  1048. * p14 - available for use.
  1049. * p15 - used to track flag status.
  1050. *
  1051. * If you patch this code to use more registers, do not forget to update
  1052. * the clobber lists for spin_lock() in arch/ia64/include/asm/spinlock.h.
  1053. */
  1054. #if (__GNUC__ == 3 && __GNUC_MINOR__ < 3)
  1055. GLOBAL_ENTRY(ia64_spinlock_contention_pre3_4)
  1056. .prologue
  1057. .save ar.pfs, r0 // this code effectively has a zero frame size
  1058. .save rp, r28
  1059. .body
  1060. nop 0
  1061. tbit.nz p15,p0=r27,IA64_PSR_I_BIT
  1062. .restore sp // pop existing prologue after next insn
  1063. mov b6 = r28
  1064. .prologue
  1065. .save ar.pfs, r0
  1066. .altrp b6
  1067. .body
  1068. ;;
  1069. (p15) ssm psr.i // reenable interrupts if they were on
  1070. // DavidM says that srlz.d is slow and is not required in this case
  1071. .wait:
  1072. // exponential backoff, kdb, lockmeter etc. go in here
  1073. hint @pause
  1074. ld4 r30=[r31] // don't use ld4.bias; if it's contended, we won't write the word
  1075. nop 0
  1076. ;;
  1077. cmp4.ne p14,p0=r30,r0
  1078. (p14) br.cond.sptk.few .wait
  1079. (p15) rsm psr.i // disable interrupts if we reenabled them
  1080. br.cond.sptk.few b6 // lock is now free, try to acquire
  1081. .global ia64_spinlock_contention_pre3_4_end // for kernprof
  1082. ia64_spinlock_contention_pre3_4_end:
  1083. END(ia64_spinlock_contention_pre3_4)
  1084. #else
  1085. GLOBAL_ENTRY(ia64_spinlock_contention)
  1086. .prologue
  1087. .altrp b6
  1088. .body
  1089. tbit.nz p15,p0=r27,IA64_PSR_I_BIT
  1090. ;;
  1091. .wait:
  1092. (p15) ssm psr.i // reenable interrupts if they were on
  1093. // DavidM says that srlz.d is slow and is not required in this case
  1094. .wait2:
  1095. // exponential backoff, kdb, lockmeter etc. go in here
  1096. hint @pause
  1097. ld4 r30=[r31] // don't use ld4.bias; if it's contended, we won't write the word
  1098. ;;
  1099. cmp4.ne p14,p0=r30,r0
  1100. mov r30 = 1
  1101. (p14) br.cond.sptk.few .wait2
  1102. (p15) rsm psr.i // disable interrupts if we reenabled them
  1103. ;;
  1104. cmpxchg4.acq r30=[r31], r30, ar.ccv
  1105. ;;
  1106. cmp4.ne p14,p0=r0,r30
  1107. (p14) br.cond.sptk.few .wait
  1108. br.ret.sptk.many b6 // lock is now taken
  1109. END(ia64_spinlock_contention)
  1110. #endif
  1111. #ifdef CONFIG_HOTPLUG_CPU
  1112. GLOBAL_ENTRY(ia64_jump_to_sal)
  1113. alloc r16=ar.pfs,1,0,0,0;;
  1114. rsm psr.i | psr.ic
  1115. {
  1116. flushrs
  1117. srlz.i
  1118. }
  1119. tpa r25=in0
  1120. movl r18=tlb_purge_done;;
  1121. DATA_VA_TO_PA(r18);;
  1122. mov b1=r18 // Return location
  1123. movl r18=ia64_do_tlb_purge;;
  1124. DATA_VA_TO_PA(r18);;
  1125. mov b2=r18 // doing tlb_flush work
  1126. mov ar.rsc=0 // Put RSE in enforced lazy, LE mode
  1127. movl r17=1f;;
  1128. DATA_VA_TO_PA(r17);;
  1129. mov cr.iip=r17
  1130. movl r16=SAL_PSR_BITS_TO_SET;;
  1131. mov cr.ipsr=r16
  1132. mov cr.ifs=r0;;
  1133. rfi;;
  1134. 1:
  1135. /*
  1136. * Invalidate all TLB data/inst
  1137. */
  1138. br.sptk.many b2;; // jump to tlb purge code
  1139. tlb_purge_done:
  1140. RESTORE_REGION_REGS(r25, r17,r18,r19);;
  1141. RESTORE_REG(b0, r25, r17);;
  1142. RESTORE_REG(b1, r25, r17);;
  1143. RESTORE_REG(b2, r25, r17);;
  1144. RESTORE_REG(b3, r25, r17);;
  1145. RESTORE_REG(b4, r25, r17);;
  1146. RESTORE_REG(b5, r25, r17);;
  1147. ld8 r1=[r25],0x08;;
  1148. ld8 r12=[r25],0x08;;
  1149. ld8 r13=[r25],0x08;;
  1150. RESTORE_REG(ar.fpsr, r25, r17);;
  1151. RESTORE_REG(ar.pfs, r25, r17);;
  1152. RESTORE_REG(ar.rnat, r25, r17);;
  1153. RESTORE_REG(ar.unat, r25, r17);;
  1154. RESTORE_REG(ar.bspstore, r25, r17);;
  1155. RESTORE_REG(cr.dcr, r25, r17);;
  1156. RESTORE_REG(cr.iva, r25, r17);;
  1157. RESTORE_REG(cr.pta, r25, r17);;
  1158. srlz.d;; // required not to violate RAW dependency
  1159. RESTORE_REG(cr.itv, r25, r17);;
  1160. RESTORE_REG(cr.pmv, r25, r17);;
  1161. RESTORE_REG(cr.cmcv, r25, r17);;
  1162. RESTORE_REG(cr.lrr0, r25, r17);;
  1163. RESTORE_REG(cr.lrr1, r25, r17);;
  1164. ld8 r4=[r25],0x08;;
  1165. ld8 r5=[r25],0x08;;
  1166. ld8 r6=[r25],0x08;;
  1167. ld8 r7=[r25],0x08;;
  1168. ld8 r17=[r25],0x08;;
  1169. mov pr=r17,-1;;
  1170. RESTORE_REG(ar.lc, r25, r17);;
  1171. /*
  1172. * Now Restore floating point regs
  1173. */
  1174. ldf.fill.nta f2=[r25],16;;
  1175. ldf.fill.nta f3=[r25],16;;
  1176. ldf.fill.nta f4=[r25],16;;
  1177. ldf.fill.nta f5=[r25],16;;
  1178. ldf.fill.nta f16=[r25],16;;
  1179. ldf.fill.nta f17=[r25],16;;
  1180. ldf.fill.nta f18=[r25],16;;
  1181. ldf.fill.nta f19=[r25],16;;
  1182. ldf.fill.nta f20=[r25],16;;
  1183. ldf.fill.nta f21=[r25],16;;
  1184. ldf.fill.nta f22=[r25],16;;
  1185. ldf.fill.nta f23=[r25],16;;
  1186. ldf.fill.nta f24=[r25],16;;
  1187. ldf.fill.nta f25=[r25],16;;
  1188. ldf.fill.nta f26=[r25],16;;
  1189. ldf.fill.nta f27=[r25],16;;
  1190. ldf.fill.nta f28=[r25],16;;
  1191. ldf.fill.nta f29=[r25],16;;
  1192. ldf.fill.nta f30=[r25],16;;
  1193. ldf.fill.nta f31=[r25],16;;
  1194. /*
  1195. * Now that we have done all the register restores
  1196. * we are now ready for the big DIVE to SAL Land
  1197. */
  1198. ssm psr.ic;;
  1199. srlz.d;;
  1200. br.ret.sptk.many b0;;
  1201. END(ia64_jump_to_sal)
  1202. #endif /* CONFIG_HOTPLUG_CPU */
  1203. #endif /* CONFIG_SMP */