Angel Pons | 7c1d70e | 2020-04-04 18:51:19 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 2 | |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 3 | #include <arch/cache.h> |
Kyösti Mälkki | 13f6650 | 2019-03-03 08:01:05 +0200 | [diff] [blame] | 4 | #include <device/mmio.h> |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 5 | #include <cbfs.h> |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 6 | #include <console/console.h> |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 7 | #include <string.h> |
| 8 | #include <timer.h> |
| 9 | |
| 10 | #include <soc/iomap.h> |
| 11 | #include <soc/soc_services.h> |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 12 | |
| 13 | #include "mbn_header.h" |
| 14 | |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 15 | static void *load_ipq_blob(const char *file_name) |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 16 | { |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 17 | struct mbn_header *blob_mbn; |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 18 | void *blob_dest; |
Aaron Durbin | 899d13d | 2015-05-15 23:39:23 -0500 | [diff] [blame] | 19 | size_t blob_size; |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 20 | |
Aaron Durbin | 899d13d | 2015-05-15 23:39:23 -0500 | [diff] [blame] | 21 | blob_mbn = cbfs_boot_map_with_leak(file_name, CBFS_TYPE_RAW, |
| 22 | &blob_size); |
| 23 | if (!blob_mbn) |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 24 | return NULL; |
| 25 | |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 26 | /* some sanity checks on the headers */ |
| 27 | if ((blob_mbn->mbn_version != 3) || |
Aaron Durbin | 899d13d | 2015-05-15 23:39:23 -0500 | [diff] [blame] | 28 | (blob_mbn->mbn_total_size > blob_size)) |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 29 | return NULL; |
| 30 | |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 31 | blob_dest = (void *) blob_mbn->mbn_destination; |
| 32 | if (blob_mbn->mbn_destination) { |
| 33 | /* Copy the blob to the appropriate memory location. */ |
| 34 | memcpy(blob_dest, blob_mbn + 1, blob_mbn->mbn_total_size); |
| 35 | cache_sync_instructions(); |
| 36 | return blob_dest; |
| 37 | } |
| 38 | |
| 39 | /* |
| 40 | * The blob did not have to be relocated, return its address in CBFS |
| 41 | * cache. |
| 42 | */ |
| 43 | return blob_mbn + 1; |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 44 | } |
| 45 | |
Vadim Bendebury | b16a6c4 | 2015-03-05 17:36:00 -0800 | [diff] [blame] | 46 | #define DDR_VERSION() ((const char *)0x2a03f600) |
| 47 | #define MAX_DDR_VERSION_SIZE 48 |
| 48 | |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 49 | int initialize_dram(void) |
| 50 | { |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 51 | void *cdt; |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 52 | int (*ddr_init_function)(void *cdt_header); |
| 53 | |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 54 | cdt = load_ipq_blob("cdt.mbn"); |
| 55 | ddr_init_function = load_ipq_blob("ddr.mbn"); |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 56 | |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 57 | if (!cdt || !ddr_init_function) { |
| 58 | printk(BIOS_ERR, "cdt: %p, ddr_init_function: %p\n", |
| 59 | cdt, ddr_init_function); |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 60 | die("could not find DDR initialization blobs\n"); |
| 61 | } |
| 62 | |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 63 | if (ddr_init_function(cdt) < 0) |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 64 | die("Fail to Initialize DDR\n"); |
| 65 | |
Vadim Bendebury | b16a6c4 | 2015-03-05 17:36:00 -0800 | [diff] [blame] | 66 | /* |
Jonathan Neuschäfer | 5268b76 | 2018-02-12 12:24:25 +0100 | [diff] [blame] | 67 | * Once DDR initializer finished, its version can be found at a fixed |
Vadim Bendebury | b16a6c4 | 2015-03-05 17:36:00 -0800 | [diff] [blame] | 68 | * address in SRAM. |
| 69 | */ |
| 70 | printk(BIOS_INFO, "DDR version %.*s initialized\n", |
| 71 | MAX_DDR_VERSION_SIZE, DDR_VERSION()); |
Vadim Bendebury | ef77f87 | 2014-12-10 20:42:58 -0800 | [diff] [blame] | 72 | |
| 73 | return 0; |
| 74 | } |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 75 | |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 76 | void start_tzbsp(void) |
| 77 | { |
| 78 | void *tzbsp = load_ipq_blob("tz.mbn"); |
| 79 | |
| 80 | if (!tzbsp) |
| 81 | die("could not find or map TZBSP\n"); |
| 82 | |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 83 | printk(BIOS_INFO, "Starting TZBSP\n"); |
| 84 | |
Vikas Das | 08f249e | 2014-09-22 17:49:56 -0700 | [diff] [blame] | 85 | tz_init_wrapper(0, 0, tzbsp); |
| 86 | } |
| 87 | |
Vadim Bendebury | b16a6c4 | 2015-03-05 17:36:00 -0800 | [diff] [blame] | 88 | /* RPM version is encoded in a 32 bit word at the fixed address */ |
| 89 | #define RPM_VERSION() (*((u32 *)(0x00108008))) |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 90 | void start_rpm(void) |
| 91 | { |
| 92 | u32 load_addr; |
| 93 | u32 ready_mask = 1 << 10; |
Vadim Bendebury | b16a6c4 | 2015-03-05 17:36:00 -0800 | [diff] [blame] | 94 | u32 rpm_version; |
| 95 | |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 96 | struct stopwatch sw; |
| 97 | |
Julius Werner | 2f37bd6 | 2015-02-19 14:51:15 -0800 | [diff] [blame] | 98 | if (read32(RPM_SIGNAL_COOKIE) == RPM_FW_MAGIC_NUM) { |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 99 | printk(BIOS_INFO, "RPM appears to have already started\n"); |
| 100 | return; |
| 101 | } |
| 102 | |
| 103 | load_addr = (u32) load_ipq_blob("rpm.mbn"); |
| 104 | if (!load_addr) |
| 105 | die("could not find or map RPM code\n"); |
| 106 | |
| 107 | printk(BIOS_INFO, "Starting RPM\n"); |
| 108 | |
| 109 | /* Clear 'ready' indication. */ |
Sourabh Banerjee | 0bd22ce | 2015-04-24 22:54:18 +0530 | [diff] [blame] | 110 | /* |
| 111 | * RPM_INT_ACK is clear-on-write type register, |
| 112 | * read-modify-write is not recommended. |
| 113 | */ |
| 114 | write32(RPM_INT_ACK, ready_mask); |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 115 | |
| 116 | /* Set RPM entry address */ |
Julius Werner | 2f37bd6 | 2015-02-19 14:51:15 -0800 | [diff] [blame] | 117 | write32(RPM_SIGNAL_ENTRY, load_addr); |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 118 | /* Set cookie */ |
Julius Werner | 2f37bd6 | 2015-02-19 14:51:15 -0800 | [diff] [blame] | 119 | write32(RPM_SIGNAL_COOKIE, RPM_FW_MAGIC_NUM); |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 120 | |
| 121 | /* Wait for RPM start indication, up to 100ms. */ |
| 122 | stopwatch_init_usecs_expire(&sw, 100000); |
Julius Werner | 2f37bd6 | 2015-02-19 14:51:15 -0800 | [diff] [blame] | 123 | while (!(read32(RPM_INT) & ready_mask)) |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 124 | if (stopwatch_expired(&sw)) |
| 125 | die("RPM Initialization failed\n"); |
| 126 | |
| 127 | /* Acknowledge RPM initialization */ |
Julius Werner | 2f37bd6 | 2015-02-19 14:51:15 -0800 | [diff] [blame] | 128 | write32(RPM_INT_ACK, ready_mask); |
Vadim Bendebury | b16a6c4 | 2015-03-05 17:36:00 -0800 | [diff] [blame] | 129 | |
| 130 | /* Report RPM version, it is encoded in a 32 bit value. */ |
| 131 | rpm_version = RPM_VERSION(); |
| 132 | printk(BIOS_INFO, "Started RPM version %d.%d.%d\n", |
| 133 | rpm_version >> 24, |
| 134 | (rpm_version >> 16) & 0xff, |
| 135 | rpm_version & 0xffff); |
Vadim Bendebury | 6114c99 | 2014-12-16 14:34:28 -0800 | [diff] [blame] | 136 | } |