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
|
/*
* Remote IO Hub
*
* Copyright © 2018, 2021 Oracle and/or its affiliates.
*
* This work is licensed under the terms of the GNU GPL, version 2 or later.
* See the COPYING file in the top-level directory.
*
*/
#include "qemu/osdep.h"
#include "qemu-common.h"
#include "hw/pci/pci.h"
#include "hw/pci/pci_ids.h"
#include "hw/pci/pci_bus.h"
#include "qemu/thread.h"
#include "hw/boards.h"
#include "hw/remote/machine.h"
#include "hw/remote/iohub.h"
#include "qemu/main-loop.h"
void remote_iohub_init(RemoteIOHubState *iohub)
{
int pirq;
memset(&iohub->irqfds, 0, sizeof(iohub->irqfds));
memset(&iohub->resamplefds, 0, sizeof(iohub->resamplefds));
for (pirq = 0; pirq < REMOTE_IOHUB_NB_PIRQS; pirq++) {
qemu_mutex_init(&iohub->irq_level_lock[pirq]);
iohub->irq_level[pirq] = 0;
event_notifier_init_fd(&iohub->irqfds[pirq], -1);
event_notifier_init_fd(&iohub->resamplefds[pirq], -1);
}
}
void remote_iohub_finalize(RemoteIOHubState *iohub)
{
int pirq;
for (pirq = 0; pirq < REMOTE_IOHUB_NB_PIRQS; pirq++) {
qemu_set_fd_handler(event_notifier_get_fd(&iohub->resamplefds[pirq]),
NULL, NULL, NULL);
event_notifier_cleanup(&iohub->irqfds[pirq]);
event_notifier_cleanup(&iohub->resamplefds[pirq]);
qemu_mutex_destroy(&iohub->irq_level_lock[pirq]);
}
}
int remote_iohub_map_irq(PCIDevice *pci_dev, int intx)
{
return pci_dev->devfn;
}
void remote_iohub_set_irq(void *opaque, int pirq, int level)
{
RemoteIOHubState *iohub = opaque;
assert(pirq >= 0);
assert(pirq < PCI_DEVFN_MAX);
QEMU_LOCK_GUARD(&iohub->irq_level_lock[pirq]);
if (level) {
if (++iohub->irq_level[pirq] == 1) {
event_notifier_set(&iohub->irqfds[pirq]);
}
} else if (iohub->irq_level[pirq] > 0) {
iohub->irq_level[pirq]--;
}
}
static void intr_resample_handler(void *opaque)
{
ResampleToken *token = opaque;
RemoteIOHubState *iohub = token->iohub;
int pirq, s;
pirq = token->pirq;
s = event_notifier_test_and_clear(&iohub->resamplefds[pirq]);
assert(s >= 0);
QEMU_LOCK_GUARD(&iohub->irq_level_lock[pirq]);
if (iohub->irq_level[pirq]) {
event_notifier_set(&iohub->irqfds[pirq]);
}
}
void process_set_irqfd_msg(PCIDevice *pci_dev, MPQemuMsg *msg)
{
RemoteMachineState *machine = REMOTE_MACHINE(current_machine);
RemoteIOHubState *iohub = &machine->iohub;
int pirq, intx;
intx = pci_get_byte(pci_dev->config + PCI_INTERRUPT_PIN) - 1;
pirq = remote_iohub_map_irq(pci_dev, intx);
if (event_notifier_get_fd(&iohub->irqfds[pirq]) != -1) {
qemu_set_fd_handler(event_notifier_get_fd(&iohub->resamplefds[pirq]),
NULL, NULL, NULL);
event_notifier_cleanup(&iohub->irqfds[pirq]);
event_notifier_cleanup(&iohub->resamplefds[pirq]);
memset(&iohub->token[pirq], 0, sizeof(ResampleToken));
}
event_notifier_init_fd(&iohub->irqfds[pirq], msg->fds[0]);
event_notifier_init_fd(&iohub->resamplefds[pirq], msg->fds[1]);
iohub->token[pirq].iohub = iohub;
iohub->token[pirq].pirq = pirq;
qemu_set_fd_handler(msg->fds[1], intr_resample_handler, NULL,
&iohub->token[pirq]);
}
|
