1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <stdio.h>
#include <console/console.h>
#include <device/mmio.h>
#include <soc/addressmap.h>
#include <soc/tracker_common.h>
static struct tracker {
uintptr_t base_addr;
u32 timeout;
u32 entry;
u32 offset[2];
const char *str;
} tracker_data[TRACKER_NUM] = {
[TRACKER_SYSTRACKER] = {
.base_addr = DBG_TRACKER_BASE,
.timeout = BUS_DBG_CON_TIMEOUT,
.entry = SYS_TRACK_ENTRY,
.offset[0] = AR_TRACK_OFFSET,
.offset[1] = AW_TRACK_OFFSET,
.str = "systracker",
},
[TRACKER_INFRATRACKER] = {
.base_addr = INFRA_TRACKER_BASE,
.timeout = BUSTRACKER_TIMEOUT,
.entry = INFRA_ENTRY_NUM,
.offset[0] = AR_TRACK_OFFSET,
.offset[1] = AW_TRACK_OFFSET,
.str = "infra_tracker",
},
[TRACKER_PERISYSTRACKER] = {
.base_addr = PERI_TRACKER_BASE,
.timeout = BUSTRACKER_TIMEOUT,
.entry = PERI_ENTRY_NUM,
.offset[0] = AR_TRACK_OFFSET,
.offset[1] = AW_TRACK_OFFSET,
.str = "peri_tracker",
},
};
static void setup_init(void)
{
u32 val;
/*
* Set infra/peri tracker timeout.
* timeout = clock_in_mhz * 1000 / 16 * timeout_in_ms
*
* timeout: 200ms
* infra tracker clock: 156MHz
* peri tracker clock: 78MHz
*/
val = 156 * 1000 / 16 * 200;
write32((void *)(INFRA_TRACKER_BASE + BUS_DBG_TIMER_CON0), val);
write32((void *)(INFRA_TRACKER_BASE + BUS_DBG_TIMER_CON1), val);
val = 78 * 1000 / 16 * 200;
write32((void *)(PERI_TRACKER_BASE + BUS_DBG_TIMER_CON0), val);
write32((void *)(PERI_TRACKER_BASE + BUS_DBG_TIMER_CON1), val);
/* Enable infra/peri tracer because tracker and tracer share the same enable bit. */
write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_1), 1 << BUS_TRACE_EN);
write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_2), 1 << BUS_TRACE_EN);
/*
* Enable infra/peri tracker.
* bit[0] - BUS_DBG_EN
* bit[1] - TIMEOUT_EN
* bit[2] - SLV_ERR_EN
* bit[13] - HALT_ON_TIMEOUT_EN
* bit[14] - BUS_OT_WEN_CTRL
*/
val = BIT(0) | BIT(1) | BIT(2) | BIT(13) | BIT(14);
write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_AO_1), val);
write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_AO_2), val);
}
static void tracker_dump_data(void)
{
int i, j, k;
int size;
uintptr_t reg;
struct tracker *tra;
for (j = 0; j < TRACKER_NUM; j++) {
tra = &tracker_data[j];
if (!(read32((void *)(tra->base_addr)) & tra->timeout))
continue;
printk(BIOS_INFO, "**Dump %s debug register start**\n", tra->str);
for (k = 0; k < 2; k++) {
/*
* for systracker:
* offset[0] dump from offset 0x100 ~ 0x2F8.
* offset[1] dump from offset 0x300 ~ 0x4FC
*
* for infra tracker:
* offset[0] dump from offset 0x100 ~ 0x1F8
* offset[1] dump from offset 0x300 ~ 0x3FC
*
* for perisys tracker:
* offset[0] dump from offset 0x100 ~ 0x2F8
* offset[1] dump from offset 0x300 ~ 0x4FC
*/
size = 2 * tra->entry;
for (i = 0; i < size; i++) {
reg = tra->base_addr + tra->offset[k] + i * 4;
printk(BIOS_INFO, "%#lx:%#x,", reg, read32((void *)reg));
if (i % 4 == 3 || i == size - 1)
printk(BIOS_INFO, "\n");
}
}
printk(BIOS_INFO, "**Dump %s debug register end**\n", tra->str);
}
}
void bustracker_init(void)
{
tracker_dump_data();
setup_init();
}
|