xref: /openbmc/qemu/ui/console.c (revision 3aff6c2f)
1 /*
2  * QEMU graphical console
3  *
4  * Copyright (c) 2004 Fabrice Bellard
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a copy
7  * of this software and associated documentation files (the "Software"), to deal
8  * in the Software without restriction, including without limitation the rights
9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10  * copies of the Software, and to permit persons to whom the Software is
11  * furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22  * THE SOFTWARE.
23  */
24 #include "qemu-common.h"
25 #include "ui/console.h"
26 #include "hw/qdev-core.h"
27 #include "qemu/timer.h"
28 #include "qmp-commands.h"
29 #include "sysemu/char.h"
30 #include "trace.h"
31 
32 #define DEFAULT_BACKSCROLL 512
33 #define CONSOLE_CURSOR_PERIOD 500
34 
35 typedef struct TextAttributes {
36     uint8_t fgcol:4;
37     uint8_t bgcol:4;
38     uint8_t bold:1;
39     uint8_t uline:1;
40     uint8_t blink:1;
41     uint8_t invers:1;
42     uint8_t unvisible:1;
43 } TextAttributes;
44 
45 typedef struct TextCell {
46     uint8_t ch;
47     TextAttributes t_attrib;
48 } TextCell;
49 
50 #define MAX_ESC_PARAMS 3
51 
52 enum TTYState {
53     TTY_STATE_NORM,
54     TTY_STATE_ESC,
55     TTY_STATE_CSI,
56 };
57 
58 typedef struct QEMUFIFO {
59     uint8_t *buf;
60     int buf_size;
61     int count, wptr, rptr;
62 } QEMUFIFO;
63 
64 static int qemu_fifo_write(QEMUFIFO *f, const uint8_t *buf, int len1)
65 {
66     int l, len;
67 
68     l = f->buf_size - f->count;
69     if (len1 > l)
70         len1 = l;
71     len = len1;
72     while (len > 0) {
73         l = f->buf_size - f->wptr;
74         if (l > len)
75             l = len;
76         memcpy(f->buf + f->wptr, buf, l);
77         f->wptr += l;
78         if (f->wptr >= f->buf_size)
79             f->wptr = 0;
80         buf += l;
81         len -= l;
82     }
83     f->count += len1;
84     return len1;
85 }
86 
87 static int qemu_fifo_read(QEMUFIFO *f, uint8_t *buf, int len1)
88 {
89     int l, len;
90 
91     if (len1 > f->count)
92         len1 = f->count;
93     len = len1;
94     while (len > 0) {
95         l = f->buf_size - f->rptr;
96         if (l > len)
97             l = len;
98         memcpy(buf, f->buf + f->rptr, l);
99         f->rptr += l;
100         if (f->rptr >= f->buf_size)
101             f->rptr = 0;
102         buf += l;
103         len -= l;
104     }
105     f->count -= len1;
106     return len1;
107 }
108 
109 typedef enum {
110     GRAPHIC_CONSOLE,
111     TEXT_CONSOLE,
112     TEXT_CONSOLE_FIXED_SIZE
113 } console_type_t;
114 
115 struct QemuConsole {
116     Object parent;
117 
118     int index;
119     console_type_t console_type;
120     DisplayState *ds;
121     DisplaySurface *surface;
122     int dcls;
123 
124     /* Graphic console state.  */
125     Object *device;
126     uint32_t head;
127     QemuUIInfo ui_info;
128     const GraphicHwOps *hw_ops;
129     void *hw;
130 
131     /* Text console state */
132     int width;
133     int height;
134     int total_height;
135     int backscroll_height;
136     int x, y;
137     int x_saved, y_saved;
138     int y_displayed;
139     int y_base;
140     TextAttributes t_attrib_default; /* default text attributes */
141     TextAttributes t_attrib; /* currently active text attributes */
142     TextCell *cells;
143     int text_x[2], text_y[2], cursor_invalidate;
144     int echo;
145 
146     int update_x0;
147     int update_y0;
148     int update_x1;
149     int update_y1;
150 
151     enum TTYState state;
152     int esc_params[MAX_ESC_PARAMS];
153     int nb_esc_params;
154 
155     CharDriverState *chr;
156     /* fifo for key pressed */
157     QEMUFIFO out_fifo;
158     uint8_t out_fifo_buf[16];
159     QEMUTimer *kbd_timer;
160 };
161 
162 struct DisplayState {
163     QEMUTimer *gui_timer;
164     uint64_t last_update;
165     uint64_t update_interval;
166     bool refreshing;
167     bool have_gfx;
168     bool have_text;
169 
170     QLIST_HEAD(, DisplayChangeListener) listeners;
171 };
172 
173 static DisplayState *display_state;
174 static QemuConsole *active_console;
175 static QemuConsole **consoles;
176 static int nb_consoles = 0;
177 static bool cursor_visible_phase;
178 static QEMUTimer *cursor_timer;
179 
180 static void text_console_do_init(CharDriverState *chr, DisplayState *ds);
181 static void dpy_refresh(DisplayState *s);
182 static DisplayState *get_alloc_displaystate(void);
183 static void text_console_update_cursor_timer(void);
184 static void text_console_update_cursor(void *opaque);
185 
186 static void gui_update(void *opaque)
187 {
188     uint64_t interval = GUI_REFRESH_INTERVAL_IDLE;
189     uint64_t dcl_interval;
190     DisplayState *ds = opaque;
191     DisplayChangeListener *dcl;
192     int i;
193 
194     ds->refreshing = true;
195     dpy_refresh(ds);
196     ds->refreshing = false;
197 
198     QLIST_FOREACH(dcl, &ds->listeners, next) {
199         dcl_interval = dcl->update_interval ?
200             dcl->update_interval : GUI_REFRESH_INTERVAL_DEFAULT;
201         if (interval > dcl_interval) {
202             interval = dcl_interval;
203         }
204     }
205     if (ds->update_interval != interval) {
206         ds->update_interval = interval;
207         for (i = 0; i < nb_consoles; i++) {
208             if (consoles[i]->hw_ops->update_interval) {
209                 consoles[i]->hw_ops->update_interval(consoles[i]->hw, interval);
210             }
211         }
212         trace_console_refresh(interval);
213     }
214     ds->last_update = qemu_clock_get_ms(QEMU_CLOCK_REALTIME);
215     timer_mod(ds->gui_timer, ds->last_update + interval);
216 }
217 
218 static void gui_setup_refresh(DisplayState *ds)
219 {
220     DisplayChangeListener *dcl;
221     bool need_timer = false;
222     bool have_gfx = false;
223     bool have_text = false;
224 
225     QLIST_FOREACH(dcl, &ds->listeners, next) {
226         if (dcl->ops->dpy_refresh != NULL) {
227             need_timer = true;
228         }
229         if (dcl->ops->dpy_gfx_update != NULL) {
230             have_gfx = true;
231         }
232         if (dcl->ops->dpy_text_update != NULL) {
233             have_text = true;
234         }
235     }
236 
237     if (need_timer && ds->gui_timer == NULL) {
238         ds->gui_timer = timer_new_ms(QEMU_CLOCK_REALTIME, gui_update, ds);
239         timer_mod(ds->gui_timer, qemu_clock_get_ms(QEMU_CLOCK_REALTIME));
240     }
241     if (!need_timer && ds->gui_timer != NULL) {
242         timer_del(ds->gui_timer);
243         timer_free(ds->gui_timer);
244         ds->gui_timer = NULL;
245     }
246 
247     ds->have_gfx = have_gfx;
248     ds->have_text = have_text;
249 }
250 
251 void graphic_hw_update(QemuConsole *con)
252 {
253     if (!con) {
254         con = active_console;
255     }
256     if (con && con->hw_ops->gfx_update) {
257         con->hw_ops->gfx_update(con->hw);
258     }
259 }
260 
261 void graphic_hw_invalidate(QemuConsole *con)
262 {
263     if (!con) {
264         con = active_console;
265     }
266     if (con && con->hw_ops->invalidate) {
267         con->hw_ops->invalidate(con->hw);
268     }
269 }
270 
271 static void ppm_save(const char *filename, struct DisplaySurface *ds,
272                      Error **errp)
273 {
274     int width = pixman_image_get_width(ds->image);
275     int height = pixman_image_get_height(ds->image);
276     int fd;
277     FILE *f;
278     int y;
279     int ret;
280     pixman_image_t *linebuf;
281 
282     trace_ppm_save(filename, ds);
283     fd = qemu_open(filename, O_WRONLY | O_CREAT | O_TRUNC | O_BINARY, 0666);
284     if (fd == -1) {
285         error_setg(errp, "failed to open file '%s': %s", filename,
286                    strerror(errno));
287         return;
288     }
289     f = fdopen(fd, "wb");
290     ret = fprintf(f, "P6\n%d %d\n%d\n", width, height, 255);
291     if (ret < 0) {
292         linebuf = NULL;
293         goto write_err;
294     }
295     linebuf = qemu_pixman_linebuf_create(PIXMAN_BE_r8g8b8, width);
296     for (y = 0; y < height; y++) {
297         qemu_pixman_linebuf_fill(linebuf, ds->image, width, 0, y);
298         clearerr(f);
299         ret = fwrite(pixman_image_get_data(linebuf), 1,
300                      pixman_image_get_stride(linebuf), f);
301         (void)ret;
302         if (ferror(f)) {
303             goto write_err;
304         }
305     }
306 
307 out:
308     qemu_pixman_image_unref(linebuf);
309     fclose(f);
310     return;
311 
312 write_err:
313     error_setg(errp, "failed to write to file '%s': %s", filename,
314                strerror(errno));
315     unlink(filename);
316     goto out;
317 }
318 
319 void qmp_screendump(const char *filename, Error **errp)
320 {
321     QemuConsole *con = qemu_console_lookup_by_index(0);
322     DisplaySurface *surface;
323 
324     if (con == NULL) {
325         error_setg(errp, "There is no QemuConsole I can screendump from.");
326         return;
327     }
328 
329     graphic_hw_update(con);
330     surface = qemu_console_surface(con);
331     ppm_save(filename, surface, errp);
332 }
333 
334 void graphic_hw_text_update(QemuConsole *con, console_ch_t *chardata)
335 {
336     if (!con) {
337         con = active_console;
338     }
339     if (con && con->hw_ops->text_update) {
340         con->hw_ops->text_update(con->hw, chardata);
341     }
342 }
343 
344 static void vga_fill_rect(QemuConsole *con,
345                           int posx, int posy, int width, int height,
346                           pixman_color_t color)
347 {
348     DisplaySurface *surface = qemu_console_surface(con);
349     pixman_rectangle16_t rect = {
350         .x = posx, .y = posy, .width = width, .height = height
351     };
352 
353     pixman_image_fill_rectangles(PIXMAN_OP_SRC, surface->image,
354                                  &color, 1, &rect);
355 }
356 
357 /* copy from (xs, ys) to (xd, yd) a rectangle of size (w, h) */
358 static void vga_bitblt(QemuConsole *con,
359                        int xs, int ys, int xd, int yd, int w, int h)
360 {
361     DisplaySurface *surface = qemu_console_surface(con);
362 
363     pixman_image_composite(PIXMAN_OP_SRC,
364                            surface->image, NULL, surface->image,
365                            xs, ys, 0, 0, xd, yd, w, h);
366 }
367 
368 /***********************************************************/
369 /* basic char display */
370 
371 #define FONT_HEIGHT 16
372 #define FONT_WIDTH 8
373 
374 #include "vgafont.h"
375 
376 #ifndef CONFIG_CURSES
377 enum color_names {
378     COLOR_BLACK   = 0,
379     COLOR_RED     = 1,
380     COLOR_GREEN   = 2,
381     COLOR_YELLOW  = 3,
382     COLOR_BLUE    = 4,
383     COLOR_MAGENTA = 5,
384     COLOR_CYAN    = 6,
385     COLOR_WHITE   = 7
386 };
387 #endif
388 
389 #define QEMU_RGB(r, g, b)                                               \
390     { .red = r << 8, .green = g << 8, .blue = b << 8, .alpha = 0xffff }
391 
392 static const pixman_color_t color_table_rgb[2][8] = {
393     {   /* dark */
394         QEMU_RGB(0x00, 0x00, 0x00),  /* black */
395         QEMU_RGB(0xaa, 0x00, 0x00),  /* red */
396         QEMU_RGB(0x00, 0xaa, 0x00),  /* green */
397         QEMU_RGB(0xaa, 0xaa, 0x00),  /* yellow */
398         QEMU_RGB(0x00, 0x00, 0xaa),  /* blue */
399         QEMU_RGB(0xaa, 0x00, 0xaa),  /* magenta */
400         QEMU_RGB(0x00, 0xaa, 0xaa),  /* cyan */
401         QEMU_RGB(0xaa, 0xaa, 0xaa),  /* white */
402     },
403     {   /* bright */
404         QEMU_RGB(0x00, 0x00, 0x00),  /* black */
405         QEMU_RGB(0xff, 0x00, 0x00),  /* red */
406         QEMU_RGB(0x00, 0xff, 0x00),  /* green */
407         QEMU_RGB(0xff, 0xff, 0x00),  /* yellow */
408         QEMU_RGB(0x00, 0x00, 0xff),  /* blue */
409         QEMU_RGB(0xff, 0x00, 0xff),  /* magenta */
410         QEMU_RGB(0x00, 0xff, 0xff),  /* cyan */
411         QEMU_RGB(0xff, 0xff, 0xff),  /* white */
412     }
413 };
414 
415 static void vga_putcharxy(QemuConsole *s, int x, int y, int ch,
416                           TextAttributes *t_attrib)
417 {
418     static pixman_image_t *glyphs[256];
419     DisplaySurface *surface = qemu_console_surface(s);
420     pixman_color_t fgcol, bgcol;
421 
422     if (t_attrib->invers) {
423         bgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
424         fgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
425     } else {
426         fgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
427         bgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
428     }
429 
430     if (!glyphs[ch]) {
431         glyphs[ch] = qemu_pixman_glyph_from_vgafont(FONT_HEIGHT, vgafont16, ch);
432     }
433     qemu_pixman_glyph_render(glyphs[ch], surface->image,
434                              &fgcol, &bgcol, x, y, FONT_WIDTH, FONT_HEIGHT);
435 }
436 
437 static void text_console_resize(QemuConsole *s)
438 {
439     TextCell *cells, *c, *c1;
440     int w1, x, y, last_width;
441 
442     last_width = s->width;
443     s->width = surface_width(s->surface) / FONT_WIDTH;
444     s->height = surface_height(s->surface) / FONT_HEIGHT;
445 
446     w1 = last_width;
447     if (s->width < w1)
448         w1 = s->width;
449 
450     cells = g_malloc(s->width * s->total_height * sizeof(TextCell));
451     for(y = 0; y < s->total_height; y++) {
452         c = &cells[y * s->width];
453         if (w1 > 0) {
454             c1 = &s->cells[y * last_width];
455             for(x = 0; x < w1; x++) {
456                 *c++ = *c1++;
457             }
458         }
459         for(x = w1; x < s->width; x++) {
460             c->ch = ' ';
461             c->t_attrib = s->t_attrib_default;
462             c++;
463         }
464     }
465     g_free(s->cells);
466     s->cells = cells;
467 }
468 
469 static inline void text_update_xy(QemuConsole *s, int x, int y)
470 {
471     s->text_x[0] = MIN(s->text_x[0], x);
472     s->text_x[1] = MAX(s->text_x[1], x);
473     s->text_y[0] = MIN(s->text_y[0], y);
474     s->text_y[1] = MAX(s->text_y[1], y);
475 }
476 
477 static void invalidate_xy(QemuConsole *s, int x, int y)
478 {
479     if (!qemu_console_is_visible(s)) {
480         return;
481     }
482     if (s->update_x0 > x * FONT_WIDTH)
483         s->update_x0 = x * FONT_WIDTH;
484     if (s->update_y0 > y * FONT_HEIGHT)
485         s->update_y0 = y * FONT_HEIGHT;
486     if (s->update_x1 < (x + 1) * FONT_WIDTH)
487         s->update_x1 = (x + 1) * FONT_WIDTH;
488     if (s->update_y1 < (y + 1) * FONT_HEIGHT)
489         s->update_y1 = (y + 1) * FONT_HEIGHT;
490 }
491 
492 static void update_xy(QemuConsole *s, int x, int y)
493 {
494     TextCell *c;
495     int y1, y2;
496 
497     if (s->ds->have_text) {
498         text_update_xy(s, x, y);
499     }
500 
501     y1 = (s->y_base + y) % s->total_height;
502     y2 = y1 - s->y_displayed;
503     if (y2 < 0) {
504         y2 += s->total_height;
505     }
506     if (y2 < s->height) {
507         c = &s->cells[y1 * s->width + x];
508         vga_putcharxy(s, x, y2, c->ch,
509                       &(c->t_attrib));
510         invalidate_xy(s, x, y2);
511     }
512 }
513 
514 static void console_show_cursor(QemuConsole *s, int show)
515 {
516     TextCell *c;
517     int y, y1;
518     int x = s->x;
519 
520     if (s->ds->have_text) {
521         s->cursor_invalidate = 1;
522     }
523 
524     if (x >= s->width) {
525         x = s->width - 1;
526     }
527     y1 = (s->y_base + s->y) % s->total_height;
528     y = y1 - s->y_displayed;
529     if (y < 0) {
530         y += s->total_height;
531     }
532     if (y < s->height) {
533         c = &s->cells[y1 * s->width + x];
534         if (show && cursor_visible_phase) {
535             TextAttributes t_attrib = s->t_attrib_default;
536             t_attrib.invers = !(t_attrib.invers); /* invert fg and bg */
537             vga_putcharxy(s, x, y, c->ch, &t_attrib);
538         } else {
539             vga_putcharxy(s, x, y, c->ch, &(c->t_attrib));
540         }
541         invalidate_xy(s, x, y);
542     }
543 }
544 
545 static void console_refresh(QemuConsole *s)
546 {
547     DisplaySurface *surface = qemu_console_surface(s);
548     TextCell *c;
549     int x, y, y1;
550 
551     if (s->ds->have_text) {
552         s->text_x[0] = 0;
553         s->text_y[0] = 0;
554         s->text_x[1] = s->width - 1;
555         s->text_y[1] = s->height - 1;
556         s->cursor_invalidate = 1;
557     }
558 
559     vga_fill_rect(s, 0, 0, surface_width(surface), surface_height(surface),
560                   color_table_rgb[0][COLOR_BLACK]);
561     y1 = s->y_displayed;
562     for (y = 0; y < s->height; y++) {
563         c = s->cells + y1 * s->width;
564         for (x = 0; x < s->width; x++) {
565             vga_putcharxy(s, x, y, c->ch,
566                           &(c->t_attrib));
567             c++;
568         }
569         if (++y1 == s->total_height) {
570             y1 = 0;
571         }
572     }
573     console_show_cursor(s, 1);
574     dpy_gfx_update(s, 0, 0,
575                    surface_width(surface), surface_height(surface));
576 }
577 
578 static void console_scroll(QemuConsole *s, int ydelta)
579 {
580     int i, y1;
581 
582     if (ydelta > 0) {
583         for(i = 0; i < ydelta; i++) {
584             if (s->y_displayed == s->y_base)
585                 break;
586             if (++s->y_displayed == s->total_height)
587                 s->y_displayed = 0;
588         }
589     } else {
590         ydelta = -ydelta;
591         i = s->backscroll_height;
592         if (i > s->total_height - s->height)
593             i = s->total_height - s->height;
594         y1 = s->y_base - i;
595         if (y1 < 0)
596             y1 += s->total_height;
597         for(i = 0; i < ydelta; i++) {
598             if (s->y_displayed == y1)
599                 break;
600             if (--s->y_displayed < 0)
601                 s->y_displayed = s->total_height - 1;
602         }
603     }
604     console_refresh(s);
605 }
606 
607 static void console_put_lf(QemuConsole *s)
608 {
609     TextCell *c;
610     int x, y1;
611 
612     s->y++;
613     if (s->y >= s->height) {
614         s->y = s->height - 1;
615 
616         if (s->y_displayed == s->y_base) {
617             if (++s->y_displayed == s->total_height)
618                 s->y_displayed = 0;
619         }
620         if (++s->y_base == s->total_height)
621             s->y_base = 0;
622         if (s->backscroll_height < s->total_height)
623             s->backscroll_height++;
624         y1 = (s->y_base + s->height - 1) % s->total_height;
625         c = &s->cells[y1 * s->width];
626         for(x = 0; x < s->width; x++) {
627             c->ch = ' ';
628             c->t_attrib = s->t_attrib_default;
629             c++;
630         }
631         if (s->y_displayed == s->y_base) {
632             if (s->ds->have_text) {
633                 s->text_x[0] = 0;
634                 s->text_y[0] = 0;
635                 s->text_x[1] = s->width - 1;
636                 s->text_y[1] = s->height - 1;
637             }
638 
639             vga_bitblt(s, 0, FONT_HEIGHT, 0, 0,
640                        s->width * FONT_WIDTH,
641                        (s->height - 1) * FONT_HEIGHT);
642             vga_fill_rect(s, 0, (s->height - 1) * FONT_HEIGHT,
643                           s->width * FONT_WIDTH, FONT_HEIGHT,
644                           color_table_rgb[0][s->t_attrib_default.bgcol]);
645             s->update_x0 = 0;
646             s->update_y0 = 0;
647             s->update_x1 = s->width * FONT_WIDTH;
648             s->update_y1 = s->height * FONT_HEIGHT;
649         }
650     }
651 }
652 
653 /* Set console attributes depending on the current escape codes.
654  * NOTE: I know this code is not very efficient (checking every color for it
655  * self) but it is more readable and better maintainable.
656  */
657 static void console_handle_escape(QemuConsole *s)
658 {
659     int i;
660 
661     for (i=0; i<s->nb_esc_params; i++) {
662         switch (s->esc_params[i]) {
663             case 0: /* reset all console attributes to default */
664                 s->t_attrib = s->t_attrib_default;
665                 break;
666             case 1:
667                 s->t_attrib.bold = 1;
668                 break;
669             case 4:
670                 s->t_attrib.uline = 1;
671                 break;
672             case 5:
673                 s->t_attrib.blink = 1;
674                 break;
675             case 7:
676                 s->t_attrib.invers = 1;
677                 break;
678             case 8:
679                 s->t_attrib.unvisible = 1;
680                 break;
681             case 22:
682                 s->t_attrib.bold = 0;
683                 break;
684             case 24:
685                 s->t_attrib.uline = 0;
686                 break;
687             case 25:
688                 s->t_attrib.blink = 0;
689                 break;
690             case 27:
691                 s->t_attrib.invers = 0;
692                 break;
693             case 28:
694                 s->t_attrib.unvisible = 0;
695                 break;
696             /* set foreground color */
697             case 30:
698                 s->t_attrib.fgcol=COLOR_BLACK;
699                 break;
700             case 31:
701                 s->t_attrib.fgcol=COLOR_RED;
702                 break;
703             case 32:
704                 s->t_attrib.fgcol=COLOR_GREEN;
705                 break;
706             case 33:
707                 s->t_attrib.fgcol=COLOR_YELLOW;
708                 break;
709             case 34:
710                 s->t_attrib.fgcol=COLOR_BLUE;
711                 break;
712             case 35:
713                 s->t_attrib.fgcol=COLOR_MAGENTA;
714                 break;
715             case 36:
716                 s->t_attrib.fgcol=COLOR_CYAN;
717                 break;
718             case 37:
719                 s->t_attrib.fgcol=COLOR_WHITE;
720                 break;
721             /* set background color */
722             case 40:
723                 s->t_attrib.bgcol=COLOR_BLACK;
724                 break;
725             case 41:
726                 s->t_attrib.bgcol=COLOR_RED;
727                 break;
728             case 42:
729                 s->t_attrib.bgcol=COLOR_GREEN;
730                 break;
731             case 43:
732                 s->t_attrib.bgcol=COLOR_YELLOW;
733                 break;
734             case 44:
735                 s->t_attrib.bgcol=COLOR_BLUE;
736                 break;
737             case 45:
738                 s->t_attrib.bgcol=COLOR_MAGENTA;
739                 break;
740             case 46:
741                 s->t_attrib.bgcol=COLOR_CYAN;
742                 break;
743             case 47:
744                 s->t_attrib.bgcol=COLOR_WHITE;
745                 break;
746         }
747     }
748 }
749 
750 static void console_clear_xy(QemuConsole *s, int x, int y)
751 {
752     int y1 = (s->y_base + y) % s->total_height;
753     TextCell *c = &s->cells[y1 * s->width + x];
754     c->ch = ' ';
755     c->t_attrib = s->t_attrib_default;
756     update_xy(s, x, y);
757 }
758 
759 /* set cursor, checking bounds */
760 static void set_cursor(QemuConsole *s, int x, int y)
761 {
762     if (x < 0) {
763         x = 0;
764     }
765     if (y < 0) {
766         y = 0;
767     }
768     if (y >= s->height) {
769         y = s->height - 1;
770     }
771     if (x >= s->width) {
772         x = s->width - 1;
773     }
774 
775     s->x = x;
776     s->y = y;
777 }
778 
779 static void console_putchar(QemuConsole *s, int ch)
780 {
781     TextCell *c;
782     int y1, i;
783     int x, y;
784 
785     switch(s->state) {
786     case TTY_STATE_NORM:
787         switch(ch) {
788         case '\r':  /* carriage return */
789             s->x = 0;
790             break;
791         case '\n':  /* newline */
792             console_put_lf(s);
793             break;
794         case '\b':  /* backspace */
795             if (s->x > 0)
796                 s->x--;
797             break;
798         case '\t':  /* tabspace */
799             if (s->x + (8 - (s->x % 8)) > s->width) {
800                 s->x = 0;
801                 console_put_lf(s);
802             } else {
803                 s->x = s->x + (8 - (s->x % 8));
804             }
805             break;
806         case '\a':  /* alert aka. bell */
807             /* TODO: has to be implemented */
808             break;
809         case 14:
810             /* SI (shift in), character set 0 (ignored) */
811             break;
812         case 15:
813             /* SO (shift out), character set 1 (ignored) */
814             break;
815         case 27:    /* esc (introducing an escape sequence) */
816             s->state = TTY_STATE_ESC;
817             break;
818         default:
819             if (s->x >= s->width) {
820                 /* line wrap */
821                 s->x = 0;
822                 console_put_lf(s);
823             }
824             y1 = (s->y_base + s->y) % s->total_height;
825             c = &s->cells[y1 * s->width + s->x];
826             c->ch = ch;
827             c->t_attrib = s->t_attrib;
828             update_xy(s, s->x, s->y);
829             s->x++;
830             break;
831         }
832         break;
833     case TTY_STATE_ESC: /* check if it is a terminal escape sequence */
834         if (ch == '[') {
835             for(i=0;i<MAX_ESC_PARAMS;i++)
836                 s->esc_params[i] = 0;
837             s->nb_esc_params = 0;
838             s->state = TTY_STATE_CSI;
839         } else {
840             s->state = TTY_STATE_NORM;
841         }
842         break;
843     case TTY_STATE_CSI: /* handle escape sequence parameters */
844         if (ch >= '0' && ch <= '9') {
845             if (s->nb_esc_params < MAX_ESC_PARAMS) {
846                 int *param = &s->esc_params[s->nb_esc_params];
847                 int digit = (ch - '0');
848 
849                 *param = (*param <= (INT_MAX - digit) / 10) ?
850                          *param * 10 + digit : INT_MAX;
851             }
852         } else {
853             if (s->nb_esc_params < MAX_ESC_PARAMS)
854                 s->nb_esc_params++;
855             if (ch == ';')
856                 break;
857             trace_console_putchar_csi(s->esc_params[0], s->esc_params[1],
858                                       ch, s->nb_esc_params);
859             s->state = TTY_STATE_NORM;
860             switch(ch) {
861             case 'A':
862                 /* move cursor up */
863                 if (s->esc_params[0] == 0) {
864                     s->esc_params[0] = 1;
865                 }
866                 set_cursor(s, s->x, s->y - s->esc_params[0]);
867                 break;
868             case 'B':
869                 /* move cursor down */
870                 if (s->esc_params[0] == 0) {
871                     s->esc_params[0] = 1;
872                 }
873                 set_cursor(s, s->x, s->y + s->esc_params[0]);
874                 break;
875             case 'C':
876                 /* move cursor right */
877                 if (s->esc_params[0] == 0) {
878                     s->esc_params[0] = 1;
879                 }
880                 set_cursor(s, s->x + s->esc_params[0], s->y);
881                 break;
882             case 'D':
883                 /* move cursor left */
884                 if (s->esc_params[0] == 0) {
885                     s->esc_params[0] = 1;
886                 }
887                 set_cursor(s, s->x - s->esc_params[0], s->y);
888                 break;
889             case 'G':
890                 /* move cursor to column */
891                 set_cursor(s, s->esc_params[0] - 1, s->y);
892                 break;
893             case 'f':
894             case 'H':
895                 /* move cursor to row, column */
896                 set_cursor(s, s->esc_params[1] - 1, s->esc_params[0] - 1);
897                 break;
898             case 'J':
899                 switch (s->esc_params[0]) {
900                 case 0:
901                     /* clear to end of screen */
902                     for (y = s->y; y < s->height; y++) {
903                         for (x = 0; x < s->width; x++) {
904                             if (y == s->y && x < s->x) {
905                                 continue;
906                             }
907                             console_clear_xy(s, x, y);
908                         }
909                     }
910                     break;
911                 case 1:
912                     /* clear from beginning of screen */
913                     for (y = 0; y <= s->y; y++) {
914                         for (x = 0; x < s->width; x++) {
915                             if (y == s->y && x > s->x) {
916                                 break;
917                             }
918                             console_clear_xy(s, x, y);
919                         }
920                     }
921                     break;
922                 case 2:
923                     /* clear entire screen */
924                     for (y = 0; y <= s->height; y++) {
925                         for (x = 0; x < s->width; x++) {
926                             console_clear_xy(s, x, y);
927                         }
928                     }
929                     break;
930                 }
931                 break;
932             case 'K':
933                 switch (s->esc_params[0]) {
934                 case 0:
935                     /* clear to eol */
936                     for(x = s->x; x < s->width; x++) {
937                         console_clear_xy(s, x, s->y);
938                     }
939                     break;
940                 case 1:
941                     /* clear from beginning of line */
942                     for (x = 0; x <= s->x; x++) {
943                         console_clear_xy(s, x, s->y);
944                     }
945                     break;
946                 case 2:
947                     /* clear entire line */
948                     for(x = 0; x < s->width; x++) {
949                         console_clear_xy(s, x, s->y);
950                     }
951                     break;
952                 }
953                 break;
954             case 'm':
955                 console_handle_escape(s);
956                 break;
957             case 'n':
958                 /* report cursor position */
959                 /* TODO: send ESC[row;colR */
960                 break;
961             case 's':
962                 /* save cursor position */
963                 s->x_saved = s->x;
964                 s->y_saved = s->y;
965                 break;
966             case 'u':
967                 /* restore cursor position */
968                 s->x = s->x_saved;
969                 s->y = s->y_saved;
970                 break;
971             default:
972                 trace_console_putchar_unhandled(ch);
973                 break;
974             }
975             break;
976         }
977     }
978 }
979 
980 void console_select(unsigned int index)
981 {
982     DisplayChangeListener *dcl;
983     QemuConsole *s;
984 
985     trace_console_select(index);
986     s = qemu_console_lookup_by_index(index);
987     if (s) {
988         DisplayState *ds = s->ds;
989 
990         active_console = s;
991         if (ds->have_gfx) {
992             QLIST_FOREACH(dcl, &ds->listeners, next) {
993                 if (dcl->con != NULL) {
994                     continue;
995                 }
996                 if (dcl->ops->dpy_gfx_switch) {
997                     dcl->ops->dpy_gfx_switch(dcl, s->surface);
998                 }
999             }
1000             dpy_gfx_update(s, 0, 0, surface_width(s->surface),
1001                            surface_height(s->surface));
1002         }
1003         if (ds->have_text) {
1004             dpy_text_resize(s, s->width, s->height);
1005         }
1006         text_console_update_cursor(NULL);
1007     }
1008 }
1009 
1010 static int console_puts(CharDriverState *chr, const uint8_t *buf, int len)
1011 {
1012     QemuConsole *s = chr->opaque;
1013     int i;
1014 
1015     s->update_x0 = s->width * FONT_WIDTH;
1016     s->update_y0 = s->height * FONT_HEIGHT;
1017     s->update_x1 = 0;
1018     s->update_y1 = 0;
1019     console_show_cursor(s, 0);
1020     for(i = 0; i < len; i++) {
1021         console_putchar(s, buf[i]);
1022     }
1023     console_show_cursor(s, 1);
1024     if (s->ds->have_gfx && s->update_x0 < s->update_x1) {
1025         dpy_gfx_update(s, s->update_x0, s->update_y0,
1026                        s->update_x1 - s->update_x0,
1027                        s->update_y1 - s->update_y0);
1028     }
1029     return len;
1030 }
1031 
1032 static void kbd_send_chars(void *opaque)
1033 {
1034     QemuConsole *s = opaque;
1035     int len;
1036     uint8_t buf[16];
1037 
1038     len = qemu_chr_be_can_write(s->chr);
1039     if (len > s->out_fifo.count)
1040         len = s->out_fifo.count;
1041     if (len > 0) {
1042         if (len > sizeof(buf))
1043             len = sizeof(buf);
1044         qemu_fifo_read(&s->out_fifo, buf, len);
1045         qemu_chr_be_write(s->chr, buf, len);
1046     }
1047     /* characters are pending: we send them a bit later (XXX:
1048        horrible, should change char device API) */
1049     if (s->out_fifo.count > 0) {
1050         timer_mod(s->kbd_timer, qemu_clock_get_ms(QEMU_CLOCK_REALTIME) + 1);
1051     }
1052 }
1053 
1054 /* called when an ascii key is pressed */
1055 void kbd_put_keysym_console(QemuConsole *s, int keysym)
1056 {
1057     uint8_t buf[16], *q;
1058     int c;
1059 
1060     if (!s || (s->console_type == GRAPHIC_CONSOLE))
1061         return;
1062 
1063     switch(keysym) {
1064     case QEMU_KEY_CTRL_UP:
1065         console_scroll(s, -1);
1066         break;
1067     case QEMU_KEY_CTRL_DOWN:
1068         console_scroll(s, 1);
1069         break;
1070     case QEMU_KEY_CTRL_PAGEUP:
1071         console_scroll(s, -10);
1072         break;
1073     case QEMU_KEY_CTRL_PAGEDOWN:
1074         console_scroll(s, 10);
1075         break;
1076     default:
1077         /* convert the QEMU keysym to VT100 key string */
1078         q = buf;
1079         if (keysym >= 0xe100 && keysym <= 0xe11f) {
1080             *q++ = '\033';
1081             *q++ = '[';
1082             c = keysym - 0xe100;
1083             if (c >= 10)
1084                 *q++ = '0' + (c / 10);
1085             *q++ = '0' + (c % 10);
1086             *q++ = '~';
1087         } else if (keysym >= 0xe120 && keysym <= 0xe17f) {
1088             *q++ = '\033';
1089             *q++ = '[';
1090             *q++ = keysym & 0xff;
1091         } else if (s->echo && (keysym == '\r' || keysym == '\n')) {
1092             console_puts(s->chr, (const uint8_t *) "\r", 1);
1093             *q++ = '\n';
1094         } else {
1095             *q++ = keysym;
1096         }
1097         if (s->echo) {
1098             console_puts(s->chr, buf, q - buf);
1099         }
1100         if (s->chr->chr_read) {
1101             qemu_fifo_write(&s->out_fifo, buf, q - buf);
1102             kbd_send_chars(s);
1103         }
1104         break;
1105     }
1106 }
1107 
1108 static const int qcode_to_keysym[Q_KEY_CODE_MAX] = {
1109     [Q_KEY_CODE_UP]     = QEMU_KEY_UP,
1110     [Q_KEY_CODE_DOWN]   = QEMU_KEY_DOWN,
1111     [Q_KEY_CODE_RIGHT]  = QEMU_KEY_RIGHT,
1112     [Q_KEY_CODE_LEFT]   = QEMU_KEY_LEFT,
1113     [Q_KEY_CODE_HOME]   = QEMU_KEY_HOME,
1114     [Q_KEY_CODE_END]    = QEMU_KEY_END,
1115     [Q_KEY_CODE_PGUP]   = QEMU_KEY_PAGEUP,
1116     [Q_KEY_CODE_PGDN]   = QEMU_KEY_PAGEDOWN,
1117     [Q_KEY_CODE_DELETE] = QEMU_KEY_DELETE,
1118 };
1119 
1120 bool kbd_put_qcode_console(QemuConsole *s, int qcode)
1121 {
1122     int keysym;
1123 
1124     keysym = qcode_to_keysym[qcode];
1125     if (keysym == 0) {
1126         return false;
1127     }
1128     kbd_put_keysym_console(s, keysym);
1129     return true;
1130 }
1131 
1132 void kbd_put_string_console(QemuConsole *s, const char *str, int len)
1133 {
1134     int i;
1135 
1136     for (i = 0; i < len && str[i]; i++) {
1137         kbd_put_keysym_console(s, str[i]);
1138     }
1139 }
1140 
1141 void kbd_put_keysym(int keysym)
1142 {
1143     kbd_put_keysym_console(active_console, keysym);
1144 }
1145 
1146 static void text_console_invalidate(void *opaque)
1147 {
1148     QemuConsole *s = (QemuConsole *) opaque;
1149 
1150     if (s->ds->have_text && s->console_type == TEXT_CONSOLE) {
1151         text_console_resize(s);
1152     }
1153     console_refresh(s);
1154 }
1155 
1156 static void text_console_update(void *opaque, console_ch_t *chardata)
1157 {
1158     QemuConsole *s = (QemuConsole *) opaque;
1159     int i, j, src;
1160 
1161     if (s->text_x[0] <= s->text_x[1]) {
1162         src = (s->y_base + s->text_y[0]) * s->width;
1163         chardata += s->text_y[0] * s->width;
1164         for (i = s->text_y[0]; i <= s->text_y[1]; i ++)
1165             for (j = 0; j < s->width; j ++, src ++)
1166                 console_write_ch(chardata ++, s->cells[src].ch |
1167                                 (s->cells[src].t_attrib.fgcol << 12) |
1168                                 (s->cells[src].t_attrib.bgcol << 8) |
1169                                 (s->cells[src].t_attrib.bold << 21));
1170         dpy_text_update(s, s->text_x[0], s->text_y[0],
1171                         s->text_x[1] - s->text_x[0], i - s->text_y[0]);
1172         s->text_x[0] = s->width;
1173         s->text_y[0] = s->height;
1174         s->text_x[1] = 0;
1175         s->text_y[1] = 0;
1176     }
1177     if (s->cursor_invalidate) {
1178         dpy_text_cursor(s, s->x, s->y);
1179         s->cursor_invalidate = 0;
1180     }
1181 }
1182 
1183 static QemuConsole *new_console(DisplayState *ds, console_type_t console_type,
1184                                 uint32_t head)
1185 {
1186     Object *obj;
1187     QemuConsole *s;
1188     int i;
1189 
1190     obj = object_new(TYPE_QEMU_CONSOLE);
1191     s = QEMU_CONSOLE(obj);
1192     s->head = head;
1193     object_property_add_link(obj, "device", TYPE_DEVICE,
1194                              (Object **)&s->device,
1195                              object_property_allow_set_link,
1196                              OBJ_PROP_LINK_UNREF_ON_RELEASE,
1197                              &error_abort);
1198     object_property_add_uint32_ptr(obj, "head",
1199                                    &s->head, &error_abort);
1200 
1201     if (!active_console || ((active_console->console_type != GRAPHIC_CONSOLE) &&
1202         (console_type == GRAPHIC_CONSOLE))) {
1203         active_console = s;
1204     }
1205     s->ds = ds;
1206     s->console_type = console_type;
1207 
1208     consoles = g_realloc(consoles, sizeof(*consoles) * (nb_consoles+1));
1209     if (console_type != GRAPHIC_CONSOLE) {
1210         s->index = nb_consoles;
1211         consoles[nb_consoles++] = s;
1212     } else {
1213         /* HACK: Put graphical consoles before text consoles.  */
1214         for (i = nb_consoles; i > 0; i--) {
1215             if (consoles[i - 1]->console_type == GRAPHIC_CONSOLE)
1216                 break;
1217             consoles[i] = consoles[i - 1];
1218             consoles[i]->index = i;
1219         }
1220         s->index = i;
1221         consoles[i] = s;
1222         nb_consoles++;
1223     }
1224     return s;
1225 }
1226 
1227 static void qemu_alloc_display(DisplaySurface *surface, int width, int height,
1228                                int linesize, PixelFormat pf, int newflags)
1229 {
1230     surface->pf = pf;
1231 
1232     qemu_pixman_image_unref(surface->image);
1233     surface->image = NULL;
1234 
1235     surface->format = qemu_pixman_get_format(&pf);
1236     assert(surface->format != 0);
1237     surface->image = pixman_image_create_bits(surface->format,
1238                                               width, height,
1239                                               NULL, linesize);
1240     assert(surface->image != NULL);
1241 
1242     surface->flags = newflags | QEMU_ALLOCATED_FLAG;
1243 #ifdef HOST_WORDS_BIGENDIAN
1244     surface->flags |= QEMU_BIG_ENDIAN_FLAG;
1245 #endif
1246 }
1247 
1248 DisplaySurface *qemu_create_displaysurface(int width, int height)
1249 {
1250     DisplaySurface *surface = g_new0(DisplaySurface, 1);
1251     int linesize = width * 4;
1252 
1253     trace_displaysurface_create(surface, width, height);
1254     qemu_alloc_display(surface, width, height, linesize,
1255                        qemu_default_pixelformat(32), 0);
1256     return surface;
1257 }
1258 
1259 DisplaySurface *qemu_create_displaysurface_from(int width, int height, int bpp,
1260                                                 int linesize, uint8_t *data,
1261                                                 bool byteswap)
1262 {
1263     DisplaySurface *surface = g_new0(DisplaySurface, 1);
1264 
1265     trace_displaysurface_create_from(surface, width, height, bpp, byteswap);
1266     if (byteswap) {
1267         surface->pf = qemu_different_endianness_pixelformat(bpp);
1268     } else {
1269         surface->pf = qemu_default_pixelformat(bpp);
1270     }
1271 
1272     surface->format = qemu_pixman_get_format(&surface->pf);
1273     assert(surface->format != 0);
1274     surface->image = pixman_image_create_bits(surface->format,
1275                                               width, height,
1276                                               (void *)data, linesize);
1277     assert(surface->image != NULL);
1278 
1279 #ifdef HOST_WORDS_BIGENDIAN
1280     surface->flags = QEMU_BIG_ENDIAN_FLAG;
1281 #endif
1282 
1283     return surface;
1284 }
1285 
1286 static DisplaySurface *qemu_create_message_surface(int w, int h,
1287                                                    const char *msg)
1288 {
1289     DisplaySurface *surface = qemu_create_displaysurface(w, h);
1290     pixman_color_t bg = color_table_rgb[0][COLOR_BLACK];
1291     pixman_color_t fg = color_table_rgb[0][COLOR_WHITE];
1292     pixman_image_t *glyph;
1293     int len, x, y, i;
1294 
1295     len = strlen(msg);
1296     x = (w / FONT_WIDTH  - len) / 2;
1297     y = (h / FONT_HEIGHT - 1)   / 2;
1298     for (i = 0; i < len; i++) {
1299         glyph = qemu_pixman_glyph_from_vgafont(FONT_HEIGHT, vgafont16, msg[i]);
1300         qemu_pixman_glyph_render(glyph, surface->image, &fg, &bg,
1301                                  x+i, y, FONT_WIDTH, FONT_HEIGHT);
1302         qemu_pixman_image_unref(glyph);
1303     }
1304     return surface;
1305 }
1306 
1307 void qemu_free_displaysurface(DisplaySurface *surface)
1308 {
1309     if (surface == NULL) {
1310         return;
1311     }
1312     trace_displaysurface_free(surface);
1313     qemu_pixman_image_unref(surface->image);
1314     g_free(surface);
1315 }
1316 
1317 void register_displaychangelistener(DisplayChangeListener *dcl)
1318 {
1319     static const char nodev[] =
1320         "This VM has no graphic display device.";
1321     static DisplaySurface *dummy;
1322     QemuConsole *con;
1323 
1324     trace_displaychangelistener_register(dcl, dcl->ops->dpy_name);
1325     dcl->ds = get_alloc_displaystate();
1326     QLIST_INSERT_HEAD(&dcl->ds->listeners, dcl, next);
1327     gui_setup_refresh(dcl->ds);
1328     if (dcl->con) {
1329         dcl->con->dcls++;
1330         con = dcl->con;
1331     } else {
1332         con = active_console;
1333     }
1334     if (dcl->ops->dpy_gfx_switch) {
1335         if (con) {
1336             dcl->ops->dpy_gfx_switch(dcl, con->surface);
1337         } else {
1338             if (!dummy) {
1339                 dummy = qemu_create_message_surface(640, 480, nodev);
1340             }
1341             dcl->ops->dpy_gfx_switch(dcl, dummy);
1342         }
1343     }
1344     text_console_update_cursor(NULL);
1345 }
1346 
1347 void update_displaychangelistener(DisplayChangeListener *dcl,
1348                                   uint64_t interval)
1349 {
1350     DisplayState *ds = dcl->ds;
1351 
1352     dcl->update_interval = interval;
1353     if (!ds->refreshing && ds->update_interval > interval) {
1354         timer_mod(ds->gui_timer, ds->last_update + interval);
1355     }
1356 }
1357 
1358 void unregister_displaychangelistener(DisplayChangeListener *dcl)
1359 {
1360     DisplayState *ds = dcl->ds;
1361     trace_displaychangelistener_unregister(dcl, dcl->ops->dpy_name);
1362     if (dcl->con) {
1363         dcl->con->dcls--;
1364     }
1365     QLIST_REMOVE(dcl, next);
1366     gui_setup_refresh(ds);
1367 }
1368 
1369 int dpy_set_ui_info(QemuConsole *con, QemuUIInfo *info)
1370 {
1371     assert(con != NULL);
1372     con->ui_info = *info;
1373     if (con->hw_ops->ui_info) {
1374         return con->hw_ops->ui_info(con->hw, con->head, info);
1375     }
1376     return -1;
1377 }
1378 
1379 void dpy_gfx_update(QemuConsole *con, int x, int y, int w, int h)
1380 {
1381     DisplayState *s = con->ds;
1382     DisplayChangeListener *dcl;
1383     int width = surface_width(con->surface);
1384     int height = surface_height(con->surface);
1385 
1386     x = MAX(x, 0);
1387     y = MAX(y, 0);
1388     x = MIN(x, width);
1389     y = MIN(y, height);
1390     w = MIN(w, width - x);
1391     h = MIN(h, height - y);
1392 
1393     if (!qemu_console_is_visible(con)) {
1394         return;
1395     }
1396     QLIST_FOREACH(dcl, &s->listeners, next) {
1397         if (con != (dcl->con ? dcl->con : active_console)) {
1398             continue;
1399         }
1400         if (dcl->ops->dpy_gfx_update) {
1401             dcl->ops->dpy_gfx_update(dcl, x, y, w, h);
1402         }
1403     }
1404 }
1405 
1406 void dpy_gfx_replace_surface(QemuConsole *con,
1407                              DisplaySurface *surface)
1408 {
1409     DisplayState *s = con->ds;
1410     DisplaySurface *old_surface = con->surface;
1411     DisplayChangeListener *dcl;
1412 
1413     con->surface = surface;
1414     QLIST_FOREACH(dcl, &s->listeners, next) {
1415         if (con != (dcl->con ? dcl->con : active_console)) {
1416             continue;
1417         }
1418         if (dcl->ops->dpy_gfx_switch) {
1419             dcl->ops->dpy_gfx_switch(dcl, surface);
1420         }
1421     }
1422     qemu_free_displaysurface(old_surface);
1423 }
1424 
1425 static void dpy_refresh(DisplayState *s)
1426 {
1427     DisplayChangeListener *dcl;
1428 
1429     QLIST_FOREACH(dcl, &s->listeners, next) {
1430         if (dcl->ops->dpy_refresh) {
1431             dcl->ops->dpy_refresh(dcl);
1432         }
1433     }
1434 }
1435 
1436 void dpy_gfx_copy(QemuConsole *con, int src_x, int src_y,
1437                   int dst_x, int dst_y, int w, int h)
1438 {
1439     DisplayState *s = con->ds;
1440     DisplayChangeListener *dcl;
1441 
1442     if (!qemu_console_is_visible(con)) {
1443         return;
1444     }
1445     QLIST_FOREACH(dcl, &s->listeners, next) {
1446         if (con != (dcl->con ? dcl->con : active_console)) {
1447             continue;
1448         }
1449         if (dcl->ops->dpy_gfx_copy) {
1450             dcl->ops->dpy_gfx_copy(dcl, src_x, src_y, dst_x, dst_y, w, h);
1451         } else { /* TODO */
1452             dcl->ops->dpy_gfx_update(dcl, dst_x, dst_y, w, h);
1453         }
1454     }
1455 }
1456 
1457 void dpy_text_cursor(QemuConsole *con, int x, int y)
1458 {
1459     DisplayState *s = con->ds;
1460     DisplayChangeListener *dcl;
1461 
1462     if (!qemu_console_is_visible(con)) {
1463         return;
1464     }
1465     QLIST_FOREACH(dcl, &s->listeners, next) {
1466         if (con != (dcl->con ? dcl->con : active_console)) {
1467             continue;
1468         }
1469         if (dcl->ops->dpy_text_cursor) {
1470             dcl->ops->dpy_text_cursor(dcl, x, y);
1471         }
1472     }
1473 }
1474 
1475 void dpy_text_update(QemuConsole *con, int x, int y, int w, int h)
1476 {
1477     DisplayState *s = con->ds;
1478     DisplayChangeListener *dcl;
1479 
1480     if (!qemu_console_is_visible(con)) {
1481         return;
1482     }
1483     QLIST_FOREACH(dcl, &s->listeners, next) {
1484         if (con != (dcl->con ? dcl->con : active_console)) {
1485             continue;
1486         }
1487         if (dcl->ops->dpy_text_update) {
1488             dcl->ops->dpy_text_update(dcl, x, y, w, h);
1489         }
1490     }
1491 }
1492 
1493 void dpy_text_resize(QemuConsole *con, int w, int h)
1494 {
1495     DisplayState *s = con->ds;
1496     struct DisplayChangeListener *dcl;
1497 
1498     if (!qemu_console_is_visible(con)) {
1499         return;
1500     }
1501     QLIST_FOREACH(dcl, &s->listeners, next) {
1502         if (con != (dcl->con ? dcl->con : active_console)) {
1503             continue;
1504         }
1505         if (dcl->ops->dpy_text_resize) {
1506             dcl->ops->dpy_text_resize(dcl, w, h);
1507         }
1508     }
1509 }
1510 
1511 void dpy_mouse_set(QemuConsole *con, int x, int y, int on)
1512 {
1513     DisplayState *s = con->ds;
1514     DisplayChangeListener *dcl;
1515 
1516     if (!qemu_console_is_visible(con)) {
1517         return;
1518     }
1519     QLIST_FOREACH(dcl, &s->listeners, next) {
1520         if (con != (dcl->con ? dcl->con : active_console)) {
1521             continue;
1522         }
1523         if (dcl->ops->dpy_mouse_set) {
1524             dcl->ops->dpy_mouse_set(dcl, x, y, on);
1525         }
1526     }
1527 }
1528 
1529 void dpy_cursor_define(QemuConsole *con, QEMUCursor *cursor)
1530 {
1531     DisplayState *s = con->ds;
1532     DisplayChangeListener *dcl;
1533 
1534     if (!qemu_console_is_visible(con)) {
1535         return;
1536     }
1537     QLIST_FOREACH(dcl, &s->listeners, next) {
1538         if (con != (dcl->con ? dcl->con : active_console)) {
1539             continue;
1540         }
1541         if (dcl->ops->dpy_cursor_define) {
1542             dcl->ops->dpy_cursor_define(dcl, cursor);
1543         }
1544     }
1545 }
1546 
1547 bool dpy_cursor_define_supported(QemuConsole *con)
1548 {
1549     DisplayState *s = con->ds;
1550     DisplayChangeListener *dcl;
1551 
1552     QLIST_FOREACH(dcl, &s->listeners, next) {
1553         if (dcl->ops->dpy_cursor_define) {
1554             return true;
1555         }
1556     }
1557     return false;
1558 }
1559 
1560 /***********************************************************/
1561 /* register display */
1562 
1563 /* console.c internal use only */
1564 static DisplayState *get_alloc_displaystate(void)
1565 {
1566     if (!display_state) {
1567         display_state = g_new0(DisplayState, 1);
1568         cursor_timer = timer_new_ms(QEMU_CLOCK_REALTIME,
1569                                     text_console_update_cursor, NULL);
1570     }
1571     return display_state;
1572 }
1573 
1574 /*
1575  * Called by main(), after creating QemuConsoles
1576  * and before initializing ui (sdl/vnc/...).
1577  */
1578 DisplayState *init_displaystate(void)
1579 {
1580     gchar *name;
1581     int i;
1582 
1583     get_alloc_displaystate();
1584     for (i = 0; i < nb_consoles; i++) {
1585         if (consoles[i]->console_type != GRAPHIC_CONSOLE &&
1586             consoles[i]->ds == NULL) {
1587             text_console_do_init(consoles[i]->chr, display_state);
1588         }
1589 
1590         /* Hook up into the qom tree here (not in new_console()), once
1591          * all QemuConsoles are created and the order / numbering
1592          * doesn't change any more */
1593         name = g_strdup_printf("console[%d]", i);
1594         object_property_add_child(container_get(object_get_root(), "/backend"),
1595                                   name, OBJECT(consoles[i]), &error_abort);
1596         g_free(name);
1597     }
1598 
1599     return display_state;
1600 }
1601 
1602 QemuConsole *graphic_console_init(DeviceState *dev, uint32_t head,
1603                                   const GraphicHwOps *hw_ops,
1604                                   void *opaque)
1605 {
1606     static const char noinit[] =
1607         "Guest has not initialized the display (yet).";
1608     int width = 640;
1609     int height = 480;
1610     QemuConsole *s;
1611     DisplayState *ds;
1612 
1613     ds = get_alloc_displaystate();
1614     trace_console_gfx_new();
1615     s = new_console(ds, GRAPHIC_CONSOLE, head);
1616     s->hw_ops = hw_ops;
1617     s->hw = opaque;
1618     if (dev) {
1619         object_property_set_link(OBJECT(s), OBJECT(dev), "device",
1620                                  &error_abort);
1621     }
1622 
1623     s->surface = qemu_create_message_surface(width, height, noinit);
1624     return s;
1625 }
1626 
1627 QemuConsole *qemu_console_lookup_by_index(unsigned int index)
1628 {
1629     if (index >= nb_consoles) {
1630         return NULL;
1631     }
1632     return consoles[index];
1633 }
1634 
1635 QemuConsole *qemu_console_lookup_by_device(DeviceState *dev, uint32_t head)
1636 {
1637     Object *obj;
1638     uint32_t h;
1639     int i;
1640 
1641     for (i = 0; i < nb_consoles; i++) {
1642         if (!consoles[i]) {
1643             continue;
1644         }
1645         obj = object_property_get_link(OBJECT(consoles[i]),
1646                                        "device", &error_abort);
1647         if (DEVICE(obj) != dev) {
1648             continue;
1649         }
1650         h = object_property_get_int(OBJECT(consoles[i]),
1651                                     "head", &error_abort);
1652         if (h != head) {
1653             continue;
1654         }
1655         return consoles[i];
1656     }
1657     return NULL;
1658 }
1659 
1660 bool qemu_console_is_visible(QemuConsole *con)
1661 {
1662     return (con == active_console) || (con->dcls > 0);
1663 }
1664 
1665 bool qemu_console_is_graphic(QemuConsole *con)
1666 {
1667     if (con == NULL) {
1668         con = active_console;
1669     }
1670     return con && (con->console_type == GRAPHIC_CONSOLE);
1671 }
1672 
1673 bool qemu_console_is_fixedsize(QemuConsole *con)
1674 {
1675     if (con == NULL) {
1676         con = active_console;
1677     }
1678     return con && (con->console_type != TEXT_CONSOLE);
1679 }
1680 
1681 int qemu_console_get_index(QemuConsole *con)
1682 {
1683     if (con == NULL) {
1684         con = active_console;
1685     }
1686     return con ? con->index : -1;
1687 }
1688 
1689 uint32_t qemu_console_get_head(QemuConsole *con)
1690 {
1691     if (con == NULL) {
1692         con = active_console;
1693     }
1694     return con ? con->head : -1;
1695 }
1696 
1697 QemuUIInfo *qemu_console_get_ui_info(QemuConsole *con)
1698 {
1699     assert(con != NULL);
1700     return &con->ui_info;
1701 }
1702 
1703 int qemu_console_get_width(QemuConsole *con, int fallback)
1704 {
1705     if (con == NULL) {
1706         con = active_console;
1707     }
1708     return con ? surface_width(con->surface) : fallback;
1709 }
1710 
1711 int qemu_console_get_height(QemuConsole *con, int fallback)
1712 {
1713     if (con == NULL) {
1714         con = active_console;
1715     }
1716     return con ? surface_height(con->surface) : fallback;
1717 }
1718 
1719 static void text_console_set_echo(CharDriverState *chr, bool echo)
1720 {
1721     QemuConsole *s = chr->opaque;
1722 
1723     s->echo = echo;
1724 }
1725 
1726 static void text_console_update_cursor_timer(void)
1727 {
1728     timer_mod(cursor_timer, qemu_clock_get_ms(QEMU_CLOCK_REALTIME)
1729               + CONSOLE_CURSOR_PERIOD / 2);
1730 }
1731 
1732 static void text_console_update_cursor(void *opaque)
1733 {
1734     QemuConsole *s;
1735     int i, count = 0;
1736 
1737     cursor_visible_phase = !cursor_visible_phase;
1738 
1739     for (i = 0; i < nb_consoles; i++) {
1740         s = consoles[i];
1741         if (qemu_console_is_graphic(s) ||
1742             !qemu_console_is_visible(s)) {
1743             continue;
1744         }
1745         count++;
1746         graphic_hw_invalidate(s);
1747     }
1748 
1749     if (count) {
1750         text_console_update_cursor_timer();
1751     }
1752 }
1753 
1754 static const GraphicHwOps text_console_ops = {
1755     .invalidate  = text_console_invalidate,
1756     .text_update = text_console_update,
1757 };
1758 
1759 static void text_console_do_init(CharDriverState *chr, DisplayState *ds)
1760 {
1761     QemuConsole *s;
1762     int g_width = 80 * FONT_WIDTH;
1763     int g_height = 24 * FONT_HEIGHT;
1764 
1765     s = chr->opaque;
1766 
1767     chr->chr_write = console_puts;
1768 
1769     s->out_fifo.buf = s->out_fifo_buf;
1770     s->out_fifo.buf_size = sizeof(s->out_fifo_buf);
1771     s->kbd_timer = timer_new_ms(QEMU_CLOCK_REALTIME, kbd_send_chars, s);
1772     s->ds = ds;
1773 
1774     s->y_displayed = 0;
1775     s->y_base = 0;
1776     s->total_height = DEFAULT_BACKSCROLL;
1777     s->x = 0;
1778     s->y = 0;
1779     if (!s->surface) {
1780         if (active_console && active_console->surface) {
1781             g_width = surface_width(active_console->surface);
1782             g_height = surface_height(active_console->surface);
1783         }
1784         s->surface = qemu_create_displaysurface(g_width, g_height);
1785     }
1786 
1787     s->hw_ops = &text_console_ops;
1788     s->hw = s;
1789 
1790     /* Set text attribute defaults */
1791     s->t_attrib_default.bold = 0;
1792     s->t_attrib_default.uline = 0;
1793     s->t_attrib_default.blink = 0;
1794     s->t_attrib_default.invers = 0;
1795     s->t_attrib_default.unvisible = 0;
1796     s->t_attrib_default.fgcol = COLOR_WHITE;
1797     s->t_attrib_default.bgcol = COLOR_BLACK;
1798     /* set current text attributes to default */
1799     s->t_attrib = s->t_attrib_default;
1800     text_console_resize(s);
1801 
1802     if (chr->label) {
1803         char msg[128];
1804         int len;
1805 
1806         s->t_attrib.bgcol = COLOR_BLUE;
1807         len = snprintf(msg, sizeof(msg), "%s console\r\n", chr->label);
1808         console_puts(chr, (uint8_t*)msg, len);
1809         s->t_attrib = s->t_attrib_default;
1810     }
1811 
1812     qemu_chr_be_generic_open(chr);
1813     if (chr->init)
1814         chr->init(chr);
1815 }
1816 
1817 static CharDriverState *text_console_init(ChardevVC *vc)
1818 {
1819     CharDriverState *chr;
1820     QemuConsole *s;
1821     unsigned width = 0;
1822     unsigned height = 0;
1823 
1824     chr = g_malloc0(sizeof(CharDriverState));
1825 
1826     if (vc->has_width) {
1827         width = vc->width;
1828     } else if (vc->has_cols) {
1829         width = vc->cols * FONT_WIDTH;
1830     }
1831 
1832     if (vc->has_height) {
1833         height = vc->height;
1834     } else if (vc->has_rows) {
1835         height = vc->rows * FONT_HEIGHT;
1836     }
1837 
1838     trace_console_txt_new(width, height);
1839     if (width == 0 || height == 0) {
1840         s = new_console(NULL, TEXT_CONSOLE, 0);
1841     } else {
1842         s = new_console(NULL, TEXT_CONSOLE_FIXED_SIZE, 0);
1843         s->surface = qemu_create_displaysurface(width, height);
1844     }
1845 
1846     if (!s) {
1847         g_free(chr);
1848         return NULL;
1849     }
1850 
1851     s->chr = chr;
1852     chr->opaque = s;
1853     chr->chr_set_echo = text_console_set_echo;
1854     /* console/chardev init sometimes completes elsewhere in a 2nd
1855      * stage, so defer OPENED events until they are fully initialized
1856      */
1857     chr->explicit_be_open = true;
1858 
1859     if (display_state) {
1860         text_console_do_init(chr, display_state);
1861     }
1862     return chr;
1863 }
1864 
1865 static VcHandler *vc_handler = text_console_init;
1866 
1867 CharDriverState *vc_init(ChardevVC *vc)
1868 {
1869     return vc_handler(vc);
1870 }
1871 
1872 void register_vc_handler(VcHandler *handler)
1873 {
1874     vc_handler = handler;
1875 }
1876 
1877 void qemu_console_resize(QemuConsole *s, int width, int height)
1878 {
1879     DisplaySurface *surface;
1880 
1881     assert(s->console_type == GRAPHIC_CONSOLE);
1882     surface = qemu_create_displaysurface(width, height);
1883     dpy_gfx_replace_surface(s, surface);
1884 }
1885 
1886 void qemu_console_copy(QemuConsole *con, int src_x, int src_y,
1887                        int dst_x, int dst_y, int w, int h)
1888 {
1889     assert(con->console_type == GRAPHIC_CONSOLE);
1890     dpy_gfx_copy(con, src_x, src_y, dst_x, dst_y, w, h);
1891 }
1892 
1893 DisplaySurface *qemu_console_surface(QemuConsole *console)
1894 {
1895     return console->surface;
1896 }
1897 
1898 DisplayState *qemu_console_displaystate(QemuConsole *console)
1899 {
1900     return console->ds;
1901 }
1902 
1903 PixelFormat qemu_different_endianness_pixelformat(int bpp)
1904 {
1905     PixelFormat pf;
1906 
1907     memset(&pf, 0x00, sizeof(PixelFormat));
1908 
1909     pf.bits_per_pixel = bpp;
1910     pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1911     pf.depth = bpp == 32 ? 24 : bpp;
1912 
1913     switch (bpp) {
1914         case 24:
1915             pf.rmask = 0x000000FF;
1916             pf.gmask = 0x0000FF00;
1917             pf.bmask = 0x00FF0000;
1918             pf.rmax = 255;
1919             pf.gmax = 255;
1920             pf.bmax = 255;
1921             pf.rshift = 0;
1922             pf.gshift = 8;
1923             pf.bshift = 16;
1924             pf.rbits = 8;
1925             pf.gbits = 8;
1926             pf.bbits = 8;
1927             break;
1928         case 32:
1929             pf.rmask = 0x0000FF00;
1930             pf.gmask = 0x00FF0000;
1931             pf.bmask = 0xFF000000;
1932             pf.amask = 0x00000000;
1933             pf.amax = 255;
1934             pf.rmax = 255;
1935             pf.gmax = 255;
1936             pf.bmax = 255;
1937             pf.ashift = 0;
1938             pf.rshift = 8;
1939             pf.gshift = 16;
1940             pf.bshift = 24;
1941             pf.rbits = 8;
1942             pf.gbits = 8;
1943             pf.bbits = 8;
1944             pf.abits = 8;
1945             break;
1946         default:
1947             break;
1948     }
1949     return pf;
1950 }
1951 
1952 PixelFormat qemu_default_pixelformat(int bpp)
1953 {
1954     PixelFormat pf;
1955 
1956     memset(&pf, 0x00, sizeof(PixelFormat));
1957 
1958     pf.bits_per_pixel = bpp;
1959     pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1960     pf.depth = bpp == 32 ? 24 : bpp;
1961 
1962     switch (bpp) {
1963         case 15:
1964             pf.bits_per_pixel = 16;
1965             pf.rmask = 0x00007c00;
1966             pf.gmask = 0x000003E0;
1967             pf.bmask = 0x0000001F;
1968             pf.rmax = 31;
1969             pf.gmax = 31;
1970             pf.bmax = 31;
1971             pf.rshift = 10;
1972             pf.gshift = 5;
1973             pf.bshift = 0;
1974             pf.rbits = 5;
1975             pf.gbits = 5;
1976             pf.bbits = 5;
1977             break;
1978         case 16:
1979             pf.rmask = 0x0000F800;
1980             pf.gmask = 0x000007E0;
1981             pf.bmask = 0x0000001F;
1982             pf.rmax = 31;
1983             pf.gmax = 63;
1984             pf.bmax = 31;
1985             pf.rshift = 11;
1986             pf.gshift = 5;
1987             pf.bshift = 0;
1988             pf.rbits = 5;
1989             pf.gbits = 6;
1990             pf.bbits = 5;
1991             break;
1992         case 24:
1993             pf.rmask = 0x00FF0000;
1994             pf.gmask = 0x0000FF00;
1995             pf.bmask = 0x000000FF;
1996             pf.rmax = 255;
1997             pf.gmax = 255;
1998             pf.bmax = 255;
1999             pf.rshift = 16;
2000             pf.gshift = 8;
2001             pf.bshift = 0;
2002             pf.rbits = 8;
2003             pf.gbits = 8;
2004             pf.bbits = 8;
2005             break;
2006         case 32:
2007             pf.rmask = 0x00FF0000;
2008             pf.gmask = 0x0000FF00;
2009             pf.bmask = 0x000000FF;
2010             pf.rmax = 255;
2011             pf.gmax = 255;
2012             pf.bmax = 255;
2013             pf.rshift = 16;
2014             pf.gshift = 8;
2015             pf.bshift = 0;
2016             pf.rbits = 8;
2017             pf.gbits = 8;
2018             pf.bbits = 8;
2019             break;
2020         default:
2021             break;
2022     }
2023     return pf;
2024 }
2025 
2026 static void qemu_chr_parse_vc(QemuOpts *opts, ChardevBackend *backend,
2027                               Error **errp)
2028 {
2029     int val;
2030 
2031     backend->vc = g_new0(ChardevVC, 1);
2032 
2033     val = qemu_opt_get_number(opts, "width", 0);
2034     if (val != 0) {
2035         backend->vc->has_width = true;
2036         backend->vc->width = val;
2037     }
2038 
2039     val = qemu_opt_get_number(opts, "height", 0);
2040     if (val != 0) {
2041         backend->vc->has_height = true;
2042         backend->vc->height = val;
2043     }
2044 
2045     val = qemu_opt_get_number(opts, "cols", 0);
2046     if (val != 0) {
2047         backend->vc->has_cols = true;
2048         backend->vc->cols = val;
2049     }
2050 
2051     val = qemu_opt_get_number(opts, "rows", 0);
2052     if (val != 0) {
2053         backend->vc->has_rows = true;
2054         backend->vc->rows = val;
2055     }
2056 }
2057 
2058 static const TypeInfo qemu_console_info = {
2059     .name = TYPE_QEMU_CONSOLE,
2060     .parent = TYPE_OBJECT,
2061     .instance_size = sizeof(QemuConsole),
2062     .class_size = sizeof(QemuConsoleClass),
2063 };
2064 
2065 
2066 static void register_types(void)
2067 {
2068     type_register_static(&qemu_console_info);
2069     register_char_driver_qapi("vc", CHARDEV_BACKEND_KIND_VC,
2070                               qemu_chr_parse_vc);
2071 }
2072 
2073 type_init(register_types);
2074