console.c 46.8 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

35 36 37 38 39 40 41 42 43 44
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 已提交
45 46
typedef struct TextCell {
    uint8_t ch;
47
    TextAttributes t_attrib;
B
bellard 已提交
48 49 50 51 52 53 54 55 56 57
} TextCell;

#define MAX_ESC_PARAMS 3

enum TTYState {
    TTY_STATE_NORM,
    TTY_STATE_ESC,
    TTY_STATE_CSI,
};

58 59 60 61 62 63
typedef struct QEMUFIFO {
    uint8_t *buf;
    int buf_size;
    int count, wptr, rptr;
} QEMUFIFO;

64
static int qemu_fifo_write(QEMUFIFO *f, const uint8_t *buf, int len1)
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86
{
    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;
}

87
static int qemu_fifo_read(QEMUFIFO *f, uint8_t *buf, int len1)
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
{
    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;
}

109 110
typedef enum {
    GRAPHIC_CONSOLE,
111 112
    TEXT_CONSOLE,
    TEXT_CONSOLE_FIXED_SIZE
A
Anthony Liguori 已提交
113
} console_type_t;
114

115
struct QemuConsole {
116
    int index;
A
Anthony Liguori 已提交
117
    console_type_t console_type;
B
bellard 已提交
118
    DisplayState *ds;
119

P
pbrook 已提交
120 121 122 123
    /* 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 已提交
124
    vga_hw_text_update_ptr hw_text_update;
P
pbrook 已提交
125
    void *hw;
B
bellard 已提交
126
    int g_width, g_height;
127 128

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

145 146 147 148 149
    int update_x0;
    int update_y0;
    int update_x1;
    int update_y1;

B
bellard 已提交
150 151 152 153
    enum TTYState state;
    int esc_params[MAX_ESC_PARAMS];
    int nb_esc_params;

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

161
static DisplayState *display_state;
162 163
static QemuConsole *active_console;
static QemuConsole *consoles[MAX_CONSOLES];
B
bellard 已提交
164 165
static int nb_consoles = 0;

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

void vga_hw_invalidate(void)
{
174
    if (active_console && active_console->hw_invalidate)
P
pbrook 已提交
175 176 177
        active_console->hw_invalidate(active_console->hw);
}

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

    previous_active_console = active_console;
184
    cswitch = previous_active_console && previous_active_console->index != 0;
185

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

197
    if (cswitch) {
198 199
        console_select(previous_active_console->index);
    }
P
pbrook 已提交
200 201
}

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

208 209
static void vga_fill_rect(QemuConsole *con,
                          int posx, int posy, int width, int height,
210
                          pixman_color_t color)
B
bellard 已提交
211
{
212
    DisplaySurface *surface = qemu_console_surface(con);
213 214 215 216 217
    pixman_rectangle16_t rect = {
        .x = posx, .y = posy, .width = width, .height = height
    };

    pixman_image_fill_rectangles(PIXMAN_OP_SRC, surface->image,
218
                                 &color, 1, &rect);
B
bellard 已提交
219 220 221
}

/* copy from (xs, ys) to (xd, yd) a rectangle of size (w, h) */
222 223
static void vga_bitblt(QemuConsole *con,
                       int xs, int ys, int xd, int yd, int w, int h)
B
bellard 已提交
224
{
225
    DisplaySurface *surface = qemu_console_surface(con);
226 227 228 229

    pixman_image_composite(PIXMAN_OP_SRC,
                           surface->image, NULL, surface->image,
                           xs, ys, 0, 0, xd, yd, w, h);
B
bellard 已提交
230 231 232 233 234 235 236 237 238 239
}

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

#define FONT_HEIGHT 16
#define FONT_WIDTH 8

#include "vgafont.h"

240
#ifndef CONFIG_CURSES
241 242 243 244 245 246 247 248 249 250
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
};
251
#endif
252

253 254 255 256
#define QEMU_RGB(r, g, b)                                               \
    { .red = r << 8, .green = g << 8, .blue = b << 8, .alpha = 0xffff }

static const pixman_color_t color_table_rgb[2][8] = {
257
    {   /* dark */
B
bellard 已提交
258 259 260 261 262 263 264 265
        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 */
266 267
    },
    {   /* bright */
B
bellard 已提交
268 269 270 271 272 273 274 275
        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 */
276
    }
B
bellard 已提交
277 278
};

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
#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 已提交
311

312
static void vga_putcharxy(QemuConsole *s, int x, int y, int ch,
313
                          TextAttributes *t_attrib)
B
bellard 已提交
314
{
315
    static pixman_image_t *glyphs[256];
316
    DisplaySurface *surface = qemu_console_surface(s);
317
    pixman_color_t fgcol, bgcol;
318 319

    if (t_attrib->invers) {
G
Gerd Hoffmann 已提交
320 321
        bgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
        fgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
322
    } else {
G
Gerd Hoffmann 已提交
323 324
        fgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
        bgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
325
    }
B
bellard 已提交
326

327 328
    if (!glyphs[ch]) {
        glyphs[ch] = qemu_pixman_glyph_from_vgafont(FONT_HEIGHT, vgafont16, ch);
B
bellard 已提交
329
    }
330
    qemu_pixman_glyph_render(glyphs[ch], surface->image,
331
                             &fgcol, &bgcol, x, y, FONT_WIDTH, FONT_HEIGHT);
B
bellard 已提交
332 333
}

334
static void text_console_resize(QemuConsole *s)
B
bellard 已提交
335 336 337 338 339 340 341 342 343 344 345 346
{
    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;

347
    cells = g_malloc(s->width * s->total_height * sizeof(TextCell));
B
bellard 已提交
348 349 350 351 352 353 354 355 356 357
    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 = ' ';
358
            c->t_attrib = s->t_attrib_default;
B
bellard 已提交
359 360 361
            c++;
        }
    }
362
    g_free(s->cells);
B
bellard 已提交
363 364 365
    s->cells = cells;
}

366
static inline void text_update_xy(QemuConsole *s, int x, int y)
B
balrog 已提交
367 368 369 370 371 372 373
{
    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);
}

374
static void invalidate_xy(QemuConsole *s, int x, int y)
375 376 377 378 379 380 381 382 383 384 385
{
    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;
}

386
static void update_xy(QemuConsole *s, int x, int y)
B
bellard 已提交
387 388 389 390
{
    TextCell *c;
    int y1, y2;

391 392 393 394 395 396 397
    if (s != active_console) {
        return;
    }

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

399
    if (s->ds->have_gfx) {
B
bellard 已提交
400 401 402 403 404 405
        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];
406
            vga_putcharxy(s, x, y2, c->ch,
407
                          &(c->t_attrib));
408
            invalidate_xy(s, x, y2);
B
bellard 已提交
409 410 411 412
        }
    }
}

413
static void console_show_cursor(QemuConsole *s, int show)
B
bellard 已提交
414 415 416
{
    TextCell *c;
    int y, y1;
417
    int x = s->x;
B
bellard 已提交
418

419 420 421
    if (s != active_console) {
        return;
    }
B
balrog 已提交
422

423 424 425
    if (s->ds->have_text) {
        s->cursor_invalidate = 1;
    }
B
balrog 已提交
426

427
    if (s->ds->have_gfx) {
428 429 430
        if (x >= s->width) {
            x = s->width - 1;
        }
B
bellard 已提交
431 432 433 434 435
        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) {
436
            c = &s->cells[y1 * s->width + x];
437
            if (show && s->cursor_visible_phase) {
438 439
                TextAttributes t_attrib = s->t_attrib_default;
                t_attrib.invers = !(t_attrib.invers); /* invert fg and bg */
440
                vga_putcharxy(s, x, y, c->ch, &t_attrib);
B
bellard 已提交
441
            } else {
442
                vga_putcharxy(s, x, y, c->ch, &(c->t_attrib));
B
bellard 已提交
443
            }
444
            invalidate_xy(s, x, y);
B
bellard 已提交
445 446 447 448
        }
    }
}

449
static void console_refresh(QemuConsole *s)
B
bellard 已提交
450
{
451
    DisplaySurface *surface = qemu_console_surface(s);
B
bellard 已提交
452 453 454
    TextCell *c;
    int x, y, y1;

455
    if (s != active_console)
B
bellard 已提交
456
        return;
457 458

    if (s->ds->have_text) {
B
balrog 已提交
459 460 461 462 463 464
        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 已提交
465

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

static void console_scroll(int ydelta)
{
489
    QemuConsole *s;
B
bellard 已提交
490
    int i, y1;
491

B
bellard 已提交
492
    s = active_console;
493
    if (!s || (s->console_type == GRAPHIC_CONSOLE))
B
bellard 已提交
494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520
        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);
}

521
static void console_put_lf(QemuConsole *s)
B
bellard 已提交
522 523 524 525 526 527 528
{
    TextCell *c;
    int x, y1;

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

B
bellard 已提交
530 531 532 533 534 535 536 537 538 539 540 541
        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 = ' ';
542
            c->t_attrib = s->t_attrib_default;
B
bellard 已提交
543 544 545
            c++;
        }
        if (s == active_console && s->y_displayed == s->y_base) {
546
            if (s->ds->have_text) {
B
balrog 已提交
547 548 549 550 551 552
                s->text_x[0] = 0;
                s->text_y[0] = 0;
                s->text_x[1] = s->width - 1;
                s->text_y[1] = s->height - 1;
            }

553 554 555 556 557 558 559 560 561 562 563 564
            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 已提交
565 566 567 568
        }
    }
}

569 570 571 572
/* 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.
 */
573
static void console_handle_escape(QemuConsole *s)
574 575 576 577 578 579 580 581 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
{
    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;
        }
    }
}

666
static void console_clear_xy(QemuConsole *s, int x, int y)
667 668 669 670 671 672 673 674
{
    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);
}

675
/* set cursor, checking bounds */
676
static void set_cursor(QemuConsole *s, int x, int y)
677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694
{
    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;
}

695
static void console_putchar(QemuConsole *s, int ch)
B
bellard 已提交
696 697
{
    TextCell *c;
698 699
    int y1, i;
    int x, y;
B
bellard 已提交
700 701 702 703

    switch(s->state) {
    case TTY_STATE_NORM:
        switch(ch) {
704
        case '\r':  /* carriage return */
B
bellard 已提交
705 706
            s->x = 0;
            break;
707
        case '\n':  /* newline */
B
bellard 已提交
708 709
            console_put_lf(s);
            break;
710
        case '\b':  /* backspace */
711
            if (s->x > 0)
712
                s->x--;
713 714 715
            break;
        case '\t':  /* tabspace */
            if (s->x + (8 - (s->x % 8)) > s->width) {
B
bellard 已提交
716
                s->x = 0;
717 718 719 720 721 722 723 724
                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;
725 726 727 728 729 730
        case 14:
            /* SI (shift in), character set 0 (ignored) */
            break;
        case 15:
            /* SO (shift out), character set 1 (ignored) */
            break;
731
        case 27:    /* esc (introducing an escape sequence) */
B
bellard 已提交
732 733 734
            s->state = TTY_STATE_ESC;
            break;
        default:
735 736 737 738
            if (s->x >= s->width) {
                /* line wrap */
                s->x = 0;
                console_put_lf(s);
739
            }
B
bellard 已提交
740 741 742
            y1 = (s->y_base + s->y) % s->total_height;
            c = &s->cells[y1 * s->width + s->x];
            c->ch = ch;
743
            c->t_attrib = s->t_attrib;
B
bellard 已提交
744 745 746 747 748
            update_xy(s, s->x, s->y);
            s->x++;
            break;
        }
        break;
749
    case TTY_STATE_ESC: /* check if it is a terminal escape sequence */
B
bellard 已提交
750 751 752 753 754 755 756 757 758
        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;
759
    case TTY_STATE_CSI: /* handle escape sequence parameters */
B
bellard 已提交
760 761
        if (ch >= '0' && ch <= '9') {
            if (s->nb_esc_params < MAX_ESC_PARAMS) {
762 763 764 765 766
                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 已提交
767 768
            }
        } else {
769 770
            if (s->nb_esc_params < MAX_ESC_PARAMS)
                s->nb_esc_params++;
B
bellard 已提交
771 772
            if (ch == ';')
                break;
773 774 775 776
#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 已提交
777 778
            s->state = TTY_STATE_NORM;
            switch(ch) {
779 780 781 782 783
            case 'A':
                /* move cursor up */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
784
                set_cursor(s, s->x, s->y - s->esc_params[0]);
785 786 787 788 789 790
                break;
            case 'B':
                /* move cursor down */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
791
                set_cursor(s, s->x, s->y + s->esc_params[0]);
B
bellard 已提交
792 793
                break;
            case 'C':
794 795 796 797
                /* move cursor right */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
798
                set_cursor(s, s->x + s->esc_params[0], s->y);
B
bellard 已提交
799
                break;
800 801 802 803 804
            case 'D':
                /* move cursor left */
                if (s->esc_params[0] == 0) {
                    s->esc_params[0] = 1;
                }
805
                set_cursor(s, s->x - s->esc_params[0], s->y);
806 807 808
                break;
            case 'G':
                /* move cursor to column */
809
                set_cursor(s, s->esc_params[0] - 1, s->y);
810 811 812 813
                break;
            case 'f':
            case 'H':
                /* move cursor to row, column */
814
                set_cursor(s, s->esc_params[1] - 1, s->esc_params[0] - 1);
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846
                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);
                        }
                    }
847
                    break;
848
                }
849
                break;
B
bellard 已提交
850
            case 'K':
851 852
                switch (s->esc_params[0]) {
                case 0:
853 854
                    /* clear to eol */
                    for(x = s->x; x < s->width; x++) {
855
                        console_clear_xy(s, x, s->y);
856 857
                    }
                    break;
858 859 860 861 862 863 864 865 866 867 868
                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);
                    }
869 870
                    break;
                }
871 872
                break;
            case 'm':
873 874
                console_handle_escape(s);
                break;
875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895
            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 已提交
896 897 898 899 900 901
        }
    }
}

void console_select(unsigned int index)
{
902
    DisplaySurface *surface;
903
    QemuConsole *s;
904

B
bellard 已提交
905 906
    if (index >= MAX_CONSOLES)
        return;
G
Gerd Hoffmann 已提交
907 908

    trace_console_select(index);
909
    if (active_console) {
910 911 912
        surface = qemu_console_surface(active_console);
        active_console->g_width = surface_width(surface);
        active_console->g_height = surface_height(surface);
913
    }
B
bellard 已提交
914 915
    s = consoles[index];
    if (s) {
916
        DisplayState *ds = s->ds;
917

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

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

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

959 960
static void kbd_send_chars(void *opaque)
{
961
    QemuConsole *s = opaque;
962 963
    int len;
    uint8_t buf[16];
964

965
    len = qemu_chr_be_can_write(s->chr);
966 967 968 969 970 971
    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);
972
        qemu_chr_be_write(s->chr, buf, len);
973 974 975 976
    }
    /* characters are pending: we send them a bit later (XXX:
       horrible, should change char device API) */
    if (s->out_fifo.count > 0) {
977
        qemu_mod_timer(s->kbd_timer, qemu_get_clock_ms(rt_clock) + 1);
978 979 980
    }
}

B
bellard 已提交
981 982 983
/* called when an ascii key is pressed */
void kbd_put_keysym(int keysym)
{
984
    QemuConsole *s;
B
bellard 已提交
985 986 987 988
    uint8_t buf[16], *q;
    int c;

    s = active_console;
989
    if (!s || (s->console_type == GRAPHIC_CONSOLE))
B
bellard 已提交
990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005
        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:
1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019
        /* 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;
1020 1021 1022
        } else if (s->echo && (keysym == '\r' || keysym == '\n')) {
            console_puts(s->chr, (const uint8_t *) "\r", 1);
            *q++ = '\n';
1023
        } else {
1024 1025 1026 1027
            *q++ = keysym;
        }
        if (s->echo) {
            console_puts(s->chr, buf, q - buf);
1028
        }
1029
        if (s->chr->chr_read) {
1030 1031
            qemu_fifo_write(&s->out_fifo, buf, q - buf);
            kbd_send_chars(s);
B
bellard 已提交
1032 1033 1034 1035 1036
        }
        break;
    }
}

B
balrog 已提交
1037 1038
static void text_console_invalidate(void *opaque)
{
1039
    QemuConsole *s = (QemuConsole *) opaque;
1040 1041 1042 1043 1044
    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);
1045 1046
        text_console_resize(s);
    }
B
balrog 已提交
1047 1048 1049
    console_refresh(s);
}

A
Anthony Liguori 已提交
1050
static void text_console_update(void *opaque, console_ch_t *chardata)
B
balrog 已提交
1051
{
1052
    QemuConsole *s = (QemuConsole *) opaque;
B
balrog 已提交
1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063
    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));
1064
        dpy_text_update(s, s->text_x[0], s->text_y[0],
1065
                        s->text_x[1] - s->text_x[0], i - s->text_y[0]);
B
balrog 已提交
1066 1067 1068 1069 1070 1071
        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) {
1072
        dpy_text_cursor(s, s->x, s->y);
B
balrog 已提交
1073 1074 1075 1076
        s->cursor_invalidate = 0;
    }
}

1077
static QemuConsole *new_console(DisplayState *ds, console_type_t console_type)
B
bellard 已提交
1078
{
1079
    QemuConsole *s;
P
pbrook 已提交
1080
    int i;
B
bellard 已提交
1081 1082 1083

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

1109 1110
static void qemu_alloc_display(DisplaySurface *surface, int width, int height,
                               int linesize, PixelFormat pf, int newflags)
1111 1112
{
    surface->pf = pf;
1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123

    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);

1124
    surface->flags = newflags | QEMU_ALLOCATED_FLAG;
1125
#ifdef HOST_WORDS_BIGENDIAN
1126
    surface->flags |= QEMU_BIG_ENDIAN_FLAG;
1127 1128 1129
#endif
}

1130
DisplaySurface *qemu_create_displaysurface(int width, int height)
1131 1132 1133
{
    DisplaySurface *surface = g_new0(DisplaySurface, 1);
    int linesize = width * 4;
1134 1135

    trace_displaysurface_create(surface, width, height);
1136 1137 1138 1139 1140
    qemu_alloc_display(surface, width, height, linesize,
                       qemu_default_pixelformat(32), 0);
    return surface;
}

G
Gerd Hoffmann 已提交
1141
DisplaySurface *qemu_create_displaysurface_from(int width, int height, int bpp,
G
Gerd Hoffmann 已提交
1142 1143
                                                int linesize, uint8_t *data,
                                                bool byteswap)
1144
{
1145
    DisplaySurface *surface = g_new0(DisplaySurface, 1);
1146

1147
    trace_displaysurface_create_from(surface, width, height, bpp, byteswap);
G
Gerd Hoffmann 已提交
1148 1149 1150 1151 1152
    if (byteswap) {
        surface->pf = qemu_different_endianness_pixelformat(bpp);
    } else {
        surface->pf = qemu_default_pixelformat(bpp);
    }
1153 1154 1155 1156 1157 1158 1159 1160

    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);

1161 1162 1163 1164 1165 1166 1167
#ifdef HOST_WORDS_BIGENDIAN
    surface->flags = QEMU_BIG_ENDIAN_FLAG;
#endif

    return surface;
}

1168
void qemu_free_displaysurface(DisplaySurface *surface)
1169
{
1170
    if (surface == NULL) {
1171
        return;
G
Gerd Hoffmann 已提交
1172
    }
1173 1174 1175
    trace_displaysurface_free(surface);
    qemu_pixman_image_unref(surface->image);
    g_free(surface);
1176 1177
}

1178 1179 1180 1181 1182 1183 1184
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);
1185
    if (dcl->ops->dpy_gfx_switch) {
1186
        dcl->ops->dpy_gfx_switch(dcl, ds->surface);
1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197
    }
}

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);
}

1198
void dpy_gfx_update(QemuConsole *con, int x, int y, int w, int h)
1199
{
1200
    DisplayState *s = con->ds;
1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
    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) {
1214
            dcl->ops->dpy_gfx_update(dcl, x, y, w, h);
1215 1216 1217 1218
        }
    }
}

1219
void dpy_gfx_replace_surface(QemuConsole *con,
1220
                             DisplaySurface *surface)
1221
{
1222
    DisplayState *s = con->ds;
1223
    DisplaySurface *old_surface = s->surface;
1224
    struct DisplayChangeListener *dcl;
1225 1226

    s->surface = surface;
1227
    QLIST_FOREACH(dcl, &s->listeners, next) {
1228
        if (dcl->ops->dpy_gfx_switch) {
1229
            dcl->ops->dpy_gfx_switch(dcl, surface);
1230 1231
        }
    }
1232
    qemu_free_displaysurface(old_surface);
1233 1234 1235 1236 1237 1238 1239
}

void dpy_refresh(DisplayState *s)
{
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_refresh) {
1240
            dcl->ops->dpy_refresh(dcl);
1241 1242 1243 1244
        }
    }
}

1245 1246
void dpy_gfx_copy(QemuConsole *con, int src_x, int src_y,
                  int dst_x, int dst_y, int w, int h)
1247
{
1248
    DisplayState *s = con->ds;
1249 1250 1251
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_gfx_copy) {
1252
            dcl->ops->dpy_gfx_copy(dcl, src_x, src_y, dst_x, dst_y, w, h);
1253
        } else { /* TODO */
1254
            dcl->ops->dpy_gfx_update(dcl, dst_x, dst_y, w, h);
1255 1256 1257 1258
        }
    }
}

1259
void dpy_text_cursor(QemuConsole *con, int x, int y)
1260
{
1261
    DisplayState *s = con->ds;
1262 1263 1264
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_text_cursor) {
1265
            dcl->ops->dpy_text_cursor(dcl, x, y);
1266 1267 1268 1269
        }
    }
}

1270
void dpy_text_update(QemuConsole *con, int x, int y, int w, int h)
1271
{
1272
    DisplayState *s = con->ds;
1273 1274 1275
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_text_update) {
1276
            dcl->ops->dpy_text_update(dcl, x, y, w, h);
1277 1278 1279 1280
        }
    }
}

1281
void dpy_text_resize(QemuConsole *con, int w, int h)
1282
{
1283
    DisplayState *s = con->ds;
1284 1285 1286
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_text_resize) {
1287
            dcl->ops->dpy_text_resize(dcl, w, h);
1288 1289 1290 1291
        }
    }
}

1292
void dpy_mouse_set(QemuConsole *con, int x, int y, int on)
1293
{
1294
    DisplayState *s = con->ds;
1295 1296 1297
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_mouse_set) {
1298
            dcl->ops->dpy_mouse_set(dcl, x, y, on);
1299 1300 1301 1302
        }
    }
}

1303
void dpy_cursor_define(QemuConsole *con, QEMUCursor *cursor)
1304
{
1305
    DisplayState *s = con->ds;
1306 1307 1308
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_cursor_define) {
1309
            dcl->ops->dpy_cursor_define(dcl, cursor);
1310 1311 1312 1313
        }
    }
}

1314
bool dpy_cursor_define_supported(QemuConsole *con)
1315
{
1316
    DisplayState *s = con->ds;
1317 1318 1319 1320 1321 1322 1323 1324 1325
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_cursor_define) {
            return true;
        }
    }
    return false;
}

1326 1327
static void dumb_display_init(void)
{
1328
    DisplayState *ds = g_malloc0(sizeof(DisplayState));
1329 1330 1331 1332 1333 1334 1335
    int width = 640;
    int height = 480;

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

1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361
    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;
}

1362 1363 1364 1365 1366
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 已提交
1367
{
1368
    QemuConsole *s;
1369
    DisplayState *ds;
A
aurel32 已提交
1370

1371
    ds = (DisplayState *) g_malloc0(sizeof(DisplayState));
G
Gerd Hoffmann 已提交
1372
    trace_console_gfx_new();
1373
    s = new_console(ds, GRAPHIC_CONSOLE);
P
pbrook 已提交
1374 1375 1376
    s->hw_update = update;
    s->hw_invalidate = invalidate;
    s->hw_screen_dump = screen_dump;
B
balrog 已提交
1377
    s->hw_text_update = text_update;
P
pbrook 已提交
1378
    s->hw = opaque;
1379

1380
    ds->surface = qemu_create_displaysurface(640, 480);
1381

A
aurel32 已提交
1382
    register_displaystate(ds);
1383
    return s;
B
bellard 已提交
1384 1385
}

P
pbrook 已提交
1386
int is_graphic_console(void)
B
bellard 已提交
1387
{
B
balrog 已提交
1388
    return active_console && active_console->console_type == GRAPHIC_CONSOLE;
B
bellard 已提交
1389 1390
}

1391 1392 1393 1394 1395
int is_fixedsize_console(void)
{
    return active_console && active_console->console_type != TEXT_CONSOLE;
}

1396 1397
static void text_console_set_echo(CharDriverState *chr, bool echo)
{
1398
    QemuConsole *s = chr->opaque;
1399 1400 1401 1402

    s->echo = echo;
}

1403 1404
static void text_console_update_cursor(void *opaque)
{
1405
    QemuConsole *s = opaque;
1406 1407 1408 1409 1410 1411 1412

    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 已提交
1413
static void text_console_do_init(CharDriverState *chr, DisplayState *ds)
B
bellard 已提交
1414
{
1415
    QemuConsole *s;
1416

1417
    s = chr->opaque;
G
Gerd Hoffmann 已提交
1418

B
bellard 已提交
1419
    chr->chr_write = console_puts;
B
bellard 已提交
1420

1421 1422
    s->out_fifo.buf = s->out_fifo_buf;
    s->out_fifo.buf_size = sizeof(s->out_fifo_buf);
1423
    s->kbd_timer = qemu_new_timer_ms(rt_clock, kbd_send_chars, s);
1424
    s->ds = ds;
1425

B
bellard 已提交
1426 1427 1428 1429 1430
    s->y_displayed = 0;
    s->y_base = 0;
    s->total_height = DEFAULT_BACKSCROLL;
    s->x = 0;
    s->y = 0;
1431
    if (s->console_type == TEXT_CONSOLE) {
1432 1433
        s->g_width = surface_width(s->ds->surface);
        s->g_height = surface_height(s->ds->surface);
1434
    }
1435

1436 1437 1438
    s->cursor_timer =
        qemu_new_timer_ms(rt_clock, text_console_update_cursor, s);

B
balrog 已提交
1439 1440 1441 1442
    s->hw_invalidate = text_console_invalidate;
    s->hw_text_update = text_console_update;
    s->hw = s;

1443 1444 1445 1446 1447 1448 1449 1450 1451 1452
    /* 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 已提交
1453 1454
    text_console_resize(s);

1455 1456 1457 1458
    if (chr->label) {
        char msg[128];
        int len;

1459
        s->t_attrib.bgcol = COLOR_BLUE;
1460 1461
        len = snprintf(msg, sizeof(msg), "%s console\r\n", chr->label);
        console_puts(chr, (uint8_t*)msg, len);
1462
        s->t_attrib = s->t_attrib_default;
1463 1464
    }

1465
    qemu_chr_be_generic_open(chr);
1466 1467
    if (chr->init)
        chr->init(chr);
B
bellard 已提交
1468
}
1469

G
Gerd Hoffmann 已提交
1470
static CharDriverState *text_console_init(ChardevVC *vc)
1471 1472
{
    CharDriverState *chr;
1473
    QemuConsole *s;
G
Gerd Hoffmann 已提交
1474 1475
    unsigned width = 0;
    unsigned height = 0;
1476

1477
    chr = g_malloc0(sizeof(CharDriverState));
1478

G
Gerd Hoffmann 已提交
1479 1480 1481 1482 1483
    if (vc->has_width) {
        width = vc->width;
    } else if (vc->has_cols) {
        width = vc->cols * FONT_WIDTH;
    }
1484

G
Gerd Hoffmann 已提交
1485 1486 1487 1488 1489
    if (vc->has_height) {
        height = vc->height;
    } else if (vc->has_rows) {
        height = vc->rows * FONT_HEIGHT;
    }
1490

G
Gerd Hoffmann 已提交
1491
    trace_console_txt_new(width, height);
1492 1493 1494 1495 1496 1497 1498
    if (width == 0 || height == 0) {
        s = new_console(NULL, TEXT_CONSOLE);
    } else {
        s = new_console(NULL, TEXT_CONSOLE_FIXED_SIZE);
    }

    if (!s) {
1499
        g_free(chr);
1500
        return NULL;
1501 1502 1503 1504 1505 1506
    }

    s->chr = chr;
    s->g_width = width;
    s->g_height = height;
    chr->opaque = s;
1507
    chr->chr_set_echo = text_console_set_echo;
1508
    return chr;
1509 1510
}

1511 1512
static VcHandler *vc_handler = text_console_init;

G
Gerd Hoffmann 已提交
1513
CharDriverState *vc_init(ChardevVC *vc)
1514
{
G
Gerd Hoffmann 已提交
1515
    return vc_handler(vc);
1516 1517 1518 1519 1520 1521 1522
}

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

1523 1524 1525 1526
void text_consoles_set_display(DisplayState *ds)
{
    int i;

1527 1528 1529 1530
    for (i = 0; i < nb_consoles; i++) {
        if (consoles[i]->console_type != GRAPHIC_CONSOLE) {
            text_console_do_init(consoles[i]->chr, ds);
        }
1531 1532 1533
    }
}

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

1545
void qemu_console_copy(QemuConsole *con, int src_x, int src_y,
1546
                       int dst_x, int dst_y, int w, int h)
1547
{
1548
    if (is_graphic_console()) {
1549
        dpy_gfx_copy(con, src_x, src_y, dst_x, dst_y, w, h);
1550 1551
    }
}
1552

1553 1554 1555 1556 1557 1558 1559 1560 1561 1562
DisplaySurface *qemu_console_surface(QemuConsole *console)
{
    return console->ds->surface;
}

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

1563
PixelFormat qemu_different_endianness_pixelformat(int bpp)
1564 1565 1566 1567 1568 1569
{
    PixelFormat pf;

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

    pf.bits_per_pixel = bpp;
1570
    pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1571 1572 1573
    pf.depth = bpp == 32 ? 24 : bpp;

    switch (bpp) {
1574 1575 1576 1577 1578 1579 1580 1581 1582 1583
        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;
1584 1585 1586
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
1587
            break;
1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600
        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;
1601 1602 1603 1604
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
            pf.abits = 8;
1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618
            break;
        default:
            break;
    }
    return pf;
}

PixelFormat qemu_default_pixelformat(int bpp)
{
    PixelFormat pf;

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

    pf.bits_per_pixel = bpp;
1619
    pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1620 1621 1622
    pf.depth = bpp == 32 ? 24 : bpp;

    switch (bpp) {
1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637
        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;
1638 1639 1640 1641 1642 1643 1644 1645 1646 1647
        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;
1648 1649 1650
            pf.rbits = 5;
            pf.gbits = 6;
            pf.bbits = 5;
1651 1652
            break;
        case 24:
1653 1654 1655 1656 1657 1658 1659 1660 1661
            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;
1662 1663 1664
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
1665
            break;
1666 1667 1668 1669 1670 1671 1672 1673 1674 1675
        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;
1676 1677 1678
            pf.rbits = 8;
            pf.gbits = 8;
            pf.bbits = 8;
1679 1680 1681 1682 1683 1684
            break;
        default:
            break;
    }
    return pf;
}
1685

G
Gerd Hoffmann 已提交
1686 1687 1688 1689 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
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;
    }
}

1718 1719
static void register_types(void)
{
G
Gerd Hoffmann 已提交
1720 1721
    register_char_driver_qapi("vc", CHARDEV_BACKEND_KIND_VC,
                              qemu_chr_parse_vc);
1722 1723 1724
}

type_init(register_types);