aboutsummaryrefslogtreecommitdiffstats
path: root/arch/ia64/xen
diff options
context:
space:
mode:
authorIsaku Yamahata <yamahata@valinux.co.jp>2009-03-04 07:06:55 -0500
committerTony Luck <tony.luck@intel.com>2009-03-26 14:03:14 -0400
commit0a7d32440294faea84c9aae4cb99239fe6ddb8ed (patch)
treedff11ebbb3f6371c40aef93c4db734877852a826 /arch/ia64/xen
parentdae17da60d1797c9049d21d06de0db1873eee153 (diff)
ia64/pv_ops/bp/xen: implemented binary patchable pv_cpu_ops.
implemented xen binary patch for pv_cpu_ops. Signed-off-by: Isaku Yamahata <yamahata@valinux.co.jp> Signed-off-by: Tony Luck <tony.luck@intel.com>
Diffstat (limited to 'arch/ia64/xen')
-rw-r--r--arch/ia64/xen/hypercall.S2
-rw-r--r--arch/ia64/xen/xen_pv_ops.c665
2 files changed, 667 insertions, 0 deletions
diff --git a/arch/ia64/xen/hypercall.S b/arch/ia64/xen/hypercall.S
index 45e02bb64a92..e32dae444dd6 100644
--- a/arch/ia64/xen/hypercall.S
+++ b/arch/ia64/xen/hypercall.S
@@ -9,6 +9,7 @@
9#include <asm/intrinsics.h> 9#include <asm/intrinsics.h>
10#include <asm/xen/privop.h> 10#include <asm/xen/privop.h>
11 11
12#ifdef __INTEL_COMPILER
12/* 13/*
13 * Hypercalls without parameter. 14 * Hypercalls without parameter.
14 */ 15 */
@@ -72,6 +73,7 @@ GLOBAL_ENTRY(xen_set_rr0_to_rr4)
72 br.ret.sptk.many rp 73 br.ret.sptk.many rp
73 ;; 74 ;;
74END(xen_set_rr0_to_rr4) 75END(xen_set_rr0_to_rr4)
76#endif
75 77
76GLOBAL_ENTRY(xen_send_ipi) 78GLOBAL_ENTRY(xen_send_ipi)
77 mov r14=r32 79 mov r14=r32
diff --git a/arch/ia64/xen/xen_pv_ops.c b/arch/ia64/xen/xen_pv_ops.c
index bdf1acbce81c..6c44225e7b84 100644
--- a/arch/ia64/xen/xen_pv_ops.c
+++ b/arch/ia64/xen/xen_pv_ops.c
@@ -154,6 +154,13 @@ xen_post_smp_prepare_boot_cpu(void)
154 xen_setup_vcpu_info_placement(); 154 xen_setup_vcpu_info_placement();
155} 155}
156 156
157#ifdef ASM_SUPPORTED
158static unsigned long __init_or_module
159xen_patch_bundle(void *sbundle, void *ebundle, unsigned long type);
160#endif
161static void __init
162xen_patch_branch(unsigned long tag, unsigned long type);
163
157static const struct pv_init_ops xen_init_ops __initconst = { 164static const struct pv_init_ops xen_init_ops __initconst = {
158 .banner = xen_banner, 165 .banner = xen_banner,
159 166
@@ -164,6 +171,10 @@ static const struct pv_init_ops xen_init_ops __initconst = {
164 .arch_setup_nomca = xen_arch_setup_nomca, 171 .arch_setup_nomca = xen_arch_setup_nomca,
165 172
166 .post_smp_prepare_boot_cpu = xen_post_smp_prepare_boot_cpu, 173 .post_smp_prepare_boot_cpu = xen_post_smp_prepare_boot_cpu,
174#ifdef ASM_SUPPORTED
175 .patch_bundle = xen_patch_bundle,
176#endif
177 .patch_branch = xen_patch_branch,
167}; 178};
168 179
169/*************************************************************************** 180/***************************************************************************
@@ -214,6 +225,7 @@ static struct pv_patchdata xen_patchdata __initdata = {
214 * intrinsics hooks. 225 * intrinsics hooks.
215 */ 226 */
216 227
228#ifndef ASM_SUPPORTED
217static void 229static void
218xen_set_itm_with_offset(unsigned long val) 230xen_set_itm_with_offset(unsigned long val)
219{ 231{
@@ -381,6 +393,410 @@ xen_intrin_local_irq_restore(unsigned long mask)
381 else 393 else
382 xen_rsm_i(); 394 xen_rsm_i();
383} 395}
396#else
397#define __DEFINE_FUNC(name, code) \
398 extern const char xen_ ## name ## _direct_start[]; \
399 extern const char xen_ ## name ## _direct_end[]; \
400 asm (".align 32\n" \
401 ".proc xen_" #name "\n" \
402 "xen_" #name ":\n" \
403 "xen_" #name "_direct_start:\n" \
404 code \
405 "xen_" #name "_direct_end:\n" \
406 "br.cond.sptk.many b6\n" \
407 ".endp xen_" #name "\n")
408
409#define DEFINE_VOID_FUNC0(name, code) \
410 extern void \
411 xen_ ## name (void); \
412 __DEFINE_FUNC(name, code)
413
414#define DEFINE_VOID_FUNC1(name, code) \
415 extern void \
416 xen_ ## name (unsigned long arg); \
417 __DEFINE_FUNC(name, code)
418
419#define DEFINE_VOID_FUNC2(name, code) \
420 extern void \
421 xen_ ## name (unsigned long arg0, \
422 unsigned long arg1); \
423 __DEFINE_FUNC(name, code)
424
425#define DEFINE_FUNC0(name, code) \
426 extern unsigned long \
427 xen_ ## name (void); \
428 __DEFINE_FUNC(name, code)
429
430#define DEFINE_FUNC1(name, type, code) \
431 extern unsigned long \
432 xen_ ## name (type arg); \
433 __DEFINE_FUNC(name, code)
434
435#define XEN_PSR_I_ADDR_ADDR (XSI_BASE + XSI_PSR_I_ADDR_OFS)
436
437/*
438 * static void xen_set_itm_with_offset(unsigned long val)
439 * xen_set_itm(val - XEN_MAPPEDREGS->itc_offset);
440 */
441/* 2 bundles */
442DEFINE_VOID_FUNC1(set_itm_with_offset,
443 "mov r2 = " __stringify(XSI_BASE) " + "
444 __stringify(XSI_ITC_OFFSET_OFS) "\n"
445 ";;\n"
446 "ld8 r3 = [r2]\n"
447 ";;\n"
448 "sub r8 = r8, r3\n"
449 "break " __stringify(HYPERPRIVOP_SET_ITM) "\n");
450
451/*
452 * static unsigned long xen_get_itm_with_offset(void)
453 * return ia64_native_getreg(_IA64_REG_CR_ITM) + XEN_MAPPEDREGS->itc_offset;
454 */
455/* 2 bundles */
456DEFINE_FUNC0(get_itm_with_offset,
457 "mov r2 = " __stringify(XSI_BASE) " + "
458 __stringify(XSI_ITC_OFFSET_OFS) "\n"
459 ";;\n"
460 "ld8 r3 = [r2]\n"
461 "mov r8 = cr.itm\n"
462 ";;\n"
463 "add r8 = r8, r2\n");
464
465/*
466 * static void xen_set_itc(unsigned long val)
467 * unsigned long mitc;
468 *
469 * WARN_ON(!irqs_disabled());
470 * mitc = ia64_native_getreg(_IA64_REG_AR_ITC);
471 * XEN_MAPPEDREGS->itc_offset = val - mitc;
472 * XEN_MAPPEDREGS->itc_last = val;
473 */
474/* 2 bundles */
475DEFINE_VOID_FUNC1(set_itc,
476 "mov r2 = " __stringify(XSI_BASE) " + "
477 __stringify(XSI_ITC_LAST_OFS) "\n"
478 "mov r3 = ar.itc\n"
479 ";;\n"
480 "sub r3 = r8, r3\n"
481 "st8 [r2] = r8, "
482 __stringify(XSI_ITC_LAST_OFS) " - "
483 __stringify(XSI_ITC_OFFSET_OFS) "\n"
484 ";;\n"
485 "st8 [r2] = r3\n");
486
487/*
488 * static unsigned long xen_get_itc(void)
489 * unsigned long res;
490 * unsigned long itc_offset;
491 * unsigned long itc_last;
492 * unsigned long ret_itc_last;
493 *
494 * itc_offset = XEN_MAPPEDREGS->itc_offset;
495 * do {
496 * itc_last = XEN_MAPPEDREGS->itc_last;
497 * res = ia64_native_getreg(_IA64_REG_AR_ITC);
498 * res += itc_offset;
499 * if (itc_last >= res)
500 * res = itc_last + 1;
501 * ret_itc_last = cmpxchg(&XEN_MAPPEDREGS->itc_last,
502 * itc_last, res);
503 * } while (unlikely(ret_itc_last != itc_last));
504 * return res;
505 */
506/* 5 bundles */
507DEFINE_FUNC0(get_itc,
508 "mov r2 = " __stringify(XSI_BASE) " + "
509 __stringify(XSI_ITC_OFFSET_OFS) "\n"
510 ";;\n"
511 "ld8 r9 = [r2], " __stringify(XSI_ITC_LAST_OFS) " - "
512 __stringify(XSI_ITC_OFFSET_OFS) "\n"
513 /* r9 = itc_offset */
514 /* r2 = XSI_ITC_OFFSET */
515 "888:\n"
516 "mov r8 = ar.itc\n" /* res = ar.itc */
517 ";;\n"
518 "ld8 r3 = [r2]\n" /* r3 = itc_last */
519 "add r8 = r8, r9\n" /* res = ar.itc + itc_offset */
520 ";;\n"
521 "cmp.gtu p6, p0 = r3, r8\n"
522 ";;\n"
523 "(p6) add r8 = 1, r3\n" /* if (itc_last > res) itc_last + 1 */
524 ";;\n"
525 "mov ar.ccv = r8\n"
526 ";;\n"
527 "cmpxchg8.acq r10 = [r2], r8, ar.ccv\n"
528 ";;\n"
529 "cmp.ne p6, p0 = r10, r3\n"
530 "(p6) hint @pause\n"
531 "(p6) br.cond.spnt 888b\n");
532
533DEFINE_VOID_FUNC1(fc,
534 "break " __stringify(HYPERPRIVOP_FC) "\n");
535
536/*
537 * psr_i_addr_addr = XEN_PSR_I_ADDR_ADDR
538 * masked_addr = *psr_i_addr_addr
539 * pending_intr_addr = masked_addr - 1
540 * if (val & IA64_PSR_I) {
541 * masked = *masked_addr
542 * *masked_addr = 0:xen_set_virtual_psr_i(1)
543 * compiler barrier
544 * if (masked) {
545 * uint8_t pending = *pending_intr_addr;
546 * if (pending)
547 * XEN_HYPER_SSM_I
548 * }
549 * } else {
550 * *masked_addr = 1:xen_set_virtual_psr_i(0)
551 * }
552 */
553/* 6 bundles */
554DEFINE_VOID_FUNC1(intrin_local_irq_restore,
555 /* r8 = input value: 0 or IA64_PSR_I
556 * p6 = (flags & IA64_PSR_I)
557 * = if clause
558 * p7 = !(flags & IA64_PSR_I)
559 * = else clause
560 */
561 "cmp.ne p6, p7 = r8, r0\n"
562 "mov r9 = " __stringify(XEN_PSR_I_ADDR_ADDR) "\n"
563 ";;\n"
564 /* r9 = XEN_PSR_I_ADDR */
565 "ld8 r9 = [r9]\n"
566 ";;\n"
567
568 /* r10 = masked previous value */
569 "(p6) ld1.acq r10 = [r9]\n"
570 ";;\n"
571
572 /* p8 = !masked interrupt masked previously? */
573 "(p6) cmp.ne.unc p8, p0 = r10, r0\n"
574
575 /* p7 = else clause */
576 "(p7) mov r11 = 1\n"
577 ";;\n"
578 /* masked = 1 */
579 "(p7) st1.rel [r9] = r11\n"
580
581 /* p6 = if clause */
582 /* masked = 0
583 * r9 = masked_addr - 1
584 * = pending_intr_addr
585 */
586 "(p8) st1.rel [r9] = r0, -1\n"
587 ";;\n"
588 /* r8 = pending_intr */
589 "(p8) ld1.acq r11 = [r9]\n"
590 ";;\n"
591 /* p9 = interrupt pending? */
592 "(p8) cmp.ne.unc p9, p10 = r11, r0\n"
593 ";;\n"
594 "(p10) mf\n"
595 /* issue hypercall to trigger interrupt */
596 "(p9) break " __stringify(HYPERPRIVOP_SSM_I) "\n");
597
598DEFINE_VOID_FUNC2(ptcga,
599 "break " __stringify(HYPERPRIVOP_PTC_GA) "\n");
600DEFINE_VOID_FUNC2(set_rr,
601 "break " __stringify(HYPERPRIVOP_SET_RR) "\n");
602
603/*
604 * tmp = XEN_MAPPEDREGS->interrupt_mask_addr = XEN_PSR_I_ADDR_ADDR;
605 * tmp = *tmp
606 * tmp = *tmp;
607 * psr_i = tmp? 0: IA64_PSR_I;
608 */
609/* 4 bundles */
610DEFINE_FUNC0(get_psr_i,
611 "mov r9 = " __stringify(XEN_PSR_I_ADDR_ADDR) "\n"
612 ";;\n"
613 "ld8 r9 = [r9]\n" /* r9 = XEN_PSR_I_ADDR */
614 "mov r8 = 0\n" /* psr_i = 0 */
615 ";;\n"
616 "ld1.acq r9 = [r9]\n" /* r9 = XEN_PSR_I */
617 ";;\n"
618 "cmp.eq.unc p6, p0 = r9, r0\n" /* p6 = (XEN_PSR_I != 0) */
619 ";;\n"
620 "(p6) mov r8 = " __stringify(1 << IA64_PSR_I_BIT) "\n");
621
622DEFINE_FUNC1(thash, unsigned long,
623 "break " __stringify(HYPERPRIVOP_THASH) "\n");
624DEFINE_FUNC1(get_cpuid, int,
625 "break " __stringify(HYPERPRIVOP_GET_CPUID) "\n");
626DEFINE_FUNC1(get_pmd, int,
627 "break " __stringify(HYPERPRIVOP_GET_PMD) "\n");
628DEFINE_FUNC1(get_rr, unsigned long,
629 "break " __stringify(HYPERPRIVOP_GET_RR) "\n");
630
631/*
632 * void xen_privop_ssm_i(void)
633 *
634 * int masked = !xen_get_virtual_psr_i();
635 * // masked = *(*XEN_MAPPEDREGS->interrupt_mask_addr)
636 * xen_set_virtual_psr_i(1)
637 * // *(*XEN_MAPPEDREGS->interrupt_mask_addr) = 0
638 * // compiler barrier
639 * if (masked) {
640 * uint8_t* pend_int_addr =
641 * (uint8_t*)(*XEN_MAPPEDREGS->interrupt_mask_addr) - 1;
642 * uint8_t pending = *pend_int_addr;
643 * if (pending)
644 * XEN_HYPER_SSM_I
645 * }
646 */
647/* 4 bundles */
648DEFINE_VOID_FUNC0(ssm_i,
649 "mov r8 = " __stringify(XEN_PSR_I_ADDR_ADDR) "\n"
650 ";;\n"
651 "ld8 r8 = [r8]\n" /* r8 = XEN_PSR_I_ADDR */
652 ";;\n"
653 "ld1.acq r9 = [r8]\n" /* r9 = XEN_PSR_I */
654 ";;\n"
655 "st1.rel [r8] = r0, -1\n" /* psr_i = 0. enable interrupt
656 * r8 = XEN_PSR_I_ADDR - 1
657 * = pend_int_addr
658 */
659 "cmp.eq.unc p0, p6 = r9, r0\n"/* p6 = !XEN_PSR_I
660 * previously interrupt
661 * masked?
662 */
663 ";;\n"
664 "(p6) ld1.acq r8 = [r8]\n" /* r8 = xen_pend_int */
665 ";;\n"
666 "(p6) cmp.eq.unc p6, p7 = r8, r0\n" /*interrupt pending?*/
667 ";;\n"
668 /* issue hypercall to get interrupt */
669 "(p7) break " __stringify(HYPERPRIVOP_SSM_I) "\n"
670 ";;\n");
671
672/*
673 * psr_i_addr_addr = XEN_MAPPEDREGS->interrupt_mask_addr
674 * = XEN_PSR_I_ADDR_ADDR;
675 * psr_i_addr = *psr_i_addr_addr;
676 * *psr_i_addr = 1;
677 */
678/* 2 bundles */
679DEFINE_VOID_FUNC0(rsm_i,
680 "mov r8 = " __stringify(XEN_PSR_I_ADDR_ADDR) "\n"
681 /* r8 = XEN_PSR_I_ADDR */
682 "mov r9 = 1\n"
683 ";;\n"
684 "ld8 r8 = [r8]\n" /* r8 = XEN_PSR_I */
685 ";;\n"
686 "st1.rel [r8] = r9\n"); /* XEN_PSR_I = 1 */
687
688extern void
689xen_set_rr0_to_rr4(unsigned long val0, unsigned long val1,
690 unsigned long val2, unsigned long val3,
691 unsigned long val4);
692__DEFINE_FUNC(set_rr0_to_rr4,
693 "break " __stringify(HYPERPRIVOP_SET_RR0_TO_RR4) "\n");
694
695
696extern unsigned long xen_getreg(int regnum);
697#define __DEFINE_GET_REG(id, privop) \
698 "mov r2 = " __stringify(_IA64_REG_ ## id) "\n" \
699 ";;\n" \
700 "cmp.eq p6, p0 = r2, r8\n" \
701 ";;\n" \
702 "(p6) break " __stringify(HYPERPRIVOP_GET_ ## privop) "\n" \
703 "(p6) br.cond.sptk.many b6\n" \
704 ";;\n"
705
706__DEFINE_FUNC(getreg,
707 __DEFINE_GET_REG(PSR, PSR)
708#ifdef CONFIG_IA32_SUPPORT
709 __DEFINE_GET_REG(AR_EFLAG, EFLAG)
710#endif
711
712 /* get_itc */
713 "mov r2 = " __stringify(_IA64_REG_AR_ITC) "\n"
714 ";;\n"
715 "cmp.eq p6, p0 = r2, r8\n"
716 ";;\n"
717 "(p6) br.cond.spnt xen_get_itc\n"
718 ";;\n"
719
720 /* get itm */
721 "mov r2 = " __stringify(_IA64_REG_CR_ITM) "\n"
722 ";;\n"
723 "cmp.eq p6, p0 = r2, r8\n"
724 ";;\n"
725 "(p6) br.cond.spnt xen_get_itm_with_offset\n"
726 ";;\n"
727
728 __DEFINE_GET_REG(CR_IVR, IVR)
729 __DEFINE_GET_REG(CR_TPR, TPR)
730
731 /* fall back */
732 "movl r2 = ia64_native_getreg_func\n"
733 ";;\n"
734 "mov b7 = r2\n"
735 ";;\n"
736 "br.cond.sptk.many b7\n");
737
738extern void xen_setreg(int regnum, unsigned long val);
739#define __DEFINE_SET_REG(id, privop) \
740 "mov r2 = " __stringify(_IA64_REG_ ## id) "\n" \
741 ";;\n" \
742 "cmp.eq p6, p0 = r2, r9\n" \
743 ";;\n" \
744 "(p6) break " __stringify(HYPERPRIVOP_ ## privop) "\n" \
745 "(p6) br.cond.sptk.many b6\n" \
746 ";;\n"
747
748__DEFINE_FUNC(setreg,
749 /* kr0 .. kr 7*/
750 /*
751 * if (_IA64_REG_AR_KR0 <= regnum &&
752 * regnum <= _IA64_REG_AR_KR7) {
753 * register __index asm ("r8") = regnum - _IA64_REG_AR_KR0
754 * register __val asm ("r9") = val
755 * "break HYPERPRIVOP_SET_KR"
756 * }
757 */
758 "mov r17 = r9\n"
759 "mov r2 = " __stringify(_IA64_REG_AR_KR0) "\n"
760 ";;\n"
761 "cmp.ge p6, p0 = r9, r2\n"
762 "sub r17 = r17, r2\n"
763 ";;\n"
764 "(p6) cmp.ge.unc p7, p0 = "
765 __stringify(_IA64_REG_AR_KR7) " - " __stringify(_IA64_REG_AR_KR0)
766 ", r17\n"
767 ";;\n"
768 "(p7) mov r9 = r8\n"
769 ";;\n"
770 "(p7) mov r8 = r17\n"
771 "(p7) break " __stringify(HYPERPRIVOP_SET_KR) "\n"
772
773 /* set itm */
774 "mov r2 = " __stringify(_IA64_REG_CR_ITM) "\n"
775 ";;\n"
776 "cmp.eq p6, p0 = r2, r8\n"
777 ";;\n"
778 "(p6) br.cond.spnt xen_set_itm_with_offset\n"
779
780 /* set itc */
781 "mov r2 = " __stringify(_IA64_REG_AR_ITC) "\n"
782 ";;\n"
783 "cmp.eq p6, p0 = r2, r8\n"
784 ";;\n"
785 "(p6) br.cond.spnt xen_set_itc\n"
786
787#ifdef CONFIG_IA32_SUPPORT
788 __DEFINE_SET_REG(AR_EFLAG, SET_EFLAG)
789#endif
790 __DEFINE_SET_REG(CR_TPR, SET_TPR)
791 __DEFINE_SET_REG(CR_EOI, EOI)
792
793 /* fall back */
794 "movl r2 = ia64_native_setreg_func\n"
795 ";;\n"
796 "mov b7 = r2\n"
797 ";;\n"
798 "br.cond.sptk.many b7\n");
799#endif
384 800
385static const struct pv_cpu_ops xen_cpu_ops __initconst = { 801static const struct pv_cpu_ops xen_cpu_ops __initconst = {
386 .fc = xen_fc, 802 .fc = xen_fc,
@@ -486,3 +902,252 @@ xen_setup_pv_ops(void)
486 902
487 paravirt_cpu_asm_init(&xen_cpu_asm_switch); 903 paravirt_cpu_asm_init(&xen_cpu_asm_switch);
488} 904}
905
906#ifdef ASM_SUPPORTED
907/***************************************************************************
908 * binary pacthing
909 * pv_init_ops.patch_bundle
910 */
911
912#define DEFINE_FUNC_GETREG(name, privop) \
913 DEFINE_FUNC0(get_ ## name, \
914 "break "__stringify(HYPERPRIVOP_GET_ ## privop) "\n")
915
916DEFINE_FUNC_GETREG(psr, PSR);
917DEFINE_FUNC_GETREG(eflag, EFLAG);
918DEFINE_FUNC_GETREG(ivr, IVR);
919DEFINE_FUNC_GETREG(tpr, TPR);
920
921#define DEFINE_FUNC_SET_KR(n) \
922 DEFINE_VOID_FUNC0(set_kr ## n, \
923 ";;\n" \
924 "mov r9 = r8\n" \
925 "mov r8 = " #n "\n" \
926 "break " __stringify(HYPERPRIVOP_SET_KR) "\n")
927
928DEFINE_FUNC_SET_KR(0);
929DEFINE_FUNC_SET_KR(1);
930DEFINE_FUNC_SET_KR(2);
931DEFINE_FUNC_SET_KR(3);
932DEFINE_FUNC_SET_KR(4);
933DEFINE_FUNC_SET_KR(5);
934DEFINE_FUNC_SET_KR(6);
935DEFINE_FUNC_SET_KR(7);
936
937#define __DEFINE_FUNC_SETREG(name, privop) \
938 DEFINE_VOID_FUNC0(name, \
939 "break "__stringify(HYPERPRIVOP_ ## privop) "\n")
940
941#define DEFINE_FUNC_SETREG(name, privop) \
942 __DEFINE_FUNC_SETREG(set_ ## name, SET_ ## privop)
943
944DEFINE_FUNC_SETREG(eflag, EFLAG);
945DEFINE_FUNC_SETREG(tpr, TPR);
946__DEFINE_FUNC_SETREG(eoi, EOI);
947
948extern const char xen_check_events[];
949extern const char __xen_intrin_local_irq_restore_direct_start[];
950extern const char __xen_intrin_local_irq_restore_direct_end[];
951extern const unsigned long __xen_intrin_local_irq_restore_direct_reloc;
952
953asm (
954 ".align 32\n"
955 ".proc xen_check_events\n"
956 "xen_check_events:\n"
957 /* masked = 0
958 * r9 = masked_addr - 1
959 * = pending_intr_addr
960 */
961 "st1.rel [r9] = r0, -1\n"
962 ";;\n"
963 /* r8 = pending_intr */
964 "ld1.acq r11 = [r9]\n"
965 ";;\n"
966 /* p9 = interrupt pending? */
967 "cmp.ne p9, p10 = r11, r0\n"
968 ";;\n"
969 "(p10) mf\n"
970 /* issue hypercall to trigger interrupt */
971 "(p9) break " __stringify(HYPERPRIVOP_SSM_I) "\n"
972 "br.cond.sptk.many b6\n"
973 ".endp xen_check_events\n"
974 "\n"
975 ".align 32\n"
976 ".proc __xen_intrin_local_irq_restore_direct\n"
977 "__xen_intrin_local_irq_restore_direct:\n"
978 "__xen_intrin_local_irq_restore_direct_start:\n"
979 "1:\n"
980 "{\n"
981 "cmp.ne p6, p7 = r8, r0\n"
982 "mov r17 = ip\n" /* get ip to calc return address */
983 "mov r9 = "__stringify(XEN_PSR_I_ADDR_ADDR) "\n"
984 ";;\n"
985 "}\n"
986 "{\n"
987 /* r9 = XEN_PSR_I_ADDR */
988 "ld8 r9 = [r9]\n"
989 ";;\n"
990 /* r10 = masked previous value */
991 "(p6) ld1.acq r10 = [r9]\n"
992 "adds r17 = 1f - 1b, r17\n" /* calculate return address */
993 ";;\n"
994 "}\n"
995 "{\n"
996 /* p8 = !masked interrupt masked previously? */
997 "(p6) cmp.ne.unc p8, p0 = r10, r0\n"
998 "\n"
999 /* p7 = else clause */
1000 "(p7) mov r11 = 1\n"
1001 ";;\n"
1002 "(p8) mov b6 = r17\n" /* set return address */
1003 "}\n"
1004 "{\n"
1005 /* masked = 1 */
1006 "(p7) st1.rel [r9] = r11\n"
1007 "\n"
1008 "[99:]\n"
1009 "(p8) brl.cond.dptk.few xen_check_events\n"
1010 "}\n"
1011 /* pv calling stub is 5 bundles. fill nop to adjust return address */
1012 "{\n"
1013 "nop 0\n"
1014 "nop 0\n"
1015 "nop 0\n"
1016 "}\n"
1017 "1:\n"
1018 "__xen_intrin_local_irq_restore_direct_end:\n"
1019 ".endp __xen_intrin_local_irq_restore_direct\n"
1020 "\n"
1021 ".align 8\n"
1022 "__xen_intrin_local_irq_restore_direct_reloc:\n"
1023 "data8 99b\n"
1024);
1025
1026static struct paravirt_patch_bundle_elem xen_patch_bundle_elems[]
1027__initdata_or_module =
1028{
1029#define XEN_PATCH_BUNDLE_ELEM(name, type) \
1030 { \
1031 (void*)xen_ ## name ## _direct_start, \
1032 (void*)xen_ ## name ## _direct_end, \
1033 PARAVIRT_PATCH_TYPE_ ## type, \
1034 }
1035
1036 XEN_PATCH_BUNDLE_ELEM(fc, FC),
1037 XEN_PATCH_BUNDLE_ELEM(thash, THASH),
1038 XEN_PATCH_BUNDLE_ELEM(get_cpuid, GET_CPUID),
1039 XEN_PATCH_BUNDLE_ELEM(get_pmd, GET_PMD),
1040 XEN_PATCH_BUNDLE_ELEM(ptcga, PTCGA),
1041 XEN_PATCH_BUNDLE_ELEM(get_rr, GET_RR),
1042 XEN_PATCH_BUNDLE_ELEM(set_rr, SET_RR),
1043 XEN_PATCH_BUNDLE_ELEM(set_rr0_to_rr4, SET_RR0_TO_RR4),
1044 XEN_PATCH_BUNDLE_ELEM(ssm_i, SSM_I),
1045 XEN_PATCH_BUNDLE_ELEM(rsm_i, RSM_I),
1046 XEN_PATCH_BUNDLE_ELEM(get_psr_i, GET_PSR_I),
1047 {
1048 (void*)__xen_intrin_local_irq_restore_direct_start,
1049 (void*)__xen_intrin_local_irq_restore_direct_end,
1050 PARAVIRT_PATCH_TYPE_INTRIN_LOCAL_IRQ_RESTORE,
1051 },
1052
1053#define XEN_PATCH_BUNDLE_ELEM_GETREG(name, reg) \
1054 { \
1055 xen_get_ ## name ## _direct_start, \
1056 xen_get_ ## name ## _direct_end, \
1057 PARAVIRT_PATCH_TYPE_GETREG + _IA64_REG_ ## reg, \
1058 }
1059
1060 XEN_PATCH_BUNDLE_ELEM_GETREG(psr, PSR),
1061 XEN_PATCH_BUNDLE_ELEM_GETREG(eflag, AR_EFLAG),
1062
1063 XEN_PATCH_BUNDLE_ELEM_GETREG(ivr, CR_IVR),
1064 XEN_PATCH_BUNDLE_ELEM_GETREG(tpr, CR_TPR),
1065
1066 XEN_PATCH_BUNDLE_ELEM_GETREG(itc, AR_ITC),
1067 XEN_PATCH_BUNDLE_ELEM_GETREG(itm_with_offset, CR_ITM),
1068
1069
1070#define __XEN_PATCH_BUNDLE_ELEM_SETREG(name, reg) \
1071 { \
1072 xen_ ## name ## _direct_start, \
1073 xen_ ## name ## _direct_end, \
1074 PARAVIRT_PATCH_TYPE_SETREG + _IA64_REG_ ## reg, \
1075 }
1076
1077#define XEN_PATCH_BUNDLE_ELEM_SETREG(name, reg) \
1078 __XEN_PATCH_BUNDLE_ELEM_SETREG(set_ ## name, reg)
1079
1080 XEN_PATCH_BUNDLE_ELEM_SETREG(kr0, AR_KR0),
1081 XEN_PATCH_BUNDLE_ELEM_SETREG(kr1, AR_KR1),
1082 XEN_PATCH_BUNDLE_ELEM_SETREG(kr2, AR_KR2),
1083 XEN_PATCH_BUNDLE_ELEM_SETREG(kr3, AR_KR3),
1084 XEN_PATCH_BUNDLE_ELEM_SETREG(kr4, AR_KR4),
1085 XEN_PATCH_BUNDLE_ELEM_SETREG(kr5, AR_KR5),
1086 XEN_PATCH_BUNDLE_ELEM_SETREG(kr6, AR_KR6),
1087 XEN_PATCH_BUNDLE_ELEM_SETREG(kr7, AR_KR7),
1088
1089 XEN_PATCH_BUNDLE_ELEM_SETREG(eflag, AR_EFLAG),
1090 XEN_PATCH_BUNDLE_ELEM_SETREG(tpr, CR_TPR),
1091 __XEN_PATCH_BUNDLE_ELEM_SETREG(eoi, CR_EOI),
1092
1093 XEN_PATCH_BUNDLE_ELEM_SETREG(itc, AR_ITC),
1094 XEN_PATCH_BUNDLE_ELEM_SETREG(itm_with_offset, CR_ITM),
1095};
1096
1097static unsigned long __init_or_module
1098xen_patch_bundle(void *sbundle, void *ebundle, unsigned long type)
1099{
1100 const unsigned long nelems = sizeof(xen_patch_bundle_elems) /
1101 sizeof(xen_patch_bundle_elems[0]);
1102 unsigned long used;
1103 const struct paravirt_patch_bundle_elem *found;
1104
1105 used = __paravirt_patch_apply_bundle(sbundle, ebundle, type,
1106 xen_patch_bundle_elems, nelems,
1107 &found);
1108
1109 if (found == NULL)
1110 /* fallback */
1111 return ia64_native_patch_bundle(sbundle, ebundle, type);
1112 if (used == 0)
1113 return used;
1114
1115 /* relocation */
1116 switch (type) {
1117 case PARAVIRT_PATCH_TYPE_INTRIN_LOCAL_IRQ_RESTORE: {
1118 unsigned long reloc =
1119 __xen_intrin_local_irq_restore_direct_reloc;
1120 unsigned long reloc_offset = reloc - (unsigned long)
1121 __xen_intrin_local_irq_restore_direct_start;
1122 unsigned long tag = (unsigned long)sbundle + reloc_offset;
1123 paravirt_patch_reloc_brl(tag, xen_check_events);
1124 break;
1125 }
1126 default:
1127 /* nothing */
1128 break;
1129 }
1130 return used;
1131}
1132#endif /* ASM_SUPPOTED */
1133
1134const struct paravirt_patch_branch_target xen_branch_target[]
1135__initconst = {
1136#define PARAVIRT_BR_TARGET(name, type) \
1137 { \
1138 &xen_ ## name, \
1139 PARAVIRT_PATCH_TYPE_BR_ ## type, \
1140 }
1141 PARAVIRT_BR_TARGET(switch_to, SWITCH_TO),
1142 PARAVIRT_BR_TARGET(leave_syscall, LEAVE_SYSCALL),
1143 PARAVIRT_BR_TARGET(work_processed_syscall, WORK_PROCESSED_SYSCALL),
1144 PARAVIRT_BR_TARGET(leave_kernel, LEAVE_KERNEL),
1145};
1146
1147static void __init
1148xen_patch_branch(unsigned long tag, unsigned long type)
1149{
1150 const unsigned long nelem =
1151 sizeof(xen_branch_target) / sizeof(xen_branch_target[0]);
1152 __paravirt_patch_apply_branch(tag, type, xen_branch_target, nelem);
1153}