643 case MISCREG_L2CTLR: 644 { 645 // mostly unimplemented, just set NumCPUs field from sim and return 646 L2CTLR l2ctlr = 0; 647 // b00:1CPU to b11:4CPUs 648 l2ctlr.numCPUs = tc->getSystemPtr()->numContexts() - 1; 649 return l2ctlr; 650 } 651 case MISCREG_DBGDIDR: 652 /* For now just implement the version number. 653 * ARMv7, v7.1 Debug architecture (0b0101 --> 0x5) 654 */ 655 return 0x5 << 16; 656 case MISCREG_DBGDSCRint: 657 return 0; 658 case MISCREG_ISR: 659 return tc->getCpuPtr()->getInterruptController(tc->threadId())->getISR( 660 readMiscRegNoEffect(MISCREG_HCR), 661 readMiscRegNoEffect(MISCREG_CPSR), 662 readMiscRegNoEffect(MISCREG_SCR)); 663 case MISCREG_ISR_EL1: 664 return tc->getCpuPtr()->getInterruptController(tc->threadId())->getISR( 665 readMiscRegNoEffect(MISCREG_HCR_EL2), 666 readMiscRegNoEffect(MISCREG_CPSR), 667 readMiscRegNoEffect(MISCREG_SCR_EL3)); 668 case MISCREG_DCZID_EL0: 669 return 0x04; // DC ZVA clear 64-byte chunks 670 case MISCREG_HCPTR: 671 { 672 RegVal val = readMiscRegNoEffect(misc_reg); 673 // The trap bit associated with CP14 is defined as RAZ 674 val &= ~(1 << 14); 675 // If a CP bit in NSACR is 0 then the corresponding bit in 676 // HCPTR is RAO/WI 677 bool secure_lookup = haveSecurity && 678 inSecureState(readMiscRegNoEffect(MISCREG_SCR), 679 readMiscRegNoEffect(MISCREG_CPSR)); 680 if (!secure_lookup) { 681 RegVal mask = readMiscRegNoEffect(MISCREG_NSACR); 682 val |= (mask ^ 0x7FFF) & 0xBFFF; 683 } 684 // Set the bits for unimplemented coprocessors to RAO/WI 685 val |= 0x33FF; 686 return (val); 687 } 688 case MISCREG_HDFAR: // alias for secure DFAR 689 return readMiscRegNoEffect(MISCREG_DFAR_S); 690 case MISCREG_HIFAR: // alias for secure IFAR 691 return readMiscRegNoEffect(MISCREG_IFAR_S); 692 693 case MISCREG_ID_PFR0: 694 // !ThumbEE | !Jazelle | Thumb | ARM 695 return 0x00000031; 696 case MISCREG_ID_PFR1: 697 { // Timer | Virti | !M Profile | TrustZone | ARMv4 698 bool haveTimer = (system->getGenericTimer() != NULL); 699 return 0x00000001 700 | (haveSecurity ? 0x00000010 : 0x0) 701 | (haveVirtualization ? 0x00001000 : 0x0) 702 | (haveTimer ? 0x00010000 : 0x0); 703 } 704 case MISCREG_ID_AA64PFR0_EL1: 705 return 0x0000000000000002 | // AArch{64,32} supported at EL0 706 0x0000000000000020 | // EL1 707 (haveVirtualization ? 0x0000000000000200 : 0) | // EL2 708 (haveSecurity ? 0x0000000000002000 : 0) | // EL3 709 (haveSVE ? 0x0000000100000000 : 0) | // SVE 710 (haveGICv3CPUInterface ? 0x0000000001000000 : 0); 711 case MISCREG_ID_AA64PFR1_EL1: 712 return 0; // bits [63:0] RES0 (reserved for future use) 713 714 // Generic Timer registers 715 case MISCREG_CNTHV_CTL_EL2: 716 case MISCREG_CNTHV_CVAL_EL2: 717 case MISCREG_CNTHV_TVAL_EL2: 718 case MISCREG_CNTFRQ ... MISCREG_CNTHP_CTL: 719 case MISCREG_CNTPCT ... MISCREG_CNTHP_CVAL: 720 case MISCREG_CNTKCTL_EL1 ... MISCREG_CNTV_CVAL_EL0: 721 case MISCREG_CNTVOFF_EL2 ... MISCREG_CNTPS_CVAL_EL1: 722 return getGenericTimer(tc).readMiscReg(misc_reg); 723 724 case MISCREG_ICC_PMR_EL1 ... MISCREG_ICC_IGRPEN1_EL3: 725 case MISCREG_ICH_AP0R0_EL2 ... MISCREG_ICH_LR15_EL2: 726 return getGICv3CPUInterface(tc).readMiscReg(misc_reg); 727 728 default: 729 break; 730 731 } 732 return readMiscRegNoEffect(misc_reg); 733} 734 735void 736ISA::setMiscRegNoEffect(int misc_reg, RegVal val) 737{ 738 assert(misc_reg < NumMiscRegs); 739 740 const auto ® = lookUpMiscReg[misc_reg]; // bit masks 741 const auto &map = getMiscIndices(misc_reg); 742 int lower = map.first, upper = map.second; 743 744 auto v = (val & ~reg.wi()) | reg.rao(); 745 if (upper > 0) { 746 miscRegs[lower] = bits(v, 31, 0); 747 miscRegs[upper] = bits(v, 63, 32); 748 DPRINTF(MiscRegs, "Writing to misc reg %d (%d:%d) : %#x\n", 749 misc_reg, lower, upper, v); 750 } else { 751 miscRegs[lower] = v; 752 DPRINTF(MiscRegs, "Writing to misc reg %d (%d) : %#x\n", 753 misc_reg, lower, v); 754 } 755} 756 757void 758ISA::setMiscReg(int misc_reg, RegVal val, ThreadContext *tc) 759{ 760 761 RegVal newVal = val; 762 bool secure_lookup; 763 SCR scr; 764 765 if (misc_reg == MISCREG_CPSR) { 766 updateRegMap(val); 767 768 769 CPSR old_cpsr = miscRegs[MISCREG_CPSR]; 770 int old_mode = old_cpsr.mode; 771 CPSR cpsr = val; 772 if (old_mode != cpsr.mode || cpsr.il != old_cpsr.il) { 773 getITBPtr(tc)->invalidateMiscReg(); 774 getDTBPtr(tc)->invalidateMiscReg(); 775 } 776 777 DPRINTF(Arm, "Updating CPSR from %#x to %#x f:%d i:%d a:%d mode:%#x\n", 778 miscRegs[misc_reg], cpsr, cpsr.f, cpsr.i, cpsr.a, cpsr.mode); 779 PCState pc = tc->pcState(); 780 pc.nextThumb(cpsr.t); 781 pc.nextJazelle(cpsr.j); 782 pc.illegalExec(cpsr.il == 1); 783 784 tc->getDecoderPtr()->setSveLen((getCurSveVecLenInBits(tc) >> 7) - 1); 785 786 // Follow slightly different semantics if a CheckerCPU object 787 // is connected 788 CheckerCPU *checker = tc->getCheckerCpuPtr(); 789 if (checker) { 790 tc->pcStateNoRecord(pc); 791 } else { 792 tc->pcState(pc); 793 } 794 } else { 795#ifndef NDEBUG 796 if (!miscRegInfo[misc_reg][MISCREG_IMPLEMENTED]) { 797 if (miscRegInfo[misc_reg][MISCREG_WARN_NOT_FAIL]) 798 warn("Unimplemented system register %s write with %#x.\n", 799 miscRegName[misc_reg], val); 800 else 801 panic("Unimplemented system register %s write with %#x.\n", 802 miscRegName[misc_reg], val); 803 } 804#endif 805 switch (unflattenMiscReg(misc_reg)) { 806 case MISCREG_CPACR: 807 { 808 809 const uint32_t ones = (uint32_t)(-1); 810 CPACR cpacrMask = 0; 811 // Only cp10, cp11, and ase are implemented, nothing else should 812 // be writable 813 cpacrMask.cp10 = ones; 814 cpacrMask.cp11 = ones; 815 cpacrMask.asedis = ones; 816 817 // Security Extensions may limit the writability of CPACR 818 if (haveSecurity) { 819 scr = readMiscRegNoEffect(MISCREG_SCR); 820 CPSR cpsr = readMiscRegNoEffect(MISCREG_CPSR); 821 if (scr.ns && (cpsr.mode != MODE_MON) && ELIs32(tc, EL3)) { 822 NSACR nsacr = readMiscRegNoEffect(MISCREG_NSACR); 823 // NB: Skipping the full loop, here 824 if (!nsacr.cp10) cpacrMask.cp10 = 0; 825 if (!nsacr.cp11) cpacrMask.cp11 = 0; 826 } 827 } 828 829 RegVal old_val = readMiscRegNoEffect(MISCREG_CPACR); 830 newVal &= cpacrMask; 831 newVal |= old_val & ~cpacrMask; 832 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 833 miscRegName[misc_reg], newVal); 834 } 835 break; 836 case MISCREG_CPACR_EL1: 837 { 838 const uint32_t ones = (uint32_t)(-1); 839 CPACR cpacrMask = 0; 840 cpacrMask.tta = ones; 841 cpacrMask.fpen = ones; 842 if (haveSVE) { 843 cpacrMask.zen = ones; 844 } 845 newVal &= cpacrMask; 846 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 847 miscRegName[misc_reg], newVal); 848 } 849 break; 850 case MISCREG_CPTR_EL2: 851 { 852 const uint32_t ones = (uint32_t)(-1); 853 CPTR cptrMask = 0; 854 cptrMask.tcpac = ones; 855 cptrMask.tta = ones; 856 cptrMask.tfp = ones; 857 if (haveSVE) { 858 cptrMask.tz = ones; 859 } 860 newVal &= cptrMask; 861 cptrMask = 0; 862 cptrMask.res1_13_12_el2 = ones; 863 cptrMask.res1_7_0_el2 = ones; 864 if (!haveSVE) { 865 cptrMask.res1_8_el2 = ones; 866 } 867 cptrMask.res1_9_el2 = ones; 868 newVal |= cptrMask; 869 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 870 miscRegName[misc_reg], newVal); 871 } 872 break; 873 case MISCREG_CPTR_EL3: 874 { 875 const uint32_t ones = (uint32_t)(-1); 876 CPTR cptrMask = 0; 877 cptrMask.tcpac = ones; 878 cptrMask.tta = ones; 879 cptrMask.tfp = ones; 880 if (haveSVE) { 881 cptrMask.ez = ones; 882 } 883 newVal &= cptrMask; 884 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 885 miscRegName[misc_reg], newVal); 886 } 887 break; 888 case MISCREG_CSSELR: 889 warn_once("The csselr register isn't implemented.\n"); 890 return; 891 892 case MISCREG_DC_ZVA_Xt: 893 warn("Calling DC ZVA! Not Implemeted! Expect WEIRD results\n"); 894 return; 895 896 case MISCREG_FPSCR: 897 { 898 const uint32_t ones = (uint32_t)(-1); 899 FPSCR fpscrMask = 0; 900 fpscrMask.ioc = ones; 901 fpscrMask.dzc = ones; 902 fpscrMask.ofc = ones; 903 fpscrMask.ufc = ones; 904 fpscrMask.ixc = ones; 905 fpscrMask.idc = ones; 906 fpscrMask.ioe = ones; 907 fpscrMask.dze = ones; 908 fpscrMask.ofe = ones; 909 fpscrMask.ufe = ones; 910 fpscrMask.ixe = ones; 911 fpscrMask.ide = ones; 912 fpscrMask.len = ones; 913 fpscrMask.fz16 = ones; 914 fpscrMask.stride = ones; 915 fpscrMask.rMode = ones; 916 fpscrMask.fz = ones; 917 fpscrMask.dn = ones; 918 fpscrMask.ahp = ones; 919 fpscrMask.qc = ones; 920 fpscrMask.v = ones; 921 fpscrMask.c = ones; 922 fpscrMask.z = ones; 923 fpscrMask.n = ones; 924 newVal = (newVal & (uint32_t)fpscrMask) | 925 (readMiscRegNoEffect(MISCREG_FPSCR) & 926 ~(uint32_t)fpscrMask); 927 tc->getDecoderPtr()->setContext(newVal); 928 } 929 break; 930 case MISCREG_FPSR: 931 { 932 const uint32_t ones = (uint32_t)(-1); 933 FPSCR fpscrMask = 0; 934 fpscrMask.ioc = ones; 935 fpscrMask.dzc = ones; 936 fpscrMask.ofc = ones; 937 fpscrMask.ufc = ones; 938 fpscrMask.ixc = ones; 939 fpscrMask.idc = ones; 940 fpscrMask.qc = ones; 941 fpscrMask.v = ones; 942 fpscrMask.c = ones; 943 fpscrMask.z = ones; 944 fpscrMask.n = ones; 945 newVal = (newVal & (uint32_t)fpscrMask) | 946 (readMiscRegNoEffect(MISCREG_FPSCR) & 947 ~(uint32_t)fpscrMask); 948 misc_reg = MISCREG_FPSCR; 949 } 950 break; 951 case MISCREG_FPCR: 952 { 953 const uint32_t ones = (uint32_t)(-1); 954 FPSCR fpscrMask = 0; 955 fpscrMask.len = ones; 956 fpscrMask.fz16 = ones; 957 fpscrMask.stride = ones; 958 fpscrMask.rMode = ones; 959 fpscrMask.fz = ones; 960 fpscrMask.dn = ones; 961 fpscrMask.ahp = ones; 962 newVal = (newVal & (uint32_t)fpscrMask) | 963 (readMiscRegNoEffect(MISCREG_FPSCR) & 964 ~(uint32_t)fpscrMask); 965 misc_reg = MISCREG_FPSCR; 966 } 967 break; 968 case MISCREG_CPSR_Q: 969 { 970 assert(!(newVal & ~CpsrMaskQ)); 971 newVal = readMiscRegNoEffect(MISCREG_CPSR) | newVal; 972 misc_reg = MISCREG_CPSR; 973 } 974 break; 975 case MISCREG_FPSCR_QC: 976 { 977 newVal = readMiscRegNoEffect(MISCREG_FPSCR) | 978 (newVal & FpscrQcMask); 979 misc_reg = MISCREG_FPSCR; 980 } 981 break; 982 case MISCREG_FPSCR_EXC: 983 { 984 newVal = readMiscRegNoEffect(MISCREG_FPSCR) | 985 (newVal & FpscrExcMask); 986 misc_reg = MISCREG_FPSCR; 987 } 988 break; 989 case MISCREG_FPEXC: 990 { 991 // vfpv3 architecture, section B.6.1 of DDI04068 992 // bit 29 - valid only if fpexc[31] is 0 993 const uint32_t fpexcMask = 0x60000000; 994 newVal = (newVal & fpexcMask) | 995 (readMiscRegNoEffect(MISCREG_FPEXC) & ~fpexcMask); 996 } 997 break; 998 case MISCREG_HCR: 999 { 1000 if (!haveVirtualization) 1001 return; 1002 } 1003 break; 1004 case MISCREG_IFSR: 1005 { 1006 // ARM ARM (ARM DDI 0406C.b) B4.1.96 1007 const uint32_t ifsrMask = 1008 mask(31, 13) | mask(11, 11) | mask(8, 6); 1009 newVal = newVal & ~ifsrMask; 1010 } 1011 break; 1012 case MISCREG_DFSR: 1013 { 1014 // ARM ARM (ARM DDI 0406C.b) B4.1.52 1015 const uint32_t dfsrMask = mask(31, 14) | mask(8, 8); 1016 newVal = newVal & ~dfsrMask; 1017 } 1018 break; 1019 case MISCREG_AMAIR0: 1020 case MISCREG_AMAIR1: 1021 { 1022 // ARM ARM (ARM DDI 0406C.b) B4.1.5 1023 // Valid only with LPAE 1024 if (!haveLPAE) 1025 return; 1026 DPRINTF(MiscRegs, "Writing AMAIR: %#x\n", newVal); 1027 } 1028 break; 1029 case MISCREG_SCR: 1030 getITBPtr(tc)->invalidateMiscReg(); 1031 getDTBPtr(tc)->invalidateMiscReg(); 1032 break; 1033 case MISCREG_SCTLR: 1034 { 1035 DPRINTF(MiscRegs, "Writing SCTLR: %#x\n", newVal); 1036 scr = readMiscRegNoEffect(MISCREG_SCR); 1037 1038 MiscRegIndex sctlr_idx; 1039 if (haveSecurity && !highestELIs64 && !scr.ns) { 1040 sctlr_idx = MISCREG_SCTLR_S; 1041 } else { 1042 sctlr_idx = MISCREG_SCTLR_NS; 1043 } 1044 1045 SCTLR sctlr = miscRegs[sctlr_idx]; 1046 SCTLR new_sctlr = newVal; 1047 new_sctlr.nmfi = ((bool)sctlr.nmfi) && !haveVirtualization; 1048 miscRegs[sctlr_idx] = (RegVal)new_sctlr; 1049 getITBPtr(tc)->invalidateMiscReg(); 1050 getDTBPtr(tc)->invalidateMiscReg(); 1051 } 1052 case MISCREG_MIDR: 1053 case MISCREG_ID_PFR0: 1054 case MISCREG_ID_PFR1: 1055 case MISCREG_ID_DFR0: 1056 case MISCREG_ID_MMFR0: 1057 case MISCREG_ID_MMFR1: 1058 case MISCREG_ID_MMFR2: 1059 case MISCREG_ID_MMFR3: 1060 case MISCREG_ID_ISAR0: 1061 case MISCREG_ID_ISAR1: 1062 case MISCREG_ID_ISAR2: 1063 case MISCREG_ID_ISAR3: 1064 case MISCREG_ID_ISAR4: 1065 case MISCREG_ID_ISAR5: 1066 1067 case MISCREG_MPIDR: 1068 case MISCREG_FPSID: 1069 case MISCREG_TLBTR: 1070 case MISCREG_MVFR0: 1071 case MISCREG_MVFR1: 1072 1073 case MISCREG_ID_AA64AFR0_EL1: 1074 case MISCREG_ID_AA64AFR1_EL1: 1075 case MISCREG_ID_AA64DFR0_EL1: 1076 case MISCREG_ID_AA64DFR1_EL1: 1077 case MISCREG_ID_AA64ISAR0_EL1: 1078 case MISCREG_ID_AA64ISAR1_EL1: 1079 case MISCREG_ID_AA64MMFR0_EL1: 1080 case MISCREG_ID_AA64MMFR1_EL1: 1081 case MISCREG_ID_AA64MMFR2_EL1: 1082 case MISCREG_ID_AA64PFR0_EL1: 1083 case MISCREG_ID_AA64PFR1_EL1: 1084 // ID registers are constants. 1085 return; 1086 1087 // TLB Invalidate All 1088 case MISCREG_TLBIALL: // TLBI all entries, EL0&1, 1089 { 1090 assert32(tc); 1091 scr = readMiscReg(MISCREG_SCR, tc); 1092 1093 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1094 tlbiOp(tc); 1095 return; 1096 } 1097 // TLB Invalidate All, Inner Shareable 1098 case MISCREG_TLBIALLIS: 1099 { 1100 assert32(tc); 1101 scr = readMiscReg(MISCREG_SCR, tc); 1102 1103 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1104 tlbiOp.broadcast(tc); 1105 return; 1106 } 1107 // Instruction TLB Invalidate All 1108 case MISCREG_ITLBIALL: 1109 { 1110 assert32(tc); 1111 scr = readMiscReg(MISCREG_SCR, tc); 1112 1113 ITLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1114 tlbiOp(tc); 1115 return; 1116 } 1117 // Data TLB Invalidate All 1118 case MISCREG_DTLBIALL: 1119 { 1120 assert32(tc); 1121 scr = readMiscReg(MISCREG_SCR, tc); 1122 1123 DTLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1124 tlbiOp(tc); 1125 return; 1126 } 1127 // TLB Invalidate by VA 1128 // mcr tlbimval(is) is invalidating all matching entries 1129 // regardless of the level of lookup, since in gem5 we cache 1130 // in the tlb the last level of lookup only. 1131 case MISCREG_TLBIMVA: 1132 case MISCREG_TLBIMVAL: 1133 { 1134 assert32(tc); 1135 scr = readMiscReg(MISCREG_SCR, tc); 1136 1137 TLBIMVA tlbiOp(EL1, 1138 haveSecurity && !scr.ns, 1139 mbits(newVal, 31, 12), 1140 bits(newVal, 7,0)); 1141 1142 tlbiOp(tc); 1143 return; 1144 } 1145 // TLB Invalidate by VA, Inner Shareable 1146 case MISCREG_TLBIMVAIS: 1147 case MISCREG_TLBIMVALIS: 1148 { 1149 assert32(tc); 1150 scr = readMiscReg(MISCREG_SCR, tc); 1151 1152 TLBIMVA tlbiOp(EL1, 1153 haveSecurity && !scr.ns, 1154 mbits(newVal, 31, 12), 1155 bits(newVal, 7,0)); 1156 1157 tlbiOp.broadcast(tc); 1158 return; 1159 } 1160 // TLB Invalidate by ASID match 1161 case MISCREG_TLBIASID: 1162 { 1163 assert32(tc); 1164 scr = readMiscReg(MISCREG_SCR, tc); 1165 1166 TLBIASID tlbiOp(EL1, 1167 haveSecurity && !scr.ns, 1168 bits(newVal, 7,0)); 1169 1170 tlbiOp(tc); 1171 return; 1172 } 1173 // TLB Invalidate by ASID match, Inner Shareable 1174 case MISCREG_TLBIASIDIS: 1175 { 1176 assert32(tc); 1177 scr = readMiscReg(MISCREG_SCR, tc); 1178 1179 TLBIASID tlbiOp(EL1, 1180 haveSecurity && !scr.ns, 1181 bits(newVal, 7,0)); 1182 1183 tlbiOp.broadcast(tc); 1184 return; 1185 } 1186 // mcr tlbimvaal(is) is invalidating all matching entries 1187 // regardless of the level of lookup, since in gem5 we cache 1188 // in the tlb the last level of lookup only. 1189 // TLB Invalidate by VA, All ASID 1190 case MISCREG_TLBIMVAA: 1191 case MISCREG_TLBIMVAAL: 1192 { 1193 assert32(tc); 1194 scr = readMiscReg(MISCREG_SCR, tc); 1195 1196 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1197 mbits(newVal, 31,12)); 1198 1199 tlbiOp(tc); 1200 return; 1201 } 1202 // TLB Invalidate by VA, All ASID, Inner Shareable 1203 case MISCREG_TLBIMVAAIS: 1204 case MISCREG_TLBIMVAALIS: 1205 { 1206 assert32(tc); 1207 scr = readMiscReg(MISCREG_SCR, tc); 1208 1209 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1210 mbits(newVal, 31,12)); 1211 1212 tlbiOp.broadcast(tc); 1213 return; 1214 } 1215 // mcr tlbimvalh(is) is invalidating all matching entries 1216 // regardless of the level of lookup, since in gem5 we cache 1217 // in the tlb the last level of lookup only. 1218 // TLB Invalidate by VA, Hyp mode 1219 case MISCREG_TLBIMVAH: 1220 case MISCREG_TLBIMVALH: 1221 { 1222 assert32(tc); 1223 scr = readMiscReg(MISCREG_SCR, tc); 1224 1225 TLBIMVAA tlbiOp(EL2, haveSecurity && !scr.ns, 1226 mbits(newVal, 31,12)); 1227 1228 tlbiOp(tc); 1229 return; 1230 } 1231 // TLB Invalidate by VA, Hyp mode, Inner Shareable 1232 case MISCREG_TLBIMVAHIS: 1233 case MISCREG_TLBIMVALHIS: 1234 { 1235 assert32(tc); 1236 scr = readMiscReg(MISCREG_SCR, tc); 1237 1238 TLBIMVAA tlbiOp(EL2, haveSecurity && !scr.ns, 1239 mbits(newVal, 31,12)); 1240 1241 tlbiOp.broadcast(tc); 1242 return; 1243 } 1244 // mcr tlbiipas2l(is) is invalidating all matching entries 1245 // regardless of the level of lookup, since in gem5 we cache 1246 // in the tlb the last level of lookup only. 1247 // TLB Invalidate by Intermediate Physical Address, Stage 2 1248 case MISCREG_TLBIIPAS2: 1249 case MISCREG_TLBIIPAS2L: 1250 { 1251 assert32(tc); 1252 scr = readMiscReg(MISCREG_SCR, tc); 1253 1254 TLBIIPA tlbiOp(EL1, 1255 haveSecurity && !scr.ns, 1256 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1257 1258 tlbiOp(tc); 1259 return; 1260 } 1261 // TLB Invalidate by Intermediate Physical Address, Stage 2, 1262 // Inner Shareable 1263 case MISCREG_TLBIIPAS2IS: 1264 case MISCREG_TLBIIPAS2LIS: 1265 { 1266 assert32(tc); 1267 scr = readMiscReg(MISCREG_SCR, tc); 1268 1269 TLBIIPA tlbiOp(EL1, 1270 haveSecurity && !scr.ns, 1271 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1272 1273 tlbiOp.broadcast(tc); 1274 return; 1275 } 1276 // Instruction TLB Invalidate by VA 1277 case MISCREG_ITLBIMVA: 1278 { 1279 assert32(tc); 1280 scr = readMiscReg(MISCREG_SCR, tc); 1281 1282 ITLBIMVA tlbiOp(EL1, 1283 haveSecurity && !scr.ns, 1284 mbits(newVal, 31, 12), 1285 bits(newVal, 7,0)); 1286 1287 tlbiOp(tc); 1288 return; 1289 } 1290 // Data TLB Invalidate by VA 1291 case MISCREG_DTLBIMVA: 1292 { 1293 assert32(tc); 1294 scr = readMiscReg(MISCREG_SCR, tc); 1295 1296 DTLBIMVA tlbiOp(EL1, 1297 haveSecurity && !scr.ns, 1298 mbits(newVal, 31, 12), 1299 bits(newVal, 7,0)); 1300 1301 tlbiOp(tc); 1302 return; 1303 } 1304 // Instruction TLB Invalidate by ASID match 1305 case MISCREG_ITLBIASID: 1306 { 1307 assert32(tc); 1308 scr = readMiscReg(MISCREG_SCR, tc); 1309 1310 ITLBIASID tlbiOp(EL1, 1311 haveSecurity && !scr.ns, 1312 bits(newVal, 7,0)); 1313 1314 tlbiOp(tc); 1315 return; 1316 } 1317 // Data TLB Invalidate by ASID match 1318 case MISCREG_DTLBIASID: 1319 { 1320 assert32(tc); 1321 scr = readMiscReg(MISCREG_SCR, tc); 1322 1323 DTLBIASID tlbiOp(EL1, 1324 haveSecurity && !scr.ns, 1325 bits(newVal, 7,0)); 1326 1327 tlbiOp(tc); 1328 return; 1329 } 1330 // TLB Invalidate All, Non-Secure Non-Hyp 1331 case MISCREG_TLBIALLNSNH: 1332 { 1333 assert32(tc); 1334 1335 TLBIALLN tlbiOp(EL1); 1336 tlbiOp(tc); 1337 return; 1338 } 1339 // TLB Invalidate All, Non-Secure Non-Hyp, Inner Shareable 1340 case MISCREG_TLBIALLNSNHIS: 1341 { 1342 assert32(tc); 1343 1344 TLBIALLN tlbiOp(EL1); 1345 tlbiOp.broadcast(tc); 1346 return; 1347 } 1348 // TLB Invalidate All, Hyp mode 1349 case MISCREG_TLBIALLH: 1350 { 1351 assert32(tc); 1352 1353 TLBIALLN tlbiOp(EL2); 1354 tlbiOp(tc); 1355 return; 1356 } 1357 // TLB Invalidate All, Hyp mode, Inner Shareable 1358 case MISCREG_TLBIALLHIS: 1359 { 1360 assert32(tc); 1361 1362 TLBIALLN tlbiOp(EL2); 1363 tlbiOp.broadcast(tc); 1364 return; 1365 } 1366 // AArch64 TLB Invalidate All, EL3 1367 case MISCREG_TLBI_ALLE3: 1368 { 1369 assert64(tc); 1370 1371 TLBIALL tlbiOp(EL3, true); 1372 tlbiOp(tc); 1373 return; 1374 } 1375 // AArch64 TLB Invalidate All, EL3, Inner Shareable 1376 case MISCREG_TLBI_ALLE3IS: 1377 { 1378 assert64(tc); 1379 1380 TLBIALL tlbiOp(EL3, true); 1381 tlbiOp.broadcast(tc); 1382 return; 1383 } 1384 // AArch64 TLB Invalidate All, EL2, Inner Shareable 1385 case MISCREG_TLBI_ALLE2: 1386 case MISCREG_TLBI_ALLE2IS: 1387 { 1388 assert64(tc); 1389 scr = readMiscReg(MISCREG_SCR, tc); 1390 1391 TLBIALL tlbiOp(EL2, haveSecurity && !scr.ns); 1392 tlbiOp(tc); 1393 return; 1394 } 1395 // AArch64 TLB Invalidate All, EL1 1396 case MISCREG_TLBI_ALLE1: 1397 case MISCREG_TLBI_VMALLE1: 1398 case MISCREG_TLBI_VMALLS12E1: 1399 // @todo: handle VMID and stage 2 to enable Virtualization 1400 { 1401 assert64(tc); 1402 scr = readMiscReg(MISCREG_SCR, tc); 1403 1404 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1405 tlbiOp(tc); 1406 return; 1407 } 1408 // AArch64 TLB Invalidate All, EL1, Inner Shareable 1409 case MISCREG_TLBI_ALLE1IS: 1410 case MISCREG_TLBI_VMALLE1IS: 1411 case MISCREG_TLBI_VMALLS12E1IS: 1412 // @todo: handle VMID and stage 2 to enable Virtualization 1413 { 1414 assert64(tc); 1415 scr = readMiscReg(MISCREG_SCR, tc); 1416 1417 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1418 tlbiOp.broadcast(tc); 1419 return; 1420 } 1421 // VAEx(IS) and VALEx(IS) are the same because TLBs 1422 // only store entries 1423 // from the last level of translation table walks 1424 // @todo: handle VMID to enable Virtualization 1425 // AArch64 TLB Invalidate by VA, EL3 1426 case MISCREG_TLBI_VAE3_Xt: 1427 case MISCREG_TLBI_VALE3_Xt: 1428 { 1429 assert64(tc); 1430 1431 TLBIMVA tlbiOp(EL3, true, 1432 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1433 0xbeef); 1434 tlbiOp(tc); 1435 return; 1436 } 1437 // AArch64 TLB Invalidate by VA, EL3, Inner Shareable 1438 case MISCREG_TLBI_VAE3IS_Xt: 1439 case MISCREG_TLBI_VALE3IS_Xt: 1440 { 1441 assert64(tc); 1442 1443 TLBIMVA tlbiOp(EL3, true, 1444 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1445 0xbeef); 1446 1447 tlbiOp.broadcast(tc); 1448 return; 1449 } 1450 // AArch64 TLB Invalidate by VA, EL2 1451 case MISCREG_TLBI_VAE2_Xt: 1452 case MISCREG_TLBI_VALE2_Xt: 1453 { 1454 assert64(tc); 1455 scr = readMiscReg(MISCREG_SCR, tc); 1456 1457 TLBIMVA tlbiOp(EL2, haveSecurity && !scr.ns, 1458 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1459 0xbeef); 1460 tlbiOp(tc); 1461 return; 1462 } 1463 // AArch64 TLB Invalidate by VA, EL2, Inner Shareable 1464 case MISCREG_TLBI_VAE2IS_Xt: 1465 case MISCREG_TLBI_VALE2IS_Xt: 1466 { 1467 assert64(tc); 1468 scr = readMiscReg(MISCREG_SCR, tc); 1469 1470 TLBIMVA tlbiOp(EL2, haveSecurity && !scr.ns, 1471 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1472 0xbeef); 1473 1474 tlbiOp.broadcast(tc); 1475 return; 1476 } 1477 // AArch64 TLB Invalidate by VA, EL1 1478 case MISCREG_TLBI_VAE1_Xt: 1479 case MISCREG_TLBI_VALE1_Xt: 1480 { 1481 assert64(tc); 1482 scr = readMiscReg(MISCREG_SCR, tc); 1483 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1484 bits(newVal, 55, 48); 1485 1486 TLBIMVA tlbiOp(EL1, haveSecurity && !scr.ns, 1487 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1488 asid); 1489 1490 tlbiOp(tc); 1491 return; 1492 } 1493 // AArch64 TLB Invalidate by VA, EL1, Inner Shareable 1494 case MISCREG_TLBI_VAE1IS_Xt: 1495 case MISCREG_TLBI_VALE1IS_Xt: 1496 { 1497 assert64(tc); 1498 scr = readMiscReg(MISCREG_SCR, tc); 1499 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1500 bits(newVal, 55, 48); 1501 1502 TLBIMVA tlbiOp(EL1, haveSecurity && !scr.ns, 1503 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1504 asid); 1505 1506 tlbiOp.broadcast(tc); 1507 return; 1508 } 1509 // AArch64 TLB Invalidate by ASID, EL1 1510 // @todo: handle VMID to enable Virtualization 1511 case MISCREG_TLBI_ASIDE1_Xt: 1512 { 1513 assert64(tc); 1514 scr = readMiscReg(MISCREG_SCR, tc); 1515 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1516 bits(newVal, 55, 48); 1517 1518 TLBIASID tlbiOp(EL1, haveSecurity && !scr.ns, asid); 1519 tlbiOp(tc); 1520 return; 1521 } 1522 // AArch64 TLB Invalidate by ASID, EL1, Inner Shareable 1523 case MISCREG_TLBI_ASIDE1IS_Xt: 1524 { 1525 assert64(tc); 1526 scr = readMiscReg(MISCREG_SCR, tc); 1527 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1528 bits(newVal, 55, 48); 1529 1530 TLBIASID tlbiOp(EL1, haveSecurity && !scr.ns, asid); 1531 tlbiOp.broadcast(tc); 1532 return; 1533 } 1534 // VAAE1(IS) and VAALE1(IS) are the same because TLBs only store 1535 // entries from the last level of translation table walks 1536 // AArch64 TLB Invalidate by VA, All ASID, EL1 1537 case MISCREG_TLBI_VAAE1_Xt: 1538 case MISCREG_TLBI_VAALE1_Xt: 1539 { 1540 assert64(tc); 1541 scr = readMiscReg(MISCREG_SCR, tc); 1542 1543 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1544 static_cast<Addr>(bits(newVal, 43, 0)) << 12); 1545 1546 tlbiOp(tc); 1547 return; 1548 } 1549 // AArch64 TLB Invalidate by VA, All ASID, EL1, Inner Shareable 1550 case MISCREG_TLBI_VAAE1IS_Xt: 1551 case MISCREG_TLBI_VAALE1IS_Xt: 1552 { 1553 assert64(tc); 1554 scr = readMiscReg(MISCREG_SCR, tc); 1555 1556 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1557 static_cast<Addr>(bits(newVal, 43, 0)) << 12); 1558 1559 tlbiOp.broadcast(tc); 1560 return; 1561 } 1562 // AArch64 TLB Invalidate by Intermediate Physical Address, 1563 // Stage 2, EL1 1564 case MISCREG_TLBI_IPAS2E1_Xt: 1565 case MISCREG_TLBI_IPAS2LE1_Xt: 1566 { 1567 assert64(tc); 1568 scr = readMiscReg(MISCREG_SCR, tc); 1569 1570 TLBIIPA tlbiOp(EL1, haveSecurity && !scr.ns, 1571 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1572 1573 tlbiOp(tc); 1574 return; 1575 } 1576 // AArch64 TLB Invalidate by Intermediate Physical Address, 1577 // Stage 2, EL1, Inner Shareable 1578 case MISCREG_TLBI_IPAS2E1IS_Xt: 1579 case MISCREG_TLBI_IPAS2LE1IS_Xt: 1580 { 1581 assert64(tc); 1582 scr = readMiscReg(MISCREG_SCR, tc); 1583 1584 TLBIIPA tlbiOp(EL1, haveSecurity && !scr.ns, 1585 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1586 1587 tlbiOp.broadcast(tc); 1588 return; 1589 } 1590 case MISCREG_ACTLR: 1591 warn("Not doing anything for write of miscreg ACTLR\n"); 1592 break; 1593 1594 case MISCREG_PMXEVTYPER_PMCCFILTR: 1595 case MISCREG_PMINTENSET_EL1 ... MISCREG_PMOVSSET_EL0: 1596 case MISCREG_PMEVCNTR0_EL0 ... MISCREG_PMEVTYPER5_EL0: 1597 case MISCREG_PMCR ... MISCREG_PMOVSSET: 1598 pmu->setMiscReg(misc_reg, newVal); 1599 break; 1600 1601 1602 case MISCREG_HSTR: // TJDBX, now redifined to be RES0 1603 { 1604 HSTR hstrMask = 0; 1605 hstrMask.tjdbx = 1; 1606 newVal &= ~((uint32_t) hstrMask); 1607 break; 1608 } 1609 case MISCREG_HCPTR: 1610 { 1611 // If a CP bit in NSACR is 0 then the corresponding bit in 1612 // HCPTR is RAO/WI. Same applies to NSASEDIS 1613 secure_lookup = haveSecurity && 1614 inSecureState(readMiscRegNoEffect(MISCREG_SCR), 1615 readMiscRegNoEffect(MISCREG_CPSR)); 1616 if (!secure_lookup) { 1617 RegVal oldValue = readMiscRegNoEffect(MISCREG_HCPTR); 1618 RegVal mask = 1619 (readMiscRegNoEffect(MISCREG_NSACR) ^ 0x7FFF) & 0xBFFF; 1620 newVal = (newVal & ~mask) | (oldValue & mask); 1621 } 1622 break; 1623 } 1624 case MISCREG_HDFAR: // alias for secure DFAR 1625 misc_reg = MISCREG_DFAR_S; 1626 break; 1627 case MISCREG_HIFAR: // alias for secure IFAR 1628 misc_reg = MISCREG_IFAR_S; 1629 break; 1630 case MISCREG_ATS1CPR: 1631 case MISCREG_ATS1CPW: 1632 case MISCREG_ATS1CUR: 1633 case MISCREG_ATS1CUW: 1634 case MISCREG_ATS12NSOPR: 1635 case MISCREG_ATS12NSOPW: 1636 case MISCREG_ATS12NSOUR: 1637 case MISCREG_ATS12NSOUW: 1638 case MISCREG_ATS1HR: 1639 case MISCREG_ATS1HW: 1640 { 1641 Request::Flags flags = 0; 1642 BaseTLB::Mode mode = BaseTLB::Read; 1643 TLB::ArmTranslationType tranType = TLB::NormalTran; 1644 Fault fault; 1645 switch(misc_reg) { 1646 case MISCREG_ATS1CPR: 1647 flags = TLB::MustBeOne; 1648 tranType = TLB::S1CTran; 1649 mode = BaseTLB::Read; 1650 break; 1651 case MISCREG_ATS1CPW: 1652 flags = TLB::MustBeOne; 1653 tranType = TLB::S1CTran; 1654 mode = BaseTLB::Write; 1655 break; 1656 case MISCREG_ATS1CUR: 1657 flags = TLB::MustBeOne | TLB::UserMode; 1658 tranType = TLB::S1CTran; 1659 mode = BaseTLB::Read; 1660 break; 1661 case MISCREG_ATS1CUW: 1662 flags = TLB::MustBeOne | TLB::UserMode; 1663 tranType = TLB::S1CTran; 1664 mode = BaseTLB::Write; 1665 break; 1666 case MISCREG_ATS12NSOPR: 1667 if (!haveSecurity) 1668 panic("Security Extensions required for ATS12NSOPR"); 1669 flags = TLB::MustBeOne; 1670 tranType = TLB::S1S2NsTran; 1671 mode = BaseTLB::Read; 1672 break; 1673 case MISCREG_ATS12NSOPW: 1674 if (!haveSecurity) 1675 panic("Security Extensions required for ATS12NSOPW"); 1676 flags = TLB::MustBeOne; 1677 tranType = TLB::S1S2NsTran; 1678 mode = BaseTLB::Write; 1679 break; 1680 case MISCREG_ATS12NSOUR: 1681 if (!haveSecurity) 1682 panic("Security Extensions required for ATS12NSOUR"); 1683 flags = TLB::MustBeOne | TLB::UserMode; 1684 tranType = TLB::S1S2NsTran; 1685 mode = BaseTLB::Read; 1686 break; 1687 case MISCREG_ATS12NSOUW: 1688 if (!haveSecurity) 1689 panic("Security Extensions required for ATS12NSOUW"); 1690 flags = TLB::MustBeOne | TLB::UserMode; 1691 tranType = TLB::S1S2NsTran; 1692 mode = BaseTLB::Write; 1693 break; 1694 case MISCREG_ATS1HR: // only really useful from secure mode. 1695 flags = TLB::MustBeOne; 1696 tranType = TLB::HypMode; 1697 mode = BaseTLB::Read; 1698 break; 1699 case MISCREG_ATS1HW: 1700 flags = TLB::MustBeOne; 1701 tranType = TLB::HypMode; 1702 mode = BaseTLB::Write; 1703 break; 1704 } 1705 // If we're in timing mode then doing the translation in 1706 // functional mode then we're slightly distorting performance 1707 // results obtained from simulations. The translation should be 1708 // done in the same mode the core is running in. NOTE: This 1709 // can't be an atomic translation because that causes problems 1710 // with unexpected atomic snoop requests. 1711 warn("Translating via %s in functional mode! Fix Me!\n", 1712 miscRegName[misc_reg]); 1713 1714 auto req = std::make_shared<Request>( 1715 0, val, 0, flags, Request::funcMasterId, 1716 tc->pcState().pc(), tc->contextId()); 1717 1718 fault = getDTBPtr(tc)->translateFunctional( 1719 req, tc, mode, tranType); 1720 1721 TTBCR ttbcr = readMiscRegNoEffect(MISCREG_TTBCR); 1722 HCR hcr = readMiscRegNoEffect(MISCREG_HCR); 1723 1724 RegVal newVal; 1725 if (fault == NoFault) { 1726 Addr paddr = req->getPaddr(); 1727 if (haveLPAE && (ttbcr.eae || tranType & TLB::HypMode || 1728 ((tranType & TLB::S1S2NsTran) && hcr.vm) )) { 1729 newVal = (paddr & mask(39, 12)) | 1730 (getDTBPtr(tc)->getAttr()); 1731 } else { 1732 newVal = (paddr & 0xfffff000) | 1733 (getDTBPtr(tc)->getAttr()); 1734 } 1735 DPRINTF(MiscRegs, 1736 "MISCREG: Translated addr 0x%08x: PAR: 0x%08x\n", 1737 val, newVal); 1738 } else { 1739 ArmFault *armFault = static_cast<ArmFault *>(fault.get()); 1740 armFault->update(tc); 1741 // Set fault bit and FSR 1742 FSR fsr = armFault->getFsr(tc); 1743 1744 newVal = ((fsr >> 9) & 1) << 11; 1745 if (newVal) { 1746 // LPAE - rearange fault status 1747 newVal |= ((fsr >> 0) & 0x3f) << 1; 1748 } else { 1749 // VMSA - rearange fault status 1750 newVal |= ((fsr >> 0) & 0xf) << 1; 1751 newVal |= ((fsr >> 10) & 0x1) << 5; 1752 newVal |= ((fsr >> 12) & 0x1) << 6; 1753 } 1754 newVal |= 0x1; // F bit 1755 newVal |= ((armFault->iss() >> 7) & 0x1) << 8; 1756 newVal |= armFault->isStage2() ? 0x200 : 0; 1757 DPRINTF(MiscRegs, 1758 "MISCREG: Translated addr 0x%08x fault fsr %#x: PAR: 0x%08x\n", 1759 val, fsr, newVal); 1760 } 1761 setMiscRegNoEffect(MISCREG_PAR, newVal); 1762 return; 1763 } 1764 case MISCREG_TTBCR: 1765 { 1766 TTBCR ttbcr = readMiscRegNoEffect(MISCREG_TTBCR); 1767 const uint32_t ones = (uint32_t)(-1); 1768 TTBCR ttbcrMask = 0; 1769 TTBCR ttbcrNew = newVal; 1770 1771 // ARM DDI 0406C.b, ARMv7-32 1772 ttbcrMask.n = ones; // T0SZ 1773 if (haveSecurity) { 1774 ttbcrMask.pd0 = ones; 1775 ttbcrMask.pd1 = ones; 1776 } 1777 ttbcrMask.epd0 = ones; 1778 ttbcrMask.irgn0 = ones; 1779 ttbcrMask.orgn0 = ones; 1780 ttbcrMask.sh0 = ones; 1781 ttbcrMask.ps = ones; // T1SZ 1782 ttbcrMask.a1 = ones; 1783 ttbcrMask.epd1 = ones; 1784 ttbcrMask.irgn1 = ones; 1785 ttbcrMask.orgn1 = ones; 1786 ttbcrMask.sh1 = ones; 1787 if (haveLPAE) 1788 ttbcrMask.eae = ones; 1789 1790 if (haveLPAE && ttbcrNew.eae) { 1791 newVal = newVal & ttbcrMask; 1792 } else { 1793 newVal = (newVal & ttbcrMask) | (ttbcr & (~ttbcrMask)); 1794 } 1795 // Invalidate TLB MiscReg 1796 getITBPtr(tc)->invalidateMiscReg(); 1797 getDTBPtr(tc)->invalidateMiscReg(); 1798 break; 1799 } 1800 case MISCREG_TTBR0: 1801 case MISCREG_TTBR1: 1802 { 1803 TTBCR ttbcr = readMiscRegNoEffect(MISCREG_TTBCR); 1804 if (haveLPAE) { 1805 if (ttbcr.eae) { 1806 // ARMv7 bit 63-56, 47-40 reserved, UNK/SBZP 1807 // ARMv8 AArch32 bit 63-56 only 1808 uint64_t ttbrMask = mask(63,56) | mask(47,40); 1809 newVal = (newVal & (~ttbrMask)); 1810 } 1811 } 1812 // Invalidate TLB MiscReg 1813 getITBPtr(tc)->invalidateMiscReg(); 1814 getDTBPtr(tc)->invalidateMiscReg(); 1815 break; 1816 } 1817 case MISCREG_SCTLR_EL1: 1818 case MISCREG_CONTEXTIDR: 1819 case MISCREG_PRRR: 1820 case MISCREG_NMRR: 1821 case MISCREG_MAIR0: 1822 case MISCREG_MAIR1: 1823 case MISCREG_DACR: 1824 case MISCREG_VTTBR: 1825 case MISCREG_SCR_EL3: 1826 case MISCREG_HCR_EL2: 1827 case MISCREG_TCR_EL1: 1828 case MISCREG_TCR_EL2: 1829 case MISCREG_TCR_EL3: 1830 case MISCREG_SCTLR_EL2: 1831 case MISCREG_SCTLR_EL3: 1832 case MISCREG_HSCTLR: 1833 case MISCREG_TTBR0_EL1: 1834 case MISCREG_TTBR1_EL1: 1835 case MISCREG_TTBR0_EL2: 1836 case MISCREG_TTBR1_EL2: 1837 case MISCREG_TTBR0_EL3: 1838 getITBPtr(tc)->invalidateMiscReg(); 1839 getDTBPtr(tc)->invalidateMiscReg(); 1840 break; 1841 case MISCREG_NZCV: 1842 { 1843 CPSR cpsr = val; 1844 1845 tc->setCCReg(CCREG_NZ, cpsr.nz); 1846 tc->setCCReg(CCREG_C, cpsr.c); 1847 tc->setCCReg(CCREG_V, cpsr.v); 1848 } 1849 break; 1850 case MISCREG_DAIF: 1851 { 1852 CPSR cpsr = miscRegs[MISCREG_CPSR]; 1853 cpsr.daif = (uint8_t) ((CPSR) newVal).daif; 1854 newVal = cpsr; 1855 misc_reg = MISCREG_CPSR; 1856 } 1857 break; 1858 case MISCREG_SP_EL0: 1859 tc->setIntReg(INTREG_SP0, newVal); 1860 break; 1861 case MISCREG_SP_EL1: 1862 tc->setIntReg(INTREG_SP1, newVal); 1863 break; 1864 case MISCREG_SP_EL2: 1865 tc->setIntReg(INTREG_SP2, newVal); 1866 break; 1867 case MISCREG_SPSEL: 1868 { 1869 CPSR cpsr = miscRegs[MISCREG_CPSR]; 1870 cpsr.sp = (uint8_t) ((CPSR) newVal).sp; 1871 newVal = cpsr; 1872 misc_reg = MISCREG_CPSR; 1873 } 1874 break; 1875 case MISCREG_CURRENTEL: 1876 { 1877 CPSR cpsr = miscRegs[MISCREG_CPSR]; 1878 cpsr.el = (uint8_t) ((CPSR) newVal).el; 1879 newVal = cpsr; 1880 misc_reg = MISCREG_CPSR; 1881 } 1882 break;
| 653 case MISCREG_L2CTLR: 654 { 655 // mostly unimplemented, just set NumCPUs field from sim and return 656 L2CTLR l2ctlr = 0; 657 // b00:1CPU to b11:4CPUs 658 l2ctlr.numCPUs = tc->getSystemPtr()->numContexts() - 1; 659 return l2ctlr; 660 } 661 case MISCREG_DBGDIDR: 662 /* For now just implement the version number. 663 * ARMv7, v7.1 Debug architecture (0b0101 --> 0x5) 664 */ 665 return 0x5 << 16; 666 case MISCREG_DBGDSCRint: 667 return 0; 668 case MISCREG_ISR: 669 return tc->getCpuPtr()->getInterruptController(tc->threadId())->getISR( 670 readMiscRegNoEffect(MISCREG_HCR), 671 readMiscRegNoEffect(MISCREG_CPSR), 672 readMiscRegNoEffect(MISCREG_SCR)); 673 case MISCREG_ISR_EL1: 674 return tc->getCpuPtr()->getInterruptController(tc->threadId())->getISR( 675 readMiscRegNoEffect(MISCREG_HCR_EL2), 676 readMiscRegNoEffect(MISCREG_CPSR), 677 readMiscRegNoEffect(MISCREG_SCR_EL3)); 678 case MISCREG_DCZID_EL0: 679 return 0x04; // DC ZVA clear 64-byte chunks 680 case MISCREG_HCPTR: 681 { 682 RegVal val = readMiscRegNoEffect(misc_reg); 683 // The trap bit associated with CP14 is defined as RAZ 684 val &= ~(1 << 14); 685 // If a CP bit in NSACR is 0 then the corresponding bit in 686 // HCPTR is RAO/WI 687 bool secure_lookup = haveSecurity && 688 inSecureState(readMiscRegNoEffect(MISCREG_SCR), 689 readMiscRegNoEffect(MISCREG_CPSR)); 690 if (!secure_lookup) { 691 RegVal mask = readMiscRegNoEffect(MISCREG_NSACR); 692 val |= (mask ^ 0x7FFF) & 0xBFFF; 693 } 694 // Set the bits for unimplemented coprocessors to RAO/WI 695 val |= 0x33FF; 696 return (val); 697 } 698 case MISCREG_HDFAR: // alias for secure DFAR 699 return readMiscRegNoEffect(MISCREG_DFAR_S); 700 case MISCREG_HIFAR: // alias for secure IFAR 701 return readMiscRegNoEffect(MISCREG_IFAR_S); 702 703 case MISCREG_ID_PFR0: 704 // !ThumbEE | !Jazelle | Thumb | ARM 705 return 0x00000031; 706 case MISCREG_ID_PFR1: 707 { // Timer | Virti | !M Profile | TrustZone | ARMv4 708 bool haveTimer = (system->getGenericTimer() != NULL); 709 return 0x00000001 710 | (haveSecurity ? 0x00000010 : 0x0) 711 | (haveVirtualization ? 0x00001000 : 0x0) 712 | (haveTimer ? 0x00010000 : 0x0); 713 } 714 case MISCREG_ID_AA64PFR0_EL1: 715 return 0x0000000000000002 | // AArch{64,32} supported at EL0 716 0x0000000000000020 | // EL1 717 (haveVirtualization ? 0x0000000000000200 : 0) | // EL2 718 (haveSecurity ? 0x0000000000002000 : 0) | // EL3 719 (haveSVE ? 0x0000000100000000 : 0) | // SVE 720 (haveGICv3CPUInterface ? 0x0000000001000000 : 0); 721 case MISCREG_ID_AA64PFR1_EL1: 722 return 0; // bits [63:0] RES0 (reserved for future use) 723 724 // Generic Timer registers 725 case MISCREG_CNTHV_CTL_EL2: 726 case MISCREG_CNTHV_CVAL_EL2: 727 case MISCREG_CNTHV_TVAL_EL2: 728 case MISCREG_CNTFRQ ... MISCREG_CNTHP_CTL: 729 case MISCREG_CNTPCT ... MISCREG_CNTHP_CVAL: 730 case MISCREG_CNTKCTL_EL1 ... MISCREG_CNTV_CVAL_EL0: 731 case MISCREG_CNTVOFF_EL2 ... MISCREG_CNTPS_CVAL_EL1: 732 return getGenericTimer(tc).readMiscReg(misc_reg); 733 734 case MISCREG_ICC_PMR_EL1 ... MISCREG_ICC_IGRPEN1_EL3: 735 case MISCREG_ICH_AP0R0_EL2 ... MISCREG_ICH_LR15_EL2: 736 return getGICv3CPUInterface(tc).readMiscReg(misc_reg); 737 738 default: 739 break; 740 741 } 742 return readMiscRegNoEffect(misc_reg); 743} 744 745void 746ISA::setMiscRegNoEffect(int misc_reg, RegVal val) 747{ 748 assert(misc_reg < NumMiscRegs); 749 750 const auto ® = lookUpMiscReg[misc_reg]; // bit masks 751 const auto &map = getMiscIndices(misc_reg); 752 int lower = map.first, upper = map.second; 753 754 auto v = (val & ~reg.wi()) | reg.rao(); 755 if (upper > 0) { 756 miscRegs[lower] = bits(v, 31, 0); 757 miscRegs[upper] = bits(v, 63, 32); 758 DPRINTF(MiscRegs, "Writing to misc reg %d (%d:%d) : %#x\n", 759 misc_reg, lower, upper, v); 760 } else { 761 miscRegs[lower] = v; 762 DPRINTF(MiscRegs, "Writing to misc reg %d (%d) : %#x\n", 763 misc_reg, lower, v); 764 } 765} 766 767void 768ISA::setMiscReg(int misc_reg, RegVal val, ThreadContext *tc) 769{ 770 771 RegVal newVal = val; 772 bool secure_lookup; 773 SCR scr; 774 775 if (misc_reg == MISCREG_CPSR) { 776 updateRegMap(val); 777 778 779 CPSR old_cpsr = miscRegs[MISCREG_CPSR]; 780 int old_mode = old_cpsr.mode; 781 CPSR cpsr = val; 782 if (old_mode != cpsr.mode || cpsr.il != old_cpsr.il) { 783 getITBPtr(tc)->invalidateMiscReg(); 784 getDTBPtr(tc)->invalidateMiscReg(); 785 } 786 787 DPRINTF(Arm, "Updating CPSR from %#x to %#x f:%d i:%d a:%d mode:%#x\n", 788 miscRegs[misc_reg], cpsr, cpsr.f, cpsr.i, cpsr.a, cpsr.mode); 789 PCState pc = tc->pcState(); 790 pc.nextThumb(cpsr.t); 791 pc.nextJazelle(cpsr.j); 792 pc.illegalExec(cpsr.il == 1); 793 794 tc->getDecoderPtr()->setSveLen((getCurSveVecLenInBits(tc) >> 7) - 1); 795 796 // Follow slightly different semantics if a CheckerCPU object 797 // is connected 798 CheckerCPU *checker = tc->getCheckerCpuPtr(); 799 if (checker) { 800 tc->pcStateNoRecord(pc); 801 } else { 802 tc->pcState(pc); 803 } 804 } else { 805#ifndef NDEBUG 806 if (!miscRegInfo[misc_reg][MISCREG_IMPLEMENTED]) { 807 if (miscRegInfo[misc_reg][MISCREG_WARN_NOT_FAIL]) 808 warn("Unimplemented system register %s write with %#x.\n", 809 miscRegName[misc_reg], val); 810 else 811 panic("Unimplemented system register %s write with %#x.\n", 812 miscRegName[misc_reg], val); 813 } 814#endif 815 switch (unflattenMiscReg(misc_reg)) { 816 case MISCREG_CPACR: 817 { 818 819 const uint32_t ones = (uint32_t)(-1); 820 CPACR cpacrMask = 0; 821 // Only cp10, cp11, and ase are implemented, nothing else should 822 // be writable 823 cpacrMask.cp10 = ones; 824 cpacrMask.cp11 = ones; 825 cpacrMask.asedis = ones; 826 827 // Security Extensions may limit the writability of CPACR 828 if (haveSecurity) { 829 scr = readMiscRegNoEffect(MISCREG_SCR); 830 CPSR cpsr = readMiscRegNoEffect(MISCREG_CPSR); 831 if (scr.ns && (cpsr.mode != MODE_MON) && ELIs32(tc, EL3)) { 832 NSACR nsacr = readMiscRegNoEffect(MISCREG_NSACR); 833 // NB: Skipping the full loop, here 834 if (!nsacr.cp10) cpacrMask.cp10 = 0; 835 if (!nsacr.cp11) cpacrMask.cp11 = 0; 836 } 837 } 838 839 RegVal old_val = readMiscRegNoEffect(MISCREG_CPACR); 840 newVal &= cpacrMask; 841 newVal |= old_val & ~cpacrMask; 842 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 843 miscRegName[misc_reg], newVal); 844 } 845 break; 846 case MISCREG_CPACR_EL1: 847 { 848 const uint32_t ones = (uint32_t)(-1); 849 CPACR cpacrMask = 0; 850 cpacrMask.tta = ones; 851 cpacrMask.fpen = ones; 852 if (haveSVE) { 853 cpacrMask.zen = ones; 854 } 855 newVal &= cpacrMask; 856 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 857 miscRegName[misc_reg], newVal); 858 } 859 break; 860 case MISCREG_CPTR_EL2: 861 { 862 const uint32_t ones = (uint32_t)(-1); 863 CPTR cptrMask = 0; 864 cptrMask.tcpac = ones; 865 cptrMask.tta = ones; 866 cptrMask.tfp = ones; 867 if (haveSVE) { 868 cptrMask.tz = ones; 869 } 870 newVal &= cptrMask; 871 cptrMask = 0; 872 cptrMask.res1_13_12_el2 = ones; 873 cptrMask.res1_7_0_el2 = ones; 874 if (!haveSVE) { 875 cptrMask.res1_8_el2 = ones; 876 } 877 cptrMask.res1_9_el2 = ones; 878 newVal |= cptrMask; 879 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 880 miscRegName[misc_reg], newVal); 881 } 882 break; 883 case MISCREG_CPTR_EL3: 884 { 885 const uint32_t ones = (uint32_t)(-1); 886 CPTR cptrMask = 0; 887 cptrMask.tcpac = ones; 888 cptrMask.tta = ones; 889 cptrMask.tfp = ones; 890 if (haveSVE) { 891 cptrMask.ez = ones; 892 } 893 newVal &= cptrMask; 894 DPRINTF(MiscRegs, "Writing misc reg %s: %#x\n", 895 miscRegName[misc_reg], newVal); 896 } 897 break; 898 case MISCREG_CSSELR: 899 warn_once("The csselr register isn't implemented.\n"); 900 return; 901 902 case MISCREG_DC_ZVA_Xt: 903 warn("Calling DC ZVA! Not Implemeted! Expect WEIRD results\n"); 904 return; 905 906 case MISCREG_FPSCR: 907 { 908 const uint32_t ones = (uint32_t)(-1); 909 FPSCR fpscrMask = 0; 910 fpscrMask.ioc = ones; 911 fpscrMask.dzc = ones; 912 fpscrMask.ofc = ones; 913 fpscrMask.ufc = ones; 914 fpscrMask.ixc = ones; 915 fpscrMask.idc = ones; 916 fpscrMask.ioe = ones; 917 fpscrMask.dze = ones; 918 fpscrMask.ofe = ones; 919 fpscrMask.ufe = ones; 920 fpscrMask.ixe = ones; 921 fpscrMask.ide = ones; 922 fpscrMask.len = ones; 923 fpscrMask.fz16 = ones; 924 fpscrMask.stride = ones; 925 fpscrMask.rMode = ones; 926 fpscrMask.fz = ones; 927 fpscrMask.dn = ones; 928 fpscrMask.ahp = ones; 929 fpscrMask.qc = ones; 930 fpscrMask.v = ones; 931 fpscrMask.c = ones; 932 fpscrMask.z = ones; 933 fpscrMask.n = ones; 934 newVal = (newVal & (uint32_t)fpscrMask) | 935 (readMiscRegNoEffect(MISCREG_FPSCR) & 936 ~(uint32_t)fpscrMask); 937 tc->getDecoderPtr()->setContext(newVal); 938 } 939 break; 940 case MISCREG_FPSR: 941 { 942 const uint32_t ones = (uint32_t)(-1); 943 FPSCR fpscrMask = 0; 944 fpscrMask.ioc = ones; 945 fpscrMask.dzc = ones; 946 fpscrMask.ofc = ones; 947 fpscrMask.ufc = ones; 948 fpscrMask.ixc = ones; 949 fpscrMask.idc = ones; 950 fpscrMask.qc = ones; 951 fpscrMask.v = ones; 952 fpscrMask.c = ones; 953 fpscrMask.z = ones; 954 fpscrMask.n = ones; 955 newVal = (newVal & (uint32_t)fpscrMask) | 956 (readMiscRegNoEffect(MISCREG_FPSCR) & 957 ~(uint32_t)fpscrMask); 958 misc_reg = MISCREG_FPSCR; 959 } 960 break; 961 case MISCREG_FPCR: 962 { 963 const uint32_t ones = (uint32_t)(-1); 964 FPSCR fpscrMask = 0; 965 fpscrMask.len = ones; 966 fpscrMask.fz16 = ones; 967 fpscrMask.stride = ones; 968 fpscrMask.rMode = ones; 969 fpscrMask.fz = ones; 970 fpscrMask.dn = ones; 971 fpscrMask.ahp = ones; 972 newVal = (newVal & (uint32_t)fpscrMask) | 973 (readMiscRegNoEffect(MISCREG_FPSCR) & 974 ~(uint32_t)fpscrMask); 975 misc_reg = MISCREG_FPSCR; 976 } 977 break; 978 case MISCREG_CPSR_Q: 979 { 980 assert(!(newVal & ~CpsrMaskQ)); 981 newVal = readMiscRegNoEffect(MISCREG_CPSR) | newVal; 982 misc_reg = MISCREG_CPSR; 983 } 984 break; 985 case MISCREG_FPSCR_QC: 986 { 987 newVal = readMiscRegNoEffect(MISCREG_FPSCR) | 988 (newVal & FpscrQcMask); 989 misc_reg = MISCREG_FPSCR; 990 } 991 break; 992 case MISCREG_FPSCR_EXC: 993 { 994 newVal = readMiscRegNoEffect(MISCREG_FPSCR) | 995 (newVal & FpscrExcMask); 996 misc_reg = MISCREG_FPSCR; 997 } 998 break; 999 case MISCREG_FPEXC: 1000 { 1001 // vfpv3 architecture, section B.6.1 of DDI04068 1002 // bit 29 - valid only if fpexc[31] is 0 1003 const uint32_t fpexcMask = 0x60000000; 1004 newVal = (newVal & fpexcMask) | 1005 (readMiscRegNoEffect(MISCREG_FPEXC) & ~fpexcMask); 1006 } 1007 break; 1008 case MISCREG_HCR: 1009 { 1010 if (!haveVirtualization) 1011 return; 1012 } 1013 break; 1014 case MISCREG_IFSR: 1015 { 1016 // ARM ARM (ARM DDI 0406C.b) B4.1.96 1017 const uint32_t ifsrMask = 1018 mask(31, 13) | mask(11, 11) | mask(8, 6); 1019 newVal = newVal & ~ifsrMask; 1020 } 1021 break; 1022 case MISCREG_DFSR: 1023 { 1024 // ARM ARM (ARM DDI 0406C.b) B4.1.52 1025 const uint32_t dfsrMask = mask(31, 14) | mask(8, 8); 1026 newVal = newVal & ~dfsrMask; 1027 } 1028 break; 1029 case MISCREG_AMAIR0: 1030 case MISCREG_AMAIR1: 1031 { 1032 // ARM ARM (ARM DDI 0406C.b) B4.1.5 1033 // Valid only with LPAE 1034 if (!haveLPAE) 1035 return; 1036 DPRINTF(MiscRegs, "Writing AMAIR: %#x\n", newVal); 1037 } 1038 break; 1039 case MISCREG_SCR: 1040 getITBPtr(tc)->invalidateMiscReg(); 1041 getDTBPtr(tc)->invalidateMiscReg(); 1042 break; 1043 case MISCREG_SCTLR: 1044 { 1045 DPRINTF(MiscRegs, "Writing SCTLR: %#x\n", newVal); 1046 scr = readMiscRegNoEffect(MISCREG_SCR); 1047 1048 MiscRegIndex sctlr_idx; 1049 if (haveSecurity && !highestELIs64 && !scr.ns) { 1050 sctlr_idx = MISCREG_SCTLR_S; 1051 } else { 1052 sctlr_idx = MISCREG_SCTLR_NS; 1053 } 1054 1055 SCTLR sctlr = miscRegs[sctlr_idx]; 1056 SCTLR new_sctlr = newVal; 1057 new_sctlr.nmfi = ((bool)sctlr.nmfi) && !haveVirtualization; 1058 miscRegs[sctlr_idx] = (RegVal)new_sctlr; 1059 getITBPtr(tc)->invalidateMiscReg(); 1060 getDTBPtr(tc)->invalidateMiscReg(); 1061 } 1062 case MISCREG_MIDR: 1063 case MISCREG_ID_PFR0: 1064 case MISCREG_ID_PFR1: 1065 case MISCREG_ID_DFR0: 1066 case MISCREG_ID_MMFR0: 1067 case MISCREG_ID_MMFR1: 1068 case MISCREG_ID_MMFR2: 1069 case MISCREG_ID_MMFR3: 1070 case MISCREG_ID_ISAR0: 1071 case MISCREG_ID_ISAR1: 1072 case MISCREG_ID_ISAR2: 1073 case MISCREG_ID_ISAR3: 1074 case MISCREG_ID_ISAR4: 1075 case MISCREG_ID_ISAR5: 1076 1077 case MISCREG_MPIDR: 1078 case MISCREG_FPSID: 1079 case MISCREG_TLBTR: 1080 case MISCREG_MVFR0: 1081 case MISCREG_MVFR1: 1082 1083 case MISCREG_ID_AA64AFR0_EL1: 1084 case MISCREG_ID_AA64AFR1_EL1: 1085 case MISCREG_ID_AA64DFR0_EL1: 1086 case MISCREG_ID_AA64DFR1_EL1: 1087 case MISCREG_ID_AA64ISAR0_EL1: 1088 case MISCREG_ID_AA64ISAR1_EL1: 1089 case MISCREG_ID_AA64MMFR0_EL1: 1090 case MISCREG_ID_AA64MMFR1_EL1: 1091 case MISCREG_ID_AA64MMFR2_EL1: 1092 case MISCREG_ID_AA64PFR0_EL1: 1093 case MISCREG_ID_AA64PFR1_EL1: 1094 // ID registers are constants. 1095 return; 1096 1097 // TLB Invalidate All 1098 case MISCREG_TLBIALL: // TLBI all entries, EL0&1, 1099 { 1100 assert32(tc); 1101 scr = readMiscReg(MISCREG_SCR, tc); 1102 1103 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1104 tlbiOp(tc); 1105 return; 1106 } 1107 // TLB Invalidate All, Inner Shareable 1108 case MISCREG_TLBIALLIS: 1109 { 1110 assert32(tc); 1111 scr = readMiscReg(MISCREG_SCR, tc); 1112 1113 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1114 tlbiOp.broadcast(tc); 1115 return; 1116 } 1117 // Instruction TLB Invalidate All 1118 case MISCREG_ITLBIALL: 1119 { 1120 assert32(tc); 1121 scr = readMiscReg(MISCREG_SCR, tc); 1122 1123 ITLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1124 tlbiOp(tc); 1125 return; 1126 } 1127 // Data TLB Invalidate All 1128 case MISCREG_DTLBIALL: 1129 { 1130 assert32(tc); 1131 scr = readMiscReg(MISCREG_SCR, tc); 1132 1133 DTLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1134 tlbiOp(tc); 1135 return; 1136 } 1137 // TLB Invalidate by VA 1138 // mcr tlbimval(is) is invalidating all matching entries 1139 // regardless of the level of lookup, since in gem5 we cache 1140 // in the tlb the last level of lookup only. 1141 case MISCREG_TLBIMVA: 1142 case MISCREG_TLBIMVAL: 1143 { 1144 assert32(tc); 1145 scr = readMiscReg(MISCREG_SCR, tc); 1146 1147 TLBIMVA tlbiOp(EL1, 1148 haveSecurity && !scr.ns, 1149 mbits(newVal, 31, 12), 1150 bits(newVal, 7,0)); 1151 1152 tlbiOp(tc); 1153 return; 1154 } 1155 // TLB Invalidate by VA, Inner Shareable 1156 case MISCREG_TLBIMVAIS: 1157 case MISCREG_TLBIMVALIS: 1158 { 1159 assert32(tc); 1160 scr = readMiscReg(MISCREG_SCR, tc); 1161 1162 TLBIMVA tlbiOp(EL1, 1163 haveSecurity && !scr.ns, 1164 mbits(newVal, 31, 12), 1165 bits(newVal, 7,0)); 1166 1167 tlbiOp.broadcast(tc); 1168 return; 1169 } 1170 // TLB Invalidate by ASID match 1171 case MISCREG_TLBIASID: 1172 { 1173 assert32(tc); 1174 scr = readMiscReg(MISCREG_SCR, tc); 1175 1176 TLBIASID tlbiOp(EL1, 1177 haveSecurity && !scr.ns, 1178 bits(newVal, 7,0)); 1179 1180 tlbiOp(tc); 1181 return; 1182 } 1183 // TLB Invalidate by ASID match, Inner Shareable 1184 case MISCREG_TLBIASIDIS: 1185 { 1186 assert32(tc); 1187 scr = readMiscReg(MISCREG_SCR, tc); 1188 1189 TLBIASID tlbiOp(EL1, 1190 haveSecurity && !scr.ns, 1191 bits(newVal, 7,0)); 1192 1193 tlbiOp.broadcast(tc); 1194 return; 1195 } 1196 // mcr tlbimvaal(is) is invalidating all matching entries 1197 // regardless of the level of lookup, since in gem5 we cache 1198 // in the tlb the last level of lookup only. 1199 // TLB Invalidate by VA, All ASID 1200 case MISCREG_TLBIMVAA: 1201 case MISCREG_TLBIMVAAL: 1202 { 1203 assert32(tc); 1204 scr = readMiscReg(MISCREG_SCR, tc); 1205 1206 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1207 mbits(newVal, 31,12)); 1208 1209 tlbiOp(tc); 1210 return; 1211 } 1212 // TLB Invalidate by VA, All ASID, Inner Shareable 1213 case MISCREG_TLBIMVAAIS: 1214 case MISCREG_TLBIMVAALIS: 1215 { 1216 assert32(tc); 1217 scr = readMiscReg(MISCREG_SCR, tc); 1218 1219 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1220 mbits(newVal, 31,12)); 1221 1222 tlbiOp.broadcast(tc); 1223 return; 1224 } 1225 // mcr tlbimvalh(is) is invalidating all matching entries 1226 // regardless of the level of lookup, since in gem5 we cache 1227 // in the tlb the last level of lookup only. 1228 // TLB Invalidate by VA, Hyp mode 1229 case MISCREG_TLBIMVAH: 1230 case MISCREG_TLBIMVALH: 1231 { 1232 assert32(tc); 1233 scr = readMiscReg(MISCREG_SCR, tc); 1234 1235 TLBIMVAA tlbiOp(EL2, haveSecurity && !scr.ns, 1236 mbits(newVal, 31,12)); 1237 1238 tlbiOp(tc); 1239 return; 1240 } 1241 // TLB Invalidate by VA, Hyp mode, Inner Shareable 1242 case MISCREG_TLBIMVAHIS: 1243 case MISCREG_TLBIMVALHIS: 1244 { 1245 assert32(tc); 1246 scr = readMiscReg(MISCREG_SCR, tc); 1247 1248 TLBIMVAA tlbiOp(EL2, haveSecurity && !scr.ns, 1249 mbits(newVal, 31,12)); 1250 1251 tlbiOp.broadcast(tc); 1252 return; 1253 } 1254 // mcr tlbiipas2l(is) is invalidating all matching entries 1255 // regardless of the level of lookup, since in gem5 we cache 1256 // in the tlb the last level of lookup only. 1257 // TLB Invalidate by Intermediate Physical Address, Stage 2 1258 case MISCREG_TLBIIPAS2: 1259 case MISCREG_TLBIIPAS2L: 1260 { 1261 assert32(tc); 1262 scr = readMiscReg(MISCREG_SCR, tc); 1263 1264 TLBIIPA tlbiOp(EL1, 1265 haveSecurity && !scr.ns, 1266 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1267 1268 tlbiOp(tc); 1269 return; 1270 } 1271 // TLB Invalidate by Intermediate Physical Address, Stage 2, 1272 // Inner Shareable 1273 case MISCREG_TLBIIPAS2IS: 1274 case MISCREG_TLBIIPAS2LIS: 1275 { 1276 assert32(tc); 1277 scr = readMiscReg(MISCREG_SCR, tc); 1278 1279 TLBIIPA tlbiOp(EL1, 1280 haveSecurity && !scr.ns, 1281 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1282 1283 tlbiOp.broadcast(tc); 1284 return; 1285 } 1286 // Instruction TLB Invalidate by VA 1287 case MISCREG_ITLBIMVA: 1288 { 1289 assert32(tc); 1290 scr = readMiscReg(MISCREG_SCR, tc); 1291 1292 ITLBIMVA tlbiOp(EL1, 1293 haveSecurity && !scr.ns, 1294 mbits(newVal, 31, 12), 1295 bits(newVal, 7,0)); 1296 1297 tlbiOp(tc); 1298 return; 1299 } 1300 // Data TLB Invalidate by VA 1301 case MISCREG_DTLBIMVA: 1302 { 1303 assert32(tc); 1304 scr = readMiscReg(MISCREG_SCR, tc); 1305 1306 DTLBIMVA tlbiOp(EL1, 1307 haveSecurity && !scr.ns, 1308 mbits(newVal, 31, 12), 1309 bits(newVal, 7,0)); 1310 1311 tlbiOp(tc); 1312 return; 1313 } 1314 // Instruction TLB Invalidate by ASID match 1315 case MISCREG_ITLBIASID: 1316 { 1317 assert32(tc); 1318 scr = readMiscReg(MISCREG_SCR, tc); 1319 1320 ITLBIASID tlbiOp(EL1, 1321 haveSecurity && !scr.ns, 1322 bits(newVal, 7,0)); 1323 1324 tlbiOp(tc); 1325 return; 1326 } 1327 // Data TLB Invalidate by ASID match 1328 case MISCREG_DTLBIASID: 1329 { 1330 assert32(tc); 1331 scr = readMiscReg(MISCREG_SCR, tc); 1332 1333 DTLBIASID tlbiOp(EL1, 1334 haveSecurity && !scr.ns, 1335 bits(newVal, 7,0)); 1336 1337 tlbiOp(tc); 1338 return; 1339 } 1340 // TLB Invalidate All, Non-Secure Non-Hyp 1341 case MISCREG_TLBIALLNSNH: 1342 { 1343 assert32(tc); 1344 1345 TLBIALLN tlbiOp(EL1); 1346 tlbiOp(tc); 1347 return; 1348 } 1349 // TLB Invalidate All, Non-Secure Non-Hyp, Inner Shareable 1350 case MISCREG_TLBIALLNSNHIS: 1351 { 1352 assert32(tc); 1353 1354 TLBIALLN tlbiOp(EL1); 1355 tlbiOp.broadcast(tc); 1356 return; 1357 } 1358 // TLB Invalidate All, Hyp mode 1359 case MISCREG_TLBIALLH: 1360 { 1361 assert32(tc); 1362 1363 TLBIALLN tlbiOp(EL2); 1364 tlbiOp(tc); 1365 return; 1366 } 1367 // TLB Invalidate All, Hyp mode, Inner Shareable 1368 case MISCREG_TLBIALLHIS: 1369 { 1370 assert32(tc); 1371 1372 TLBIALLN tlbiOp(EL2); 1373 tlbiOp.broadcast(tc); 1374 return; 1375 } 1376 // AArch64 TLB Invalidate All, EL3 1377 case MISCREG_TLBI_ALLE3: 1378 { 1379 assert64(tc); 1380 1381 TLBIALL tlbiOp(EL3, true); 1382 tlbiOp(tc); 1383 return; 1384 } 1385 // AArch64 TLB Invalidate All, EL3, Inner Shareable 1386 case MISCREG_TLBI_ALLE3IS: 1387 { 1388 assert64(tc); 1389 1390 TLBIALL tlbiOp(EL3, true); 1391 tlbiOp.broadcast(tc); 1392 return; 1393 } 1394 // AArch64 TLB Invalidate All, EL2, Inner Shareable 1395 case MISCREG_TLBI_ALLE2: 1396 case MISCREG_TLBI_ALLE2IS: 1397 { 1398 assert64(tc); 1399 scr = readMiscReg(MISCREG_SCR, tc); 1400 1401 TLBIALL tlbiOp(EL2, haveSecurity && !scr.ns); 1402 tlbiOp(tc); 1403 return; 1404 } 1405 // AArch64 TLB Invalidate All, EL1 1406 case MISCREG_TLBI_ALLE1: 1407 case MISCREG_TLBI_VMALLE1: 1408 case MISCREG_TLBI_VMALLS12E1: 1409 // @todo: handle VMID and stage 2 to enable Virtualization 1410 { 1411 assert64(tc); 1412 scr = readMiscReg(MISCREG_SCR, tc); 1413 1414 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1415 tlbiOp(tc); 1416 return; 1417 } 1418 // AArch64 TLB Invalidate All, EL1, Inner Shareable 1419 case MISCREG_TLBI_ALLE1IS: 1420 case MISCREG_TLBI_VMALLE1IS: 1421 case MISCREG_TLBI_VMALLS12E1IS: 1422 // @todo: handle VMID and stage 2 to enable Virtualization 1423 { 1424 assert64(tc); 1425 scr = readMiscReg(MISCREG_SCR, tc); 1426 1427 TLBIALL tlbiOp(EL1, haveSecurity && !scr.ns); 1428 tlbiOp.broadcast(tc); 1429 return; 1430 } 1431 // VAEx(IS) and VALEx(IS) are the same because TLBs 1432 // only store entries 1433 // from the last level of translation table walks 1434 // @todo: handle VMID to enable Virtualization 1435 // AArch64 TLB Invalidate by VA, EL3 1436 case MISCREG_TLBI_VAE3_Xt: 1437 case MISCREG_TLBI_VALE3_Xt: 1438 { 1439 assert64(tc); 1440 1441 TLBIMVA tlbiOp(EL3, true, 1442 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1443 0xbeef); 1444 tlbiOp(tc); 1445 return; 1446 } 1447 // AArch64 TLB Invalidate by VA, EL3, Inner Shareable 1448 case MISCREG_TLBI_VAE3IS_Xt: 1449 case MISCREG_TLBI_VALE3IS_Xt: 1450 { 1451 assert64(tc); 1452 1453 TLBIMVA tlbiOp(EL3, true, 1454 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1455 0xbeef); 1456 1457 tlbiOp.broadcast(tc); 1458 return; 1459 } 1460 // AArch64 TLB Invalidate by VA, EL2 1461 case MISCREG_TLBI_VAE2_Xt: 1462 case MISCREG_TLBI_VALE2_Xt: 1463 { 1464 assert64(tc); 1465 scr = readMiscReg(MISCREG_SCR, tc); 1466 1467 TLBIMVA tlbiOp(EL2, haveSecurity && !scr.ns, 1468 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1469 0xbeef); 1470 tlbiOp(tc); 1471 return; 1472 } 1473 // AArch64 TLB Invalidate by VA, EL2, Inner Shareable 1474 case MISCREG_TLBI_VAE2IS_Xt: 1475 case MISCREG_TLBI_VALE2IS_Xt: 1476 { 1477 assert64(tc); 1478 scr = readMiscReg(MISCREG_SCR, tc); 1479 1480 TLBIMVA tlbiOp(EL2, haveSecurity && !scr.ns, 1481 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1482 0xbeef); 1483 1484 tlbiOp.broadcast(tc); 1485 return; 1486 } 1487 // AArch64 TLB Invalidate by VA, EL1 1488 case MISCREG_TLBI_VAE1_Xt: 1489 case MISCREG_TLBI_VALE1_Xt: 1490 { 1491 assert64(tc); 1492 scr = readMiscReg(MISCREG_SCR, tc); 1493 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1494 bits(newVal, 55, 48); 1495 1496 TLBIMVA tlbiOp(EL1, haveSecurity && !scr.ns, 1497 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1498 asid); 1499 1500 tlbiOp(tc); 1501 return; 1502 } 1503 // AArch64 TLB Invalidate by VA, EL1, Inner Shareable 1504 case MISCREG_TLBI_VAE1IS_Xt: 1505 case MISCREG_TLBI_VALE1IS_Xt: 1506 { 1507 assert64(tc); 1508 scr = readMiscReg(MISCREG_SCR, tc); 1509 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1510 bits(newVal, 55, 48); 1511 1512 TLBIMVA tlbiOp(EL1, haveSecurity && !scr.ns, 1513 static_cast<Addr>(bits(newVal, 43, 0)) << 12, 1514 asid); 1515 1516 tlbiOp.broadcast(tc); 1517 return; 1518 } 1519 // AArch64 TLB Invalidate by ASID, EL1 1520 // @todo: handle VMID to enable Virtualization 1521 case MISCREG_TLBI_ASIDE1_Xt: 1522 { 1523 assert64(tc); 1524 scr = readMiscReg(MISCREG_SCR, tc); 1525 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1526 bits(newVal, 55, 48); 1527 1528 TLBIASID tlbiOp(EL1, haveSecurity && !scr.ns, asid); 1529 tlbiOp(tc); 1530 return; 1531 } 1532 // AArch64 TLB Invalidate by ASID, EL1, Inner Shareable 1533 case MISCREG_TLBI_ASIDE1IS_Xt: 1534 { 1535 assert64(tc); 1536 scr = readMiscReg(MISCREG_SCR, tc); 1537 auto asid = haveLargeAsid64 ? bits(newVal, 63, 48) : 1538 bits(newVal, 55, 48); 1539 1540 TLBIASID tlbiOp(EL1, haveSecurity && !scr.ns, asid); 1541 tlbiOp.broadcast(tc); 1542 return; 1543 } 1544 // VAAE1(IS) and VAALE1(IS) are the same because TLBs only store 1545 // entries from the last level of translation table walks 1546 // AArch64 TLB Invalidate by VA, All ASID, EL1 1547 case MISCREG_TLBI_VAAE1_Xt: 1548 case MISCREG_TLBI_VAALE1_Xt: 1549 { 1550 assert64(tc); 1551 scr = readMiscReg(MISCREG_SCR, tc); 1552 1553 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1554 static_cast<Addr>(bits(newVal, 43, 0)) << 12); 1555 1556 tlbiOp(tc); 1557 return; 1558 } 1559 // AArch64 TLB Invalidate by VA, All ASID, EL1, Inner Shareable 1560 case MISCREG_TLBI_VAAE1IS_Xt: 1561 case MISCREG_TLBI_VAALE1IS_Xt: 1562 { 1563 assert64(tc); 1564 scr = readMiscReg(MISCREG_SCR, tc); 1565 1566 TLBIMVAA tlbiOp(EL1, haveSecurity && !scr.ns, 1567 static_cast<Addr>(bits(newVal, 43, 0)) << 12); 1568 1569 tlbiOp.broadcast(tc); 1570 return; 1571 } 1572 // AArch64 TLB Invalidate by Intermediate Physical Address, 1573 // Stage 2, EL1 1574 case MISCREG_TLBI_IPAS2E1_Xt: 1575 case MISCREG_TLBI_IPAS2LE1_Xt: 1576 { 1577 assert64(tc); 1578 scr = readMiscReg(MISCREG_SCR, tc); 1579 1580 TLBIIPA tlbiOp(EL1, haveSecurity && !scr.ns, 1581 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1582 1583 tlbiOp(tc); 1584 return; 1585 } 1586 // AArch64 TLB Invalidate by Intermediate Physical Address, 1587 // Stage 2, EL1, Inner Shareable 1588 case MISCREG_TLBI_IPAS2E1IS_Xt: 1589 case MISCREG_TLBI_IPAS2LE1IS_Xt: 1590 { 1591 assert64(tc); 1592 scr = readMiscReg(MISCREG_SCR, tc); 1593 1594 TLBIIPA tlbiOp(EL1, haveSecurity && !scr.ns, 1595 static_cast<Addr>(bits(newVal, 35, 0)) << 12); 1596 1597 tlbiOp.broadcast(tc); 1598 return; 1599 } 1600 case MISCREG_ACTLR: 1601 warn("Not doing anything for write of miscreg ACTLR\n"); 1602 break; 1603 1604 case MISCREG_PMXEVTYPER_PMCCFILTR: 1605 case MISCREG_PMINTENSET_EL1 ... MISCREG_PMOVSSET_EL0: 1606 case MISCREG_PMEVCNTR0_EL0 ... MISCREG_PMEVTYPER5_EL0: 1607 case MISCREG_PMCR ... MISCREG_PMOVSSET: 1608 pmu->setMiscReg(misc_reg, newVal); 1609 break; 1610 1611 1612 case MISCREG_HSTR: // TJDBX, now redifined to be RES0 1613 { 1614 HSTR hstrMask = 0; 1615 hstrMask.tjdbx = 1; 1616 newVal &= ~((uint32_t) hstrMask); 1617 break; 1618 } 1619 case MISCREG_HCPTR: 1620 { 1621 // If a CP bit in NSACR is 0 then the corresponding bit in 1622 // HCPTR is RAO/WI. Same applies to NSASEDIS 1623 secure_lookup = haveSecurity && 1624 inSecureState(readMiscRegNoEffect(MISCREG_SCR), 1625 readMiscRegNoEffect(MISCREG_CPSR)); 1626 if (!secure_lookup) { 1627 RegVal oldValue = readMiscRegNoEffect(MISCREG_HCPTR); 1628 RegVal mask = 1629 (readMiscRegNoEffect(MISCREG_NSACR) ^ 0x7FFF) & 0xBFFF; 1630 newVal = (newVal & ~mask) | (oldValue & mask); 1631 } 1632 break; 1633 } 1634 case MISCREG_HDFAR: // alias for secure DFAR 1635 misc_reg = MISCREG_DFAR_S; 1636 break; 1637 case MISCREG_HIFAR: // alias for secure IFAR 1638 misc_reg = MISCREG_IFAR_S; 1639 break; 1640 case MISCREG_ATS1CPR: 1641 case MISCREG_ATS1CPW: 1642 case MISCREG_ATS1CUR: 1643 case MISCREG_ATS1CUW: 1644 case MISCREG_ATS12NSOPR: 1645 case MISCREG_ATS12NSOPW: 1646 case MISCREG_ATS12NSOUR: 1647 case MISCREG_ATS12NSOUW: 1648 case MISCREG_ATS1HR: 1649 case MISCREG_ATS1HW: 1650 { 1651 Request::Flags flags = 0; 1652 BaseTLB::Mode mode = BaseTLB::Read; 1653 TLB::ArmTranslationType tranType = TLB::NormalTran; 1654 Fault fault; 1655 switch(misc_reg) { 1656 case MISCREG_ATS1CPR: 1657 flags = TLB::MustBeOne; 1658 tranType = TLB::S1CTran; 1659 mode = BaseTLB::Read; 1660 break; 1661 case MISCREG_ATS1CPW: 1662 flags = TLB::MustBeOne; 1663 tranType = TLB::S1CTran; 1664 mode = BaseTLB::Write; 1665 break; 1666 case MISCREG_ATS1CUR: 1667 flags = TLB::MustBeOne | TLB::UserMode; 1668 tranType = TLB::S1CTran; 1669 mode = BaseTLB::Read; 1670 break; 1671 case MISCREG_ATS1CUW: 1672 flags = TLB::MustBeOne | TLB::UserMode; 1673 tranType = TLB::S1CTran; 1674 mode = BaseTLB::Write; 1675 break; 1676 case MISCREG_ATS12NSOPR: 1677 if (!haveSecurity) 1678 panic("Security Extensions required for ATS12NSOPR"); 1679 flags = TLB::MustBeOne; 1680 tranType = TLB::S1S2NsTran; 1681 mode = BaseTLB::Read; 1682 break; 1683 case MISCREG_ATS12NSOPW: 1684 if (!haveSecurity) 1685 panic("Security Extensions required for ATS12NSOPW"); 1686 flags = TLB::MustBeOne; 1687 tranType = TLB::S1S2NsTran; 1688 mode = BaseTLB::Write; 1689 break; 1690 case MISCREG_ATS12NSOUR: 1691 if (!haveSecurity) 1692 panic("Security Extensions required for ATS12NSOUR"); 1693 flags = TLB::MustBeOne | TLB::UserMode; 1694 tranType = TLB::S1S2NsTran; 1695 mode = BaseTLB::Read; 1696 break; 1697 case MISCREG_ATS12NSOUW: 1698 if (!haveSecurity) 1699 panic("Security Extensions required for ATS12NSOUW"); 1700 flags = TLB::MustBeOne | TLB::UserMode; 1701 tranType = TLB::S1S2NsTran; 1702 mode = BaseTLB::Write; 1703 break; 1704 case MISCREG_ATS1HR: // only really useful from secure mode. 1705 flags = TLB::MustBeOne; 1706 tranType = TLB::HypMode; 1707 mode = BaseTLB::Read; 1708 break; 1709 case MISCREG_ATS1HW: 1710 flags = TLB::MustBeOne; 1711 tranType = TLB::HypMode; 1712 mode = BaseTLB::Write; 1713 break; 1714 } 1715 // If we're in timing mode then doing the translation in 1716 // functional mode then we're slightly distorting performance 1717 // results obtained from simulations. The translation should be 1718 // done in the same mode the core is running in. NOTE: This 1719 // can't be an atomic translation because that causes problems 1720 // with unexpected atomic snoop requests. 1721 warn("Translating via %s in functional mode! Fix Me!\n", 1722 miscRegName[misc_reg]); 1723 1724 auto req = std::make_shared<Request>( 1725 0, val, 0, flags, Request::funcMasterId, 1726 tc->pcState().pc(), tc->contextId()); 1727 1728 fault = getDTBPtr(tc)->translateFunctional( 1729 req, tc, mode, tranType); 1730 1731 TTBCR ttbcr = readMiscRegNoEffect(MISCREG_TTBCR); 1732 HCR hcr = readMiscRegNoEffect(MISCREG_HCR); 1733 1734 RegVal newVal; 1735 if (fault == NoFault) { 1736 Addr paddr = req->getPaddr(); 1737 if (haveLPAE && (ttbcr.eae || tranType & TLB::HypMode || 1738 ((tranType & TLB::S1S2NsTran) && hcr.vm) )) { 1739 newVal = (paddr & mask(39, 12)) | 1740 (getDTBPtr(tc)->getAttr()); 1741 } else { 1742 newVal = (paddr & 0xfffff000) | 1743 (getDTBPtr(tc)->getAttr()); 1744 } 1745 DPRINTF(MiscRegs, 1746 "MISCREG: Translated addr 0x%08x: PAR: 0x%08x\n", 1747 val, newVal); 1748 } else { 1749 ArmFault *armFault = static_cast<ArmFault *>(fault.get()); 1750 armFault->update(tc); 1751 // Set fault bit and FSR 1752 FSR fsr = armFault->getFsr(tc); 1753 1754 newVal = ((fsr >> 9) & 1) << 11; 1755 if (newVal) { 1756 // LPAE - rearange fault status 1757 newVal |= ((fsr >> 0) & 0x3f) << 1; 1758 } else { 1759 // VMSA - rearange fault status 1760 newVal |= ((fsr >> 0) & 0xf) << 1; 1761 newVal |= ((fsr >> 10) & 0x1) << 5; 1762 newVal |= ((fsr >> 12) & 0x1) << 6; 1763 } 1764 newVal |= 0x1; // F bit 1765 newVal |= ((armFault->iss() >> 7) & 0x1) << 8; 1766 newVal |= armFault->isStage2() ? 0x200 : 0; 1767 DPRINTF(MiscRegs, 1768 "MISCREG: Translated addr 0x%08x fault fsr %#x: PAR: 0x%08x\n", 1769 val, fsr, newVal); 1770 } 1771 setMiscRegNoEffect(MISCREG_PAR, newVal); 1772 return; 1773 } 1774 case MISCREG_TTBCR: 1775 { 1776 TTBCR ttbcr = readMiscRegNoEffect(MISCREG_TTBCR); 1777 const uint32_t ones = (uint32_t)(-1); 1778 TTBCR ttbcrMask = 0; 1779 TTBCR ttbcrNew = newVal; 1780 1781 // ARM DDI 0406C.b, ARMv7-32 1782 ttbcrMask.n = ones; // T0SZ 1783 if (haveSecurity) { 1784 ttbcrMask.pd0 = ones; 1785 ttbcrMask.pd1 = ones; 1786 } 1787 ttbcrMask.epd0 = ones; 1788 ttbcrMask.irgn0 = ones; 1789 ttbcrMask.orgn0 = ones; 1790 ttbcrMask.sh0 = ones; 1791 ttbcrMask.ps = ones; // T1SZ 1792 ttbcrMask.a1 = ones; 1793 ttbcrMask.epd1 = ones; 1794 ttbcrMask.irgn1 = ones; 1795 ttbcrMask.orgn1 = ones; 1796 ttbcrMask.sh1 = ones; 1797 if (haveLPAE) 1798 ttbcrMask.eae = ones; 1799 1800 if (haveLPAE && ttbcrNew.eae) { 1801 newVal = newVal & ttbcrMask; 1802 } else { 1803 newVal = (newVal & ttbcrMask) | (ttbcr & (~ttbcrMask)); 1804 } 1805 // Invalidate TLB MiscReg 1806 getITBPtr(tc)->invalidateMiscReg(); 1807 getDTBPtr(tc)->invalidateMiscReg(); 1808 break; 1809 } 1810 case MISCREG_TTBR0: 1811 case MISCREG_TTBR1: 1812 { 1813 TTBCR ttbcr = readMiscRegNoEffect(MISCREG_TTBCR); 1814 if (haveLPAE) { 1815 if (ttbcr.eae) { 1816 // ARMv7 bit 63-56, 47-40 reserved, UNK/SBZP 1817 // ARMv8 AArch32 bit 63-56 only 1818 uint64_t ttbrMask = mask(63,56) | mask(47,40); 1819 newVal = (newVal & (~ttbrMask)); 1820 } 1821 } 1822 // Invalidate TLB MiscReg 1823 getITBPtr(tc)->invalidateMiscReg(); 1824 getDTBPtr(tc)->invalidateMiscReg(); 1825 break; 1826 } 1827 case MISCREG_SCTLR_EL1: 1828 case MISCREG_CONTEXTIDR: 1829 case MISCREG_PRRR: 1830 case MISCREG_NMRR: 1831 case MISCREG_MAIR0: 1832 case MISCREG_MAIR1: 1833 case MISCREG_DACR: 1834 case MISCREG_VTTBR: 1835 case MISCREG_SCR_EL3: 1836 case MISCREG_HCR_EL2: 1837 case MISCREG_TCR_EL1: 1838 case MISCREG_TCR_EL2: 1839 case MISCREG_TCR_EL3: 1840 case MISCREG_SCTLR_EL2: 1841 case MISCREG_SCTLR_EL3: 1842 case MISCREG_HSCTLR: 1843 case MISCREG_TTBR0_EL1: 1844 case MISCREG_TTBR1_EL1: 1845 case MISCREG_TTBR0_EL2: 1846 case MISCREG_TTBR1_EL2: 1847 case MISCREG_TTBR0_EL3: 1848 getITBPtr(tc)->invalidateMiscReg(); 1849 getDTBPtr(tc)->invalidateMiscReg(); 1850 break; 1851 case MISCREG_NZCV: 1852 { 1853 CPSR cpsr = val; 1854 1855 tc->setCCReg(CCREG_NZ, cpsr.nz); 1856 tc->setCCReg(CCREG_C, cpsr.c); 1857 tc->setCCReg(CCREG_V, cpsr.v); 1858 } 1859 break; 1860 case MISCREG_DAIF: 1861 { 1862 CPSR cpsr = miscRegs[MISCREG_CPSR]; 1863 cpsr.daif = (uint8_t) ((CPSR) newVal).daif; 1864 newVal = cpsr; 1865 misc_reg = MISCREG_CPSR; 1866 } 1867 break; 1868 case MISCREG_SP_EL0: 1869 tc->setIntReg(INTREG_SP0, newVal); 1870 break; 1871 case MISCREG_SP_EL1: 1872 tc->setIntReg(INTREG_SP1, newVal); 1873 break; 1874 case MISCREG_SP_EL2: 1875 tc->setIntReg(INTREG_SP2, newVal); 1876 break; 1877 case MISCREG_SPSEL: 1878 { 1879 CPSR cpsr = miscRegs[MISCREG_CPSR]; 1880 cpsr.sp = (uint8_t) ((CPSR) newVal).sp; 1881 newVal = cpsr; 1882 misc_reg = MISCREG_CPSR; 1883 } 1884 break; 1885 case MISCREG_CURRENTEL: 1886 { 1887 CPSR cpsr = miscRegs[MISCREG_CPSR]; 1888 cpsr.el = (uint8_t) ((CPSR) newVal).el; 1889 newVal = cpsr; 1890 misc_reg = MISCREG_CPSR; 1891 } 1892 break;
|