console.c 46.9 KB
Newer Older
B
bellard 已提交
1 2
/*
 * QEMU graphical console
3
 *
B
bellard 已提交
4
 * Copyright (c) 2004 Fabrice Bellard
5
 *
B
bellard 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
P
pbrook 已提交
24
#include "qemu-common.h"
25
#include "ui/console.h"
26
#include "qemu/timer.h"
L
Luiz Capitulino 已提交
27
#include "qmp-commands.h"
28
#include "sysemu/char.h"
B
bellard 已提交
29

30
//#define DEBUG_CONSOLE
B
bellard 已提交
31 32
#define DEFAULT_BACKSCROLL 512
#define MAX_CONSOLES 12
33
#define CONSOLE_CURSOR_PERIOD 500
B
bellard 已提交
34

B
bellard 已提交
35 36
#define QEMU_RGBA(r, g, b, a) (((a) << 24) | ((r) << 16) | ((g) << 8) | (b))
#define QEMU_RGB(r, g, b) QEMU_RGBA(r, g, b, 0xff)
B
bellard 已提交
37

38 39 40 41 42 43 44 45 46 47
typedef struct TextAttributes {
    uint8_t fgcol:4;
    uint8_t bgcol:4;
    uint8_t bold:1;
    uint8_t uline:1;
    uint8_t blink:1;
    uint8_t invers:1;
    uint8_t unvisible:1;
} TextAttributes;

B
bellard 已提交
48 49
typedef struct TextCell {
    uint8_t ch;
50
    TextAttributes t_attrib;
B
bellard 已提交
51 52 53 54 55 56 57 58 59 60
} TextCell;

#define MAX_ESC_PARAMS 3

enum TTYState {
    TTY_STATE_NORM,
    TTY_STATE_ESC,
    TTY_STATE_CSI,
};

61 62 63 64 65 66
typedef struct QEMUFIFO {
    uint8_t *buf;
    int buf_size;
    int count, wptr, rptr;
} QEMUFIFO;

67
static int qemu_fifo_write(QEMUFIFO *f, const uint8_t *buf, int len1)
68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89
{
    int l, len;

    l = f->buf_size - f->count;
    if (len1 > l)
        len1 = l;
    len = len1;
    while (len > 0) {
        l = f->buf_size - f->wptr;
        if (l > len)
            l = len;
        memcpy(f->buf + f->wptr, buf, l);
        f->wptr += l;
        if (f->wptr >= f->buf_size)
            f->wptr = 0;
        buf += l;
        len -= l;
    }
    f->count += len1;
    return len1;
}

90
static int qemu_fifo_read(QEMUFIFO *f, uint8_t *buf, int len1)
91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111
{
    int l, len;

    if (len1 > f->count)
        len1 = f->count;
    len = len1;
    while (len > 0) {
        l = f->buf_size - f->rptr;
        if (l > len)
            l = len;
        memcpy(buf, f->buf + f->rptr, l);
        f->rptr += l;
        if (f->rptr >= f->buf_size)
            f->rptr = 0;
        buf += l;
        len -= l;
    }
    f->count -= len1;
    return len1;
}

112 113
typedef enum {
    GRAPHIC_CONSOLE,
114 115
    TEXT_CONSOLE,
    TEXT_CONSOLE_FIXED_SIZE
A
Anthony Liguori 已提交
116
} console_type_t;
117

118
struct QemuConsole {
119
    int index;
A
Anthony Liguori 已提交
120
    console_type_t console_type;
B
bellard 已提交
121
    DisplayState *ds;
122

P
pbrook 已提交
123 124 125 126
    /* Graphic console state.  */
    vga_hw_update_ptr hw_update;
    vga_hw_invalidate_ptr hw_invalidate;
    vga_hw_screen_dump_ptr hw_screen_dump;
B
balrog 已提交
127
    vga_hw_text_update_ptr hw_text_update;
P
pbrook 已提交
128
    void *hw;
B
bellard 已提交
129
    int g_width, g_height;
130 131

    /* Text console state */
B
bellard 已提交
132 133 134 135 136
    int width;
    int height;
    int total_height;
    int backscroll_height;
    int x, y;
137
    int x_saved, y_saved;
B
bellard 已提交
138 139
    int y_displayed;
    int y_base;
140 141
    TextAttributes t_attrib_default; /* default text attributes */
    TextAttributes t_attrib; /* currently active text attributes */
B
bellard 已提交
142
    TextCell *cells;
B
balrog 已提交
143
    int text_x[2], text_y[2], cursor_invalidate;
144
    int echo;
145 146
    bool cursor_visible_phase;
    QEMUTimer *cursor_timer;
B
bellard 已提交
147

148 149 150 151 152
    int update_x0;
    int update_y0;
    int update_x1;
    int update_y1;

B
bellard 已提交
153 154 155 156
    enum TTYState state;
    int esc_params[MAX_ESC_PARAMS];
    int nb_esc_params;

157
    CharDriverState *chr;
158 159 160 161
    /* fifo for key pressed */
    QEMUFIFO out_fifo;
    uint8_t out_fifo_buf[16];
    QEMUTimer *kbd_timer;
B
bellard 已提交
162 163
};

164
static DisplayState *display_state;
165 166
static QemuConsole *active_console;
static QemuConsole *consoles[MAX_CONSOLES];
B
bellard 已提交
167 168
static int nb_consoles = 0;

P
pbrook 已提交
169 170
void vga_hw_update(void)
{
171
    if (active_console && active_console->hw_update)
P
pbrook 已提交
172 173 174 175 176
        active_console->hw_update(active_console->hw);
}

void vga_hw_invalidate(void)
{
177
    if (active_console && active_console->hw_invalidate)
P
pbrook 已提交
178 179 180
        active_console->hw_invalidate(active_console->hw);
}

L
Luiz Capitulino 已提交
181
void qmp_screendump(const char *filename, Error **errp)
P
pbrook 已提交
182
{
183
    QemuConsole *previous_active_console;
184
    bool cswitch;
185 186

    previous_active_console = active_console;
187
    cswitch = previous_active_console && previous_active_console->index != 0;
188

189
    /* There is currently no way of specifying which screen we want to dump,
A
aurel32 已提交
190
       so always dump the first one.  */
191 192 193
    if (cswitch) {
        console_select(0);
    }
194
    if (consoles[0] && consoles[0]->hw_screen_dump) {
L
Luiz Capitulino 已提交
195
        consoles[0]->hw_screen_dump(consoles[0]->hw, filename, cswitch, errp);
196
    } else {
197
        error_setg(errp, "device doesn't support screendump");
198 199
    }

200
    if (cswitch) {
201 202
        console_select(previous_active_console->index);
    }
P
pbrook 已提交
203 204
}

A
Anthony Liguori 已提交
205
void vga_hw_text_update(console_ch_t *chardata)
B
balrog 已提交
206 207 208 209 210
{
    if (active_console && active_console->hw_text_update)
        active_console->hw_text_update(active_console->hw, chardata);
}

211 212 213
static void vga_fill_rect(QemuConsole *con,
                          int posx, int posy, int width, int height,
                          uint32_t color)
B
bellard 已提交
214
{
215
    DisplaySurface *surface = qemu_console_surface(con);
216 217 218 219 220 221 222 223
    pixman_rectangle16_t rect = {
        .x = posx, .y = posy, .width = width, .height = height
    };
    pixman_color_t pcolor;

    pcolor = qemu_pixman_color(&surface->pf, color);
    pixman_image_fill_rectangles(PIXMAN_OP_SRC, surface->image,
                                 &pcolor, 1, &rect);
B
bellard 已提交
224 225 226
}

/* copy from (xs, ys) to (xd, yd) a rectangle of size (w, h) */
227 228
static void vga_bitblt(QemuConsole *con,
                       int xs, int ys, int xd, int yd, int w, int h)
B
bellard 已提交
229
{
230
    DisplaySurface *surface = qemu_console_surface(con);
231 232 233 234

    pixman_image_composite(PIXMAN_OP_SRC,
                           surface->image, NULL, surface->image,
                           xs, ys, 0, 0, xd, yd, w, h);
B
bellard 已提交
235 236 237 238 239 240 241 242 243 244
}

/***********************************************************/
/* basic char display */

#define FONT_HEIGHT 16
#define FONT_WIDTH 8

#include "vgafont.h"

245
#ifndef CONFIG_CURSES
246 247 248 249 250 251 252 253 254 255
enum color_names {
    COLOR_BLACK   = 0,
    COLOR_RED     = 1,
    COLOR_GREEN   = 2,
    COLOR_YELLOW  = 3,
    COLOR_BLUE    = 4,
    COLOR_MAGENTA = 5,
    COLOR_CYAN    = 6,
    COLOR_WHITE   = 7
};
256
#endif
257 258 259

static const uint32_t color_table_rgb[2][8] = {
    {   /* dark */
B
bellard 已提交
260 261 262 263 264 265 266 267
        QEMU_RGB(0x00, 0x00, 0x00),  /* black */
        QEMU_RGB(0xaa, 0x00, 0x00),  /* red */
        QEMU_RGB(0x00, 0xaa, 0x00),  /* green */
        QEMU_RGB(0xaa, 0xaa, 0x00),  /* yellow */
        QEMU_RGB(0x00, 0x00, 0xaa),  /* blue */
        QEMU_RGB(0xaa, 0x00, 0xaa),  /* magenta */
        QEMU_RGB(0x00, 0xaa, 0xaa),  /* cyan */
        QEMU_RGB(0xaa, 0xaa, 0xaa),  /* white */
268 269
    },
    {   /* bright */
B
bellard 已提交
270 271 272 273 274 275 276 277
        QEMU_RGB(0x00, 0x00, 0x00),  /* black */
        QEMU_RGB(0xff, 0x00, 0x00),  /* red */
        QEMU_RGB(0x00, 0xff, 0x00),  /* green */
        QEMU_RGB(0xff, 0xff, 0x00),  /* yellow */
        QEMU_RGB(0x00, 0x00, 0xff),  /* blue */
        QEMU_RGB(0xff, 0x00, 0xff),  /* magenta */
        QEMU_RGB(0x00, 0xff, 0xff),  /* cyan */
        QEMU_RGB(0xff, 0xff, 0xff),  /* white */
278
    }
B
bellard 已提交
279 280
};

281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312
#ifdef DEBUG_CONSOLE
static void console_print_text_attributes(TextAttributes *t_attrib, char ch)
{
    if (t_attrib->bold) {
        printf("b");
    } else {
        printf(" ");
    }
    if (t_attrib->uline) {
        printf("u");
    } else {
        printf(" ");
    }
    if (t_attrib->blink) {
        printf("l");
    } else {
        printf(" ");
    }
    if (t_attrib->invers) {
        printf("i");
    } else {
        printf(" ");
    }
    if (t_attrib->unvisible) {
        printf("n");
    } else {
        printf(" ");
    }

    printf(" fg: %d bg: %d ch:'%2X' '%c'\n", t_attrib->fgcol, t_attrib->bgcol, ch, ch);
}
#endif
B
bellard 已提交
313

314
static void vga_putcharxy(QemuConsole *s, int x, int y, int ch,
315
                          TextAttributes *t_attrib)
B
bellard 已提交
316
{
317
    static pixman_image_t *glyphs[256];
318
    DisplaySurface *surface = qemu_console_surface(s);
319
    unsigned int fgcol, bgcol;
320 321
    pixman_image_t *ifg, *ibg;
    pixman_color_t cfg, cbg;
322 323

    if (t_attrib->invers) {
G
Gerd Hoffmann 已提交
324 325
        bgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
        fgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
326
    } else {
G
Gerd Hoffmann 已提交
327 328
        fgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
        bgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
329
    }
330 331 332 333
    cfg = qemu_pixman_color(&surface->pf, fgcol);
    cbg = qemu_pixman_color(&surface->pf, bgcol);
    ifg = pixman_image_create_solid_fill(&cfg);
    ibg = pixman_image_create_solid_fill(&cbg);
B
bellard 已提交
334

335 336
    if (!glyphs[ch]) {
        glyphs[ch] = qemu_pixman_glyph_from_vgafont(FONT_HEIGHT, vgafont16, ch);
B
bellard 已提交
337
    }
338 339
    qemu_pixman_glyph_render(glyphs[ch], surface->image,
                             &cfg, &cbg, x, y, FONT_WIDTH, FONT_HEIGHT);
B
bellard 已提交
340 341
}

342
static void text_console_resize(QemuConsole *s)
B
bellard 已提交
343 344 345 346 347 348 349 350 351 352 353 354
{
    TextCell *cells, *c, *c1;
    int w1, x, y, last_width;

    last_width = s->width;
    s->width = s->g_width / FONT_WIDTH;
    s->height = s->g_height / FONT_HEIGHT;

    w1 = last_width;
    if (s->width < w1)
        w1 = s->width;

355
    cells = g_malloc(s->width * s->total_height * sizeof(TextCell));
B
bellard 已提交
356 357 358 359 360 361 362 363 364 365
    for(y = 0; y < s->total_height; y++) {
        c = &cells[y * s->width];
        if (w1 > 0) {
            c1 = &s->cells[y * last_width];
            for(x = 0; x < w1; x++) {
                *c++ = *c1++;
            }
        }
        for(x = w1; x < s->width; x++) {
            c->ch = ' ';
366
            c->t_attrib = s->t_attrib_default;
B
bellard 已提交
367 368 369
            c++;
        }
    }
370
    g_free(s->cells);
B
bellard 已提交
371 372 373
    s->cells = cells;
}

374
static inline void text_update_xy(QemuConsole *s, int x, int y)
B
balrog 已提交
375 376 377 378 379 380 381
{
    s->text_x[0] = MIN(s->text_x[0], x);
    s->text_x[1] = MAX(s->text_x[1], x);
    s->text_y[0] = MIN(s->text_y[0], y);
    s->text_y[1] = MAX(s->text_y[1], y);
}

382
static void invalidate_xy(QemuConsole *s, int x, int y)
383 384 385 386 387 388 389 390 391 392 393
{
    if (s->update_x0 > x * FONT_WIDTH)
        s->update_x0 = x * FONT_WIDTH;
    if (s->update_y0 > y * FONT_HEIGHT)
        s->update_y0 = y * FONT_HEIGHT;
    if (s->update_x1 < (x + 1) * FONT_WIDTH)
        s->update_x1 = (x + 1) * FONT_WIDTH;
    if (s->update_y1 < (y + 1) * FONT_HEIGHT)
        s->update_y1 = (y + 1) * FONT_HEIGHT;
}

394
static void update_xy(QemuConsole *s, int x, int y)
B
bellard 已提交
395 396 397 398
{
    TextCell *c;
    int y1, y2;

399 400 401 402 403 404 405
    if (s != active_console) {
        return;
    }

    if (s->ds->have_text) {
        text_update_xy(s, x, y);
    }
B
balrog 已提交
406

407
    if (s->ds->have_gfx) {
B
bellard 已提交
408 409 410 411 412 413
        y1 = (s->y_base + y) % s->total_height;
        y2 = y1 - s->y_displayed;
        if (y2 < 0)
            y2 += s->total_height;
        if (y2 < s->height) {
            c = &s->cells[y1 * s->width + x];
414
            vga_putcharxy(s, x, y2, c->ch,
415
                          &(c->t_attrib));
416
            invalidate_xy(s, x, y2);
B
bellard 已提交
417 418 419 420
        }
    }
}

421
static void console_show_cursor(QemuConsole *s, int show)
B
bellard 已提交
422 423 424
{
    TextCell *c;
    int y, y1;
425
    int x = s->x;
B
bellard 已提交
426

427 428 429
    if (s != active_console) {
        return;
    }
B
balrog 已提交
430

431 432 433
    if (s->ds->have_text) {
        s->cursor_invalidate = 1;
    }
B
balrog 已提交
434

435
    if (s->ds->have_gfx) {
436 437 438
        if (x >= s->width) {
            x = s->width - 1;
        }
B
bellard 已提交
439 440 441 442 443
        y1 = (s->y_base + s->y) % s->total_height;
        y = y1 - s->y_displayed;
        if (y < 0)
            y += s->total_height;
        if (y < s->height) {
444
            c = &s->cells[y1 * s->width + x];
445
            if (show && s->cursor_visible_phase) {
446 447
                TextAttributes t_attrib = s->t_attrib_default;
                t_attrib.invers = !(t_attrib.invers); /* invert fg and bg */
448
                vga_putcharxy(s, x, y, c->ch, &t_attrib);
B
bellard 已提交
449
            } else {
450
                vga_putcharxy(s, x, y, c->ch, &(c->t_attrib));
B
bellard 已提交
451
            }
452
            invalidate_xy(s, x, y);
B
bellard 已提交
453 454 455 456
        }
    }
}

457
static void console_refresh(QemuConsole *s)
B
bellard 已提交
458
{
459
    DisplaySurface *surface = qemu_console_surface(s);
B
bellard 已提交
460 461 462
    TextCell *c;
    int x, y, y1;

463
    if (s != active_console)
B
bellard 已提交
464
        return;
465 466

    if (s->ds->have_text) {
B
balrog 已提交
467 468 469 470 471 472
        s->text_x[0] = 0;
        s->text_y[0] = 0;
        s->text_x[1] = s->width - 1;
        s->text_y[1] = s->height - 1;
        s->cursor_invalidate = 1;
    }
B
bellard 已提交
473

474
    if (s->ds->have_gfx) {
475
        vga_fill_rect(s, 0, 0, surface_width(surface), surface_height(surface),
G
Gerd Hoffmann 已提交
476
                      color_table_rgb[0][COLOR_BLACK]);
477 478 479 480
        y1 = s->y_displayed;
        for (y = 0; y < s->height; y++) {
            c = s->cells + y1 * s->width;
            for (x = 0; x < s->width; x++) {
481
                vga_putcharxy(s, x, y, c->ch,
482 483 484 485 486 487
                              &(c->t_attrib));
                c++;
            }
            if (++y1 == s->total_height) {
                y1 = 0;
            }
B
bellard 已提交
488
        }
489
        console_show_cursor(s, 1);
490 491
        dpy_gfx_update(s, 0, 0,
                       surface_width(surface), surface_height(surface));
B
bellard 已提交
492 493 494 495 496
    }
}

static void console_scroll(int ydelta)
{
497
    QemuConsole *s;
B
bellard 已提交
498
    int i, y1;
499

B
bellard 已提交
500
    s = active_console;
501
    if (!s || (s->console_type == GRAPHIC_CONSOLE))
B
bellard 已提交
502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528
        return;

    if (ydelta > 0) {
        for(i = 0; i < ydelta; i++) {
            if (s->y_displayed == s->y_base)
                break;
            if (++s->y_displayed == s->total_height)
                s->y_displayed = 0;
        }
    } else {
        ydelta = -ydelta;
        i = s->backscroll_height;
        if (i > s->total_height - s->height)
            i = s->total_height - s->height;
        y1 = s->y_base - i;
        if (y1 < 0)
            y1 += s->total_height;
        for(i = 0; i < ydelta; i++) {
            if (s->y_displayed == y1)
                break;
            if (--s->y_displayed < 0)
                s->y_displayed = s->total_height - 1;
        }
    }
    console_refresh(s);
}

529
static void console_put_lf(QemuConsole *s)
B
bellard 已提交
530 531 532 533 534 535 536
{
    TextCell *c;
    int x, y1;

    s->y++;
    if (s->y >= s->height) {
        s->y = s->height - 1;
537

B
bellard 已提交
538 539 540 541 542 543 544 545 546 547 548 549
        if (s->y_displayed == s->y_base) {
            if (++s->y_displayed == s->total_height)
                s->y_displayed = 0;
        }
        if (++s->y_base == s->total_height)
            s->y_base = 0;
        if (s->backscroll_height < s->total_height)
            s->backscroll_height++;
        y1 = (s->y_base + s->height - 1) % s->total_height;
        c = &s->cells[y1 * s->width];
        for(x = 0; x < s->width; x++) {
            c->ch = ' ';
550
            c->t_attrib = s->t_attrib_default;
B
bellard 已提交
551 552 553
            c++;
        }
        if (s == active_console && s->y_displayed == s->y_base) {
554
            if (s->ds->have_text) {
B
balrog 已提交
555 556 557 558 559 560
                s->text_x[0] = 0;
                s->text_y[0] = 0;
                s->text_x[1] = s->width - 1;
                s->text_y[1] = s->height - 1;
            }

561 562 563 564 565 566 567 568 569 570 571 572
            if (s->ds->have_gfx) {
                vga_bitblt(s, 0, FONT_HEIGHT, 0, 0,
                           s->width * FONT_WIDTH,
                           (s->height - 1) * FONT_HEIGHT);
                vga_fill_rect(s, 0, (s->height - 1) * FONT_HEIGHT,
                              s->width * FONT_WIDTH, FONT_HEIGHT,
                              color_table_rgb[0][s->t_attrib_default.bgcol]);
                s->update_x0 = 0;
                s->update_y0 = 0;
                s->update_x1 = s->width * FONT_WIDTH;
                s->update_y1 = s->height * FONT_HEIGHT;
            }
B
bellard 已提交
573 574 575 576
        }
    }
}

577 578 579 580
/* Set console attributes depending on the current escape codes.
 * NOTE: I know this code is not very efficient (checking every color for it
 * self) but it is more readable and better maintainable.
 */
581
static void console_handle_escape(QemuConsole *s)
582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673
{
    int i;

    for (i=0; i<s->nb_esc_params; i++) {
        switch (s->esc_params[i]) {
            case 0: /* reset all console attributes to default */
                s->t_attrib = s->t_attrib_default;
                break;
            case 1:
                s->t_attrib.bold = 1;
                break;
            case 4:
                s->t_attrib.uline = 1;
                break;
            case 5:
                s->t_attrib.blink = 1;
                break;
            case 7:
                s->t_attrib.invers = 1;
                break;
            case 8:
                s->t_attrib.unvisible = 1;
                break;
            case 22:
                s->t_attrib.bold = 0;
                break;
            case 24:
                s->t_attrib.uline = 0;
                break;
            case 25:
                s->t_attrib.blink = 0;
                break;
            case 27:
                s->t_attrib.invers = 0;
                break;
            case 28:
                s->t_attrib.unvisible = 0;
                break;
            /* set foreground color */
            case 30:
                s->t_attrib.fgcol=COLOR_BLACK;
                break;
            case 31:
                s->t_attrib.fgcol=COLOR_RED;
                break;
            case 32:
                s->t_attrib.fgcol=COLOR_GREEN;
                break;
            case 33:
                s->t_attrib.fgcol=COLOR_YELLOW;
                break;
            case 34:
                s->t_attrib.fgcol=COLOR_BLUE;
                break;
            case 35:
                s->t_attrib.fgcol=COLOR_MAGENTA;
                break;
            case 36:
                s->t_attrib.fgcol=COLOR_CYAN;
                break;
            case 37:
                s->t_attrib.fgcol=COLOR_WHITE;
                break;
            /* set background color */
            case 40:
                s->t_attrib.bgcol=COLOR_BLACK;
                break;
            case 41:
                s->t_attrib.bgcol=COLOR_RED;
                break;
            case 42:
                s->t_attrib.bgcol=COLOR_GREEN;
                break;
            case 43:
                s->t_attrib.bgcol=COLOR_YELLOW;
                break;
            case 44:
                s->t_attrib.bgcol=COLOR_BLUE;
                break;
            case 45:
                s->t_attrib.bgcol=COLOR_MAGENTA;
                break;
            case 46:
                s->t_attrib.bgcol=COLOR_CYAN;
                break;
            case 47:
                s->t_attrib.bgcol=COLOR_WHITE;
                break;
        }
    }
}

674
static void console_clear_xy(QemuConsole *s, int x, int y)
675 676 677 678 679 680 681 682
{
    int y1 = (s->y_base + y) % s->total_height;
    TextCell *c = &s->cells[y1 * s->width + x];
    c->ch = ' ';
    c->t_attrib = s->t_attrib_default;
    update_xy(s, x, y);
}

683
/* set cursor, checking bounds */
684
static void set_cursor(QemuConsole *s, int x, int y)
685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702
{
    if (x < 0) {
        x = 0;
    }
    if (y < 0) {
        y = 0;
    }
    if (y >= s->height) {
        y = s->height - 1;
    }
    if (x >= s->width) {
        x = s->width - 1;
    }

    s->x = x;
    s->y = y;
}

703
static void console_putchar(QemuConsole *s, int ch)
B
bellard 已提交
704 705
{
    TextCell *c;
706 707
    int y1, i;
    int x, y;
B
bellard 已提交
708 709 710 711

    switch(s->state) {
    case TTY_STATE_NORM:
        switch(ch) {
712
        case '\r':  /* carriage return */
B
bellard 已提交
713 714
            s->x = 0;
            break;
715
        case '\n':  /* newline */
B
bellard 已提交
716 717
            console_put_lf(s);
            break;
718
        case '\b':  /* backspace */
719
            if (s->x > 0)
720
                s->x--;
721 722 723
            break;
        case '\t':  /* tabspace */
            if (s->x + (8 - (s->x % 8)) > s->width) {
B
bellard 已提交
724
                s->x = 0;
725 726 727 728 729 730 731 732
                console_put_lf(s);
            } else {
                s->x = s->x + (8 - (s->x % 8));
            }
            break;
        case '\a':  /* alert aka. bell */
            /* TODO: has to be implemented */
            break;
733 734 735 736 737 738
        case 14:
            /* SI (shift in), character set 0 (ignored) */
            break;
        case 15:
            /* SO (shift out), character set 1 (ignored) */
            break;
739
        case 27:    /* esc (introducing an escape sequence) */
B
bellard 已提交
740 741 742
            s->state = TTY_STATE_ESC;
            break;
        default:
743 744 745 746
            if (s->x >= s->width) {
                /* line wrap */
                s->x = 0;
                console_put_lf(s);
747
            }
B
bellard 已提交
748 749 750
            y1 = (s->y_base + s->y) % s->total_height;
            c = &s->cells[y1 * s->width + s->x];
            c->ch = ch;
751
            c->t_attrib = s->t_attrib;
B
bellard 已提交
752 753 754 755 756
            update_xy(s, s->x, s->y);
            s->x++;
            break;
        }
        break;
757
    case TTY_STATE_ESC: /* check if it is a terminal escape sequence */
B
bellard 已提交
758 759 760 761 762 763 764 765 766
        if (ch == '[') {
            for(i=0;i<MAX_ESC_PARAMS;i++)
                s->esc_params[i] = 0;
            s->nb_esc_params = 0;
            s->state = TTY_STATE_CSI;
        } else {
            s->state = TTY_STATE_NORM;
        }
        break;
767
    case TTY_STATE_CSI: /* handle escape sequence parameters */
B
bellard 已提交
768 769
        if (ch >= '0' && ch <= '9') {
            if (s->nb_esc_params < MAX_ESC_PARAMS) {
770 771 772 773 774
                int *param = &s->esc_params[s->nb_esc_params];
                int digit = (ch - '0');

                *param = (*param <= (INT_MAX - digit) / 10) ?
                         *param * 10 + digit : INT_MAX;
B
bellard 已提交
775 776
            }
        } else {
777 778
            if (s->nb_esc_params < MAX_ESC_PARAMS)
                s->nb_esc_params++;
B
bellard 已提交
779 780
            if (ch == ';')
                break;
781 782 783 784
#ifdef DEBUG_CONSOLE
            fprintf(stderr, "escape sequence CSI%d;%d%c, %d parameters\n",
                    s->esc_params[0], s->esc_params[1], ch, s->nb_esc_params);
#endif
B
bellard 已提交
785 786
            s->state = TTY_STATE_NORM;
            switch(ch) {
787 788 789 790 791
            case 'A':
                /* move cursor up */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
792
                set_cursor(s, s->x, s->y - s->esc_params[0]);
793 794 795 796 797 798
                break;
            case 'B':
                /* move cursor down */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
799
                set_cursor(s, s->x, s->y + s->esc_params[0]);
B
bellard 已提交
800 801
                break;
            case 'C':
802 803 804 805
                /* move cursor right */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
806
                set_cursor(s, s->x + s->esc_params[0], s->y);
B
bellard 已提交
807
                break;
808 809 810 811 812
            case 'D':
                /* move cursor left */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
813
                set_cursor(s, s->x - s->esc_params[0], s->y);
814 815 816
                break;
            case 'G':
                /* move cursor to column */
817
                set_cursor(s, s->esc_params[0] - 1, s->y);
818 819 820 821
                break;
            case 'f':
            case 'H':
                /* move cursor to row, column */
822
                set_cursor(s, s->esc_params[1] - 1, s->esc_params[0] - 1);
823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854
                break;
            case 'J':
                switch (s->esc_params[0]) {
                case 0:
                    /* clear to end of screen */
                    for (y = s->y; y < s->height; y++) {
                        for (x = 0; x < s->width; x++) {
                            if (y == s->y && x < s->x) {
                                continue;
                            }
                            console_clear_xy(s, x, y);
                        }
                    }
                    break;
                case 1:
                    /* clear from beginning of screen */
                    for (y = 0; y <= s->y; y++) {
                        for (x = 0; x < s->width; x++) {
                            if (y == s->y && x > s->x) {
                                break;
                            }
                            console_clear_xy(s, x, y);
                        }
                    }
                    break;
                case 2:
                    /* clear entire screen */
                    for (y = 0; y <= s->height; y++) {
                        for (x = 0; x < s->width; x++) {
                            console_clear_xy(s, x, y);
                        }
                    }
855
                    break;
856
                }
857
                break;
B
bellard 已提交
858
            case 'K':
859 860
                switch (s->esc_params[0]) {
                case 0:
861 862
                    /* clear to eol */
                    for(x = s->x; x < s->width; x++) {
863
                        console_clear_xy(s, x, s->y);
864 865
                    }
                    break;
866 867 868 869 870 871 872 873 874 875 876
                case 1:
                    /* clear from beginning of line */
                    for (x = 0; x <= s->x; x++) {
                        console_clear_xy(s, x, s->y);
                    }
                    break;
                case 2:
                    /* clear entire line */
                    for(x = 0; x < s->width; x++) {
                        console_clear_xy(s, x, s->y);
                    }
877 878
                    break;
                }
879 880
                break;
            case 'm':
881 882
                console_handle_escape(s);
                break;
883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903
            case 'n':
                /* report cursor position */
                /* TODO: send ESC[row;colR */
                break;
            case 's':
                /* save cursor position */
                s->x_saved = s->x;
                s->y_saved = s->y;
                break;
            case 'u':
                /* restore cursor position */
                s->x = s->x_saved;
                s->y = s->y_saved;
                break;
            default:
#ifdef DEBUG_CONSOLE
                fprintf(stderr, "unhandled escape character '%c'\n", ch);
#endif
                break;
            }
            break;
B
bellard 已提交
904 905 906 907 908 909
        }
    }
}

void console_select(unsigned int index)
{
910
    DisplaySurface *surface;
911
    QemuConsole *s;
912

B
bellard 已提交
913 914
    if (index >= MAX_CONSOLES)
        return;
915
    if (active_console) {
916 917 918
        surface = qemu_console_surface(active_console);
        active_console->g_width = surface_width(surface);
        active_console->g_height = surface_height(surface);
919
    }
B
bellard 已提交
920 921
    s = consoles[index];
    if (s) {
922
        DisplayState *ds = s->ds;
923

924
        if (active_console && active_console->cursor_timer) {
925 926
            qemu_del_timer(active_console->cursor_timer);
        }
B
bellard 已提交
927
        active_console = s;
928
        if (ds->have_gfx) {
929
            surface = qemu_create_displaysurface(s->g_width, s->g_height);
930
            dpy_gfx_replace_surface(s, surface);
931 932
        }
        if (ds->have_text) {
933
            dpy_text_resize(s, s->width, s->height);
934
        }
935 936 937 938
        if (s->cursor_timer) {
            qemu_mod_timer(s->cursor_timer,
                   qemu_get_clock_ms(rt_clock) + CONSOLE_CURSOR_PERIOD / 2);
        }
B
balrog 已提交
939
        vga_hw_invalidate();
B
bellard 已提交
940 941 942 943 944
    }
}

static int console_puts(CharDriverState *chr, const uint8_t *buf, int len)
{
945
    QemuConsole *s = chr->opaque;
B
bellard 已提交
946 947
    int i;

948 949 950 951
    s->update_x0 = s->width * FONT_WIDTH;
    s->update_y0 = s->height * FONT_HEIGHT;
    s->update_x1 = 0;
    s->update_y1 = 0;
B
bellard 已提交
952 953 954 955 956
    console_show_cursor(s, 0);
    for(i = 0; i < len; i++) {
        console_putchar(s, buf[i]);
    }
    console_show_cursor(s, 1);
957
    if (s->ds->have_gfx && s->update_x0 < s->update_x1) {
958
        dpy_gfx_update(s, s->update_x0, s->update_y0,
959 960
                       s->update_x1 - s->update_x0,
                       s->update_y1 - s->update_y0);
961
    }
B
bellard 已提交
962 963 964
    return len;
}

965 966
static void kbd_send_chars(void *opaque)
{
967
    QemuConsole *s = opaque;
968 969
    int len;
    uint8_t buf[16];
970

971
    len = qemu_chr_be_can_write(s->chr);
972 973 974 975 976 977
    if (len > s->out_fifo.count)
        len = s->out_fifo.count;
    if (len > 0) {
        if (len > sizeof(buf))
            len = sizeof(buf);
        qemu_fifo_read(&s->out_fifo, buf, len);
978
        qemu_chr_be_write(s->chr, buf, len);
979 980 981 982
    }
    /* characters are pending: we send them a bit later (XXX:
       horrible, should change char device API) */
    if (s->out_fifo.count > 0) {
983
        qemu_mod_timer(s->kbd_timer, qemu_get_clock_ms(rt_clock) + 1);
984 985 986
    }
}

B
bellard 已提交
987 988 989
/* called when an ascii key is pressed */
void kbd_put_keysym(int keysym)
{
990
    QemuConsole *s;
B
bellard 已提交
991 992 993 994
    uint8_t buf[16], *q;
    int c;

    s = active_console;
995
    if (!s || (s->console_type == GRAPHIC_CONSOLE))
B
bellard 已提交
996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011
        return;

    switch(keysym) {
    case QEMU_KEY_CTRL_UP:
        console_scroll(-1);
        break;
    case QEMU_KEY_CTRL_DOWN:
        console_scroll(1);
        break;
    case QEMU_KEY_CTRL_PAGEUP:
        console_scroll(-10);
        break;
    case QEMU_KEY_CTRL_PAGEDOWN:
        console_scroll(10);
        break;
    default:
1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
        /* convert the QEMU keysym to VT100 key string */
        q = buf;
        if (keysym >= 0xe100 && keysym <= 0xe11f) {
            *q++ = '\033';
            *q++ = '[';
            c = keysym - 0xe100;
            if (c >= 10)
                *q++ = '0' + (c / 10);
            *q++ = '0' + (c % 10);
            *q++ = '~';
        } else if (keysym >= 0xe120 && keysym <= 0xe17f) {
            *q++ = '\033';
            *q++ = '[';
            *q++ = keysym & 0xff;
1026 1027 1028
        } else if (s->echo && (keysym == '\r' || keysym == '\n')) {
            console_puts(s->chr, (const uint8_t *) "\r", 1);
            *q++ = '\n';
1029
        } else {
1030 1031 1032 1033
            *q++ = keysym;
        }
        if (s->echo) {
            console_puts(s->chr, buf, q - buf);
1034
        }
1035
        if (s->chr->chr_read) {
1036 1037
            qemu_fifo_write(&s->out_fifo, buf, q - buf);
            kbd_send_chars(s);
B
bellard 已提交
1038 1039 1040 1041 1042
        }
        break;
    }
}

B
balrog 已提交
1043 1044
static void text_console_invalidate(void *opaque)
{
1045
    QemuConsole *s = (QemuConsole *) opaque;
1046 1047 1048 1049 1050
    DisplaySurface *surface = qemu_console_surface(s);

    if (s->ds->have_text && s->console_type == TEXT_CONSOLE) {
        s->g_width = surface_width(surface);
        s->g_height = surface_height(surface);
1051 1052
        text_console_resize(s);
    }
B
balrog 已提交
1053 1054 1055
    console_refresh(s);
}

A
Anthony Liguori 已提交
1056
static void text_console_update(void *opaque, console_ch_t *chardata)
B
balrog 已提交
1057
{
1058
    QemuConsole *s = (QemuConsole *) opaque;
B
balrog 已提交
1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069
    int i, j, src;

    if (s->text_x[0] <= s->text_x[1]) {
        src = (s->y_base + s->text_y[0]) * s->width;
        chardata += s->text_y[0] * s->width;
        for (i = s->text_y[0]; i <= s->text_y[1]; i ++)
            for (j = 0; j < s->width; j ++, src ++)
                console_write_ch(chardata ++, s->cells[src].ch |
                                (s->cells[src].t_attrib.fgcol << 12) |
                                (s->cells[src].t_attrib.bgcol << 8) |
                                (s->cells[src].t_attrib.bold << 21));
1070
        dpy_text_update(s, s->text_x[0], s->text_y[0],
1071
                        s->text_x[1] - s->text_x[0], i - s->text_y[0]);
B
balrog 已提交
1072 1073 1074 1075 1076 1077
        s->text_x[0] = s->width;
        s->text_y[0] = s->height;
        s->text_x[1] = 0;
        s->text_y[1] = 0;
    }
    if (s->cursor_invalidate) {
1078
        dpy_text_cursor(s, s->x, s->y);
B
balrog 已提交
1079 1080 1081 1082
        s->cursor_invalidate = 0;
    }
}

1083
static QemuConsole *new_console(DisplayState *ds, console_type_t console_type)
B
bellard 已提交
1084
{
1085
    QemuConsole *s;
P
pbrook 已提交
1086
    int i;
B
bellard 已提交
1087 1088 1089

    if (nb_consoles >= MAX_CONSOLES)
        return NULL;
1090
    s = g_malloc0(sizeof(QemuConsole));
1091 1092
    if (!active_console || ((active_console->console_type != GRAPHIC_CONSOLE) &&
        (console_type == GRAPHIC_CONSOLE))) {
B
bellard 已提交
1093
        active_console = s;
1094
    }
B
bellard 已提交
1095
    s->ds = ds;
1096 1097
    s->console_type = console_type;
    if (console_type != GRAPHIC_CONSOLE) {
1098
        s->index = nb_consoles;
P
pbrook 已提交
1099 1100 1101 1102
        consoles[nb_consoles++] = s;
    } else {
        /* HACK: Put graphical consoles before text consoles.  */
        for (i = nb_consoles; i > 0; i--) {
1103
            if (consoles[i - 1]->console_type == GRAPHIC_CONSOLE)
P
pbrook 已提交
1104 1105
                break;
            consoles[i] = consoles[i - 1];
1106
            consoles[i]->index = i;
P
pbrook 已提交
1107
        }
1108
        s->index = i;
P
pbrook 已提交
1109
        consoles[i] = s;
1110
        nb_consoles++;
P
pbrook 已提交
1111 1112 1113 1114
    }
    return s;
}

1115 1116
static void qemu_alloc_display(DisplaySurface *surface, int width, int height,
                               int linesize, PixelFormat pf, int newflags)
1117 1118
{
    surface->pf = pf;
1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129

    qemu_pixman_image_unref(surface->image);
    surface->image = NULL;

    surface->format = qemu_pixman_get_format(&pf);
    assert(surface->format != 0);
    surface->image = pixman_image_create_bits(surface->format,
                                              width, height,
                                              NULL, linesize);
    assert(surface->image != NULL);

1130
    surface->flags = newflags | QEMU_ALLOCATED_FLAG;
1131
#ifdef HOST_WORDS_BIGENDIAN
1132
    surface->flags |= QEMU_BIG_ENDIAN_FLAG;
1133 1134 1135
#endif
}

1136
DisplaySurface *qemu_create_displaysurface(int width, int height)
1137 1138 1139
{
    DisplaySurface *surface = g_new0(DisplaySurface, 1);
    int linesize = width * 4;
1140 1141

    trace_displaysurface_create(surface, width, height);
1142 1143 1144 1145 1146
    qemu_alloc_display(surface, width, height, linesize,
                       qemu_default_pixelformat(32), 0);
    return surface;
}

G
Gerd Hoffmann 已提交
1147
DisplaySurface *qemu_create_displaysurface_from(int width, int height, int bpp,
G
Gerd Hoffmann 已提交
1148 1149
                                                int linesize, uint8_t *data,
                                                bool byteswap)
1150
{
1151
    DisplaySurface *surface = g_new0(DisplaySurface, 1);
1152

1153
    trace_displaysurface_create_from(surface, width, height, bpp, byteswap);
G
Gerd Hoffmann 已提交
1154 1155 1156 1157 1158
    if (byteswap) {
        surface->pf = qemu_different_endianness_pixelformat(bpp);
    } else {
        surface->pf = qemu_default_pixelformat(bpp);
    }
1159 1160 1161 1162 1163 1164 1165 1166

    surface->format = qemu_pixman_get_format(&surface->pf);
    assert(surface->format != 0);
    surface->image = pixman_image_create_bits(surface->format,
                                              width, height,
                                              (void *)data, linesize);
    assert(surface->image != NULL);

1167 1168 1169 1170 1171 1172 1173
#ifdef HOST_WORDS_BIGENDIAN
    surface->flags = QEMU_BIG_ENDIAN_FLAG;
#endif

    return surface;
}

1174
void qemu_free_displaysurface(DisplaySurface *surface)
1175
{
1176
    if (surface == NULL) {
1177
        return;
G
Gerd Hoffmann 已提交
1178
    }
1179 1180 1181
    trace_displaysurface_free(surface);
    qemu_pixman_image_unref(surface->image);
    g_free(surface);
1182 1183
}

1184 1185 1186 1187 1188 1189 1190
void register_displaychangelistener(DisplayState *ds,
                                    DisplayChangeListener *dcl)
{
    trace_displaychangelistener_register(dcl, dcl->ops->dpy_name);
    dcl->ds = ds;
    QLIST_INSERT_HEAD(&ds->listeners, dcl, next);
    gui_setup_refresh(ds);
1191
    if (dcl->ops->dpy_gfx_switch) {
1192
        dcl->ops->dpy_gfx_switch(dcl, ds->surface);
1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203
    }
}

void unregister_displaychangelistener(DisplayChangeListener *dcl)
{
    DisplayState *ds = dcl->ds;
    trace_displaychangelistener_unregister(dcl, dcl->ops->dpy_name);
    QLIST_REMOVE(dcl, next);
    gui_setup_refresh(ds);
}

1204
void dpy_gfx_update(QemuConsole *con, int x, int y, int w, int h)
1205
{
1206
    DisplayState *s = con->ds;
1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219
    struct DisplayChangeListener *dcl;
    int width = pixman_image_get_width(s->surface->image);
    int height = pixman_image_get_height(s->surface->image);

    x = MAX(x, 0);
    y = MAX(y, 0);
    x = MIN(x, width);
    y = MIN(y, height);
    w = MIN(w, width - x);
    h = MIN(h, height - y);

    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_gfx_update) {
1220
            dcl->ops->dpy_gfx_update(dcl, x, y, w, h);
1221 1222 1223 1224
        }
    }
}

1225
void dpy_gfx_replace_surface(QemuConsole *con,
1226
                             DisplaySurface *surface)
1227
{
1228
    DisplayState *s = con->ds;
1229
    DisplaySurface *old_surface = s->surface;
1230
    struct DisplayChangeListener *dcl;
1231 1232

    s->surface = surface;
1233
    QLIST_FOREACH(dcl, &s->listeners, next) {
1234
        if (dcl->ops->dpy_gfx_switch) {
1235
            dcl->ops->dpy_gfx_switch(dcl, surface);
1236 1237
        }
    }
1238
    qemu_free_displaysurface(old_surface);
1239 1240 1241 1242 1243 1244 1245
}

void dpy_refresh(DisplayState *s)
{
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_refresh) {
1246
            dcl->ops->dpy_refresh(dcl);
1247 1248 1249 1250
        }
    }
}

1251 1252
void dpy_gfx_copy(QemuConsole *con, int src_x, int src_y,
                  int dst_x, int dst_y, int w, int h)
1253
{
1254
    DisplayState *s = con->ds;
1255 1256 1257
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_gfx_copy) {
1258
            dcl->ops->dpy_gfx_copy(dcl, src_x, src_y, dst_x, dst_y, w, h);
1259
        } else { /* TODO */
1260
            dcl->ops->dpy_gfx_update(dcl, dst_x, dst_y, w, h);
1261 1262 1263 1264
        }
    }
}

1265
void dpy_text_cursor(QemuConsole *con, int x, int y)
1266
{
1267
    DisplayState *s = con->ds;
1268 1269 1270
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_text_cursor) {
1271
            dcl->ops->dpy_text_cursor(dcl, x, y);
1272 1273 1274 1275
        }
    }
}

1276
void dpy_text_update(QemuConsole *con, int x, int y, int w, int h)
1277
{
1278
    DisplayState *s = con->ds;
1279 1280 1281
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_text_update) {
1282
            dcl->ops->dpy_text_update(dcl, x, y, w, h);
1283 1284 1285 1286
        }
    }
}

1287
void dpy_text_resize(QemuConsole *con, int w, int h)
1288
{
1289
    DisplayState *s = con->ds;
1290 1291 1292
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_text_resize) {
1293
            dcl->ops->dpy_text_resize(dcl, w, h);
1294 1295 1296 1297
        }
    }
}

1298
void dpy_mouse_set(QemuConsole *con, int x, int y, int on)
1299
{
1300
    DisplayState *s = con->ds;
1301 1302 1303
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_mouse_set) {
1304
            dcl->ops->dpy_mouse_set(dcl, x, y, on);
1305 1306 1307 1308
        }
    }
}

1309
void dpy_cursor_define(QemuConsole *con, QEMUCursor *cursor)
1310
{
1311
    DisplayState *s = con->ds;
1312 1313 1314
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_cursor_define) {
1315
            dcl->ops->dpy_cursor_define(dcl, cursor);
1316 1317 1318 1319
        }
    }
}

1320
bool dpy_cursor_define_supported(QemuConsole *con)
1321
{
1322
    DisplayState *s = con->ds;
1323 1324 1325 1326 1327 1328 1329 1330 1331
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_cursor_define) {
            return true;
        }
    }
    return false;
}

1332 1333
static void dumb_display_init(void)
{
1334
    DisplayState *ds = g_malloc0(sizeof(DisplayState));
1335 1336 1337 1338 1339 1340 1341
    int width = 640;
    int height = 480;

    if (is_fixedsize_console()) {
        width = active_console->g_width;
        height = active_console->g_height;
    }
1342
    ds->surface = qemu_create_displaysurface(width, height);
1343

1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367
    register_displaystate(ds);
}

/***********************************************************/
/* register display */

void register_displaystate(DisplayState *ds)
{
    DisplayState **s;
    s = &display_state;
    while (*s != NULL)
        s = &(*s)->next;
    ds->next = NULL;
    *s = ds;
}

DisplayState *get_displaystate(void)
{
    if (!display_state) {
        dumb_display_init ();
    }
    return display_state;
}

1368 1369 1370 1371 1372
QemuConsole *graphic_console_init(vga_hw_update_ptr update,
                                  vga_hw_invalidate_ptr invalidate,
                                  vga_hw_screen_dump_ptr screen_dump,
                                  vga_hw_text_update_ptr text_update,
                                  void *opaque)
P
pbrook 已提交
1373
{
1374
    QemuConsole *s;
1375
    DisplayState *ds;
A
aurel32 已提交
1376

1377
    ds = (DisplayState *) g_malloc0(sizeof(DisplayState));
1378
    s = new_console(ds, GRAPHIC_CONSOLE);
P
pbrook 已提交
1379 1380 1381
    s->hw_update = update;
    s->hw_invalidate = invalidate;
    s->hw_screen_dump = screen_dump;
B
balrog 已提交
1382
    s->hw_text_update = text_update;
P
pbrook 已提交
1383
    s->hw = opaque;
1384

1385
    ds->surface = qemu_create_displaysurface(640, 480);
1386

A
aurel32 已提交
1387
    register_displaystate(ds);
1388
    return s;
B
bellard 已提交
1389 1390
}

P
pbrook 已提交
1391
int is_graphic_console(void)
B
bellard 已提交
1392
{
B
balrog 已提交
1393
    return active_console && active_console->console_type == GRAPHIC_CONSOLE;
B
bellard 已提交
1394 1395
}

1396 1397 1398 1399 1400
int is_fixedsize_console(void)
{
    return active_console && active_console->console_type != TEXT_CONSOLE;
}

1401 1402
static void text_console_set_echo(CharDriverState *chr, bool echo)
{
1403
    QemuConsole *s = chr->opaque;
1404 1405 1406 1407

    s->echo = echo;
}

1408 1409
static void text_console_update_cursor(void *opaque)
{
1410
    QemuConsole *s = opaque;
1411 1412 1413 1414 1415 1416 1417

    s->cursor_visible_phase = !s->cursor_visible_phase;
    vga_hw_invalidate();
    qemu_mod_timer(s->cursor_timer,
                   qemu_get_clock_ms(rt_clock) + CONSOLE_CURSOR_PERIOD / 2);
}

P
Paolo Bonzini 已提交
1418
static void text_console_do_init(CharDriverState *chr, DisplayState *ds)
B
bellard 已提交
1419
{
1420
    QemuConsole *s;
1421

1422
    s = chr->opaque;
G
Gerd Hoffmann 已提交
1423

B
bellard 已提交
1424
    chr->chr_write = console_puts;
B
bellard 已提交
1425

1426 1427
    s->out_fifo.buf = s->out_fifo_buf;
    s->out_fifo.buf_size = sizeof(s->out_fifo_buf);
1428
    s->kbd_timer = qemu_new_timer_ms(rt_clock, kbd_send_chars, s);
1429
    s->ds = ds;
1430

B
bellard 已提交
1431 1432 1433 1434 1435
    s->y_displayed = 0;
    s->y_base = 0;
    s->total_height = DEFAULT_BACKSCROLL;
    s->x = 0;
    s->y = 0;
1436
    if (s->console_type == TEXT_CONSOLE) {
1437 1438
        s->g_width = surface_width(s->ds->surface);
        s->g_height = surface_height(s->ds->surface);
1439
    }
1440

1441 1442 1443
    s->cursor_timer =
        qemu_new_timer_ms(rt_clock, text_console_update_cursor, s);

B
balrog 已提交
1444 1445 1446 1447
    s->hw_invalidate = text_console_invalidate;
    s->hw_text_update = text_console_update;
    s->hw = s;

1448 1449 1450 1451 1452 1453 1454 1455 1456 1457
    /* Set text attribute defaults */
    s->t_attrib_default.bold = 0;
    s->t_attrib_default.uline = 0;
    s->t_attrib_default.blink = 0;
    s->t_attrib_default.invers = 0;
    s->t_attrib_default.unvisible = 0;
    s->t_attrib_default.fgcol = COLOR_WHITE;
    s->t_attrib_default.bgcol = COLOR_BLACK;
    /* set current text attributes to default */
    s->t_attrib = s->t_attrib_default;
B
bellard 已提交
1458 1459
    text_console_resize(s);

1460 1461 1462 1463
    if (chr->label) {
        char msg[128];
        int len;

1464
        s->t_attrib.bgcol = COLOR_BLUE;
1465 1466
        len = snprintf(msg, sizeof(msg), "%s console\r\n", chr->label);
        console_puts(chr, (uint8_t*)msg, len);
1467
        s->t_attrib = s->t_attrib_default;
1468 1469
    }

1470
    qemu_chr_be_generic_open(chr);
1471 1472
    if (chr->init)
        chr->init(chr);
B
bellard 已提交
1473
}
1474

G
Gerd Hoffmann 已提交
1475
static CharDriverState *text_console_init(ChardevVC *vc)
1476 1477
{
    CharDriverState *chr;
1478
    QemuConsole *s;
G
Gerd Hoffmann 已提交
1479 1480
    unsigned width = 0;
    unsigned height = 0;
1481

1482
    chr = g_malloc0(sizeof(CharDriverState));
1483

G
Gerd Hoffmann 已提交
1484 1485 1486 1487 1488
    if (vc->has_width) {
        width = vc->width;
    } else if (vc->has_cols) {
        width = vc->cols * FONT_WIDTH;
    }
1489

G
Gerd Hoffmann 已提交
1490 1491 1492 1493 1494
    if (vc->has_height) {
        height = vc->height;
    } else if (vc->has_rows) {
        height = vc->rows * FONT_HEIGHT;
    }
1495 1496 1497 1498 1499 1500 1501 1502

    if (width == 0 || height == 0) {
        s = new_console(NULL, TEXT_CONSOLE);
    } else {
        s = new_console(NULL, TEXT_CONSOLE_FIXED_SIZE);
    }

    if (!s) {
1503
        g_free(chr);
1504
        return NULL;
1505 1506 1507 1508 1509 1510
    }

    s->chr = chr;
    s->g_width = width;
    s->g_height = height;
    chr->opaque = s;
1511
    chr->chr_set_echo = text_console_set_echo;
1512
    return chr;
1513 1514
}

1515 1516
static VcHandler *vc_handler = text_console_init;

G
Gerd Hoffmann 已提交
1517
CharDriverState *vc_init(ChardevVC *vc)
1518
{
G
Gerd Hoffmann 已提交
1519
    return vc_handler(vc);
1520 1521 1522 1523 1524 1525 1526
}

void register_vc_handler(VcHandler *handler)
{
    vc_handler = handler;
}

1527 1528 1529 1530
void text_consoles_set_display(DisplayState *ds)
{
    int i;

1531 1532 1533 1534
    for (i = 0; i < nb_consoles; i++) {
        if (consoles[i]->console_type != GRAPHIC_CONSOLE) {
            text_console_do_init(consoles[i]->chr, ds);
        }
1535 1536 1537
    }
}

1538
void qemu_console_resize(QemuConsole *s, int width, int height)
1539
{
1540 1541 1542
    s->g_width = width;
    s->g_height = height;
    if (is_graphic_console()) {
1543 1544
        DisplaySurface *surface;
        surface = qemu_create_displaysurface(width, height);
1545
        dpy_gfx_replace_surface(s, surface);
1546 1547
    }
}
1548

1549
void qemu_console_copy(QemuConsole *con, int src_x, int src_y,
1550
                       int dst_x, int dst_y, int w, int h)
1551
{
1552
    if (is_graphic_console()) {
1553
        dpy_gfx_copy(con, src_x, src_y, dst_x, dst_y, w, h);
1554 1555
    }
}
1556

1557 1558 1559 1560 1561 1562 1563 1564 1565 1566
DisplaySurface *qemu_console_surface(QemuConsole *console)
{
    return console->ds->surface;
}

DisplayState *qemu_console_displaystate(QemuConsole *console)
{
    return console->ds;
}

1567
PixelFormat qemu_different_endianness_pixelformat(int bpp)
1568 1569 1570 1571 1572 1573
{
    PixelFormat pf;

    memset(&pf, 0x00, sizeof(PixelFormat));

    pf.bits_per_pixel = bpp;
1574
    pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1575 1576 1577
    pf.depth = bpp == 32 ? 24 : bpp;

    switch (bpp) {
1578 1579 1580 1581 1582 1583 1584 1585 1586 1587
        case 24:
            pf.rmask = 0x000000FF;
            pf.gmask = 0x0000FF00;
            pf.bmask = 0x00FF0000;
            pf.rmax = 255;
            pf.gmax = 255;
            pf.bmax = 255;
            pf.rshift = 0;
            pf.gshift = 8;
            pf.bshift = 16;
1588 1589 1590
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
1591
            break;
1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604
        case 32:
            pf.rmask = 0x0000FF00;
            pf.gmask = 0x00FF0000;
            pf.bmask = 0xFF000000;
            pf.amask = 0x00000000;
            pf.amax = 255;
            pf.rmax = 255;
            pf.gmax = 255;
            pf.bmax = 255;
            pf.ashift = 0;
            pf.rshift = 8;
            pf.gshift = 16;
            pf.bshift = 24;
1605 1606 1607 1608
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
            pf.abits = 8;
1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622
            break;
        default:
            break;
    }
    return pf;
}

PixelFormat qemu_default_pixelformat(int bpp)
{
    PixelFormat pf;

    memset(&pf, 0x00, sizeof(PixelFormat));

    pf.bits_per_pixel = bpp;
1623
    pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1624 1625 1626
    pf.depth = bpp == 32 ? 24 : bpp;

    switch (bpp) {
1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641
        case 15:
            pf.bits_per_pixel = 16;
            pf.rmask = 0x00007c00;
            pf.gmask = 0x000003E0;
            pf.bmask = 0x0000001F;
            pf.rmax = 31;
            pf.gmax = 31;
            pf.bmax = 31;
            pf.rshift = 10;
            pf.gshift = 5;
            pf.bshift = 0;
            pf.rbits = 5;
            pf.gbits = 5;
            pf.bbits = 5;
            break;
1642 1643 1644 1645 1646 1647 1648 1649 1650 1651
        case 16:
            pf.rmask = 0x0000F800;
            pf.gmask = 0x000007E0;
            pf.bmask = 0x0000001F;
            pf.rmax = 31;
            pf.gmax = 63;
            pf.bmax = 31;
            pf.rshift = 11;
            pf.gshift = 5;
            pf.bshift = 0;
1652 1653 1654
            pf.rbits = 5;
            pf.gbits = 6;
            pf.bbits = 5;
1655 1656
            break;
        case 24:
1657 1658 1659 1660 1661 1662 1663 1664 1665
            pf.rmask = 0x00FF0000;
            pf.gmask = 0x0000FF00;
            pf.bmask = 0x000000FF;
            pf.rmax = 255;
            pf.gmax = 255;
            pf.bmax = 255;
            pf.rshift = 16;
            pf.gshift = 8;
            pf.bshift = 0;
1666 1667 1668
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
1669
            break;
1670 1671 1672 1673 1674 1675 1676 1677 1678 1679
        case 32:
            pf.rmask = 0x00FF0000;
            pf.gmask = 0x0000FF00;
            pf.bmask = 0x000000FF;
            pf.rmax = 255;
            pf.gmax = 255;
            pf.bmax = 255;
            pf.rshift = 16;
            pf.gshift = 8;
            pf.bshift = 0;
1680 1681 1682
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
1683 1684 1685 1686 1687 1688
            break;
        default:
            break;
    }
    return pf;
}
1689

G
Gerd Hoffmann 已提交
1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721
static void qemu_chr_parse_vc(QemuOpts *opts, ChardevBackend *backend,
                              Error **errp)
{
    int val;

    backend->vc = g_new0(ChardevVC, 1);

    val = qemu_opt_get_number(opts, "width", 0);
    if (val != 0) {
        backend->vc->has_width = true;
        backend->vc->width = val;
    }

    val = qemu_opt_get_number(opts, "height", 0);
    if (val != 0) {
        backend->vc->has_height = true;
        backend->vc->height = val;
    }

    val = qemu_opt_get_number(opts, "cols", 0);
    if (val != 0) {
        backend->vc->has_cols = true;
        backend->vc->cols = val;
    }

    val = qemu_opt_get_number(opts, "rows", 0);
    if (val != 0) {
        backend->vc->has_rows = true;
        backend->vc->rows = val;
    }
}

1722 1723
static void register_types(void)
{
G
Gerd Hoffmann 已提交
1724 1725
    register_char_driver_qapi("vc", CHARDEV_BACKEND_KIND_VC,
                              qemu_chr_parse_vc);
1726 1727 1728
}

type_init(register_types);