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: MIT */
#include "hv.h"
#include "aic.h"
#include "iodev.h"
#include "uart.h"
#include "uart_regs.h"
#include "usb.h"
bool active = false;
u32 ucon = 0;
u32 utrstat = 0;
u32 ufstat = 0;
int vuart_irq = 0;
static void update_irq(void)
{
ssize_t rx_queued;
iodev_handle_events(IODEV_USB_VUART);
utrstat |= UTRSTAT_TXBE | UTRSTAT_TXE;
utrstat &= ~UTRSTAT_RXD;
ufstat = 0;
if ((rx_queued = iodev_can_read(IODEV_USB_VUART))) {
utrstat |= UTRSTAT_RXD;
if (rx_queued > 15)
ufstat = FIELD_PREP(UFSTAT_RXCNT, 15) | UFSTAT_RXFULL;
else
ufstat = FIELD_PREP(UFSTAT_RXCNT, rx_queued);
if (FIELD_GET(UCON_RXMODE, ucon) == UCON_MODE_IRQ && ucon & UCON_RXTO_ENA) {
utrstat |= UTRSTAT_RXTO;
}
}
if (FIELD_GET(UCON_TXMODE, ucon) == UCON_MODE_IRQ && ucon & UCON_TXTHRESH_ENA) {
utrstat |= UTRSTAT_TXTHRESH;
}
if (vuart_irq) {
uart_clear_irqs();
if (utrstat & (UTRSTAT_TXTHRESH | UTRSTAT_RXTHRESH | UTRSTAT_RXTO)) {
aic_set_sw(vuart_irq, true);
} else {
aic_set_sw(vuart_irq, false);
}
}
// printf("HV: vuart UTRSTAT=0x%x UFSTAT=0x%x UCON=0x%x\n", utrstat, ufstat, ucon);
}
static bool handle_vuart(struct exc_info *ctx, u64 addr, u64 *val, bool write, int width)
{
UNUSED(ctx);
UNUSED(width);
addr &= 0xfff;
update_irq();
if (write) {
// printf("HV: vuart W 0x%lx <- 0x%lx (%d)\n", addr, *val, width);
switch (addr) {
case UCON:
ucon = *val;
break;
case UTXH: {
uint8_t b = *val;
if (iodev_can_write(IODEV_USB_VUART))
iodev_write(IODEV_USB_VUART, &b, 1);
break;
}
case UTRSTAT:
utrstat &= ~(*val & (UTRSTAT_TXTHRESH | UTRSTAT_RXTHRESH | UTRSTAT_RXTO));
break;
}
} else {
switch (addr) {
case UCON:
*val = ucon;
break;
case URXH:
if (iodev_can_read(IODEV_USB_VUART)) {
uint8_t c;
iodev_read(IODEV_USB_VUART, &c, 1);
*val = c;
} else {
*val = 0;
}
break;
case UTRSTAT:
*val = utrstat;
break;
case UFSTAT:
*val = ufstat;
break;
default:
*val = 0;
break;
}
// printf("HV: vuart R 0x%lx -> 0x%lx (%d)\n", addr, *val, width);
}
return true;
}
void hv_vuart_poll(void)
{
if (!active)
return;
update_irq();
}
void hv_map_vuart(u64 base, int irq, iodev_id_t iodev)
{
hv_map_hook(base, handle_vuart, 0x1000);
usb_iodev_vuart_setup(iodev);
vuart_irq = irq;
active = true;
}
|
