Huayang Duan | c2ef102 | 2018-09-26 14:24:02 +0800 | [diff] [blame] | 1 | /* |
| 2 | * This file is part of the coreboot project. |
| 3 | * |
| 4 | * Copyright 2018 MediaTek Inc. |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License as published by |
| 8 | * the Free Software Foundation; version 2 of the License. |
| 9 | * |
| 10 | * This program is distributed in the hope that it will be useful, |
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 13 | * GNU General Public License for more details. |
| 14 | */ |
| 15 | |
Huayang Duan | 4d15d2f | 2018-09-26 21:23:53 +0800 | [diff] [blame] | 16 | #include <assert.h> |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 17 | #include <cbfs.h> |
Huayang Duan | 4d15d2f | 2018-09-26 21:23:53 +0800 | [diff] [blame] | 18 | #include <console/console.h> |
Yu-Ping Wu | e67dce0 | 2019-10-14 16:56:50 +0800 | [diff] [blame] | 19 | #include <ip_checksum.h> |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 20 | #include <security/vboot/vboot_common.h> |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 21 | #include <soc/dramc_param.h> |
Huayang Duan | 4d15d2f | 2018-09-26 21:23:53 +0800 | [diff] [blame] | 22 | #include <soc/dramc_pi_api.h> |
Huayang Duan | c2ef102 | 2018-09-26 14:24:02 +0800 | [diff] [blame] | 23 | #include <soc/emi.h> |
Huayang Duan | 4d15d2f | 2018-09-26 21:23:53 +0800 | [diff] [blame] | 24 | #include <symbols.h> |
Huayang Duan | c2ef102 | 2018-09-26 14:24:02 +0800 | [diff] [blame] | 25 | |
Yu-Ping Wu | ffb5ea3 | 2019-10-07 15:55:57 +0800 | [diff] [blame] | 26 | static int mt_mem_test(void) |
Huayang Duan | c2ef102 | 2018-09-26 14:24:02 +0800 | [diff] [blame] | 27 | { |
Huayang Duan | 4d15d2f | 2018-09-26 21:23:53 +0800 | [diff] [blame] | 28 | u64 rank_size[RANK_MAX]; |
| 29 | |
Julius Werner | cd49cce | 2019-03-05 16:53:33 -0800 | [diff] [blame] | 30 | if (CONFIG(MEMORY_TEST)) { |
Huayang Duan | 4d15d2f | 2018-09-26 21:23:53 +0800 | [diff] [blame] | 31 | size_t r; |
| 32 | u8 *addr = _dram; |
| 33 | |
| 34 | dramc_get_rank_size(rank_size); |
| 35 | |
| 36 | for (r = RANK_0; r < RANK_MAX; r++) { |
| 37 | int i; |
| 38 | |
| 39 | if (rank_size[r] == 0) |
| 40 | break; |
| 41 | |
| 42 | i = complex_mem_test(addr, 0x2000); |
| 43 | |
| 44 | printk(BIOS_DEBUG, "[MEM] complex R/W mem test %s : %d\n", |
| 45 | (i == 0) ? "pass" : "fail", i); |
| 46 | |
Yu-Ping Wu | ffb5ea3 | 2019-10-07 15:55:57 +0800 | [diff] [blame] | 47 | if (i != 0) { |
Yu-Ping Wu | 31ec0c4 | 2019-10-09 16:11:47 +0800 | [diff] [blame] | 48 | printk(BIOS_ERR, "DRAM memory test failed\n"); |
Yu-Ping Wu | ffb5ea3 | 2019-10-07 15:55:57 +0800 | [diff] [blame] | 49 | return -1; |
| 50 | } |
Huayang Duan | 4d15d2f | 2018-09-26 21:23:53 +0800 | [diff] [blame] | 51 | |
| 52 | addr += rank_size[r]; |
| 53 | } |
| 54 | } |
Yu-Ping Wu | ffb5ea3 | 2019-10-07 15:55:57 +0800 | [diff] [blame] | 55 | |
| 56 | return 0; |
Huayang Duan | c2ef102 | 2018-09-26 14:24:02 +0800 | [diff] [blame] | 57 | } |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 58 | |
| 59 | static void dump_param_header(const struct dramc_param *dparam) |
| 60 | { |
| 61 | const struct dramc_param_header *header = &dparam->header; |
| 62 | |
| 63 | printk(BIOS_DEBUG, "header.status = %#x\n", header->status); |
| 64 | printk(BIOS_DEBUG, "header.magic = %#x (expected: %#x)\n", |
| 65 | header->magic, DRAMC_PARAM_HEADER_MAGIC); |
| 66 | printk(BIOS_DEBUG, "header.version = %#x (expected: %#x)\n", |
| 67 | header->version, DRAMC_PARAM_HEADER_VERSION); |
| 68 | printk(BIOS_DEBUG, "header.size = %#x (expected: %#lx)\n", |
| 69 | header->size, sizeof(*dparam)); |
| 70 | printk(BIOS_DEBUG, "header.config = %#x\n", header->config); |
| 71 | printk(BIOS_DEBUG, "header.flags = %#x\n", header->flags); |
| 72 | printk(BIOS_DEBUG, "header.checksum = %#x\n", header->checksum); |
| 73 | } |
| 74 | |
Yu-Ping Wu | e67dce0 | 2019-10-14 16:56:50 +0800 | [diff] [blame] | 75 | static u32 compute_checksum(const struct dramc_param *dparam) |
| 76 | { |
| 77 | return (u32)compute_ip_checksum(dparam->freq_params, |
| 78 | sizeof(dparam->freq_params)); |
| 79 | } |
| 80 | |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 81 | static int dram_run_fast_calibration(const struct dramc_param *dparam, |
| 82 | u16 config) |
| 83 | { |
| 84 | if (!is_valid_dramc_param(dparam)) { |
| 85 | printk(BIOS_WARNING, |
| 86 | "Invalid DRAM calibration data from flash\n"); |
| 87 | dump_param_header(dparam); |
| 88 | return -1; |
| 89 | } |
| 90 | |
Yu-Ping Wu | 31ec0c4 | 2019-10-09 16:11:47 +0800 | [diff] [blame] | 91 | if (dparam->header.config != config) { |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 92 | printk(BIOS_WARNING, |
| 93 | "Incompatible config for calibration data from flash " |
| 94 | "(expected: %#x, saved: %#x)\n", |
| 95 | config, dparam->header.config); |
| 96 | return -1; |
| 97 | } |
| 98 | |
Yu-Ping Wu | e67dce0 | 2019-10-14 16:56:50 +0800 | [diff] [blame] | 99 | const u32 checksum = compute_checksum(dparam); |
| 100 | if (dparam->header.checksum != checksum) { |
| 101 | printk(BIOS_ERR, |
| 102 | "Invalid DRAM calibration checksum from flash " |
| 103 | "(expected: %#x, saved: %#x)\n", |
| 104 | checksum, dparam->header.checksum); |
| 105 | return -1; |
| 106 | } |
| 107 | |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 108 | return 0; |
| 109 | } |
| 110 | |
| 111 | static int dram_run_full_calibration(struct dramc_param *dparam, u16 config) |
| 112 | { |
| 113 | initialize_dramc_param(dparam, config); |
| 114 | |
| 115 | /* Load and run the provided blob for full-calibration if available */ |
| 116 | struct prog dram = PROG_INIT(PROG_REFCODE, CONFIG_CBFS_PREFIX "/dram"); |
| 117 | |
| 118 | if (prog_locate(&dram)) |
| 119 | return -1; |
| 120 | |
| 121 | if (cbfs_prog_stage_load(&dram)) |
| 122 | return -2; |
| 123 | |
Hung-Te Lin | beeab4e | 2019-10-15 17:49:24 +0800 | [diff] [blame] | 124 | dparam->do_putc = do_putchar; |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 125 | prog_set_entry(&dram, prog_entry(&dram), dparam); |
| 126 | prog_run(&dram); |
| 127 | |
| 128 | if (dparam->header.status != DRAMC_SUCCESS) { |
| 129 | printk(BIOS_ERR, "Full calibration failed: status = %d\n", |
| 130 | dparam->header.status); |
| 131 | return -3; |
| 132 | } |
| 133 | |
| 134 | if (!(dparam->header.flags & DRAMC_FLAG_HAS_SAVED_DATA)) { |
| 135 | printk(BIOS_ERR, |
| 136 | "Full calibration executed without saving parameters. " |
| 137 | "Please ensure the blob is built properly.\n"); |
| 138 | return -4; |
| 139 | } |
| 140 | |
| 141 | return 0; |
| 142 | } |
| 143 | |
| 144 | static void set_source_to_flash(struct sdram_params *freq_params) |
| 145 | { |
| 146 | for (u8 shuffle = DRAM_DFS_SHUFFLE_1; shuffle < DRAM_DFS_SHUFFLE_MAX; |
| 147 | shuffle++) |
| 148 | freq_params[shuffle].source = DRAMC_PARAM_SOURCE_FLASH; |
| 149 | } |
| 150 | |
| 151 | static void init_sdram_params(struct sdram_params *dst, |
| 152 | const struct sdram_params *src) |
| 153 | { |
| 154 | for (u8 shuffle = DRAM_DFS_SHUFFLE_1; shuffle < DRAM_DFS_SHUFFLE_MAX; |
| 155 | shuffle++) |
| 156 | memcpy(&dst[shuffle], src, sizeof(*dst)); |
| 157 | } |
| 158 | |
| 159 | void mt_mem_init(struct dramc_param_ops *dparam_ops) |
| 160 | { |
| 161 | struct dramc_param *dparam = dparam_ops->param; |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 162 | |
| 163 | u16 config = 0; |
| 164 | if (CONFIG(MT8183_DRAM_EMCP)) |
| 165 | config |= DRAMC_CONFIG_EMCP; |
| 166 | |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 167 | const bool recovery_mode = vboot_recovery_mode_enabled(); |
| 168 | |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 169 | /* Load calibration params from flash and run fast calibration */ |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 170 | if (recovery_mode) { |
| 171 | printk(BIOS_WARNING, "Skip loading cached calibration data\n"); |
Yu-Ping Wu | 46009ea | 2019-10-17 13:38:32 +0800 | [diff] [blame^] | 172 | if (vboot_recovery_mode_memory_retrain()) { |
| 173 | printk(BIOS_WARNING, "Retrain memory in next boot\n"); |
| 174 | /* Use 0xFF as erased flash data. */ |
| 175 | memset(dparam, 0xff, sizeof(*dparam)); |
| 176 | dparam_ops->write_to_flash(dparam); |
| 177 | } |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 178 | } else if (dparam_ops->read_from_flash(dparam)) { |
| 179 | printk(BIOS_INFO, "DRAM-K: Fast Calibration\n"); |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 180 | if (dram_run_fast_calibration(dparam, config) == 0) { |
| 181 | printk(BIOS_INFO, |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 182 | "Calibration params loaded from flash\n"); |
Yu-Ping Wu | ffb5ea3 | 2019-10-07 15:55:57 +0800 | [diff] [blame] | 183 | if (mt_set_emi(dparam) == 0 && mt_mem_test() == 0) |
| 184 | return; |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 185 | } else { |
| 186 | printk(BIOS_ERR, |
| 187 | "Failed to apply cached calibration data\n"); |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 188 | } |
| 189 | } else { |
| 190 | printk(BIOS_WARNING, |
| 191 | "Failed to read calibration data from flash\n"); |
| 192 | } |
| 193 | |
| 194 | /* Run full calibration */ |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 195 | printk(BIOS_INFO, "DRAM-K: Full Calibration\n"); |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 196 | int err = dram_run_full_calibration(dparam, config); |
| 197 | if (err == 0) { |
| 198 | printk(BIOS_INFO, "Successfully loaded DRAM blobs and " |
| 199 | "ran DRAM calibration\n"); |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 200 | /* |
| 201 | * In recovery mode the system boots in RO but the flash params |
| 202 | * should be calibrated for RW so we can't mix them up. |
| 203 | */ |
| 204 | if (!recovery_mode) { |
| 205 | set_source_to_flash(dparam->freq_params); |
| 206 | dparam->header.checksum = compute_checksum(dparam); |
| 207 | dparam_ops->write_to_flash(dparam); |
| 208 | printk(BIOS_DEBUG, "Calibration params saved to flash: " |
| 209 | "version=%#x, size=%#x\n", |
| 210 | dparam->header.version, dparam->header.size); |
| 211 | } |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 212 | return; |
| 213 | } |
| 214 | |
| 215 | printk(BIOS_ERR, "Failed to do full calibration (%d), " |
| 216 | "falling back to load default sdram param\n", err); |
| 217 | |
| 218 | /* Init params from sdram configs and run partial calibration */ |
Yu-Ping Wu | 998a3cc | 2019-10-16 18:29:50 +0800 | [diff] [blame] | 219 | printk(BIOS_INFO, "DRAM-K: Partial Calibration\n"); |
Yu-Ping Wu | 0e5b196 | 2019-10-07 16:57:24 +0800 | [diff] [blame] | 220 | init_sdram_params(dparam->freq_params, get_sdram_config()); |
Yu-Ping Wu | ffb5ea3 | 2019-10-07 15:55:57 +0800 | [diff] [blame] | 221 | if (mt_set_emi(dparam) != 0) |
| 222 | die("Set emi failed with params from sdram config\n"); |
| 223 | if (mt_mem_test() != 0) |
| 224 | die("Memory test failed with params from sdram config\n"); |
Huayang Duan | 078332e | 2019-08-27 13:36:14 +0800 | [diff] [blame] | 225 | } |