1 /* SPDX-License-Identifier: GPL-2.0-only */
2
3 #include <console/console.h>
4 #include <device/mmio.h>
5 #include <soc/addressmap.h>
6 #include <soc/lastbus_v1.h>
7
8 static unsigned long preisys_dump_offset[] = {
9 0x500, /* PERIBUS_DBG0 */
10 0x504, /* PERIBUS_DBG1 */
11 0x508, /* PERIBUS_DBG2 */
12 0x50C, /* PERIBUS_DBG3 */
13 0x510, /* PERIBUS_DBG4 */
14 0x514, /* PERIBUS_DBG5 */
15 0x518, /* PERIBUS_DBG6 */
16 0x51C, /* PERIBUS_DBG7 */
17 0x520, /* PERIBUS_DBG8 */
18 0x524, /* PERIBUS_DBG9 */
19 0x528, /* PERIBUS_DBG10 */
20 0x52C, /* PERIBUS_DBG11 */
21 0x530, /* PERIBUS_DBG12 */
22 0x534, /* PERIBUS_DBG13 */
23 0x538, /* PERIBUS_DBG14 */
24 0x53C, /* PERIBUS_DBG15 */
25 0x580, /* PERIBUS_DBG16 */
26 0x584, /* PERIBUS_DBG17 */
27 };
28
lastbus_setup(void)29 static void lastbus_setup(void)
30 {
31 /* peri lastbus init */
32 write32p(PERICFG_BASE + BUS_PERI_R0, PERISYS_TIMEOUT);
33 write32p(PERICFG_BASE + BUS_PERI_R1, PERISYS_ENABLE);
34
35 /* infra lastbus init */
36 write32p(INFRACFG_AO_BASE + BUS_INFRA_CTRL, INFRASYS_CONFIG);
37 }
38
lastbus_dump(void)39 static void lastbus_dump(void)
40 {
41 unsigned int i;
42 uintptr_t reg;
43
44 if (read32p(INFRACFG_AO_BASE + BUS_INFRA_CTRL) & 0x1) {
45 printk(BIOS_DEBUG, "** Dump lastbus infra debug registers start **\n");
46 for (i = 0; i < INFRA_NUM; i++) {
47 reg = INFRACFG_AO_BASE + BUS_INFRA_SNAPSHOT + 4 * i;
48 printk(BIOS_DEBUG, "%08x\n", read32p(reg));
49 }
50 }
51
52 if (read32p(PERICFG_BASE + BUS_PERI_R1) & 0x1) {
53 printk(BIOS_DEBUG, "** Dump lastbus peri debug registers start **\n");
54 for (i = 0; i < PERI_NUM; i++) {
55 reg = PERICFG_BASE + preisys_dump_offset[i];
56 printk(BIOS_DEBUG, "%08x\n", read32p(reg));
57 }
58 }
59 }
60
lastbus_init(void)61 void lastbus_init(void)
62 {
63 lastbus_dump();
64 lastbus_setup();
65 }
66