paravirt.c 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903
  1. /******************************************************************************
  2. * arch/ia64/kernel/paravirt.c
  3. *
  4. * Copyright (c) 2008 Isaku Yamahata <yamahata at valinux co jp>
  5. * VA Linux Systems Japan K.K.
  6. * Yaozu (Eddie) Dong <eddie.dong@intel.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 as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  21. *
  22. */
  23. #include <linux/init.h>
  24. #include <linux/compiler.h>
  25. #include <linux/io.h>
  26. #include <linux/irq.h>
  27. #include <linux/module.h>
  28. #include <linux/types.h>
  29. #include <asm/iosapic.h>
  30. #include <asm/paravirt.h>
  31. /***************************************************************************
  32. * general info
  33. */
  34. struct pv_info pv_info = {
  35. .kernel_rpl = 0,
  36. .paravirt_enabled = 0,
  37. .name = "bare hardware"
  38. };
  39. /***************************************************************************
  40. * pv_init_ops
  41. * initialization hooks.
  42. */
  43. static void __init
  44. ia64_native_patch_branch(unsigned long tag, unsigned long type);
  45. struct pv_init_ops pv_init_ops =
  46. {
  47. #ifdef ASM_SUPPORTED
  48. .patch_bundle = ia64_native_patch_bundle,
  49. #endif
  50. .patch_branch = ia64_native_patch_branch,
  51. };
  52. /***************************************************************************
  53. * pv_cpu_ops
  54. * intrinsics hooks.
  55. */
  56. #ifndef ASM_SUPPORTED
  57. /* ia64_native_xxx are macros so that we have to make them real functions */
  58. #define DEFINE_VOID_FUNC1(name) \
  59. static void \
  60. ia64_native_ ## name ## _func(unsigned long arg) \
  61. { \
  62. ia64_native_ ## name(arg); \
  63. }
  64. #define DEFINE_VOID_FUNC1_VOID(name) \
  65. static void \
  66. ia64_native_ ## name ## _func(void *arg) \
  67. { \
  68. ia64_native_ ## name(arg); \
  69. }
  70. #define DEFINE_VOID_FUNC2(name) \
  71. static void \
  72. ia64_native_ ## name ## _func(unsigned long arg0, \
  73. unsigned long arg1) \
  74. { \
  75. ia64_native_ ## name(arg0, arg1); \
  76. }
  77. #define DEFINE_FUNC0(name) \
  78. static unsigned long \
  79. ia64_native_ ## name ## _func(void) \
  80. { \
  81. return ia64_native_ ## name(); \
  82. }
  83. #define DEFINE_FUNC1(name, type) \
  84. static unsigned long \
  85. ia64_native_ ## name ## _func(type arg) \
  86. { \
  87. return ia64_native_ ## name(arg); \
  88. } \
  89. DEFINE_VOID_FUNC1_VOID(fc);
  90. DEFINE_VOID_FUNC1(intrin_local_irq_restore);
  91. DEFINE_VOID_FUNC2(ptcga);
  92. DEFINE_VOID_FUNC2(set_rr);
  93. DEFINE_FUNC0(get_psr_i);
  94. DEFINE_FUNC1(thash, unsigned long);
  95. DEFINE_FUNC1(get_cpuid, int);
  96. DEFINE_FUNC1(get_pmd, int);
  97. DEFINE_FUNC1(get_rr, unsigned long);
  98. static void
  99. ia64_native_ssm_i_func(void)
  100. {
  101. ia64_native_ssm(IA64_PSR_I);
  102. }
  103. static void
  104. ia64_native_rsm_i_func(void)
  105. {
  106. ia64_native_rsm(IA64_PSR_I);
  107. }
  108. static void
  109. ia64_native_set_rr0_to_rr4_func(unsigned long val0, unsigned long val1,
  110. unsigned long val2, unsigned long val3,
  111. unsigned long val4)
  112. {
  113. ia64_native_set_rr0_to_rr4(val0, val1, val2, val3, val4);
  114. }
  115. #define CASE_GET_REG(id) \
  116. case _IA64_REG_ ## id: \
  117. res = ia64_native_getreg(_IA64_REG_ ## id); \
  118. break;
  119. #define CASE_GET_AR(id) CASE_GET_REG(AR_ ## id)
  120. #define CASE_GET_CR(id) CASE_GET_REG(CR_ ## id)
  121. unsigned long
  122. ia64_native_getreg_func(int regnum)
  123. {
  124. unsigned long res = -1;
  125. switch (regnum) {
  126. CASE_GET_REG(GP);
  127. /*CASE_GET_REG(IP);*/ /* returned ip value shouldn't be constant */
  128. CASE_GET_REG(PSR);
  129. CASE_GET_REG(TP);
  130. CASE_GET_REG(SP);
  131. CASE_GET_AR(KR0);
  132. CASE_GET_AR(KR1);
  133. CASE_GET_AR(KR2);
  134. CASE_GET_AR(KR3);
  135. CASE_GET_AR(KR4);
  136. CASE_GET_AR(KR5);
  137. CASE_GET_AR(KR6);
  138. CASE_GET_AR(KR7);
  139. CASE_GET_AR(RSC);
  140. CASE_GET_AR(BSP);
  141. CASE_GET_AR(BSPSTORE);
  142. CASE_GET_AR(RNAT);
  143. CASE_GET_AR(FCR);
  144. CASE_GET_AR(EFLAG);
  145. CASE_GET_AR(CSD);
  146. CASE_GET_AR(SSD);
  147. CASE_GET_AR(CFLAG);
  148. CASE_GET_AR(FSR);
  149. CASE_GET_AR(FIR);
  150. CASE_GET_AR(FDR);
  151. CASE_GET_AR(CCV);
  152. CASE_GET_AR(UNAT);
  153. CASE_GET_AR(FPSR);
  154. CASE_GET_AR(ITC);
  155. CASE_GET_AR(PFS);
  156. CASE_GET_AR(LC);
  157. CASE_GET_AR(EC);
  158. CASE_GET_CR(DCR);
  159. CASE_GET_CR(ITM);
  160. CASE_GET_CR(IVA);
  161. CASE_GET_CR(PTA);
  162. CASE_GET_CR(IPSR);
  163. CASE_GET_CR(ISR);
  164. CASE_GET_CR(IIP);
  165. CASE_GET_CR(IFA);
  166. CASE_GET_CR(ITIR);
  167. CASE_GET_CR(IIPA);
  168. CASE_GET_CR(IFS);
  169. CASE_GET_CR(IIM);
  170. CASE_GET_CR(IHA);
  171. CASE_GET_CR(LID);
  172. CASE_GET_CR(IVR);
  173. CASE_GET_CR(TPR);
  174. CASE_GET_CR(EOI);
  175. CASE_GET_CR(IRR0);
  176. CASE_GET_CR(IRR1);
  177. CASE_GET_CR(IRR2);
  178. CASE_GET_CR(IRR3);
  179. CASE_GET_CR(ITV);
  180. CASE_GET_CR(PMV);
  181. CASE_GET_CR(CMCV);
  182. CASE_GET_CR(LRR0);
  183. CASE_GET_CR(LRR1);
  184. default:
  185. printk(KERN_CRIT "wrong_getreg %d\n", regnum);
  186. break;
  187. }
  188. return res;
  189. }
  190. #define CASE_SET_REG(id) \
  191. case _IA64_REG_ ## id: \
  192. ia64_native_setreg(_IA64_REG_ ## id, val); \
  193. break;
  194. #define CASE_SET_AR(id) CASE_SET_REG(AR_ ## id)
  195. #define CASE_SET_CR(id) CASE_SET_REG(CR_ ## id)
  196. void
  197. ia64_native_setreg_func(int regnum, unsigned long val)
  198. {
  199. switch (regnum) {
  200. case _IA64_REG_PSR_L:
  201. ia64_native_setreg(_IA64_REG_PSR_L, val);
  202. ia64_dv_serialize_data();
  203. break;
  204. CASE_SET_REG(SP);
  205. CASE_SET_REG(GP);
  206. CASE_SET_AR(KR0);
  207. CASE_SET_AR(KR1);
  208. CASE_SET_AR(KR2);
  209. CASE_SET_AR(KR3);
  210. CASE_SET_AR(KR4);
  211. CASE_SET_AR(KR5);
  212. CASE_SET_AR(KR6);
  213. CASE_SET_AR(KR7);
  214. CASE_SET_AR(RSC);
  215. CASE_SET_AR(BSP);
  216. CASE_SET_AR(BSPSTORE);
  217. CASE_SET_AR(RNAT);
  218. CASE_SET_AR(FCR);
  219. CASE_SET_AR(EFLAG);
  220. CASE_SET_AR(CSD);
  221. CASE_SET_AR(SSD);
  222. CASE_SET_AR(CFLAG);
  223. CASE_SET_AR(FSR);
  224. CASE_SET_AR(FIR);
  225. CASE_SET_AR(FDR);
  226. CASE_SET_AR(CCV);
  227. CASE_SET_AR(UNAT);
  228. CASE_SET_AR(FPSR);
  229. CASE_SET_AR(ITC);
  230. CASE_SET_AR(PFS);
  231. CASE_SET_AR(LC);
  232. CASE_SET_AR(EC);
  233. CASE_SET_CR(DCR);
  234. CASE_SET_CR(ITM);
  235. CASE_SET_CR(IVA);
  236. CASE_SET_CR(PTA);
  237. CASE_SET_CR(IPSR);
  238. CASE_SET_CR(ISR);
  239. CASE_SET_CR(IIP);
  240. CASE_SET_CR(IFA);
  241. CASE_SET_CR(ITIR);
  242. CASE_SET_CR(IIPA);
  243. CASE_SET_CR(IFS);
  244. CASE_SET_CR(IIM);
  245. CASE_SET_CR(IHA);
  246. CASE_SET_CR(LID);
  247. CASE_SET_CR(IVR);
  248. CASE_SET_CR(TPR);
  249. CASE_SET_CR(EOI);
  250. CASE_SET_CR(IRR0);
  251. CASE_SET_CR(IRR1);
  252. CASE_SET_CR(IRR2);
  253. CASE_SET_CR(IRR3);
  254. CASE_SET_CR(ITV);
  255. CASE_SET_CR(PMV);
  256. CASE_SET_CR(CMCV);
  257. CASE_SET_CR(LRR0);
  258. CASE_SET_CR(LRR1);
  259. default:
  260. printk(KERN_CRIT "wrong setreg %d\n", regnum);
  261. break;
  262. }
  263. }
  264. #else
  265. #define __DEFINE_FUNC(name, code) \
  266. extern const char ia64_native_ ## name ## _direct_start[]; \
  267. extern const char ia64_native_ ## name ## _direct_end[]; \
  268. asm (".align 32\n" \
  269. ".proc ia64_native_" #name "_func\n" \
  270. "ia64_native_" #name "_func:\n" \
  271. "ia64_native_" #name "_direct_start:\n" \
  272. code \
  273. "ia64_native_" #name "_direct_end:\n" \
  274. "br.cond.sptk.many b6\n" \
  275. ".endp ia64_native_" #name "_func\n")
  276. #define DEFINE_VOID_FUNC0(name, code) \
  277. extern void \
  278. ia64_native_ ## name ## _func(void); \
  279. __DEFINE_FUNC(name, code)
  280. #define DEFINE_VOID_FUNC1(name, code) \
  281. extern void \
  282. ia64_native_ ## name ## _func(unsigned long arg); \
  283. __DEFINE_FUNC(name, code)
  284. #define DEFINE_VOID_FUNC1_VOID(name, code) \
  285. extern void \
  286. ia64_native_ ## name ## _func(void *arg); \
  287. __DEFINE_FUNC(name, code)
  288. #define DEFINE_VOID_FUNC2(name, code) \
  289. extern void \
  290. ia64_native_ ## name ## _func(unsigned long arg0, \
  291. unsigned long arg1); \
  292. __DEFINE_FUNC(name, code)
  293. #define DEFINE_FUNC0(name, code) \
  294. extern unsigned long \
  295. ia64_native_ ## name ## _func(void); \
  296. __DEFINE_FUNC(name, code)
  297. #define DEFINE_FUNC1(name, type, code) \
  298. extern unsigned long \
  299. ia64_native_ ## name ## _func(type arg); \
  300. __DEFINE_FUNC(name, code)
  301. DEFINE_VOID_FUNC1_VOID(fc,
  302. "fc r8\n");
  303. DEFINE_VOID_FUNC1(intrin_local_irq_restore,
  304. ";;\n"
  305. " cmp.ne p6, p7 = r8, r0\n"
  306. ";;\n"
  307. "(p6) ssm psr.i\n"
  308. "(p7) rsm psr.i\n"
  309. ";;\n"
  310. "(p6) srlz.d\n");
  311. DEFINE_VOID_FUNC2(ptcga,
  312. "ptc.ga r8, r9\n");
  313. DEFINE_VOID_FUNC2(set_rr,
  314. "mov rr[r8] = r9\n");
  315. /* ia64_native_getreg(_IA64_REG_PSR) & IA64_PSR_I */
  316. DEFINE_FUNC0(get_psr_i,
  317. "mov r2 = " __stringify(1 << IA64_PSR_I_BIT) "\n"
  318. "mov r8 = psr\n"
  319. ";;\n"
  320. "and r8 = r2, r8\n");
  321. DEFINE_FUNC1(thash, unsigned long,
  322. "thash r8 = r8\n");
  323. DEFINE_FUNC1(get_cpuid, int,
  324. "mov r8 = cpuid[r8]\n");
  325. DEFINE_FUNC1(get_pmd, int,
  326. "mov r8 = pmd[r8]\n");
  327. DEFINE_FUNC1(get_rr, unsigned long,
  328. "mov r8 = rr[r8]\n");
  329. DEFINE_VOID_FUNC0(ssm_i,
  330. "ssm psr.i\n");
  331. DEFINE_VOID_FUNC0(rsm_i,
  332. "rsm psr.i\n");
  333. extern void
  334. ia64_native_set_rr0_to_rr4_func(unsigned long val0, unsigned long val1,
  335. unsigned long val2, unsigned long val3,
  336. unsigned long val4);
  337. __DEFINE_FUNC(set_rr0_to_rr4,
  338. "mov rr[r0] = r8\n"
  339. "movl r2 = 0x2000000000000000\n"
  340. ";;\n"
  341. "mov rr[r2] = r9\n"
  342. "shl r3 = r2, 1\n" /* movl r3 = 0x4000000000000000 */
  343. ";;\n"
  344. "add r2 = r2, r3\n" /* movl r2 = 0x6000000000000000 */
  345. "mov rr[r3] = r10\n"
  346. ";;\n"
  347. "mov rr[r2] = r11\n"
  348. "shl r3 = r3, 1\n" /* movl r3 = 0x8000000000000000 */
  349. ";;\n"
  350. "mov rr[r3] = r14\n");
  351. extern unsigned long ia64_native_getreg_func(int regnum);
  352. asm(".global ia64_native_getreg_func\n");
  353. #define __DEFINE_GET_REG(id, reg) \
  354. "mov r2 = " __stringify(_IA64_REG_ ## id) "\n" \
  355. ";;\n" \
  356. "cmp.eq p6, p0 = r2, r8\n" \
  357. ";;\n" \
  358. "(p6) mov r8 = " #reg "\n" \
  359. "(p6) br.cond.sptk.many b6\n" \
  360. ";;\n"
  361. #define __DEFINE_GET_AR(id, reg) __DEFINE_GET_REG(AR_ ## id, ar.reg)
  362. #define __DEFINE_GET_CR(id, reg) __DEFINE_GET_REG(CR_ ## id, cr.reg)
  363. __DEFINE_FUNC(getreg,
  364. __DEFINE_GET_REG(GP, gp)
  365. /*__DEFINE_GET_REG(IP, ip)*/ /* returned ip value shouldn't be constant */
  366. __DEFINE_GET_REG(PSR, psr)
  367. __DEFINE_GET_REG(TP, tp)
  368. __DEFINE_GET_REG(SP, sp)
  369. __DEFINE_GET_REG(AR_KR0, ar0)
  370. __DEFINE_GET_REG(AR_KR1, ar1)
  371. __DEFINE_GET_REG(AR_KR2, ar2)
  372. __DEFINE_GET_REG(AR_KR3, ar3)
  373. __DEFINE_GET_REG(AR_KR4, ar4)
  374. __DEFINE_GET_REG(AR_KR5, ar5)
  375. __DEFINE_GET_REG(AR_KR6, ar6)
  376. __DEFINE_GET_REG(AR_KR7, ar7)
  377. __DEFINE_GET_AR(RSC, rsc)
  378. __DEFINE_GET_AR(BSP, bsp)
  379. __DEFINE_GET_AR(BSPSTORE, bspstore)
  380. __DEFINE_GET_AR(RNAT, rnat)
  381. __DEFINE_GET_AR(FCR, fcr)
  382. __DEFINE_GET_AR(EFLAG, eflag)
  383. __DEFINE_GET_AR(CSD, csd)
  384. __DEFINE_GET_AR(SSD, ssd)
  385. __DEFINE_GET_REG(AR_CFLAG, ar27)
  386. __DEFINE_GET_AR(FSR, fsr)
  387. __DEFINE_GET_AR(FIR, fir)
  388. __DEFINE_GET_AR(FDR, fdr)
  389. __DEFINE_GET_AR(CCV, ccv)
  390. __DEFINE_GET_AR(UNAT, unat)
  391. __DEFINE_GET_AR(FPSR, fpsr)
  392. __DEFINE_GET_AR(ITC, itc)
  393. __DEFINE_GET_AR(PFS, pfs)
  394. __DEFINE_GET_AR(LC, lc)
  395. __DEFINE_GET_AR(EC, ec)
  396. __DEFINE_GET_CR(DCR, dcr)
  397. __DEFINE_GET_CR(ITM, itm)
  398. __DEFINE_GET_CR(IVA, iva)
  399. __DEFINE_GET_CR(PTA, pta)
  400. __DEFINE_GET_CR(IPSR, ipsr)
  401. __DEFINE_GET_CR(ISR, isr)
  402. __DEFINE_GET_CR(IIP, iip)
  403. __DEFINE_GET_CR(IFA, ifa)
  404. __DEFINE_GET_CR(ITIR, itir)
  405. __DEFINE_GET_CR(IIPA, iipa)
  406. __DEFINE_GET_CR(IFS, ifs)
  407. __DEFINE_GET_CR(IIM, iim)
  408. __DEFINE_GET_CR(IHA, iha)
  409. __DEFINE_GET_CR(LID, lid)
  410. __DEFINE_GET_CR(IVR, ivr)
  411. __DEFINE_GET_CR(TPR, tpr)
  412. __DEFINE_GET_CR(EOI, eoi)
  413. __DEFINE_GET_CR(IRR0, irr0)
  414. __DEFINE_GET_CR(IRR1, irr1)
  415. __DEFINE_GET_CR(IRR2, irr2)
  416. __DEFINE_GET_CR(IRR3, irr3)
  417. __DEFINE_GET_CR(ITV, itv)
  418. __DEFINE_GET_CR(PMV, pmv)
  419. __DEFINE_GET_CR(CMCV, cmcv)
  420. __DEFINE_GET_CR(LRR0, lrr0)
  421. __DEFINE_GET_CR(LRR1, lrr1)
  422. "mov r8 = -1\n" /* unsupported case */
  423. );
  424. extern void ia64_native_setreg_func(int regnum, unsigned long val);
  425. asm(".global ia64_native_setreg_func\n");
  426. #define __DEFINE_SET_REG(id, reg) \
  427. "mov r2 = " __stringify(_IA64_REG_ ## id) "\n" \
  428. ";;\n" \
  429. "cmp.eq p6, p0 = r2, r9\n" \
  430. ";;\n" \
  431. "(p6) mov " #reg " = r8\n" \
  432. "(p6) br.cond.sptk.many b6\n" \
  433. ";;\n"
  434. #define __DEFINE_SET_AR(id, reg) __DEFINE_SET_REG(AR_ ## id, ar.reg)
  435. #define __DEFINE_SET_CR(id, reg) __DEFINE_SET_REG(CR_ ## id, cr.reg)
  436. __DEFINE_FUNC(setreg,
  437. "mov r2 = " __stringify(_IA64_REG_PSR_L) "\n"
  438. ";;\n"
  439. "cmp.eq p6, p0 = r2, r9\n"
  440. ";;\n"
  441. "(p6) mov psr.l = r8\n"
  442. #ifdef HAVE_SERIALIZE_DIRECTIVE
  443. ".serialize.data\n"
  444. #endif
  445. "(p6) br.cond.sptk.many b6\n"
  446. __DEFINE_SET_REG(GP, gp)
  447. __DEFINE_SET_REG(SP, sp)
  448. __DEFINE_SET_REG(AR_KR0, ar0)
  449. __DEFINE_SET_REG(AR_KR1, ar1)
  450. __DEFINE_SET_REG(AR_KR2, ar2)
  451. __DEFINE_SET_REG(AR_KR3, ar3)
  452. __DEFINE_SET_REG(AR_KR4, ar4)
  453. __DEFINE_SET_REG(AR_KR5, ar5)
  454. __DEFINE_SET_REG(AR_KR6, ar6)
  455. __DEFINE_SET_REG(AR_KR7, ar7)
  456. __DEFINE_SET_AR(RSC, rsc)
  457. __DEFINE_SET_AR(BSP, bsp)
  458. __DEFINE_SET_AR(BSPSTORE, bspstore)
  459. __DEFINE_SET_AR(RNAT, rnat)
  460. __DEFINE_SET_AR(FCR, fcr)
  461. __DEFINE_SET_AR(EFLAG, eflag)
  462. __DEFINE_SET_AR(CSD, csd)
  463. __DEFINE_SET_AR(SSD, ssd)
  464. __DEFINE_SET_REG(AR_CFLAG, ar27)
  465. __DEFINE_SET_AR(FSR, fsr)
  466. __DEFINE_SET_AR(FIR, fir)
  467. __DEFINE_SET_AR(FDR, fdr)
  468. __DEFINE_SET_AR(CCV, ccv)
  469. __DEFINE_SET_AR(UNAT, unat)
  470. __DEFINE_SET_AR(FPSR, fpsr)
  471. __DEFINE_SET_AR(ITC, itc)
  472. __DEFINE_SET_AR(PFS, pfs)
  473. __DEFINE_SET_AR(LC, lc)
  474. __DEFINE_SET_AR(EC, ec)
  475. __DEFINE_SET_CR(DCR, dcr)
  476. __DEFINE_SET_CR(ITM, itm)
  477. __DEFINE_SET_CR(IVA, iva)
  478. __DEFINE_SET_CR(PTA, pta)
  479. __DEFINE_SET_CR(IPSR, ipsr)
  480. __DEFINE_SET_CR(ISR, isr)
  481. __DEFINE_SET_CR(IIP, iip)
  482. __DEFINE_SET_CR(IFA, ifa)
  483. __DEFINE_SET_CR(ITIR, itir)
  484. __DEFINE_SET_CR(IIPA, iipa)
  485. __DEFINE_SET_CR(IFS, ifs)
  486. __DEFINE_SET_CR(IIM, iim)
  487. __DEFINE_SET_CR(IHA, iha)
  488. __DEFINE_SET_CR(LID, lid)
  489. __DEFINE_SET_CR(IVR, ivr)
  490. __DEFINE_SET_CR(TPR, tpr)
  491. __DEFINE_SET_CR(EOI, eoi)
  492. __DEFINE_SET_CR(IRR0, irr0)
  493. __DEFINE_SET_CR(IRR1, irr1)
  494. __DEFINE_SET_CR(IRR2, irr2)
  495. __DEFINE_SET_CR(IRR3, irr3)
  496. __DEFINE_SET_CR(ITV, itv)
  497. __DEFINE_SET_CR(PMV, pmv)
  498. __DEFINE_SET_CR(CMCV, cmcv)
  499. __DEFINE_SET_CR(LRR0, lrr0)
  500. __DEFINE_SET_CR(LRR1, lrr1)
  501. );
  502. #endif
  503. struct pv_cpu_ops pv_cpu_ops = {
  504. .fc = ia64_native_fc_func,
  505. .thash = ia64_native_thash_func,
  506. .get_cpuid = ia64_native_get_cpuid_func,
  507. .get_pmd = ia64_native_get_pmd_func,
  508. .ptcga = ia64_native_ptcga_func,
  509. .get_rr = ia64_native_get_rr_func,
  510. .set_rr = ia64_native_set_rr_func,
  511. .set_rr0_to_rr4 = ia64_native_set_rr0_to_rr4_func,
  512. .ssm_i = ia64_native_ssm_i_func,
  513. .getreg = ia64_native_getreg_func,
  514. .setreg = ia64_native_setreg_func,
  515. .rsm_i = ia64_native_rsm_i_func,
  516. .get_psr_i = ia64_native_get_psr_i_func,
  517. .intrin_local_irq_restore
  518. = ia64_native_intrin_local_irq_restore_func,
  519. };
  520. EXPORT_SYMBOL(pv_cpu_ops);
  521. /******************************************************************************
  522. * replacement of hand written assembly codes.
  523. */
  524. void
  525. paravirt_cpu_asm_init(const struct pv_cpu_asm_switch *cpu_asm_switch)
  526. {
  527. extern unsigned long paravirt_switch_to_targ;
  528. extern unsigned long paravirt_leave_syscall_targ;
  529. extern unsigned long paravirt_work_processed_syscall_targ;
  530. extern unsigned long paravirt_leave_kernel_targ;
  531. paravirt_switch_to_targ = cpu_asm_switch->switch_to;
  532. paravirt_leave_syscall_targ = cpu_asm_switch->leave_syscall;
  533. paravirt_work_processed_syscall_targ =
  534. cpu_asm_switch->work_processed_syscall;
  535. paravirt_leave_kernel_targ = cpu_asm_switch->leave_kernel;
  536. }
  537. /***************************************************************************
  538. * pv_iosapic_ops
  539. * iosapic read/write hooks.
  540. */
  541. static unsigned int
  542. ia64_native_iosapic_read(char __iomem *iosapic, unsigned int reg)
  543. {
  544. return __ia64_native_iosapic_read(iosapic, reg);
  545. }
  546. static void
  547. ia64_native_iosapic_write(char __iomem *iosapic, unsigned int reg, u32 val)
  548. {
  549. __ia64_native_iosapic_write(iosapic, reg, val);
  550. }
  551. struct pv_iosapic_ops pv_iosapic_ops = {
  552. .pcat_compat_init = ia64_native_iosapic_pcat_compat_init,
  553. .__get_irq_chip = ia64_native_iosapic_get_irq_chip,
  554. .__read = ia64_native_iosapic_read,
  555. .__write = ia64_native_iosapic_write,
  556. };
  557. /***************************************************************************
  558. * pv_irq_ops
  559. * irq operations
  560. */
  561. struct pv_irq_ops pv_irq_ops = {
  562. .register_ipi = ia64_native_register_ipi,
  563. .assign_irq_vector = ia64_native_assign_irq_vector,
  564. .free_irq_vector = ia64_native_free_irq_vector,
  565. .register_percpu_irq = ia64_native_register_percpu_irq,
  566. .resend_irq = ia64_native_resend_irq,
  567. };
  568. /***************************************************************************
  569. * pv_time_ops
  570. * time operations
  571. */
  572. struct static_key paravirt_steal_enabled;
  573. struct static_key paravirt_steal_rq_enabled;
  574. static int
  575. ia64_native_do_steal_accounting(unsigned long *new_itm)
  576. {
  577. return 0;
  578. }
  579. struct pv_time_ops pv_time_ops = {
  580. .do_steal_accounting = ia64_native_do_steal_accounting,
  581. .sched_clock = ia64_native_sched_clock,
  582. };
  583. /***************************************************************************
  584. * binary pacthing
  585. * pv_init_ops.patch_bundle
  586. */
  587. #ifdef ASM_SUPPORTED
  588. #define IA64_NATIVE_PATCH_DEFINE_GET_REG(name, reg) \
  589. __DEFINE_FUNC(get_ ## name, \
  590. ";;\n" \
  591. "mov r8 = " #reg "\n" \
  592. ";;\n")
  593. #define IA64_NATIVE_PATCH_DEFINE_SET_REG(name, reg) \
  594. __DEFINE_FUNC(set_ ## name, \
  595. ";;\n" \
  596. "mov " #reg " = r8\n" \
  597. ";;\n")
  598. #define IA64_NATIVE_PATCH_DEFINE_REG(name, reg) \
  599. IA64_NATIVE_PATCH_DEFINE_GET_REG(name, reg); \
  600. IA64_NATIVE_PATCH_DEFINE_SET_REG(name, reg) \
  601. #define IA64_NATIVE_PATCH_DEFINE_AR(name, reg) \
  602. IA64_NATIVE_PATCH_DEFINE_REG(ar_ ## name, ar.reg)
  603. #define IA64_NATIVE_PATCH_DEFINE_CR(name, reg) \
  604. IA64_NATIVE_PATCH_DEFINE_REG(cr_ ## name, cr.reg)
  605. IA64_NATIVE_PATCH_DEFINE_GET_REG(psr, psr);
  606. IA64_NATIVE_PATCH_DEFINE_GET_REG(tp, tp);
  607. /* IA64_NATIVE_PATCH_DEFINE_SET_REG(psr_l, psr.l); */
  608. __DEFINE_FUNC(set_psr_l,
  609. ";;\n"
  610. "mov psr.l = r8\n"
  611. #ifdef HAVE_SERIALIZE_DIRECTIVE
  612. ".serialize.data\n"
  613. #endif
  614. ";;\n");
  615. IA64_NATIVE_PATCH_DEFINE_REG(gp, gp);
  616. IA64_NATIVE_PATCH_DEFINE_REG(sp, sp);
  617. IA64_NATIVE_PATCH_DEFINE_REG(kr0, ar0);
  618. IA64_NATIVE_PATCH_DEFINE_REG(kr1, ar1);
  619. IA64_NATIVE_PATCH_DEFINE_REG(kr2, ar2);
  620. IA64_NATIVE_PATCH_DEFINE_REG(kr3, ar3);
  621. IA64_NATIVE_PATCH_DEFINE_REG(kr4, ar4);
  622. IA64_NATIVE_PATCH_DEFINE_REG(kr5, ar5);
  623. IA64_NATIVE_PATCH_DEFINE_REG(kr6, ar6);
  624. IA64_NATIVE_PATCH_DEFINE_REG(kr7, ar7);
  625. IA64_NATIVE_PATCH_DEFINE_AR(rsc, rsc);
  626. IA64_NATIVE_PATCH_DEFINE_AR(bsp, bsp);
  627. IA64_NATIVE_PATCH_DEFINE_AR(bspstore, bspstore);
  628. IA64_NATIVE_PATCH_DEFINE_AR(rnat, rnat);
  629. IA64_NATIVE_PATCH_DEFINE_AR(fcr, fcr);
  630. IA64_NATIVE_PATCH_DEFINE_AR(eflag, eflag);
  631. IA64_NATIVE_PATCH_DEFINE_AR(csd, csd);
  632. IA64_NATIVE_PATCH_DEFINE_AR(ssd, ssd);
  633. IA64_NATIVE_PATCH_DEFINE_REG(ar27, ar27);
  634. IA64_NATIVE_PATCH_DEFINE_AR(fsr, fsr);
  635. IA64_NATIVE_PATCH_DEFINE_AR(fir, fir);
  636. IA64_NATIVE_PATCH_DEFINE_AR(fdr, fdr);
  637. IA64_NATIVE_PATCH_DEFINE_AR(ccv, ccv);
  638. IA64_NATIVE_PATCH_DEFINE_AR(unat, unat);
  639. IA64_NATIVE_PATCH_DEFINE_AR(fpsr, fpsr);
  640. IA64_NATIVE_PATCH_DEFINE_AR(itc, itc);
  641. IA64_NATIVE_PATCH_DEFINE_AR(pfs, pfs);
  642. IA64_NATIVE_PATCH_DEFINE_AR(lc, lc);
  643. IA64_NATIVE_PATCH_DEFINE_AR(ec, ec);
  644. IA64_NATIVE_PATCH_DEFINE_CR(dcr, dcr);
  645. IA64_NATIVE_PATCH_DEFINE_CR(itm, itm);
  646. IA64_NATIVE_PATCH_DEFINE_CR(iva, iva);
  647. IA64_NATIVE_PATCH_DEFINE_CR(pta, pta);
  648. IA64_NATIVE_PATCH_DEFINE_CR(ipsr, ipsr);
  649. IA64_NATIVE_PATCH_DEFINE_CR(isr, isr);
  650. IA64_NATIVE_PATCH_DEFINE_CR(iip, iip);
  651. IA64_NATIVE_PATCH_DEFINE_CR(ifa, ifa);
  652. IA64_NATIVE_PATCH_DEFINE_CR(itir, itir);
  653. IA64_NATIVE_PATCH_DEFINE_CR(iipa, iipa);
  654. IA64_NATIVE_PATCH_DEFINE_CR(ifs, ifs);
  655. IA64_NATIVE_PATCH_DEFINE_CR(iim, iim);
  656. IA64_NATIVE_PATCH_DEFINE_CR(iha, iha);
  657. IA64_NATIVE_PATCH_DEFINE_CR(lid, lid);
  658. IA64_NATIVE_PATCH_DEFINE_CR(ivr, ivr);
  659. IA64_NATIVE_PATCH_DEFINE_CR(tpr, tpr);
  660. IA64_NATIVE_PATCH_DEFINE_CR(eoi, eoi);
  661. IA64_NATIVE_PATCH_DEFINE_CR(irr0, irr0);
  662. IA64_NATIVE_PATCH_DEFINE_CR(irr1, irr1);
  663. IA64_NATIVE_PATCH_DEFINE_CR(irr2, irr2);
  664. IA64_NATIVE_PATCH_DEFINE_CR(irr3, irr3);
  665. IA64_NATIVE_PATCH_DEFINE_CR(itv, itv);
  666. IA64_NATIVE_PATCH_DEFINE_CR(pmv, pmv);
  667. IA64_NATIVE_PATCH_DEFINE_CR(cmcv, cmcv);
  668. IA64_NATIVE_PATCH_DEFINE_CR(lrr0, lrr0);
  669. IA64_NATIVE_PATCH_DEFINE_CR(lrr1, lrr1);
  670. static const struct paravirt_patch_bundle_elem ia64_native_patch_bundle_elems[]
  671. __initdata_or_module =
  672. {
  673. #define IA64_NATIVE_PATCH_BUNDLE_ELEM(name, type) \
  674. { \
  675. (void*)ia64_native_ ## name ## _direct_start, \
  676. (void*)ia64_native_ ## name ## _direct_end, \
  677. PARAVIRT_PATCH_TYPE_ ## type, \
  678. }
  679. IA64_NATIVE_PATCH_BUNDLE_ELEM(fc, FC),
  680. IA64_NATIVE_PATCH_BUNDLE_ELEM(thash, THASH),
  681. IA64_NATIVE_PATCH_BUNDLE_ELEM(get_cpuid, GET_CPUID),
  682. IA64_NATIVE_PATCH_BUNDLE_ELEM(get_pmd, GET_PMD),
  683. IA64_NATIVE_PATCH_BUNDLE_ELEM(ptcga, PTCGA),
  684. IA64_NATIVE_PATCH_BUNDLE_ELEM(get_rr, GET_RR),
  685. IA64_NATIVE_PATCH_BUNDLE_ELEM(set_rr, SET_RR),
  686. IA64_NATIVE_PATCH_BUNDLE_ELEM(set_rr0_to_rr4, SET_RR0_TO_RR4),
  687. IA64_NATIVE_PATCH_BUNDLE_ELEM(ssm_i, SSM_I),
  688. IA64_NATIVE_PATCH_BUNDLE_ELEM(rsm_i, RSM_I),
  689. IA64_NATIVE_PATCH_BUNDLE_ELEM(get_psr_i, GET_PSR_I),
  690. IA64_NATIVE_PATCH_BUNDLE_ELEM(intrin_local_irq_restore,
  691. INTRIN_LOCAL_IRQ_RESTORE),
  692. #define IA64_NATIVE_PATCH_BUNDLE_ELEM_GETREG(name, reg) \
  693. { \
  694. (void*)ia64_native_get_ ## name ## _direct_start, \
  695. (void*)ia64_native_get_ ## name ## _direct_end, \
  696. PARAVIRT_PATCH_TYPE_GETREG + _IA64_REG_ ## reg, \
  697. }
  698. #define IA64_NATIVE_PATCH_BUNDLE_ELEM_SETREG(name, reg) \
  699. { \
  700. (void*)ia64_native_set_ ## name ## _direct_start, \
  701. (void*)ia64_native_set_ ## name ## _direct_end, \
  702. PARAVIRT_PATCH_TYPE_SETREG + _IA64_REG_ ## reg, \
  703. }
  704. #define IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(name, reg) \
  705. IA64_NATIVE_PATCH_BUNDLE_ELEM_GETREG(name, reg), \
  706. IA64_NATIVE_PATCH_BUNDLE_ELEM_SETREG(name, reg) \
  707. #define IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(name, reg) \
  708. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(ar_ ## name, AR_ ## reg)
  709. #define IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(name, reg) \
  710. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(cr_ ## name, CR_ ## reg)
  711. IA64_NATIVE_PATCH_BUNDLE_ELEM_GETREG(psr, PSR),
  712. IA64_NATIVE_PATCH_BUNDLE_ELEM_GETREG(tp, TP),
  713. IA64_NATIVE_PATCH_BUNDLE_ELEM_SETREG(psr_l, PSR_L),
  714. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(gp, GP),
  715. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(sp, SP),
  716. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr0, AR_KR0),
  717. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr1, AR_KR1),
  718. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr2, AR_KR2),
  719. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr3, AR_KR3),
  720. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr4, AR_KR4),
  721. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr5, AR_KR5),
  722. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr6, AR_KR6),
  723. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(kr7, AR_KR7),
  724. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(rsc, RSC),
  725. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(bsp, BSP),
  726. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(bspstore, BSPSTORE),
  727. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(rnat, RNAT),
  728. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(fcr, FCR),
  729. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(eflag, EFLAG),
  730. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(csd, CSD),
  731. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(ssd, SSD),
  732. IA64_NATIVE_PATCH_BUNDLE_ELEM_REG(ar27, AR_CFLAG),
  733. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(fsr, FSR),
  734. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(fir, FIR),
  735. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(fdr, FDR),
  736. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(ccv, CCV),
  737. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(unat, UNAT),
  738. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(fpsr, FPSR),
  739. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(itc, ITC),
  740. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(pfs, PFS),
  741. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(lc, LC),
  742. IA64_NATIVE_PATCH_BUNDLE_ELEM_AR(ec, EC),
  743. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(dcr, DCR),
  744. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(itm, ITM),
  745. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(iva, IVA),
  746. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(pta, PTA),
  747. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(ipsr, IPSR),
  748. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(isr, ISR),
  749. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(iip, IIP),
  750. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(ifa, IFA),
  751. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(itir, ITIR),
  752. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(iipa, IIPA),
  753. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(ifs, IFS),
  754. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(iim, IIM),
  755. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(iha, IHA),
  756. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(lid, LID),
  757. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(ivr, IVR),
  758. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(tpr, TPR),
  759. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(eoi, EOI),
  760. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(irr0, IRR0),
  761. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(irr1, IRR1),
  762. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(irr2, IRR2),
  763. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(irr3, IRR3),
  764. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(itv, ITV),
  765. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(pmv, PMV),
  766. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(cmcv, CMCV),
  767. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(lrr0, LRR0),
  768. IA64_NATIVE_PATCH_BUNDLE_ELEM_CR(lrr1, LRR1),
  769. };
  770. unsigned long __init_or_module
  771. ia64_native_patch_bundle(void *sbundle, void *ebundle, unsigned long type)
  772. {
  773. const unsigned long nelems = sizeof(ia64_native_patch_bundle_elems) /
  774. sizeof(ia64_native_patch_bundle_elems[0]);
  775. return __paravirt_patch_apply_bundle(sbundle, ebundle, type,
  776. ia64_native_patch_bundle_elems,
  777. nelems, NULL);
  778. }
  779. #endif /* ASM_SUPPOTED */
  780. extern const char ia64_native_switch_to[];
  781. extern const char ia64_native_leave_syscall[];
  782. extern const char ia64_native_work_processed_syscall[];
  783. extern const char ia64_native_leave_kernel[];
  784. const struct paravirt_patch_branch_target ia64_native_branch_target[]
  785. __initconst = {
  786. #define PARAVIRT_BR_TARGET(name, type) \
  787. { \
  788. ia64_native_ ## name, \
  789. PARAVIRT_PATCH_TYPE_BR_ ## type, \
  790. }
  791. PARAVIRT_BR_TARGET(switch_to, SWITCH_TO),
  792. PARAVIRT_BR_TARGET(leave_syscall, LEAVE_SYSCALL),
  793. PARAVIRT_BR_TARGET(work_processed_syscall, WORK_PROCESSED_SYSCALL),
  794. PARAVIRT_BR_TARGET(leave_kernel, LEAVE_KERNEL),
  795. };
  796. static void __init
  797. ia64_native_patch_branch(unsigned long tag, unsigned long type)
  798. {
  799. const unsigned long nelem =
  800. sizeof(ia64_native_branch_target) /
  801. sizeof(ia64_native_branch_target[0]);
  802. __paravirt_patch_apply_branch(tag, type,
  803. ia64_native_branch_target, nelem);
  804. }