Lines Matching refs:p
199 static void uasm_bgezl_hazard(u32 **p, struct uasm_reloc **r, int instance) in uasm_bgezl_hazard() argument
203 uasm_il_bgezl(p, r, 0, label_tlbw_hazard_0 + instance); in uasm_bgezl_hazard()
210 static void uasm_bgezl_label(struct uasm_label **l, u32 **p, int instance) in uasm_bgezl_label() argument
214 uasm_build_label(l, *p, label_tlbw_hazard_0 + instance); in uasm_bgezl_label()
350 static struct work_registers build_get_work_registers(u32 **p) in build_get_work_registers() argument
356 UASM_i_MTC0(p, 1, c0_kscratch(), scratch_reg); in build_get_work_registers()
365 UASM_i_CPUID_MFC0(p, K0, SMP_CPUID_REG); in build_get_work_registers()
366 UASM_i_SRL_SAFE(p, K0, K0, SMP_CPUID_REGSHIFT); in build_get_work_registers()
369 UASM_i_SLL(p, K0, K0, ilog2(sizeof(struct tlb_reg_save))); in build_get_work_registers()
371 UASM_i_LA(p, K1, (long)&handler_reg_save); in build_get_work_registers()
372 UASM_i_ADDU(p, K0, K0, K1); in build_get_work_registers()
374 UASM_i_LA(p, K0, (long)&handler_reg_save); in build_get_work_registers()
377 UASM_i_SW(p, 1, offsetof(struct tlb_reg_save, a), K0); in build_get_work_registers()
378 UASM_i_SW(p, 2, offsetof(struct tlb_reg_save, b), K0); in build_get_work_registers()
386 static void build_restore_work_registers(u32 **p) in build_restore_work_registers() argument
389 UASM_i_MFC0(p, 1, c0_kscratch(), scratch_reg); in build_restore_work_registers()
393 UASM_i_LW(p, 1, offsetof(struct tlb_reg_save, a), K0); in build_restore_work_registers()
394 UASM_i_LW(p, 2, offsetof(struct tlb_reg_save, b), K0); in build_restore_work_registers()
414 u32 *p; in build_r3000_tlb_refill_handler() local
417 p = tlb_handler; in build_r3000_tlb_refill_handler()
419 uasm_i_mfc0(&p, K0, C0_BADVADDR); in build_r3000_tlb_refill_handler()
420 uasm_i_lui(&p, K1, uasm_rel_hi(pgdc)); /* cp0 delay */ in build_r3000_tlb_refill_handler()
421 uasm_i_lw(&p, K1, uasm_rel_lo(pgdc), K1); in build_r3000_tlb_refill_handler()
422 uasm_i_srl(&p, K0, K0, 22); /* load delay */ in build_r3000_tlb_refill_handler()
423 uasm_i_sll(&p, K0, K0, 2); in build_r3000_tlb_refill_handler()
424 uasm_i_addu(&p, K1, K1, K0); in build_r3000_tlb_refill_handler()
425 uasm_i_mfc0(&p, K0, C0_CONTEXT); in build_r3000_tlb_refill_handler()
426 uasm_i_lw(&p, K1, 0, K1); /* cp0 delay */ in build_r3000_tlb_refill_handler()
427 uasm_i_andi(&p, K0, K0, 0xffc); /* load delay */ in build_r3000_tlb_refill_handler()
428 uasm_i_addu(&p, K1, K1, K0); in build_r3000_tlb_refill_handler()
429 uasm_i_lw(&p, K0, 0, K1); in build_r3000_tlb_refill_handler()
430 uasm_i_nop(&p); /* load delay */ in build_r3000_tlb_refill_handler()
431 uasm_i_mtc0(&p, K0, C0_ENTRYLO0); in build_r3000_tlb_refill_handler()
432 uasm_i_mfc0(&p, K1, C0_EPC); /* cp0 delay */ in build_r3000_tlb_refill_handler()
433 uasm_i_tlbwr(&p); /* cp0 delay */ in build_r3000_tlb_refill_handler()
434 uasm_i_jr(&p, K1); in build_r3000_tlb_refill_handler()
435 uasm_i_rfe(&p); /* branch delay */ in build_r3000_tlb_refill_handler()
437 if (p > tlb_handler + 32) in build_r3000_tlb_refill_handler()
441 (unsigned int)(p - tlb_handler)); in build_r3000_tlb_refill_handler()
481 static void __maybe_unused build_tlb_probe_entry(u32 **p) in build_tlb_probe_entry() argument
489 uasm_i_nop(p); in build_tlb_probe_entry()
490 uasm_i_tlbp(p); in build_tlb_probe_entry()
494 uasm_i_tlbp(p); in build_tlb_probe_entry()
505 static void build_tlb_write_entry(u32 **p, struct uasm_label **l, in build_tlb_write_entry() argument
518 uasm_i_ehb(p); in build_tlb_write_entry()
519 tlbw(p); in build_tlb_write_entry()
534 uasm_bgezl_hazard(p, r, hazard_instance); in build_tlb_write_entry()
535 tlbw(p); in build_tlb_write_entry()
536 uasm_bgezl_label(l, p, hazard_instance); in build_tlb_write_entry()
538 uasm_i_nop(p); in build_tlb_write_entry()
543 uasm_i_nop(p); in build_tlb_write_entry()
544 tlbw(p); in build_tlb_write_entry()
545 uasm_i_nop(p); in build_tlb_write_entry()
550 uasm_i_nop(p); /* QED specifies 2 nops hazard */ in build_tlb_write_entry()
551 uasm_i_nop(p); /* QED specifies 2 nops hazard */ in build_tlb_write_entry()
552 tlbw(p); in build_tlb_write_entry()
560 uasm_i_nop(p); in build_tlb_write_entry()
561 tlbw(p); in build_tlb_write_entry()
586 uasm_i_nop(p); in build_tlb_write_entry()
588 tlbw(p); in build_tlb_write_entry()
592 uasm_i_nop(p); in build_tlb_write_entry()
593 uasm_i_nop(p); in build_tlb_write_entry()
594 uasm_i_nop(p); in build_tlb_write_entry()
595 uasm_i_nop(p); in build_tlb_write_entry()
596 tlbw(p); in build_tlb_write_entry()
604 uasm_i_nop(p); in build_tlb_write_entry()
605 uasm_i_nop(p); in build_tlb_write_entry()
606 tlbw(p); in build_tlb_write_entry()
607 uasm_i_nop(p); in build_tlb_write_entry()
608 uasm_i_nop(p); in build_tlb_write_entry()
614 uasm_i_nop(p); in build_tlb_write_entry()
615 uasm_i_nop(p); in build_tlb_write_entry()
616 tlbw(p); in build_tlb_write_entry()
620 tlbw(p); in build_tlb_write_entry()
621 uasm_i_nop(p); in build_tlb_write_entry()
631 static __maybe_unused void build_convert_pte_to_entrylo(u32 **p, in build_convert_pte_to_entrylo() argument
636 UASM_i_ROTR(p, reg, reg, ilog2(_PAGE_GLOBAL)); in build_convert_pte_to_entrylo()
638 UASM_i_SRL(p, reg, reg, ilog2(_PAGE_NO_EXEC)); in build_convert_pte_to_entrylo()
639 UASM_i_ROTR(p, reg, reg, in build_convert_pte_to_entrylo()
644 uasm_i_dsrl_safe(p, reg, reg, ilog2(_PAGE_GLOBAL)); in build_convert_pte_to_entrylo()
646 UASM_i_SRL(p, reg, reg, ilog2(_PAGE_GLOBAL)); in build_convert_pte_to_entrylo()
653 static void build_restore_pagemask(u32 **p, struct uasm_reloc **r, in build_restore_pagemask() argument
660 uasm_i_lui(p, tmp, PM_DEFAULT_MASK >> 16); in build_restore_pagemask()
661 uasm_i_ori(p, tmp, tmp, PM_DEFAULT_MASK & 0xffff); in build_restore_pagemask()
662 uasm_i_mtc0(p, tmp, C0_PAGEMASK); in build_restore_pagemask()
663 uasm_il_b(p, r, lid); in build_restore_pagemask()
665 uasm_i_ori(p, tmp, 0, PM_DEFAULT_MASK); in build_restore_pagemask()
666 uasm_i_mtc0(p, tmp, C0_PAGEMASK); in build_restore_pagemask()
667 uasm_il_b(p, r, lid); in build_restore_pagemask()
669 uasm_i_mtc0(p, 0, C0_PAGEMASK); in build_restore_pagemask()
670 uasm_il_b(p, r, lid); in build_restore_pagemask()
673 UASM_i_MFC0(p, 1, c0_kscratch(), scratch_reg); in build_restore_pagemask()
675 UASM_i_LW(p, 1, scratchpad_offset(0), 0); in build_restore_pagemask()
679 uasm_i_lui(p, tmp, PM_DEFAULT_MASK >> 16); in build_restore_pagemask()
680 uasm_i_ori(p, tmp, tmp, PM_DEFAULT_MASK & 0xffff); in build_restore_pagemask()
681 uasm_il_b(p, r, lid); in build_restore_pagemask()
682 uasm_i_mtc0(p, tmp, C0_PAGEMASK); in build_restore_pagemask()
684 uasm_i_ori(p, tmp, 0, PM_DEFAULT_MASK); in build_restore_pagemask()
685 uasm_il_b(p, r, lid); in build_restore_pagemask()
686 uasm_i_mtc0(p, tmp, C0_PAGEMASK); in build_restore_pagemask()
688 uasm_il_b(p, r, lid); in build_restore_pagemask()
689 uasm_i_mtc0(p, 0, C0_PAGEMASK); in build_restore_pagemask()
694 static void build_huge_tlb_write_entry(u32 **p, struct uasm_label **l, in build_huge_tlb_write_entry() argument
701 uasm_i_lui(p, tmp, PM_HUGE_MASK >> 16); in build_huge_tlb_write_entry()
702 uasm_i_ori(p, tmp, tmp, PM_HUGE_MASK & 0xffff); in build_huge_tlb_write_entry()
703 uasm_i_mtc0(p, tmp, C0_PAGEMASK); in build_huge_tlb_write_entry()
705 build_tlb_write_entry(p, l, r, wmode); in build_huge_tlb_write_entry()
707 build_restore_pagemask(p, r, tmp, label_leave, restore_scratch); in build_huge_tlb_write_entry()
714 build_is_huge_pte(u32 **p, struct uasm_reloc **r, unsigned int tmp, in build_is_huge_pte() argument
717 UASM_i_LW(p, tmp, 0, pmd); in build_is_huge_pte()
719 uasm_il_bbit1(p, r, tmp, ilog2(_PAGE_HUGE), lid); in build_is_huge_pte()
721 uasm_i_andi(p, tmp, tmp, _PAGE_HUGE); in build_is_huge_pte()
722 uasm_il_bnez(p, r, tmp, lid); in build_is_huge_pte()
726 static void build_huge_update_entries(u32 **p, unsigned int pte, in build_huge_update_entries() argument
744 uasm_i_lui(p, tmp, HPAGE_SIZE >> (7 + 16)); in build_huge_update_entries()
746 build_convert_pte_to_entrylo(p, pte); in build_huge_update_entries()
747 UASM_i_MTC0(p, pte, C0_ENTRYLO0); /* load it */ in build_huge_update_entries()
750 UASM_i_ADDIU(p, pte, pte, HPAGE_SIZE >> 7); in build_huge_update_entries()
752 UASM_i_ADDU(p, pte, pte, tmp); in build_huge_update_entries()
754 UASM_i_MTC0(p, pte, C0_ENTRYLO1); /* load it */ in build_huge_update_entries()
757 static void build_huge_handler_tail(u32 **p, struct uasm_reloc **r, in build_huge_handler_tail() argument
763 UASM_i_SC(p, pte, 0, ptr); in build_huge_handler_tail()
764 uasm_il_beqz(p, r, pte, label_tlb_huge_update); in build_huge_handler_tail()
765 UASM_i_LW(p, pte, 0, ptr); /* Needed because SC killed our PTE */ in build_huge_handler_tail()
767 UASM_i_SW(p, pte, 0, ptr); in build_huge_handler_tail()
769 build_huge_update_entries(p, pte, ptr); in build_huge_handler_tail()
770 build_huge_tlb_write_entry(p, l, r, pte, tlb_indexed, 0); in build_huge_handler_tail()
780 build_get_pmde64(u32 **p, struct uasm_label **l, struct uasm_reloc **r, in build_get_pmde64() argument
789 uasm_i_dmfc0(p, tmp, C0_BADVADDR); in build_get_pmde64()
803 uasm_i_dsrl_safe(p, ptr, tmp, PGDIR_SHIFT + PGD_ORDER + PAGE_SHIFT - 3); in build_get_pmde64()
804 uasm_il_bnez(p, r, ptr, label_vmalloc); in build_get_pmde64()
806 uasm_il_bltz(p, r, tmp, label_vmalloc); in build_get_pmde64()
812 UASM_i_MFC0(p, ptr, c0_kscratch(), pgd_reg); in build_get_pmde64()
818 UASM_i_MFC0(p, ptr, C0_CONTEXT); in build_get_pmde64()
821 uasm_i_dins(p, ptr, 0, 0, 23); in build_get_pmde64()
824 uasm_i_ori(p, ptr, ptr, 0x540); in build_get_pmde64()
825 uasm_i_drotr(p, ptr, ptr, 11); in build_get_pmde64()
827 UASM_i_CPUID_MFC0(p, ptr, SMP_CPUID_REG); in build_get_pmde64()
828 uasm_i_dsrl_safe(p, ptr, ptr, SMP_CPUID_PTRSHIFT); in build_get_pmde64()
829 UASM_i_LA_mostly(p, tmp, pgdc); in build_get_pmde64()
830 uasm_i_daddu(p, ptr, ptr, tmp); in build_get_pmde64()
831 uasm_i_dmfc0(p, tmp, C0_BADVADDR); in build_get_pmde64()
832 uasm_i_ld(p, ptr, uasm_rel_lo(pgdc), ptr); in build_get_pmde64()
834 UASM_i_LA_mostly(p, ptr, pgdc); in build_get_pmde64()
835 uasm_i_ld(p, ptr, uasm_rel_lo(pgdc), ptr); in build_get_pmde64()
839 uasm_l_vmalloc_done(l, *p); in build_get_pmde64()
842 uasm_i_dsrl_safe(p, tmp, tmp, PGDIR_SHIFT - 3); in build_get_pmde64()
844 uasm_i_andi(p, tmp, tmp, (PTRS_PER_PGD - 1)<<3); in build_get_pmde64()
845 uasm_i_daddu(p, ptr, ptr, tmp); /* add in pgd offset */ in build_get_pmde64()
847 uasm_i_dmfc0(p, tmp, C0_BADVADDR); /* get faulting address */ in build_get_pmde64()
848 uasm_i_ld(p, ptr, 0, ptr); /* get pmd pointer */ in build_get_pmde64()
849 uasm_i_dsrl_safe(p, tmp, tmp, PMD_SHIFT-3); /* get pmd offset in bytes */ in build_get_pmde64()
850 uasm_i_andi(p, tmp, tmp, (PTRS_PER_PMD - 1)<<3); in build_get_pmde64()
851 uasm_i_daddu(p, ptr, ptr, tmp); /* add in pmd offset */ in build_get_pmde64()
860 build_get_pgd_vmalloc64(u32 **p, struct uasm_label **l, struct uasm_reloc **r, in build_get_pgd_vmalloc64() argument
870 uasm_l_vmalloc(l, *p); in build_get_pgd_vmalloc64()
874 uasm_il_bltz(p, r, bvaddr, label_vmalloc_done); in build_get_pgd_vmalloc64()
875 uasm_i_lui(p, ptr, uasm_rel_hi(swpd)); in build_get_pgd_vmalloc64()
879 uasm_il_bgez(p, r, bvaddr, label_large_segbits_fault); in build_get_pgd_vmalloc64()
884 uasm_il_b(p, r, label_vmalloc_done); in build_get_pgd_vmalloc64()
885 uasm_i_lui(p, ptr, uasm_rel_hi(swpd)); in build_get_pgd_vmalloc64()
887 UASM_i_LA_mostly(p, ptr, swpd); in build_get_pgd_vmalloc64()
888 uasm_il_b(p, r, label_vmalloc_done); in build_get_pgd_vmalloc64()
890 uasm_i_addiu(p, ptr, ptr, uasm_rel_lo(swpd)); in build_get_pgd_vmalloc64()
892 uasm_i_daddiu(p, ptr, ptr, uasm_rel_lo(swpd)); in build_get_pgd_vmalloc64()
896 uasm_l_large_segbits_fault(l, *p); in build_get_pgd_vmalloc64()
909 UASM_i_LA(p, ptr, (unsigned long)tlb_do_page_fault_0); in build_get_pgd_vmalloc64()
910 uasm_i_jr(p, ptr); in build_get_pgd_vmalloc64()
914 UASM_i_MFC0(p, 1, c0_kscratch(), scratch_reg); in build_get_pgd_vmalloc64()
916 UASM_i_LW(p, 1, scratchpad_offset(0), 0); in build_get_pgd_vmalloc64()
918 uasm_i_nop(p); in build_get_pgd_vmalloc64()
930 build_get_pgde32(u32 **p, unsigned int tmp, unsigned int ptr) in build_get_pgde32() argument
934 uasm_i_mfc0(p, ptr, c0_kscratch(), pgd_reg); in build_get_pgde32()
935 uasm_i_mfc0(p, tmp, C0_BADVADDR); /* get faulting address */ in build_get_pgde32()
941 uasm_i_mfc0(p, ptr, SMP_CPUID_REG); in build_get_pgde32()
942 UASM_i_LA_mostly(p, tmp, pgdc); in build_get_pgde32()
943 uasm_i_srl(p, ptr, ptr, SMP_CPUID_PTRSHIFT); in build_get_pgde32()
944 uasm_i_addu(p, ptr, tmp, ptr); in build_get_pgde32()
946 UASM_i_LA_mostly(p, ptr, pgdc); in build_get_pgde32()
948 uasm_i_mfc0(p, tmp, C0_BADVADDR); /* get faulting address */ in build_get_pgde32()
949 uasm_i_lw(p, ptr, uasm_rel_lo(pgdc), ptr); in build_get_pgde32()
951 uasm_i_srl(p, tmp, tmp, PGDIR_SHIFT); /* get pgd only bits */ in build_get_pgde32()
952 uasm_i_sll(p, tmp, tmp, PGD_T_LOG2); in build_get_pgde32()
953 uasm_i_addu(p, ptr, ptr, tmp); /* add in pgd offset */ in build_get_pgde32()
958 static void build_adjust_context(u32 **p, unsigned int ctx) in build_adjust_context() argument
980 UASM_i_SRL(p, ctx, ctx, shift); in build_adjust_context()
981 uasm_i_andi(p, ctx, ctx, mask); in build_adjust_context()
984 static void build_get_ptep(u32 **p, unsigned int tmp, unsigned int ptr) in build_get_ptep() argument
995 UASM_i_LW(p, ptr, 0, ptr); in build_get_ptep()
996 GET_CONTEXT(p, tmp); /* get context reg */ in build_get_ptep()
1000 GET_CONTEXT(p, tmp); /* get context reg */ in build_get_ptep()
1001 UASM_i_LW(p, ptr, 0, ptr); in build_get_ptep()
1005 build_adjust_context(p, tmp); in build_get_ptep()
1006 UASM_i_ADDU(p, ptr, ptr, tmp); /* add in offset */ in build_get_ptep()
1009 static void build_update_entries(u32 **p, unsigned int tmp, unsigned int ptep) in build_update_entries() argument
1021 uasm_i_addu(p, scratch, 0, ptep); in build_update_entries()
1023 uasm_i_lw(p, tmp, pte_off_even, ptep); /* even pte */ in build_update_entries()
1024 uasm_i_lw(p, ptep, pte_off_odd, ptep); /* odd pte */ in build_update_entries()
1025 UASM_i_ROTR(p, tmp, tmp, ilog2(_PAGE_GLOBAL)); in build_update_entries()
1026 UASM_i_ROTR(p, ptep, ptep, ilog2(_PAGE_GLOBAL)); in build_update_entries()
1027 UASM_i_MTC0(p, tmp, C0_ENTRYLO0); in build_update_entries()
1028 UASM_i_MTC0(p, ptep, C0_ENTRYLO1); in build_update_entries()
1030 uasm_i_lw(p, tmp, 0, scratch); in build_update_entries()
1031 uasm_i_lw(p, ptep, sizeof(pte_t), scratch); in build_update_entries()
1032 uasm_i_lui(p, scratch, 0xff); in build_update_entries()
1033 uasm_i_ori(p, scratch, scratch, 0xffff); in build_update_entries()
1034 uasm_i_and(p, tmp, scratch, tmp); in build_update_entries()
1035 uasm_i_and(p, ptep, scratch, ptep); in build_update_entries()
1036 uasm_i_mthc0(p, tmp, C0_ENTRYLO0); in build_update_entries()
1037 uasm_i_mthc0(p, ptep, C0_ENTRYLO1); in build_update_entries()
1042 UASM_i_LW(p, tmp, 0, ptep); /* get even pte */ in build_update_entries()
1043 UASM_i_LW(p, ptep, sizeof(pte_t), ptep); /* get odd pte */ in build_update_entries()
1045 build_tlb_probe_entry(p); in build_update_entries()
1046 build_convert_pte_to_entrylo(p, tmp); in build_update_entries()
1048 UASM_i_MTC0(p, 0, C0_ENTRYLO0); in build_update_entries()
1049 UASM_i_MTC0(p, tmp, C0_ENTRYLO0); /* load it */ in build_update_entries()
1050 build_convert_pte_to_entrylo(p, ptep); in build_update_entries()
1052 uasm_i_mfc0(p, tmp, C0_INDEX); in build_update_entries()
1054 UASM_i_MTC0(p, 0, C0_ENTRYLO1); in build_update_entries()
1055 UASM_i_MTC0(p, ptep, C0_ENTRYLO1); /* load it */ in build_update_entries()
1065 build_fast_tlb_refill_handler (u32 **p, struct uasm_label **l, in build_fast_tlb_refill_handler() argument
1079 UASM_i_MFC0(p, tmp, C0_BADVADDR); in build_fast_tlb_refill_handler()
1082 UASM_i_MFC0(p, ptr, c0_kscratch(), pgd_reg); in build_fast_tlb_refill_handler()
1084 UASM_i_MFC0(p, ptr, C0_CONTEXT); in build_fast_tlb_refill_handler()
1087 UASM_i_MTC0(p, scratch, c0_kscratch(), c0_scratch_reg); in build_fast_tlb_refill_handler()
1089 UASM_i_SW(p, scratch, scratchpad_offset(0), 0); in build_fast_tlb_refill_handler()
1091 uasm_i_dsrl_safe(p, scratch, tmp, in build_fast_tlb_refill_handler()
1093 uasm_il_bnez(p, r, scratch, label_vmalloc); in build_fast_tlb_refill_handler()
1098 uasm_i_dins(p, ptr, 0, 0, 23); in build_fast_tlb_refill_handler()
1102 UASM_i_MFC0(p, ptr, c0_kscratch(), pgd_reg); in build_fast_tlb_refill_handler()
1104 UASM_i_MFC0(p, ptr, C0_CONTEXT); in build_fast_tlb_refill_handler()
1106 UASM_i_MFC0(p, tmp, C0_BADVADDR); in build_fast_tlb_refill_handler()
1109 UASM_i_MTC0(p, scratch, c0_kscratch(), c0_scratch_reg); in build_fast_tlb_refill_handler()
1111 UASM_i_SW(p, scratch, scratchpad_offset(0), 0); in build_fast_tlb_refill_handler()
1115 uasm_i_dins(p, ptr, 0, 0, 23); in build_fast_tlb_refill_handler()
1117 uasm_il_bltz(p, r, tmp, label_vmalloc); in build_fast_tlb_refill_handler()
1123 uasm_i_ori(p, ptr, ptr, 0x540); in build_fast_tlb_refill_handler()
1124 uasm_i_drotr(p, ptr, ptr, 11); in build_fast_tlb_refill_handler()
1135 uasm_i_dsrl_safe(p, scratch, tmp, PGDIR_SHIFT - 3); in build_fast_tlb_refill_handler()
1137 uasm_l_vmalloc_done(l, *p); in build_fast_tlb_refill_handler()
1147 uasm_i_dsrl_safe(p, scratch, tmp, PGDIR_SHIFT - 3); in build_fast_tlb_refill_handler()
1150 GET_CONTEXT(p, tmp); /* get context reg */ in build_fast_tlb_refill_handler()
1152 uasm_i_andi(p, scratch, scratch, (PTRS_PER_PGD - 1) << 3); in build_fast_tlb_refill_handler()
1155 UASM_i_LWX(p, LOC_PTEP, scratch, ptr); in build_fast_tlb_refill_handler()
1157 uasm_i_daddu(p, ptr, ptr, scratch); /* add in pgd offset */ in build_fast_tlb_refill_handler()
1158 uasm_i_ld(p, LOC_PTEP, 0, ptr); /* get pmd pointer */ in build_fast_tlb_refill_handler()
1163 uasm_i_dsrl_safe(p, scratch, tmp, PMD_SHIFT - 3); in build_fast_tlb_refill_handler()
1164 uasm_i_andi(p, scratch, scratch, (PTRS_PER_PMD - 1) << 3); in build_fast_tlb_refill_handler()
1165 GET_CONTEXT(p, tmp); /* get context reg */ in build_fast_tlb_refill_handler()
1168 UASM_i_LWX(p, scratch, scratch, ptr); in build_fast_tlb_refill_handler()
1170 uasm_i_daddu(p, ptr, ptr, scratch); /* add in pmd offset */ in build_fast_tlb_refill_handler()
1171 UASM_i_LW(p, scratch, 0, ptr); in build_fast_tlb_refill_handler()
1175 build_adjust_context(p, tmp); in build_fast_tlb_refill_handler()
1178 uasm_il_bbit1(p, r, scratch, ilog2(_PAGE_HUGE), label_tlb_huge_update); in build_fast_tlb_refill_handler()
1185 uasm_i_nop(p); in build_fast_tlb_refill_handler()
1193 UASM_i_LWX(p, even, scratch, tmp); in build_fast_tlb_refill_handler()
1194 UASM_i_ADDIU(p, tmp, tmp, sizeof(pte_t)); in build_fast_tlb_refill_handler()
1195 UASM_i_LWX(p, odd, scratch, tmp); in build_fast_tlb_refill_handler()
1197 UASM_i_ADDU(p, ptr, scratch, tmp); /* add in offset */ in build_fast_tlb_refill_handler()
1200 UASM_i_LW(p, even, 0, ptr); /* get even pte */ in build_fast_tlb_refill_handler()
1201 UASM_i_LW(p, odd, sizeof(pte_t), ptr); /* get odd pte */ in build_fast_tlb_refill_handler()
1204 uasm_i_drotr(p, even, even, ilog2(_PAGE_GLOBAL)); in build_fast_tlb_refill_handler()
1205 UASM_i_MTC0(p, even, C0_ENTRYLO0); /* load it */ in build_fast_tlb_refill_handler()
1206 uasm_i_drotr(p, odd, odd, ilog2(_PAGE_GLOBAL)); in build_fast_tlb_refill_handler()
1208 uasm_i_dsrl_safe(p, even, even, ilog2(_PAGE_GLOBAL)); in build_fast_tlb_refill_handler()
1209 UASM_i_MTC0(p, even, C0_ENTRYLO0); /* load it */ in build_fast_tlb_refill_handler()
1210 uasm_i_dsrl_safe(p, odd, odd, ilog2(_PAGE_GLOBAL)); in build_fast_tlb_refill_handler()
1212 UASM_i_MTC0(p, odd, C0_ENTRYLO1); /* load it */ in build_fast_tlb_refill_handler()
1215 UASM_i_MFC0(p, scratch, c0_kscratch(), c0_scratch_reg); in build_fast_tlb_refill_handler()
1216 build_tlb_write_entry(p, l, r, tlb_random); in build_fast_tlb_refill_handler()
1217 uasm_l_leave(l, *p); in build_fast_tlb_refill_handler()
1220 build_tlb_write_entry(p, l, r, tlb_random); in build_fast_tlb_refill_handler()
1221 uasm_l_leave(l, *p); in build_fast_tlb_refill_handler()
1222 UASM_i_LW(p, scratch, scratchpad_offset(0), 0); in build_fast_tlb_refill_handler()
1224 UASM_i_LW(p, scratch, scratchpad_offset(0), 0); in build_fast_tlb_refill_handler()
1225 build_tlb_write_entry(p, l, r, tlb_random); in build_fast_tlb_refill_handler()
1226 uasm_l_leave(l, *p); in build_fast_tlb_refill_handler()
1230 uasm_i_eret(p); /* return from trap */ in build_fast_tlb_refill_handler()
1245 u32 *p = tlb_handler; in build_r4000_tlb_refill_handler() local
1259 htlb_info = build_fast_tlb_refill_handler(&p, &l, &r, K0, K1, in build_r4000_tlb_refill_handler()
1273 uasm_i_dmfc0(&p, K0, C0_BADVADDR); in build_r4000_tlb_refill_handler()
1274 uasm_i_dmfc0(&p, K1, C0_ENTRYHI); in build_r4000_tlb_refill_handler()
1275 uasm_i_xor(&p, K0, K0, K1); in build_r4000_tlb_refill_handler()
1276 uasm_i_dsrl_safe(&p, K1, K0, 62); in build_r4000_tlb_refill_handler()
1277 uasm_i_dsrl_safe(&p, K0, K0, 12 + 1); in build_r4000_tlb_refill_handler()
1278 uasm_i_dsll_safe(&p, K0, K0, 64 + 12 + 1 - segbits); in build_r4000_tlb_refill_handler()
1279 uasm_i_or(&p, K0, K0, K1); in build_r4000_tlb_refill_handler()
1280 uasm_il_bnez(&p, &r, K0, label_leave); in build_r4000_tlb_refill_handler()
1285 build_get_pmde64(&p, &l, &r, K0, K1); /* get pmd in K1 */ in build_r4000_tlb_refill_handler()
1287 build_get_pgde32(&p, K0, K1); /* get pgd in K1 */ in build_r4000_tlb_refill_handler()
1291 build_is_huge_pte(&p, &r, K0, K1, label_tlb_huge_update); in build_r4000_tlb_refill_handler()
1294 build_get_ptep(&p, K0, K1); in build_r4000_tlb_refill_handler()
1295 build_update_entries(&p, K0, K1); in build_r4000_tlb_refill_handler()
1296 build_tlb_write_entry(&p, &l, &r, tlb_random); in build_r4000_tlb_refill_handler()
1297 uasm_l_leave(&l, p); in build_r4000_tlb_refill_handler()
1298 uasm_i_eret(&p); /* return from trap */ in build_r4000_tlb_refill_handler()
1301 uasm_l_tlb_huge_update(&l, p); in build_r4000_tlb_refill_handler()
1303 UASM_i_LW(&p, htlb_info.huge_pte, 0, K1); in build_r4000_tlb_refill_handler()
1304 build_huge_update_entries(&p, htlb_info.huge_pte, K1); in build_r4000_tlb_refill_handler()
1305 build_huge_tlb_write_entry(&p, &l, &r, K0, tlb_random, in build_r4000_tlb_refill_handler()
1310 build_get_pgd_vmalloc64(&p, &l, &r, K0, K1, vmalloc_mode); in build_r4000_tlb_refill_handler()
1325 if ((p - tlb_handler) > 64) in build_r4000_tlb_refill_handler()
1332 uasm_copy_handler(relocs, labels, tlb_handler, p, f); in build_r4000_tlb_refill_handler()
1333 final_len = p - tlb_handler; in build_r4000_tlb_refill_handler()
1336 if (((p - tlb_handler) > (MIPS64_REFILL_INSNS * 2) - 1) in build_r4000_tlb_refill_handler()
1337 || (((p - tlb_handler) > (MIPS64_REFILL_INSNS * 2) - 3) in build_r4000_tlb_refill_handler()
1345 if ((p - tlb_handler) <= MIPS64_REFILL_INSNS) { in build_r4000_tlb_refill_handler()
1347 uasm_copy_handler(relocs, labels, tlb_handler, p, f); in build_r4000_tlb_refill_handler()
1348 final_len = p - tlb_handler; in build_r4000_tlb_refill_handler()
1368 split < p - MIPS64_REFILL_INSNS) in build_r4000_tlb_refill_handler()
1407 uasm_copy_handler(relocs, labels, split, p, final_handler); in build_r4000_tlb_refill_handler()
1409 (p - split); in build_r4000_tlb_refill_handler()
1436 u32 *p = tlbmiss_handler_setup_pgd_start; in build_setup_pgd() local
1460 UASM_i_SRA(&p, a1, a0, 29); in build_setup_pgd()
1461 UASM_i_ADDIU(&p, a1, a1, 4); in build_setup_pgd()
1462 uasm_il_bnez(&p, &r, a1, label_tlbl_goaround1); in build_setup_pgd()
1463 uasm_i_nop(&p); in build_setup_pgd()
1464 uasm_i_dinsm(&p, a0, 0, 29, 64 - 29); in build_setup_pgd()
1465 uasm_l_tlbl_goaround1(&l, p); in build_setup_pgd()
1466 UASM_i_SLL(&p, a0, a0, 11); in build_setup_pgd()
1467 uasm_i_jr(&p, 31); in build_setup_pgd()
1468 UASM_i_MTC0(&p, a0, C0_CONTEXT); in build_setup_pgd()
1471 uasm_i_jr(&p, 31); in build_setup_pgd()
1472 UASM_i_MTC0(&p, a0, c0_kscratch(), pgd_reg); in build_setup_pgd()
1477 UASM_i_CPUID_MFC0(&p, a1, SMP_CPUID_REG); in build_setup_pgd()
1478 UASM_i_SRL_SAFE(&p, a1, a1, SMP_CPUID_PTRSHIFT); in build_setup_pgd()
1479 UASM_i_LA_mostly(&p, a2, pgdc); in build_setup_pgd()
1480 UASM_i_ADDU(&p, a2, a2, a1); in build_setup_pgd()
1481 UASM_i_SW(&p, a0, uasm_rel_lo(pgdc), a2); in build_setup_pgd()
1483 UASM_i_LA_mostly(&p, a2, pgdc); in build_setup_pgd()
1484 UASM_i_SW(&p, a0, uasm_rel_lo(pgdc), a2); in build_setup_pgd()
1486 uasm_i_jr(&p, 31); in build_setup_pgd()
1490 UASM_i_MTC0(&p, a0, c0_kscratch(), pgd_reg); in build_setup_pgd()
1492 uasm_i_nop(&p); in build_setup_pgd()
1494 if (p >= tlbmiss_handler_setup_pgd_end) in build_setup_pgd()
1499 (unsigned int)(p - tlbmiss_handler_setup_pgd)); in build_setup_pgd()
1506 iPTE_LW(u32 **p, unsigned int pte, unsigned int ptr) in iPTE_LW() argument
1511 uasm_i_lld(p, pte, 0, ptr); in iPTE_LW()
1514 UASM_i_LL(p, pte, 0, ptr); in iPTE_LW()
1518 uasm_i_ld(p, pte, 0, ptr); in iPTE_LW()
1521 UASM_i_LW(p, pte, 0, ptr); in iPTE_LW()
1526 iPTE_SW(u32 **p, struct uasm_reloc **r, unsigned int pte, unsigned int ptr, in iPTE_SW() argument
1535 uasm_i_lui(p, scratch, (mode >> 16)); in iPTE_SW()
1536 uasm_i_or(p, pte, pte, scratch); in iPTE_SW()
1539 uasm_i_ori(p, pte, pte, mode); in iPTE_SW()
1543 uasm_i_scd(p, pte, 0, ptr); in iPTE_SW()
1546 UASM_i_SC(p, pte, 0, ptr); in iPTE_SW()
1549 uasm_il_beqzl(p, r, pte, label_smp_pgtable_change); in iPTE_SW()
1551 uasm_il_beqz(p, r, pte, label_smp_pgtable_change); in iPTE_SW()
1556 uasm_i_ll(p, pte, sizeof(pte_t) / 2, ptr); in iPTE_SW()
1557 uasm_i_ori(p, pte, pte, hwmode); in iPTE_SW()
1558 uasm_i_sc(p, pte, sizeof(pte_t) / 2, ptr); in iPTE_SW()
1559 uasm_il_beqz(p, r, pte, label_smp_pgtable_change); in iPTE_SW()
1561 uasm_i_lw(p, pte, 0, ptr); in iPTE_SW()
1563 uasm_i_nop(p); in iPTE_SW()
1565 uasm_i_nop(p); in iPTE_SW()
1570 uasm_i_sd(p, pte, 0, ptr); in iPTE_SW()
1573 UASM_i_SW(p, pte, 0, ptr); in iPTE_SW()
1577 uasm_i_lw(p, pte, sizeof(pte_t) / 2, ptr); in iPTE_SW()
1578 uasm_i_ori(p, pte, pte, hwmode); in iPTE_SW()
1579 uasm_i_sw(p, pte, sizeof(pte_t) / 2, ptr); in iPTE_SW()
1580 uasm_i_lw(p, pte, 0, ptr); in iPTE_SW()
1592 build_pte_present(u32 **p, struct uasm_reloc **r, in build_pte_present() argument
1600 uasm_il_bbit0(p, r, pte, ilog2(_PAGE_PRESENT), lid); in build_pte_present()
1601 uasm_i_nop(p); in build_pte_present()
1604 uasm_i_srl(p, t, cur, _PAGE_PRESENT_SHIFT); in build_pte_present()
1607 uasm_i_andi(p, t, cur, 1); in build_pte_present()
1608 uasm_il_beqz(p, r, t, lid); in build_pte_present()
1611 iPTE_LW(p, pte, ptr); in build_pte_present()
1615 uasm_i_srl(p, t, cur, _PAGE_PRESENT_SHIFT); in build_pte_present()
1618 uasm_i_andi(p, t, cur, in build_pte_present()
1620 uasm_i_xori(p, t, t, in build_pte_present()
1622 uasm_il_bnez(p, r, t, lid); in build_pte_present()
1625 iPTE_LW(p, pte, ptr); in build_pte_present()
1631 build_make_valid(u32 **p, struct uasm_reloc **r, unsigned int pte, in build_make_valid() argument
1636 iPTE_SW(p, r, pte, ptr, mode); in build_make_valid()
1644 build_pte_writable(u32 **p, struct uasm_reloc **r, in build_pte_writable() argument
1652 uasm_i_srl(p, t, cur, _PAGE_PRESENT_SHIFT); in build_pte_writable()
1655 uasm_i_andi(p, t, cur, in build_pte_writable()
1657 uasm_i_xori(p, t, t, in build_pte_writable()
1659 uasm_il_bnez(p, r, t, lid); in build_pte_writable()
1662 iPTE_LW(p, pte, ptr); in build_pte_writable()
1664 uasm_i_nop(p); in build_pte_writable()
1671 build_make_write(u32 **p, struct uasm_reloc **r, unsigned int pte, in build_make_write() argument
1677 iPTE_SW(p, r, pte, ptr, mode); in build_make_write()
1685 build_pte_modifiable(u32 **p, struct uasm_reloc **r, in build_pte_modifiable() argument
1690 uasm_il_bbit0(p, r, pte, ilog2(_PAGE_WRITE), lid); in build_pte_modifiable()
1691 uasm_i_nop(p); in build_pte_modifiable()
1694 uasm_i_srl(p, t, pte, _PAGE_WRITE_SHIFT); in build_pte_modifiable()
1695 uasm_i_andi(p, t, t, 1); in build_pte_modifiable()
1696 uasm_il_beqz(p, r, t, lid); in build_pte_modifiable()
1699 iPTE_LW(p, pte, ptr); in build_pte_modifiable()
1715 build_r3000_pte_reload_tlbwi(u32 **p, unsigned int pte, unsigned int tmp) in build_r3000_pte_reload_tlbwi() argument
1717 uasm_i_mtc0(p, pte, C0_ENTRYLO0); /* cp0 delay */ in build_r3000_pte_reload_tlbwi()
1718 uasm_i_mfc0(p, tmp, C0_EPC); /* cp0 delay */ in build_r3000_pte_reload_tlbwi()
1719 uasm_i_tlbwi(p); in build_r3000_pte_reload_tlbwi()
1720 uasm_i_jr(p, tmp); in build_r3000_pte_reload_tlbwi()
1721 uasm_i_rfe(p); /* branch delay */ in build_r3000_pte_reload_tlbwi()
1731 build_r3000_tlb_reload_write(u32 **p, struct uasm_label **l, in build_r3000_tlb_reload_write() argument
1735 uasm_i_mfc0(p, tmp, C0_INDEX); in build_r3000_tlb_reload_write()
1736 uasm_i_mtc0(p, pte, C0_ENTRYLO0); /* cp0 delay */ in build_r3000_tlb_reload_write()
1737 uasm_il_bltz(p, r, tmp, label_r3000_write_probe_fail); /* cp0 delay */ in build_r3000_tlb_reload_write()
1738 uasm_i_mfc0(p, tmp, C0_EPC); /* branch delay */ in build_r3000_tlb_reload_write()
1739 uasm_i_tlbwi(p); /* cp0 delay */ in build_r3000_tlb_reload_write()
1740 uasm_i_jr(p, tmp); in build_r3000_tlb_reload_write()
1741 uasm_i_rfe(p); /* branch delay */ in build_r3000_tlb_reload_write()
1742 uasm_l_r3000_write_probe_fail(l, *p); in build_r3000_tlb_reload_write()
1743 uasm_i_tlbwr(p); /* cp0 delay */ in build_r3000_tlb_reload_write()
1744 uasm_i_jr(p, tmp); in build_r3000_tlb_reload_write()
1745 uasm_i_rfe(p); /* branch delay */ in build_r3000_tlb_reload_write()
1749 build_r3000_tlbchange_handler_head(u32 **p, unsigned int pte, in build_r3000_tlbchange_handler_head() argument
1754 uasm_i_mfc0(p, pte, C0_BADVADDR); in build_r3000_tlbchange_handler_head()
1755 uasm_i_lui(p, ptr, uasm_rel_hi(pgdc)); /* cp0 delay */ in build_r3000_tlbchange_handler_head()
1756 uasm_i_lw(p, ptr, uasm_rel_lo(pgdc), ptr); in build_r3000_tlbchange_handler_head()
1757 uasm_i_srl(p, pte, pte, 22); /* load delay */ in build_r3000_tlbchange_handler_head()
1758 uasm_i_sll(p, pte, pte, 2); in build_r3000_tlbchange_handler_head()
1759 uasm_i_addu(p, ptr, ptr, pte); in build_r3000_tlbchange_handler_head()
1760 uasm_i_mfc0(p, pte, C0_CONTEXT); in build_r3000_tlbchange_handler_head()
1761 uasm_i_lw(p, ptr, 0, ptr); /* cp0 delay */ in build_r3000_tlbchange_handler_head()
1762 uasm_i_andi(p, pte, pte, 0xffc); /* load delay */ in build_r3000_tlbchange_handler_head()
1763 uasm_i_addu(p, ptr, ptr, pte); in build_r3000_tlbchange_handler_head()
1764 uasm_i_lw(p, pte, 0, ptr); in build_r3000_tlbchange_handler_head()
1765 uasm_i_tlbp(p); /* load delay */ in build_r3000_tlbchange_handler_head()
1770 u32 *p = handle_tlbl; in build_r3000_tlb_load_handler() local
1779 build_r3000_tlbchange_handler_head(&p, K0, K1); in build_r3000_tlb_load_handler()
1780 build_pte_present(&p, &r, K0, K1, -1, label_nopage_tlbl); in build_r3000_tlb_load_handler()
1781 uasm_i_nop(&p); /* load delay */ in build_r3000_tlb_load_handler()
1782 build_make_valid(&p, &r, K0, K1); in build_r3000_tlb_load_handler()
1783 build_r3000_tlb_reload_write(&p, &l, &r, K0, K1); in build_r3000_tlb_load_handler()
1785 uasm_l_nopage_tlbl(&l, p); in build_r3000_tlb_load_handler()
1786 uasm_i_j(&p, (unsigned long)tlb_do_page_fault_0 & 0x0fffffff); in build_r3000_tlb_load_handler()
1787 uasm_i_nop(&p); in build_r3000_tlb_load_handler()
1789 if (p >= handle_tlbl_end) in build_r3000_tlb_load_handler()
1794 (unsigned int)(p - handle_tlbl)); in build_r3000_tlb_load_handler()
1801 u32 *p = handle_tlbs; in build_r3000_tlb_store_handler() local
1810 build_r3000_tlbchange_handler_head(&p, K0, K1); in build_r3000_tlb_store_handler()
1811 build_pte_writable(&p, &r, K0, K1, -1, label_nopage_tlbs); in build_r3000_tlb_store_handler()
1812 uasm_i_nop(&p); /* load delay */ in build_r3000_tlb_store_handler()
1813 build_make_write(&p, &r, K0, K1); in build_r3000_tlb_store_handler()
1814 build_r3000_tlb_reload_write(&p, &l, &r, K0, K1); in build_r3000_tlb_store_handler()
1816 uasm_l_nopage_tlbs(&l, p); in build_r3000_tlb_store_handler()
1817 uasm_i_j(&p, (unsigned long)tlb_do_page_fault_1 & 0x0fffffff); in build_r3000_tlb_store_handler()
1818 uasm_i_nop(&p); in build_r3000_tlb_store_handler()
1820 if (p >= handle_tlbs_end) in build_r3000_tlb_store_handler()
1825 (unsigned int)(p - handle_tlbs)); in build_r3000_tlb_store_handler()
1832 u32 *p = handle_tlbm; in build_r3000_tlb_modify_handler() local
1841 build_r3000_tlbchange_handler_head(&p, K0, K1); in build_r3000_tlb_modify_handler()
1842 build_pte_modifiable(&p, &r, K0, K1, -1, label_nopage_tlbm); in build_r3000_tlb_modify_handler()
1843 uasm_i_nop(&p); /* load delay */ in build_r3000_tlb_modify_handler()
1844 build_make_write(&p, &r, K0, K1); in build_r3000_tlb_modify_handler()
1845 build_r3000_pte_reload_tlbwi(&p, K0, K1); in build_r3000_tlb_modify_handler()
1847 uasm_l_nopage_tlbm(&l, p); in build_r3000_tlb_modify_handler()
1848 uasm_i_j(&p, (unsigned long)tlb_do_page_fault_1 & 0x0fffffff); in build_r3000_tlb_modify_handler()
1849 uasm_i_nop(&p); in build_r3000_tlb_modify_handler()
1851 if (p >= handle_tlbm_end) in build_r3000_tlb_modify_handler()
1856 (unsigned int)(p - handle_tlbm)); in build_r3000_tlb_modify_handler()
1866 build_r4000_tlbchange_handler_head(u32 **p, struct uasm_label **l, in build_r4000_tlbchange_handler_head() argument
1869 struct work_registers wr = build_get_work_registers(p); in build_r4000_tlbchange_handler_head()
1872 build_get_pmde64(p, l, r, wr.r1, wr.r2); /* get pmd in ptr */ in build_r4000_tlbchange_handler_head()
1874 build_get_pgde32(p, wr.r1, wr.r2); /* get pgd in ptr */ in build_r4000_tlbchange_handler_head()
1883 build_is_huge_pte(p, r, wr.r1, wr.r2, label_tlb_huge_update); in build_r4000_tlbchange_handler_head()
1886 UASM_i_MFC0(p, wr.r1, C0_BADVADDR); in build_r4000_tlbchange_handler_head()
1887 UASM_i_LW(p, wr.r2, 0, wr.r2); in build_r4000_tlbchange_handler_head()
1888 UASM_i_SRL(p, wr.r1, wr.r1, PAGE_SHIFT + PTE_ORDER - PTE_T_LOG2); in build_r4000_tlbchange_handler_head()
1889 uasm_i_andi(p, wr.r1, wr.r1, (PTRS_PER_PTE - 1) << PTE_T_LOG2); in build_r4000_tlbchange_handler_head()
1890 UASM_i_ADDU(p, wr.r2, wr.r2, wr.r1); in build_r4000_tlbchange_handler_head()
1893 uasm_l_smp_pgtable_change(l, *p); in build_r4000_tlbchange_handler_head()
1895 iPTE_LW(p, wr.r1, wr.r2); /* get even pte */ in build_r4000_tlbchange_handler_head()
1897 build_tlb_probe_entry(p); in build_r4000_tlbchange_handler_head()
1900 uasm_i_ehb(p); in build_r4000_tlbchange_handler_head()
1901 uasm_i_mfc0(p, wr.r3, C0_INDEX); in build_r4000_tlbchange_handler_head()
1902 uasm_il_bltz(p, r, wr.r3, label_leave); in build_r4000_tlbchange_handler_head()
1903 uasm_i_nop(p); in build_r4000_tlbchange_handler_head()
1910 build_r4000_tlbchange_handler_tail(u32 **p, struct uasm_label **l, in build_r4000_tlbchange_handler_tail() argument
1914 uasm_i_ori(p, ptr, ptr, sizeof(pte_t)); in build_r4000_tlbchange_handler_tail()
1915 uasm_i_xori(p, ptr, ptr, sizeof(pte_t)); in build_r4000_tlbchange_handler_tail()
1916 build_update_entries(p, tmp, ptr); in build_r4000_tlbchange_handler_tail()
1917 build_tlb_write_entry(p, l, r, tlb_indexed); in build_r4000_tlbchange_handler_tail()
1918 uasm_l_leave(l, *p); in build_r4000_tlbchange_handler_tail()
1919 build_restore_work_registers(p); in build_r4000_tlbchange_handler_tail()
1920 uasm_i_eret(p); /* return from trap */ in build_r4000_tlbchange_handler_tail()
1923 build_get_pgd_vmalloc64(p, l, r, tmp, ptr, not_refill); in build_r4000_tlbchange_handler_tail()
1929 u32 *p = handle_tlbl; in build_r4000_tlb_load_handler() local
1942 uasm_i_dmfc0(&p, K0, C0_BADVADDR); in build_r4000_tlb_load_handler()
1943 uasm_i_dmfc0(&p, K1, C0_ENTRYHI); in build_r4000_tlb_load_handler()
1944 uasm_i_xor(&p, K0, K0, K1); in build_r4000_tlb_load_handler()
1945 uasm_i_dsrl_safe(&p, K1, K0, 62); in build_r4000_tlb_load_handler()
1946 uasm_i_dsrl_safe(&p, K0, K0, 12 + 1); in build_r4000_tlb_load_handler()
1947 uasm_i_dsll_safe(&p, K0, K0, 64 + 12 + 1 - segbits); in build_r4000_tlb_load_handler()
1948 uasm_i_or(&p, K0, K0, K1); in build_r4000_tlb_load_handler()
1949 uasm_il_bnez(&p, &r, K0, label_leave); in build_r4000_tlb_load_handler()
1953 wr = build_r4000_tlbchange_handler_head(&p, &l, &r); in build_r4000_tlb_load_handler()
1954 build_pte_present(&p, &r, wr.r1, wr.r2, wr.r3, label_nopage_tlbl); in build_r4000_tlb_load_handler()
1956 build_tlb_probe_entry(&p); in build_r4000_tlb_load_handler()
1964 uasm_il_bbit0(&p, &r, wr.r1, ilog2(_PAGE_VALID), in build_r4000_tlb_load_handler()
1967 uasm_i_andi(&p, wr.r3, wr.r1, _PAGE_VALID); in build_r4000_tlb_load_handler()
1968 uasm_il_beqz(&p, &r, wr.r3, label_tlbl_goaround1); in build_r4000_tlb_load_handler()
1970 uasm_i_nop(&p); in build_r4000_tlb_load_handler()
1972 uasm_i_tlbr(&p); in build_r4000_tlb_load_handler()
1977 uasm_i_ehb(&p); in build_r4000_tlb_load_handler()
1988 uasm_i_bbit0(&p, wr.r2, ilog2(sizeof(pte_t)), 8); in build_r4000_tlb_load_handler()
1990 uasm_i_andi(&p, wr.r3, wr.r2, sizeof(pte_t)); in build_r4000_tlb_load_handler()
1991 uasm_i_beqz(&p, wr.r3, 8); in build_r4000_tlb_load_handler()
1994 UASM_i_MFC0(&p, wr.r3, C0_ENTRYLO0); in build_r4000_tlb_load_handler()
1996 UASM_i_MFC0(&p, wr.r3, C0_ENTRYLO1); in build_r4000_tlb_load_handler()
2002 uasm_il_bbit1(&p, &r, wr.r3, 1, label_nopage_tlbl); in build_r4000_tlb_load_handler()
2003 uasm_i_nop(&p); in build_r4000_tlb_load_handler()
2004 uasm_l_tlbl_goaround1(&l, p); in build_r4000_tlb_load_handler()
2006 uasm_i_andi(&p, wr.r3, wr.r3, 2); in build_r4000_tlb_load_handler()
2007 uasm_il_bnez(&p, &r, wr.r3, label_nopage_tlbl); in build_r4000_tlb_load_handler()
2008 uasm_i_nop(&p); in build_r4000_tlb_load_handler()
2010 uasm_l_tlbl_goaround1(&l, p); in build_r4000_tlb_load_handler()
2012 build_make_valid(&p, &r, wr.r1, wr.r2); in build_r4000_tlb_load_handler()
2013 build_r4000_tlbchange_handler_tail(&p, &l, &r, wr.r1, wr.r2); in build_r4000_tlb_load_handler()
2020 uasm_l_tlb_huge_update(&l, p); in build_r4000_tlb_load_handler()
2021 iPTE_LW(&p, wr.r1, wr.r2); in build_r4000_tlb_load_handler()
2022 build_pte_present(&p, &r, wr.r1, wr.r2, wr.r3, label_nopage_tlbl); in build_r4000_tlb_load_handler()
2023 build_tlb_probe_entry(&p); in build_r4000_tlb_load_handler()
2031 uasm_il_bbit0(&p, &r, wr.r1, ilog2(_PAGE_VALID), in build_r4000_tlb_load_handler()
2034 uasm_i_andi(&p, wr.r3, wr.r1, _PAGE_VALID); in build_r4000_tlb_load_handler()
2035 uasm_il_beqz(&p, &r, wr.r3, label_tlbl_goaround2); in build_r4000_tlb_load_handler()
2037 uasm_i_nop(&p); in build_r4000_tlb_load_handler()
2039 uasm_i_tlbr(&p); in build_r4000_tlb_load_handler()
2044 uasm_i_ehb(&p); in build_r4000_tlb_load_handler()
2055 uasm_i_bbit0(&p, wr.r2, ilog2(sizeof(pte_t)), 8); in build_r4000_tlb_load_handler()
2057 uasm_i_andi(&p, wr.r3, wr.r2, sizeof(pte_t)); in build_r4000_tlb_load_handler()
2058 uasm_i_beqz(&p, wr.r3, 8); in build_r4000_tlb_load_handler()
2061 UASM_i_MFC0(&p, wr.r3, C0_ENTRYLO0); in build_r4000_tlb_load_handler()
2063 UASM_i_MFC0(&p, wr.r3, C0_ENTRYLO1); in build_r4000_tlb_load_handler()
2069 uasm_il_bbit0(&p, &r, wr.r3, 1, label_tlbl_goaround2); in build_r4000_tlb_load_handler()
2071 uasm_i_andi(&p, wr.r3, wr.r3, 2); in build_r4000_tlb_load_handler()
2072 uasm_il_beqz(&p, &r, wr.r3, label_tlbl_goaround2); in build_r4000_tlb_load_handler()
2075 uasm_i_nop(&p); in build_r4000_tlb_load_handler()
2080 build_restore_pagemask(&p, &r, wr.r3, label_nopage_tlbl, 0); in build_r4000_tlb_load_handler()
2082 uasm_l_tlbl_goaround2(&l, p); in build_r4000_tlb_load_handler()
2084 uasm_i_ori(&p, wr.r1, wr.r1, (_PAGE_ACCESSED | _PAGE_VALID)); in build_r4000_tlb_load_handler()
2085 build_huge_handler_tail(&p, &r, &l, wr.r1, wr.r2); in build_r4000_tlb_load_handler()
2088 uasm_l_nopage_tlbl(&l, p); in build_r4000_tlb_load_handler()
2089 build_restore_work_registers(&p); in build_r4000_tlb_load_handler()
2092 uasm_i_lui(&p, K0, uasm_rel_hi((long)tlb_do_page_fault_0)); in build_r4000_tlb_load_handler()
2093 uasm_i_addiu(&p, K0, K0, uasm_rel_lo((long)tlb_do_page_fault_0)); in build_r4000_tlb_load_handler()
2094 uasm_i_jr(&p, K0); in build_r4000_tlb_load_handler()
2097 uasm_i_j(&p, (unsigned long)tlb_do_page_fault_0 & 0x0fffffff); in build_r4000_tlb_load_handler()
2098 uasm_i_nop(&p); in build_r4000_tlb_load_handler()
2100 if (p >= handle_tlbl_end) in build_r4000_tlb_load_handler()
2105 (unsigned int)(p - handle_tlbl)); in build_r4000_tlb_load_handler()
2112 u32 *p = handle_tlbs; in build_r4000_tlb_store_handler() local
2122 wr = build_r4000_tlbchange_handler_head(&p, &l, &r); in build_r4000_tlb_store_handler()
2123 build_pte_writable(&p, &r, wr.r1, wr.r2, wr.r3, label_nopage_tlbs); in build_r4000_tlb_store_handler()
2125 build_tlb_probe_entry(&p); in build_r4000_tlb_store_handler()
2126 build_make_write(&p, &r, wr.r1, wr.r2); in build_r4000_tlb_store_handler()
2127 build_r4000_tlbchange_handler_tail(&p, &l, &r, wr.r1, wr.r2); in build_r4000_tlb_store_handler()
2134 uasm_l_tlb_huge_update(&l, p); in build_r4000_tlb_store_handler()
2135 iPTE_LW(&p, wr.r1, wr.r2); in build_r4000_tlb_store_handler()
2136 build_pte_writable(&p, &r, wr.r1, wr.r2, wr.r3, label_nopage_tlbs); in build_r4000_tlb_store_handler()
2137 build_tlb_probe_entry(&p); in build_r4000_tlb_store_handler()
2138 uasm_i_ori(&p, wr.r1, wr.r1, in build_r4000_tlb_store_handler()
2140 build_huge_handler_tail(&p, &r, &l, wr.r1, wr.r2); in build_r4000_tlb_store_handler()
2143 uasm_l_nopage_tlbs(&l, p); in build_r4000_tlb_store_handler()
2144 build_restore_work_registers(&p); in build_r4000_tlb_store_handler()
2147 uasm_i_lui(&p, K0, uasm_rel_hi((long)tlb_do_page_fault_1)); in build_r4000_tlb_store_handler()
2148 uasm_i_addiu(&p, K0, K0, uasm_rel_lo((long)tlb_do_page_fault_1)); in build_r4000_tlb_store_handler()
2149 uasm_i_jr(&p, K0); in build_r4000_tlb_store_handler()
2152 uasm_i_j(&p, (unsigned long)tlb_do_page_fault_1 & 0x0fffffff); in build_r4000_tlb_store_handler()
2153 uasm_i_nop(&p); in build_r4000_tlb_store_handler()
2155 if (p >= handle_tlbs_end) in build_r4000_tlb_store_handler()
2160 (unsigned int)(p - handle_tlbs)); in build_r4000_tlb_store_handler()
2167 u32 *p = handle_tlbm; in build_r4000_tlb_modify_handler() local
2177 wr = build_r4000_tlbchange_handler_head(&p, &l, &r); in build_r4000_tlb_modify_handler()
2178 build_pte_modifiable(&p, &r, wr.r1, wr.r2, wr.r3, label_nopage_tlbm); in build_r4000_tlb_modify_handler()
2180 build_tlb_probe_entry(&p); in build_r4000_tlb_modify_handler()
2182 build_make_write(&p, &r, wr.r1, wr.r2); in build_r4000_tlb_modify_handler()
2183 build_r4000_tlbchange_handler_tail(&p, &l, &r, wr.r1, wr.r2); in build_r4000_tlb_modify_handler()
2190 uasm_l_tlb_huge_update(&l, p); in build_r4000_tlb_modify_handler()
2191 iPTE_LW(&p, wr.r1, wr.r2); in build_r4000_tlb_modify_handler()
2192 build_pte_modifiable(&p, &r, wr.r1, wr.r2, wr.r3, label_nopage_tlbm); in build_r4000_tlb_modify_handler()
2193 build_tlb_probe_entry(&p); in build_r4000_tlb_modify_handler()
2194 uasm_i_ori(&p, wr.r1, wr.r1, in build_r4000_tlb_modify_handler()
2196 build_huge_handler_tail(&p, &r, &l, wr.r1, wr.r2); in build_r4000_tlb_modify_handler()
2199 uasm_l_nopage_tlbm(&l, p); in build_r4000_tlb_modify_handler()
2200 build_restore_work_registers(&p); in build_r4000_tlb_modify_handler()
2203 uasm_i_lui(&p, K0, uasm_rel_hi((long)tlb_do_page_fault_1)); in build_r4000_tlb_modify_handler()
2204 uasm_i_addiu(&p, K0, K0, uasm_rel_lo((long)tlb_do_page_fault_1)); in build_r4000_tlb_modify_handler()
2205 uasm_i_jr(&p, K0); in build_r4000_tlb_modify_handler()
2208 uasm_i_j(&p, (unsigned long)tlb_do_page_fault_1 & 0x0fffffff); in build_r4000_tlb_modify_handler()
2209 uasm_i_nop(&p); in build_r4000_tlb_modify_handler()
2211 if (p >= handle_tlbm_end) in build_r4000_tlb_modify_handler()
2216 (unsigned int)(p - handle_tlbm)); in build_r4000_tlb_modify_handler()