123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * (C) Copyright 2014 Google, Inc
- */
- #include <common.h>
- #include <command.h>
- #include <log.h>
- #include <asm/msr.h>
- #include <asm/mp.h>
- #include <asm/mtrr.h>
- 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 = simple_strtoul(argv[1], NULL, 16);
- size = simple_strtoul(argv[2], NULL, 16);
- 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 = simple_strtoul(argv[1], NULL, 16);
- 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 <reg> <type> <start> <size> - set a register\n"
- "\t<type> is Uncacheable, Combine, Through, Protect, Back\n"
- "disable <reg> - disable a register\n"
- "enable <reg> - enable a register\n"
- "\n"
- "Precede command with '-c <n>|all' to access a particular hex CPU, e.g.\n"
- " mtrr -c all list; mtrr -c 2e list"
- );
|