This source file includes following definitions.
- vbox_clear_irq
- vbox_get_flags
- vbox_report_hotplug
- vbox_irq_handler
- validate_or_set_position_hints
- vbox_update_mode_hints
- vbox_hotplug_worker
- vbox_irq_init
- vbox_irq_fini
1
2
3
4
5
6
7
8
9
10
11
12 #include <linux/pci.h>
13 #include <drm/drm_irq.h>
14 #include <drm/drm_probe_helper.h>
15
16 #include "vbox_drv.h"
17 #include "vboxvideo.h"
18
19 static void vbox_clear_irq(void)
20 {
21 outl((u32)~0, VGA_PORT_HGSMI_HOST);
22 }
23
24 static u32 vbox_get_flags(struct vbox_private *vbox)
25 {
26 return readl(vbox->guest_heap + HOST_FLAGS_OFFSET);
27 }
28
29 void vbox_report_hotplug(struct vbox_private *vbox)
30 {
31 schedule_work(&vbox->hotplug_work);
32 }
33
34 irqreturn_t vbox_irq_handler(int irq, void *arg)
35 {
36 struct drm_device *dev = (struct drm_device *)arg;
37 struct vbox_private *vbox = (struct vbox_private *)dev->dev_private;
38 u32 host_flags = vbox_get_flags(vbox);
39
40 if (!(host_flags & HGSMIHOSTFLAGS_IRQ))
41 return IRQ_NONE;
42
43
44
45
46
47
48
49 if (host_flags &
50 (HGSMIHOSTFLAGS_HOTPLUG | HGSMIHOSTFLAGS_CURSOR_CAPABILITIES) &&
51 !(host_flags & HGSMIHOSTFLAGS_VSYNC))
52 vbox_report_hotplug(vbox);
53
54 vbox_clear_irq();
55
56 return IRQ_HANDLED;
57 }
58
59
60
61
62
63
64
65 static void validate_or_set_position_hints(struct vbox_private *vbox)
66 {
67 struct vbva_modehint *hintsi, *hintsj;
68 bool valid = true;
69 u16 currentx = 0;
70 int i, j;
71
72 for (i = 0; i < vbox->num_crtcs; ++i) {
73 for (j = 0; j < i; ++j) {
74 hintsi = &vbox->last_mode_hints[i];
75 hintsj = &vbox->last_mode_hints[j];
76
77 if (hintsi->enabled && hintsj->enabled) {
78 if (hintsi->dx >= 0xffff ||
79 hintsi->dy >= 0xffff ||
80 hintsj->dx >= 0xffff ||
81 hintsj->dy >= 0xffff ||
82 (hintsi->dx <
83 hintsj->dx + (hintsj->cx & 0x8fff) &&
84 hintsi->dx + (hintsi->cx & 0x8fff) >
85 hintsj->dx) ||
86 (hintsi->dy <
87 hintsj->dy + (hintsj->cy & 0x8fff) &&
88 hintsi->dy + (hintsi->cy & 0x8fff) >
89 hintsj->dy))
90 valid = false;
91 }
92 }
93 }
94 if (!valid)
95 for (i = 0; i < vbox->num_crtcs; ++i) {
96 if (vbox->last_mode_hints[i].enabled) {
97 vbox->last_mode_hints[i].dx = currentx;
98 vbox->last_mode_hints[i].dy = 0;
99 currentx +=
100 vbox->last_mode_hints[i].cx & 0x8fff;
101 }
102 }
103 }
104
105
106 static void vbox_update_mode_hints(struct vbox_private *vbox)
107 {
108 struct drm_connector_list_iter conn_iter;
109 struct drm_device *dev = &vbox->ddev;
110 struct drm_connector *connector;
111 struct vbox_connector *vbox_conn;
112 struct vbva_modehint *hints;
113 u16 flags;
114 bool disconnected;
115 unsigned int crtc_id;
116 int ret;
117
118 ret = hgsmi_get_mode_hints(vbox->guest_pool, vbox->num_crtcs,
119 vbox->last_mode_hints);
120 if (ret) {
121 DRM_ERROR("vboxvideo: hgsmi_get_mode_hints failed: %d\n", ret);
122 return;
123 }
124
125 validate_or_set_position_hints(vbox);
126
127 drm_modeset_lock(&dev->mode_config.connection_mutex, NULL);
128 drm_connector_list_iter_begin(dev, &conn_iter);
129 drm_for_each_connector_iter(connector, &conn_iter) {
130 vbox_conn = to_vbox_connector(connector);
131
132 hints = &vbox->last_mode_hints[vbox_conn->vbox_crtc->crtc_id];
133 if (hints->magic != VBVAMODEHINT_MAGIC)
134 continue;
135
136 disconnected = !(hints->enabled);
137 crtc_id = vbox_conn->vbox_crtc->crtc_id;
138 vbox_conn->mode_hint.width = hints->cx;
139 vbox_conn->mode_hint.height = hints->cy;
140 vbox_conn->vbox_crtc->x_hint = hints->dx;
141 vbox_conn->vbox_crtc->y_hint = hints->dy;
142 vbox_conn->mode_hint.disconnected = disconnected;
143
144 if (vbox_conn->vbox_crtc->disconnected == disconnected)
145 continue;
146
147 if (disconnected)
148 flags = VBVA_SCREEN_F_ACTIVE | VBVA_SCREEN_F_DISABLED;
149 else
150 flags = VBVA_SCREEN_F_ACTIVE | VBVA_SCREEN_F_BLANK;
151
152 hgsmi_process_display_info(vbox->guest_pool, crtc_id, 0, 0, 0,
153 hints->cx * 4, hints->cx,
154 hints->cy, 0, flags);
155
156 vbox_conn->vbox_crtc->disconnected = disconnected;
157 }
158 drm_connector_list_iter_end(&conn_iter);
159 drm_modeset_unlock(&dev->mode_config.connection_mutex);
160 }
161
162 static void vbox_hotplug_worker(struct work_struct *work)
163 {
164 struct vbox_private *vbox = container_of(work, struct vbox_private,
165 hotplug_work);
166
167 vbox_update_mode_hints(vbox);
168 drm_kms_helper_hotplug_event(&vbox->ddev);
169 }
170
171 int vbox_irq_init(struct vbox_private *vbox)
172 {
173 INIT_WORK(&vbox->hotplug_work, vbox_hotplug_worker);
174 vbox_update_mode_hints(vbox);
175
176 return drm_irq_install(&vbox->ddev, vbox->ddev.pdev->irq);
177 }
178
179 void vbox_irq_fini(struct vbox_private *vbox)
180 {
181 drm_irq_uninstall(&vbox->ddev);
182 flush_work(&vbox->hotplug_work);
183 }