diff options
Diffstat (limited to 'src/soc/nvidia/tegra210/mtc.c')
-rw-r--r-- | src/soc/nvidia/tegra210/mtc.c | 89 |
1 files changed, 89 insertions, 0 deletions
diff --git a/src/soc/nvidia/tegra210/mtc.c b/src/soc/nvidia/tegra210/mtc.c new file mode 100644 index 0000000000..fb6c9cbdd7 --- /dev/null +++ b/src/soc/nvidia/tegra210/mtc.c @@ -0,0 +1,89 @@ +/* + * This file is part of the coreboot project. + * + * Copyright 2015 Google Inc. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; version 2 of the License. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc. + */ + +#include <cbfs.h> +#include <cbmem.h> +#include <console/console.h> +#include <soc/mtc.h> +#include <string.h> + +static size_t mtc_table_size; + +#define MAX_MTC_TABLE_ENTRIES 20 +#define MTC_TABLE_ENTRY_SIZE 4880 +#define MTC_TABLE_MAX_SIZE (MAX_MTC_TABLE_ENTRIES * MTC_TABLE_ENTRY_SIZE) + +int tegra210_run_mtc(void) +{ + ssize_t nread; + struct region_device fh; + + void * const mtc = (void *)(uintptr_t)CONFIG_MTC_ADDRESS; + void *dvfs_table; + size_t (*mtc_fw)(void **dvfs_table) = (void *)mtc; + + if (cbfs_boot_locate(&fh, "tegra_mtc.bin", NULL)) { + printk(BIOS_ERR, "MTC file not found: tegra_mtc.bin\n"); + return -1; + } + + /* Read MTC file into predefined region. */ + nread = rdev_readat(&fh, mtc, 0, region_device_sz(&fh)); + + if (nread != region_device_sz(&fh)) { + printk(BIOS_ERR, "MTC bytes read (%zu) != file length(%zu)!\n", + nread, region_device_sz(&fh)); + return -1; + } + + printk(BIOS_INFO, "MTC: %zu bytes loaded @ %p\n", nread, mtc); + + mtc_table_size = (*mtc_fw)(&dvfs_table); + + if ((mtc_table_size == 0) || (mtc_table_size > MTC_TABLE_MAX_SIZE)) { + printk(BIOS_ERR, "MTC Training table size is invalid.!\n"); + return -1; + } + + printk(BIOS_INFO, "MTC: Done. Entries size 0x%zx located at %p\n", + mtc_table_size, dvfs_table); + + void *cbmem_tab = cbmem_add(CBMEM_ID_MTC, mtc_table_size); + if (cbmem_tab == NULL) { + printk(BIOS_ERR, "MTC table allocation in cbmem failed!\n"); + return -1; + } + + memcpy(cbmem_tab, dvfs_table, mtc_table_size); + printk(BIOS_INFO, "MTC: Copied 0x%zx bytes from %p to %p\n", + mtc_table_size, dvfs_table, cbmem_tab); + + return 0; +} + +void soc_add_mtc(struct lb_header *header) +{ + struct lb_range *mtc; + mtc = (struct lb_range *)lb_new_record(header); + mtc->tag = LB_TAG_MTC; + mtc->size = sizeof(*mtc); + + mtc->range_start = (uintptr_t)cbmem_find(CBMEM_ID_MTC); + mtc->range_size = mtc_table_size; +} |