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
|
/* SPDX-License-Identifier: MIT */
#include "adt.h"
#include "aic.h"
#include "aic_regs.h"
#include "hv.h"
#include "uartproxy.h"
#include "utils.h"
#define IRQTRACE_IRQ BIT(0)
static u32 trace_hw_num[AIC_MAX_DIES][AIC_MAX_HW_NUM / 32];
static void emit_irqtrace(u16 die, u16 type, u16 num)
{
struct hv_evt_irqtrace evt = {
.flags = IRQTRACE_IRQ,
.type = type,
.num = die * aic->max_irq + num,
};
hv_wdt_suspend();
uartproxy_send_event(EVT_IRQTRACE, &evt, sizeof(evt));
hv_wdt_resume();
}
static bool trace_aic_event(struct exc_info *ctx, u64 addr, u64 *val, bool write, int width)
{
if (!hv_pa_rw(ctx, addr, val, write, width))
return false;
if (addr != (aic->base + aic->regs.event) || write || width != 2) {
return true;
}
u16 die = FIELD_GET(AIC_EVENT_DIE, *val);
u16 type = FIELD_GET(AIC_EVENT_TYPE, *val);
u16 num = FIELD_GET(AIC_EVENT_NUM, *val);
if (die > AIC_MAX_DIES)
return true;
switch (type) {
case AIC_EVENT_TYPE_HW:
if (trace_hw_num[die][num / 32] & BIT(num & 31)) {
emit_irqtrace(die, type, num);
}
break;
default:
// ignore
break;
}
return true;
}
bool hv_trace_irq(u32 type, u32 num, u32 count, u32 flags)
{
dprintf("HV: hv_trace_irq type: %u start: %u num: %u flags: 0x%x\n", type, num, count, flags);
if (type == AIC_EVENT_TYPE_HW) {
u32 die = num / aic->max_irq;
num %= AIC_MAX_HW_NUM;
if (die >= aic->max_irq || num >= AIC_MAX_HW_NUM || count > AIC_MAX_HW_NUM - num) {
printf("HV: invalid IRQ range: (%u, %u) for die %u\n", num, num + count, die);
return false;
}
for (u32 n = num; n < num + count; n++) {
switch (flags) {
case IRQTRACE_IRQ:
trace_hw_num[die][n / 32] |= BIT(n & 31);
break;
default:
trace_hw_num[die][n / 32] &= ~(BIT(n & 31));
break;
}
}
} else {
printf("HV: not handling AIC event type: 0x%02x num: %u\n", type, num);
return false;
}
if (!aic) {
printf("HV: AIC not initialized\n");
return false;
}
static bool hooked = false;
if (aic && !hooked) {
hv_map_hook(aic->base, trace_aic_event, aic->regs.reg_size);
hooked = true;
}
return true;
}
|
