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#include "qemu/osdep.h"
28#include "qemu/units.h"
29
30#include "hw/hw.h"
31#include "ui/input.h"
32#include "ui/console.h"
33#include "hw/xen/xen-legacy-backend.h"
34
35#include "hw/xen/interface/io/fbif.h"
36#include "hw/xen/interface/io/kbdif.h"
37#include "hw/xen/interface/io/protocols.h"
38
39#include "trace.h"
40
41#ifndef BTN_LEFT
42#define BTN_LEFT 0x110
43#endif
44
45
46
47struct common {
48 struct XenLegacyDevice xendev;
49 void *page;
50};
51
52struct XenInput {
53 struct common c;
54 int abs_pointer_wanted;
55 int raw_pointer_wanted;
56 QemuInputHandlerState *qkbd;
57 QemuInputHandlerState *qmou;
58 int axis[INPUT_AXIS__MAX];
59 int wheel;
60};
61
62#define UP_QUEUE 8
63
64struct XenFB {
65 struct common c;
66 QemuConsole *con;
67 size_t fb_len;
68 int row_stride;
69 int depth;
70 int width;
71 int height;
72 int offset;
73 void *pixels;
74 int fbpages;
75 int feature_update;
76 int bug_trigger;
77 int do_resize;
78
79 struct {
80 int x,y,w,h;
81 } up_rects[UP_QUEUE];
82 int up_count;
83 int up_fullscreen;
84};
85static const GraphicHwOps xenfb_ops;
86
87
88
89static int common_bind(struct common *c)
90{
91 uint64_t val;
92 xen_pfn_t mfn;
93
94 if (xenstore_read_fe_uint64(&c->xendev, "page-ref", &val) == -1)
95 return -1;
96 mfn = (xen_pfn_t)val;
97 assert(val == mfn);
98
99 if (xenstore_read_fe_int(&c->xendev, "event-channel", &c->xendev.remote_port) == -1)
100 return -1;
101
102 c->page = xenforeignmemory_map(xen_fmem, c->xendev.dom,
103 PROT_READ | PROT_WRITE, 1, &mfn, NULL);
104 if (c->page == NULL)
105 return -1;
106
107 xen_be_bind_evtchn(&c->xendev);
108 xen_pv_printf(&c->xendev, 1,
109 "ring mfn %"PRI_xen_pfn", remote-port %d, local-port %d\n",
110 mfn, c->xendev.remote_port, c->xendev.local_port);
111
112 return 0;
113}
114
115static void common_unbind(struct common *c)
116{
117 xen_pv_unbind_evtchn(&c->xendev);
118 if (c->page) {
119 xenforeignmemory_unmap(xen_fmem, c->page, 1);
120 c->page = NULL;
121 }
122}
123
124
125
126static int xenfb_kbd_event(struct XenInput *xenfb,
127 union xenkbd_in_event *event)
128{
129 struct xenkbd_page *page = xenfb->c.page;
130 uint32_t prod;
131
132 if (xenfb->c.xendev.be_state != XenbusStateConnected)
133 return 0;
134 if (!page)
135 return 0;
136
137 prod = page->in_prod;
138 if (prod - page->in_cons == XENKBD_IN_RING_LEN) {
139 errno = EAGAIN;
140 return -1;
141 }
142
143 xen_mb();
144 XENKBD_IN_RING_REF(page, prod) = *event;
145 xen_wmb();
146 page->in_prod = prod + 1;
147 return xen_pv_send_notify(&xenfb->c.xendev);
148}
149
150
151static int xenfb_send_key(struct XenInput *xenfb, bool down, int keycode)
152{
153 union xenkbd_in_event event;
154
155 memset(&event, 0, XENKBD_IN_EVENT_SIZE);
156 event.type = XENKBD_TYPE_KEY;
157 event.key.pressed = down ? 1 : 0;
158 event.key.keycode = keycode;
159
160 return xenfb_kbd_event(xenfb, &event);
161}
162
163
164static int xenfb_send_motion(struct XenInput *xenfb,
165 int rel_x, int rel_y, int rel_z)
166{
167 union xenkbd_in_event event;
168
169 memset(&event, 0, XENKBD_IN_EVENT_SIZE);
170 event.type = XENKBD_TYPE_MOTION;
171 event.motion.rel_x = rel_x;
172 event.motion.rel_y = rel_y;
173 event.motion.rel_z = rel_z;
174
175 return xenfb_kbd_event(xenfb, &event);
176}
177
178
179static int xenfb_send_position(struct XenInput *xenfb,
180 int abs_x, int abs_y, int z)
181{
182 union xenkbd_in_event event;
183
184 memset(&event, 0, XENKBD_IN_EVENT_SIZE);
185 event.type = XENKBD_TYPE_POS;
186 event.pos.abs_x = abs_x;
187 event.pos.abs_y = abs_y;
188 event.pos.rel_z = z;
189
190 return xenfb_kbd_event(xenfb, &event);
191}
192
193
194
195
196
197
198
199
200
201static void xenfb_key_event(DeviceState *dev, QemuConsole *src,
202 InputEvent *evt)
203{
204 struct XenInput *xenfb = (struct XenInput *)dev;
205 InputKeyEvent *key = evt->u.key.data;
206 int qcode = qemu_input_key_value_to_qcode(key->key);
207 int lnx;
208
209 if (qcode < qemu_input_map_qcode_to_linux_len) {
210 lnx = qemu_input_map_qcode_to_linux[qcode];
211
212 if (lnx) {
213 trace_xenfb_key_event(xenfb, lnx, key->down);
214 xenfb_send_key(xenfb, key->down, lnx);
215 }
216 }
217}
218
219
220
221
222
223
224
225
226
227
228static void xenfb_mouse_event(DeviceState *dev, QemuConsole *src,
229 InputEvent *evt)
230{
231 struct XenInput *xenfb = (struct XenInput *)dev;
232 InputBtnEvent *btn;
233 InputMoveEvent *move;
234 QemuConsole *con;
235 DisplaySurface *surface;
236 int scale;
237
238 switch (evt->type) {
239 case INPUT_EVENT_KIND_BTN:
240 btn = evt->u.btn.data;
241 switch (btn->button) {
242 case INPUT_BUTTON_LEFT:
243 xenfb_send_key(xenfb, btn->down, BTN_LEFT);
244 break;
245 case INPUT_BUTTON_RIGHT:
246 xenfb_send_key(xenfb, btn->down, BTN_LEFT + 1);
247 break;
248 case INPUT_BUTTON_MIDDLE:
249 xenfb_send_key(xenfb, btn->down, BTN_LEFT + 2);
250 break;
251 case INPUT_BUTTON_WHEEL_UP:
252 if (btn->down) {
253 xenfb->wheel--;
254 }
255 break;
256 case INPUT_BUTTON_WHEEL_DOWN:
257 if (btn->down) {
258 xenfb->wheel++;
259 }
260 break;
261 default:
262 break;
263 }
264 break;
265
266 case INPUT_EVENT_KIND_ABS:
267 move = evt->u.abs.data;
268 if (xenfb->raw_pointer_wanted) {
269 xenfb->axis[move->axis] = move->value;
270 } else {
271 con = qemu_console_lookup_by_index(0);
272 if (!con) {
273 xen_pv_printf(&xenfb->c.xendev, 0, "No QEMU console available");
274 return;
275 }
276 surface = qemu_console_surface(con);
277 switch (move->axis) {
278 case INPUT_AXIS_X:
279 scale = surface_width(surface) - 1;
280 break;
281 case INPUT_AXIS_Y:
282 scale = surface_height(surface) - 1;
283 break;
284 default:
285 scale = 0x8000;
286 break;
287 }
288 xenfb->axis[move->axis] = move->value * scale / 0x7fff;
289 }
290 break;
291
292 case INPUT_EVENT_KIND_REL:
293 move = evt->u.rel.data;
294 xenfb->axis[move->axis] += move->value;
295 break;
296
297 default:
298 break;
299 }
300}
301
302static void xenfb_mouse_sync(DeviceState *dev)
303{
304 struct XenInput *xenfb = (struct XenInput *)dev;
305
306 trace_xenfb_mouse_event(xenfb, xenfb->axis[INPUT_AXIS_X],
307 xenfb->axis[INPUT_AXIS_Y],
308 xenfb->wheel, 0,
309 xenfb->abs_pointer_wanted);
310 if (xenfb->abs_pointer_wanted) {
311 xenfb_send_position(xenfb, xenfb->axis[INPUT_AXIS_X],
312 xenfb->axis[INPUT_AXIS_Y],
313 xenfb->wheel);
314 } else {
315 xenfb_send_motion(xenfb, xenfb->axis[INPUT_AXIS_X],
316 xenfb->axis[INPUT_AXIS_Y],
317 xenfb->wheel);
318 xenfb->axis[INPUT_AXIS_X] = 0;
319 xenfb->axis[INPUT_AXIS_Y] = 0;
320 }
321 xenfb->wheel = 0;
322}
323
324static QemuInputHandler xenfb_keyboard = {
325 .name = "Xen PV Keyboard",
326 .mask = INPUT_EVENT_MASK_KEY,
327 .event = xenfb_key_event,
328};
329
330static QemuInputHandler xenfb_abs_mouse = {
331 .name = "Xen PV Mouse",
332 .mask = INPUT_EVENT_MASK_BTN | INPUT_EVENT_MASK_ABS,
333 .event = xenfb_mouse_event,
334 .sync = xenfb_mouse_sync,
335};
336
337static QemuInputHandler xenfb_rel_mouse = {
338 .name = "Xen PV Mouse",
339 .mask = INPUT_EVENT_MASK_BTN | INPUT_EVENT_MASK_REL,
340 .event = xenfb_mouse_event,
341 .sync = xenfb_mouse_sync,
342};
343
344static int input_init(struct XenLegacyDevice *xendev)
345{
346 xenstore_write_be_int(xendev, "feature-abs-pointer", 1);
347 xenstore_write_be_int(xendev, "feature-raw-pointer", 1);
348 return 0;
349}
350
351static int input_initialise(struct XenLegacyDevice *xendev)
352{
353 struct XenInput *in = container_of(xendev, struct XenInput, c.xendev);
354 int rc;
355
356 rc = common_bind(&in->c);
357 if (rc != 0)
358 return rc;
359
360 return 0;
361}
362
363static void input_connected(struct XenLegacyDevice *xendev)
364{
365 struct XenInput *in = container_of(xendev, struct XenInput, c.xendev);
366
367 if (xenstore_read_fe_int(xendev, "request-abs-pointer",
368 &in->abs_pointer_wanted) == -1) {
369 in->abs_pointer_wanted = 0;
370 }
371 if (xenstore_read_fe_int(xendev, "request-raw-pointer",
372 &in->raw_pointer_wanted) == -1) {
373 in->raw_pointer_wanted = 0;
374 }
375 if (in->raw_pointer_wanted && in->abs_pointer_wanted == 0) {
376 xen_pv_printf(xendev, 0, "raw pointer set without abs pointer");
377 }
378
379 if (in->qkbd) {
380 qemu_input_handler_unregister(in->qkbd);
381 }
382 if (in->qmou) {
383 qemu_input_handler_unregister(in->qmou);
384 }
385 trace_xenfb_input_connected(xendev, in->abs_pointer_wanted);
386
387 in->qkbd = qemu_input_handler_register((DeviceState *)in, &xenfb_keyboard);
388 in->qmou = qemu_input_handler_register((DeviceState *)in,
389 in->abs_pointer_wanted ? &xenfb_abs_mouse : &xenfb_rel_mouse);
390
391 if (in->raw_pointer_wanted) {
392 qemu_input_handler_activate(in->qkbd);
393 qemu_input_handler_activate(in->qmou);
394 }
395}
396
397static void input_disconnect(struct XenLegacyDevice *xendev)
398{
399 struct XenInput *in = container_of(xendev, struct XenInput, c.xendev);
400
401 if (in->qkbd) {
402 qemu_input_handler_unregister(in->qkbd);
403 in->qkbd = NULL;
404 }
405 if (in->qmou) {
406 qemu_input_handler_unregister(in->qmou);
407 in->qmou = NULL;
408 }
409 common_unbind(&in->c);
410}
411
412static void input_event(struct XenLegacyDevice *xendev)
413{
414 struct XenInput *xenfb = container_of(xendev, struct XenInput, c.xendev);
415 struct xenkbd_page *page = xenfb->c.page;
416
417
418 if (page->out_prod == page->out_cons)
419 return;
420 page->out_cons = page->out_prod;
421 xen_pv_send_notify(&xenfb->c.xendev);
422}
423
424
425
426static void xenfb_copy_mfns(int mode, int count, xen_pfn_t *dst, void *src)
427{
428 uint32_t *src32 = src;
429 uint64_t *src64 = src;
430 int i;
431
432 for (i = 0; i < count; i++)
433 dst[i] = (mode == 32) ? src32[i] : src64[i];
434}
435
436static int xenfb_map_fb(struct XenFB *xenfb)
437{
438 struct xenfb_page *page = xenfb->c.page;
439 char *protocol = xenfb->c.xendev.protocol;
440 int n_fbdirs;
441 xen_pfn_t *pgmfns = NULL;
442 xen_pfn_t *fbmfns = NULL;
443 void *map, *pd;
444 int mode, ret = -1;
445
446
447 pd = page->pd;
448 mode = sizeof(unsigned long) * 8;
449
450 if (!protocol) {
451
452
453
454
455
456
457
458
459
460 uint32_t *ptr32 = NULL;
461 uint32_t *ptr64 = NULL;
462#if defined(__i386__)
463 ptr32 = (void*)page->pd;
464 ptr64 = ((void*)page->pd) + 4;
465#elif defined(__x86_64__)
466 ptr32 = ((void*)page->pd) - 4;
467 ptr64 = (void*)page->pd;
468#endif
469 if (ptr32) {
470 if (ptr32[1] == 0) {
471 mode = 32;
472 pd = ptr32;
473 } else {
474 mode = 64;
475 pd = ptr64;
476 }
477 }
478#if defined(__x86_64__)
479 } else if (strcmp(protocol, XEN_IO_PROTO_ABI_X86_32) == 0) {
480
481 mode = 32;
482 pd = ((void*)page->pd) - 4;
483#elif defined(__i386__)
484 } else if (strcmp(protocol, XEN_IO_PROTO_ABI_X86_64) == 0) {
485
486 mode = 64;
487 pd = ((void*)page->pd) + 4;
488#endif
489 }
490
491 if (xenfb->pixels) {
492 munmap(xenfb->pixels, xenfb->fbpages * XC_PAGE_SIZE);
493 xenfb->pixels = NULL;
494 }
495
496 xenfb->fbpages = DIV_ROUND_UP(xenfb->fb_len, XC_PAGE_SIZE);
497 n_fbdirs = xenfb->fbpages * mode / 8;
498 n_fbdirs = DIV_ROUND_UP(n_fbdirs, XC_PAGE_SIZE);
499
500 pgmfns = g_malloc0(sizeof(xen_pfn_t) * n_fbdirs);
501 fbmfns = g_malloc0(sizeof(xen_pfn_t) * xenfb->fbpages);
502
503 xenfb_copy_mfns(mode, n_fbdirs, pgmfns, pd);
504 map = xenforeignmemory_map(xen_fmem, xenfb->c.xendev.dom,
505 PROT_READ, n_fbdirs, pgmfns, NULL);
506 if (map == NULL)
507 goto out;
508 xenfb_copy_mfns(mode, xenfb->fbpages, fbmfns, map);
509 xenforeignmemory_unmap(xen_fmem, map, n_fbdirs);
510
511 xenfb->pixels = xenforeignmemory_map(xen_fmem, xenfb->c.xendev.dom,
512 PROT_READ, xenfb->fbpages, fbmfns, NULL);
513 if (xenfb->pixels == NULL)
514 goto out;
515
516 ret = 0;
517
518out:
519 g_free(pgmfns);
520 g_free(fbmfns);
521 return ret;
522}
523
524static int xenfb_configure_fb(struct XenFB *xenfb, size_t fb_len_lim,
525 int width, int height, int depth,
526 size_t fb_len, int offset, int row_stride)
527{
528 size_t mfn_sz = sizeof_field(struct xenfb_page, pd[0]);
529 size_t pd_len = sizeof_field(struct xenfb_page, pd) / mfn_sz;
530 size_t fb_pages = pd_len * XC_PAGE_SIZE / mfn_sz;
531 size_t fb_len_max = fb_pages * XC_PAGE_SIZE;
532 int max_width, max_height;
533
534 if (fb_len_lim > fb_len_max) {
535 xen_pv_printf(&xenfb->c.xendev, 0,
536 "fb size limit %zu exceeds %zu, corrected\n",
537 fb_len_lim, fb_len_max);
538 fb_len_lim = fb_len_max;
539 }
540 if (fb_len_lim && fb_len > fb_len_lim) {
541 xen_pv_printf(&xenfb->c.xendev, 0,
542 "frontend fb size %zu limited to %zu\n",
543 fb_len, fb_len_lim);
544 fb_len = fb_len_lim;
545 }
546 if (depth != 8 && depth != 16 && depth != 24 && depth != 32) {
547 xen_pv_printf(&xenfb->c.xendev, 0,
548 "can't handle frontend fb depth %d\n",
549 depth);
550 return -1;
551 }
552 if (row_stride <= 0 || row_stride > fb_len) {
553 xen_pv_printf(&xenfb->c.xendev, 0, "invalid frontend stride %d\n",
554 row_stride);
555 return -1;
556 }
557 max_width = row_stride / (depth / 8);
558 if (width < 0 || width > max_width) {
559 xen_pv_printf(&xenfb->c.xendev, 0,
560 "invalid frontend width %d limited to %d\n",
561 width, max_width);
562 width = max_width;
563 }
564 if (offset < 0 || offset >= fb_len) {
565 xen_pv_printf(&xenfb->c.xendev, 0,
566 "invalid frontend offset %d (max %zu)\n",
567 offset, fb_len - 1);
568 return -1;
569 }
570 max_height = (fb_len - offset) / row_stride;
571 if (height < 0 || height > max_height) {
572 xen_pv_printf(&xenfb->c.xendev, 0,
573 "invalid frontend height %d limited to %d\n",
574 height, max_height);
575 height = max_height;
576 }
577 xenfb->fb_len = fb_len;
578 xenfb->row_stride = row_stride;
579 xenfb->depth = depth;
580 xenfb->width = width;
581 xenfb->height = height;
582 xenfb->offset = offset;
583 xenfb->up_fullscreen = 1;
584 xenfb->do_resize = 1;
585 xen_pv_printf(&xenfb->c.xendev, 1,
586 "framebuffer %dx%dx%d offset %d stride %d\n",
587 width, height, depth, offset, row_stride);
588 return 0;
589}
590
591
592#define BLT(SRC_T,DST_T,RSB,GSB,BSB,RDB,GDB,BDB) \
593 for (line = y ; line < (y+h) ; line++) { \
594 SRC_T *src = (SRC_T *)(xenfb->pixels \
595 + xenfb->offset \
596 + (line * xenfb->row_stride) \
597 + (x * xenfb->depth / 8)); \
598 DST_T *dst = (DST_T *)(data \
599 + (line * linesize) \
600 + (x * bpp / 8)); \
601 int col; \
602 const int RSS = 32 - (RSB + GSB + BSB); \
603 const int GSS = 32 - (GSB + BSB); \
604 const int BSS = 32 - (BSB); \
605 const uint32_t RSM = (~0U) << (32 - RSB); \
606 const uint32_t GSM = (~0U) << (32 - GSB); \
607 const uint32_t BSM = (~0U) << (32 - BSB); \
608 const int RDS = 32 - (RDB + GDB + BDB); \
609 const int GDS = 32 - (GDB + BDB); \
610 const int BDS = 32 - (BDB); \
611 const uint32_t RDM = (~0U) << (32 - RDB); \
612 const uint32_t GDM = (~0U) << (32 - GDB); \
613 const uint32_t BDM = (~0U) << (32 - BDB); \
614 for (col = x ; col < (x+w) ; col++) { \
615 uint32_t spix = *src; \
616 *dst = (((spix << RSS) & RSM & RDM) >> RDS) | \
617 (((spix << GSS) & GSM & GDM) >> GDS) | \
618 (((spix << BSS) & BSM & BDM) >> BDS); \
619 src = (SRC_T *) ((unsigned long) src + xenfb->depth / 8); \
620 dst = (DST_T *) ((unsigned long) dst + bpp / 8); \
621 } \
622 }
623
624
625
626
627
628
629
630
631static void xenfb_guest_copy(struct XenFB *xenfb, int x, int y, int w, int h)
632{
633 DisplaySurface *surface = qemu_console_surface(xenfb->con);
634 int line, oops = 0;
635 int bpp = surface_bits_per_pixel(surface);
636 int linesize = surface_stride(surface);
637 uint8_t *data = surface_data(surface);
638
639 if (!is_buffer_shared(surface)) {
640 switch (xenfb->depth) {
641 case 8:
642 if (bpp == 16) {
643 BLT(uint8_t, uint16_t, 3, 3, 2, 5, 6, 5);
644 } else if (bpp == 32) {
645 BLT(uint8_t, uint32_t, 3, 3, 2, 8, 8, 8);
646 } else {
647 oops = 1;
648 }
649 break;
650 case 24:
651 if (bpp == 16) {
652 BLT(uint32_t, uint16_t, 8, 8, 8, 5, 6, 5);
653 } else if (bpp == 32) {
654 BLT(uint32_t, uint32_t, 8, 8, 8, 8, 8, 8);
655 } else {
656 oops = 1;
657 }
658 break;
659 default:
660 oops = 1;
661 }
662 }
663 if (oops)
664 xen_pv_printf(&xenfb->c.xendev, 0, "%s: oops: convert %d -> %d bpp?\n",
665 __func__, xenfb->depth, bpp);
666
667 dpy_gfx_update(xenfb->con, x, y, w, h);
668}
669
670#ifdef XENFB_TYPE_REFRESH_PERIOD
671static int xenfb_queue_full(struct XenFB *xenfb)
672{
673 struct xenfb_page *page = xenfb->c.page;
674 uint32_t cons, prod;
675
676 if (!page)
677 return 1;
678
679 prod = page->in_prod;
680 cons = page->in_cons;
681 return prod - cons == XENFB_IN_RING_LEN;
682}
683
684static void xenfb_send_event(struct XenFB *xenfb, union xenfb_in_event *event)
685{
686 uint32_t prod;
687 struct xenfb_page *page = xenfb->c.page;
688
689 prod = page->in_prod;
690
691 xen_mb();
692 XENFB_IN_RING_REF(page, prod) = *event;
693 xen_wmb();
694 page->in_prod = prod + 1;
695
696 xen_pv_send_notify(&xenfb->c.xendev);
697}
698
699static void xenfb_send_refresh_period(struct XenFB *xenfb, int period)
700{
701 union xenfb_in_event event;
702
703 memset(&event, 0, sizeof(event));
704 event.type = XENFB_TYPE_REFRESH_PERIOD;
705 event.refresh_period.period = period;
706 xenfb_send_event(xenfb, &event);
707}
708#endif
709
710
711
712
713
714
715
716
717
718
719static void xenfb_update(void *opaque)
720{
721 struct XenFB *xenfb = opaque;
722 DisplaySurface *surface;
723 int i;
724
725 if (xenfb->c.xendev.be_state != XenbusStateConnected)
726 return;
727
728 if (!xenfb->feature_update) {
729
730
731 xenfb->up_fullscreen = 1;
732 }
733
734
735 if (xenfb->do_resize) {
736 pixman_format_code_t format;
737
738 xenfb->do_resize = 0;
739 switch (xenfb->depth) {
740 case 16:
741 case 32:
742
743 format = qemu_default_pixman_format(xenfb->depth, true);
744 surface = qemu_create_displaysurface_from
745 (xenfb->width, xenfb->height, format,
746 xenfb->row_stride, xenfb->pixels + xenfb->offset);
747 break;
748 default:
749
750 surface = qemu_create_displaysurface(xenfb->width, xenfb->height);
751 break;
752 }
753 dpy_gfx_replace_surface(xenfb->con, surface);
754 xen_pv_printf(&xenfb->c.xendev, 1,
755 "update: resizing: %dx%d @ %d bpp%s\n",
756 xenfb->width, xenfb->height, xenfb->depth,
757 is_buffer_shared(surface) ? " (shared)" : "");
758 xenfb->up_fullscreen = 1;
759 }
760
761
762 if (xenfb->up_fullscreen) {
763 xen_pv_printf(&xenfb->c.xendev, 3, "update: fullscreen\n");
764 xenfb_guest_copy(xenfb, 0, 0, xenfb->width, xenfb->height);
765 } else if (xenfb->up_count) {
766 xen_pv_printf(&xenfb->c.xendev, 3, "update: %d rects\n",
767 xenfb->up_count);
768 for (i = 0; i < xenfb->up_count; i++)
769 xenfb_guest_copy(xenfb,
770 xenfb->up_rects[i].x,
771 xenfb->up_rects[i].y,
772 xenfb->up_rects[i].w,
773 xenfb->up_rects[i].h);
774 } else {
775 xen_pv_printf(&xenfb->c.xendev, 3, "update: nothing\n");
776 }
777 xenfb->up_count = 0;
778 xenfb->up_fullscreen = 0;
779}
780
781static void xenfb_update_interval(void *opaque, uint64_t interval)
782{
783 struct XenFB *xenfb = opaque;
784
785 if (xenfb->feature_update) {
786#ifdef XENFB_TYPE_REFRESH_PERIOD
787 if (xenfb_queue_full(xenfb)) {
788 return;
789 }
790 xenfb_send_refresh_period(xenfb, interval);
791#endif
792 }
793}
794
795
796static void xenfb_invalidate(void *opaque)
797{
798 struct XenFB *xenfb = opaque;
799 xenfb->up_fullscreen = 1;
800}
801
802static void xenfb_handle_events(struct XenFB *xenfb)
803{
804 uint32_t prod, cons, out_cons;
805 struct xenfb_page *page = xenfb->c.page;
806
807 prod = page->out_prod;
808 out_cons = page->out_cons;
809 if (prod - out_cons > XENFB_OUT_RING_LEN) {
810 return;
811 }
812 xen_rmb();
813 for (cons = out_cons; cons != prod; cons++) {
814 union xenfb_out_event *event = &XENFB_OUT_RING_REF(page, cons);
815 uint8_t type = event->type;
816 int x, y, w, h;
817
818 switch (type) {
819 case XENFB_TYPE_UPDATE:
820 if (xenfb->up_count == UP_QUEUE)
821 xenfb->up_fullscreen = 1;
822 if (xenfb->up_fullscreen)
823 break;
824 x = MAX(event->update.x, 0);
825 y = MAX(event->update.y, 0);
826 w = MIN(event->update.width, xenfb->width - x);
827 h = MIN(event->update.height, xenfb->height - y);
828 if (w < 0 || h < 0) {
829 xen_pv_printf(&xenfb->c.xendev, 1, "bogus update ignored\n");
830 break;
831 }
832 if (x != event->update.x ||
833 y != event->update.y ||
834 w != event->update.width ||
835 h != event->update.height) {
836 xen_pv_printf(&xenfb->c.xendev, 1, "bogus update clipped\n");
837 }
838 if (w == xenfb->width && h > xenfb->height / 2) {
839
840
841 xenfb->up_fullscreen = 1;
842 } else {
843 xenfb->up_rects[xenfb->up_count].x = x;
844 xenfb->up_rects[xenfb->up_count].y = y;
845 xenfb->up_rects[xenfb->up_count].w = w;
846 xenfb->up_rects[xenfb->up_count].h = h;
847 xenfb->up_count++;
848 }
849 break;
850#ifdef XENFB_TYPE_RESIZE
851 case XENFB_TYPE_RESIZE:
852 if (xenfb_configure_fb(xenfb, xenfb->fb_len,
853 event->resize.width,
854 event->resize.height,
855 event->resize.depth,
856 xenfb->fb_len,
857 event->resize.offset,
858 event->resize.stride) < 0)
859 break;
860 xenfb_invalidate(xenfb);
861 break;
862#endif
863 }
864 }
865 xen_mb();
866 page->out_cons = cons;
867}
868
869static int fb_init(struct XenLegacyDevice *xendev)
870{
871#ifdef XENFB_TYPE_RESIZE
872 xenstore_write_be_int(xendev, "feature-resize", 1);
873#endif
874 return 0;
875}
876
877static int fb_initialise(struct XenLegacyDevice *xendev)
878{
879 struct XenFB *fb = container_of(xendev, struct XenFB, c.xendev);
880 struct xenfb_page *fb_page;
881 int videoram;
882 int rc;
883
884 if (xenstore_read_fe_int(xendev, "videoram", &videoram) == -1)
885 videoram = 0;
886
887 rc = common_bind(&fb->c);
888 if (rc != 0)
889 return rc;
890
891 fb_page = fb->c.page;
892 rc = xenfb_configure_fb(fb, videoram * MiB,
893 fb_page->width, fb_page->height, fb_page->depth,
894 fb_page->mem_length, 0, fb_page->line_length);
895 if (rc != 0)
896 return rc;
897
898 rc = xenfb_map_fb(fb);
899 if (rc != 0)
900 return rc;
901
902 fb->con = graphic_console_init(NULL, 0, &xenfb_ops, fb);
903
904 if (xenstore_read_fe_int(xendev, "feature-update", &fb->feature_update) == -1)
905 fb->feature_update = 0;
906 if (fb->feature_update)
907 xenstore_write_be_int(xendev, "request-update", 1);
908
909 xen_pv_printf(xendev, 1, "feature-update=%d, videoram=%d\n",
910 fb->feature_update, videoram);
911 return 0;
912}
913
914static void fb_disconnect(struct XenLegacyDevice *xendev)
915{
916 struct XenFB *fb = container_of(xendev, struct XenFB, c.xendev);
917
918
919
920
921
922
923 xenforeignmemory_unmap(xen_fmem, fb->pixels, fb->fbpages);
924 fb->pixels = mmap(fb->pixels, fb->fbpages * XC_PAGE_SIZE,
925 PROT_READ | PROT_WRITE, MAP_SHARED | MAP_ANON,
926 -1, 0);
927 if (fb->pixels == MAP_FAILED) {
928 xen_pv_printf(xendev, 0,
929 "Couldn't replace the framebuffer with anonymous memory errno=%d\n",
930 errno);
931 }
932 common_unbind(&fb->c);
933 fb->feature_update = 0;
934 fb->bug_trigger = 0;
935}
936
937static void fb_frontend_changed(struct XenLegacyDevice *xendev,
938 const char *node)
939{
940 struct XenFB *fb = container_of(xendev, struct XenFB, c.xendev);
941
942
943
944
945
946
947 if (fb->bug_trigger == 0 && strcmp(node, "state") == 0 &&
948 xendev->fe_state == XenbusStateConnected &&
949 xendev->be_state == XenbusStateConnected) {
950 xen_pv_printf(xendev, 2, "re-trigger connected (frontend bug)\n");
951 xen_be_set_state(xendev, XenbusStateConnected);
952 fb->bug_trigger = 1;
953 }
954}
955
956static void fb_event(struct XenLegacyDevice *xendev)
957{
958 struct XenFB *xenfb = container_of(xendev, struct XenFB, c.xendev);
959
960 xenfb_handle_events(xenfb);
961 xen_pv_send_notify(&xenfb->c.xendev);
962}
963
964
965
966struct XenDevOps xen_kbdmouse_ops = {
967 .size = sizeof(struct XenInput),
968 .init = input_init,
969 .initialise = input_initialise,
970 .connected = input_connected,
971 .disconnect = input_disconnect,
972 .event = input_event,
973};
974
975struct XenDevOps xen_framebuffer_ops = {
976 .size = sizeof(struct XenFB),
977 .init = fb_init,
978 .initialise = fb_initialise,
979 .disconnect = fb_disconnect,
980 .event = fb_event,
981 .frontend_changed = fb_frontend_changed,
982};
983
984static const GraphicHwOps xenfb_ops = {
985 .invalidate = xenfb_invalidate,
986 .gfx_update = xenfb_update,
987 .update_interval = xenfb_update_interval,
988};
989