// SPDX-License-Identifier: GPL-2.0+ /* * (C) Copyright 2014 Google, Inc */ #include #include #include #include #include #include static const char *const mtrr_type_name[MTRR_TYPE_COUNT] = { "Uncacheable", "Combine", "2", "3", "Through", "Protect", "Back", }; static void read_mtrrs(void *arg) { struct mtrr_info *info = arg; mtrr_read_all(info); } static int do_mtrr_list(int reg_count, int cpu_select) { struct mtrr_info info; int ret; int i; printf("Reg Valid Write-type %-16s %-16s %-16s\n", "Base ||", "Mask ||", "Size ||"); memset(&info, '\0', sizeof(info)); ret = mp_run_on_cpus(cpu_select, read_mtrrs, &info); if (ret) return log_msg_ret("run", ret); for (i = 0; i < reg_count; i++) { const char *type = "Invalid"; uint64_t base, mask, size; bool valid; base = info.mtrr[i].base; mask = info.mtrr[i].mask; size = ~mask & ((1ULL << CONFIG_CPU_ADDR_BITS) - 1); size |= (1 << 12) - 1; size += 1; valid = mask & MTRR_PHYS_MASK_VALID; type = mtrr_type_name[base & MTRR_BASE_TYPE_MASK]; printf("%d %-5s %-12s %016llx %016llx %016llx\n", i, valid ? "Y" : "N", type, base & ~MTRR_BASE_TYPE_MASK, mask & ~MTRR_PHYS_MASK_VALID, size); } return 0; } static int do_mtrr_set(int cpu_select, uint reg, int argc, char *const argv[]) { const char *typename = argv[0]; uint32_t start, size; uint64_t base, mask; int i, type = -1; bool valid; int ret; if (argc < 3) return CMD_RET_USAGE; for (i = 0; i < MTRR_TYPE_COUNT; i++) { if (*typename == *mtrr_type_name[i]) type = i; } if (type == -1) { printf("Invalid type name %s\n", typename); return CMD_RET_USAGE; } start = hextoul(argv[1], NULL); size = hextoul(argv[2], NULL); base = start | type; valid = native_read_msr(MTRR_PHYS_MASK_MSR(reg)) & MTRR_PHYS_MASK_VALID; mask = ~((uint64_t)size - 1); mask &= (1ULL << CONFIG_CPU_ADDR_BITS) - 1; if (valid) mask |= MTRR_PHYS_MASK_VALID; ret = mtrr_set(cpu_select, reg, base, mask); if (ret) return CMD_RET_FAILURE; return 0; } static int do_mtrr(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) { int reg_count = mtrr_get_var_count(); int cmd; int cpu_select; uint reg; int ret; cpu_select = MP_SELECT_BSP; if (argc >= 3 && !strcmp("-c", argv[1])) { const char *cpustr; cpustr = argv[2]; if (*cpustr == 'a') cpu_select = MP_SELECT_ALL; else cpu_select = simple_strtol(cpustr, NULL, 16); argc -= 2; argv += 2; } argc--; argv++; cmd = argv[0] ? *argv[0] : 0; if (argc < 1 || !cmd) { cmd = 'l'; reg = 0; } if (cmd != 'l') { if (argc < 2) return CMD_RET_USAGE; reg = hextoul(argv[1], NULL); if (reg >= reg_count) { printf("Invalid register number\n"); return CMD_RET_USAGE; } } if (cmd == 'l') { bool first; int i; i = mp_first_cpu(cpu_select); if (i < 0) { printf("Invalid CPU (err=%d)\n", i); return CMD_RET_FAILURE; } first = true; for (; i >= 0; i = mp_next_cpu(cpu_select, i)) { if (!first) printf("\n"); printf("CPU %d:\n", i); ret = do_mtrr_list(reg_count, i); if (ret) { printf("Failed to read CPU %d (err=%d)\n", i, ret); return CMD_RET_FAILURE; } first = false; } } else { switch (cmd) { case 'e': ret = mtrr_set_valid(cpu_select, reg, true); break; case 'd': ret = mtrr_set_valid(cpu_select, reg, false); break; case 's': ret = do_mtrr_set(cpu_select, reg, argc - 2, argv + 2); break; default: return CMD_RET_USAGE; } if (ret) { printf("Operation failed (err=%d)\n", ret); return CMD_RET_FAILURE; } } return 0; } U_BOOT_CMD( mtrr, 8, 1, do_mtrr, "Use x86 memory type range registers (32-bit only)", "[list] - list current registers\n" "set - set a register\n" "\t is Uncacheable, Combine, Through, Protect, Back\n" "disable - disable a register\n" "enable - enable a register\n" "\n" "Precede command with '-c |all' to access a particular hex CPU, e.g.\n" " mtrr -c all list; mtrr -c 2e list" );