“9441987446d204910a7707272c0f3a7d17f9830c”上不存在“ui/console.c”
console.c 46.7 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;
907
    if (active_console) {
908 909 910
        surface = qemu_console_surface(active_console);
        active_console->g_width = surface_width(surface);
        active_console->g_height = surface_height(surface);
911
    }
B
bellard 已提交
912 913
    s = consoles[index];
    if (s) {
914
        DisplayState *ds = s->ds;
915

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

    return surface;
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

1377
    ds->surface = qemu_create_displaysurface(640, 480);
1378

A
aurel32 已提交
1379
    register_displaystate(ds);
1380
    return s;
B
bellard 已提交
1381 1382
}

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

1388 1389 1390 1391 1392
int is_fixedsize_console(void)
{
    return active_console && active_console->console_type != TEXT_CONSOLE;
}

1393 1394
static void text_console_set_echo(CharDriverState *chr, bool echo)
{
1395
    QemuConsole *s = chr->opaque;
1396 1397 1398 1399

    s->echo = echo;
}

1400 1401
static void text_console_update_cursor(void *opaque)
{
1402
    QemuConsole *s = opaque;
1403 1404 1405 1406 1407 1408 1409

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

1414
    s = chr->opaque;
G
Gerd Hoffmann 已提交
1415

B
bellard 已提交
1416
    chr->chr_write = console_puts;
B
bellard 已提交
1417

1418 1419
    s->out_fifo.buf = s->out_fifo_buf;
    s->out_fifo.buf_size = sizeof(s->out_fifo_buf);
1420
    s->kbd_timer = qemu_new_timer_ms(rt_clock, kbd_send_chars, s);
1421
    s->ds = ds;
1422

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

1433 1434 1435
    s->cursor_timer =
        qemu_new_timer_ms(rt_clock, text_console_update_cursor, s);

B
balrog 已提交
1436 1437 1438 1439
    s->hw_invalidate = text_console_invalidate;
    s->hw_text_update = text_console_update;
    s->hw = s;

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

1452 1453 1454 1455
    if (chr->label) {
        char msg[128];
        int len;

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

1462
    qemu_chr_be_generic_open(chr);
1463 1464
    if (chr->init)
        chr->init(chr);
B
bellard 已提交
1465
}
1466

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

1474
    chr = g_malloc0(sizeof(CharDriverState));
1475

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

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

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

    if (!s) {
1495
        g_free(chr);
1496
        return NULL;
1497 1498 1499 1500 1501 1502
    }

    s->chr = chr;
    s->g_width = width;
    s->g_height = height;
    chr->opaque = s;
1503
    chr->chr_set_echo = text_console_set_echo;
1504
    return chr;
1505 1506
}

1507 1508
static VcHandler *vc_handler = text_console_init;

G
Gerd Hoffmann 已提交
1509
CharDriverState *vc_init(ChardevVC *vc)
1510
{
G
Gerd Hoffmann 已提交
1511
    return vc_handler(vc);
1512 1513 1514 1515 1516 1517 1518
}

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

1519 1520 1521 1522
void text_consoles_set_display(DisplayState *ds)
{
    int i;

1523 1524 1525 1526
    for (i = 0; i < nb_consoles; i++) {
        if (consoles[i]->console_type != GRAPHIC_CONSOLE) {
            text_console_do_init(consoles[i]->chr, ds);
        }
1527 1528 1529
    }
}

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

1541
void qemu_console_copy(QemuConsole *con, int src_x, int src_y,
1542
                       int dst_x, int dst_y, int w, int h)
1543
{
1544
    if (is_graphic_console()) {
1545
        dpy_gfx_copy(con, src_x, src_y, dst_x, dst_y, w, h);
1546 1547
    }
}
1548

1549 1550 1551 1552 1553 1554 1555 1556 1557 1558
DisplaySurface *qemu_console_surface(QemuConsole *console)
{
    return console->ds->surface;
}

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

1559
PixelFormat qemu_different_endianness_pixelformat(int bpp)
1560 1561 1562 1563 1564 1565
{
    PixelFormat pf;

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

    pf.bits_per_pixel = bpp;
1566
    pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1567 1568 1569
    pf.depth = bpp == 32 ? 24 : bpp;

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

PixelFormat qemu_default_pixelformat(int bpp)
{
    PixelFormat pf;

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

    pf.bits_per_pixel = bpp;
1615
    pf.bytes_per_pixel = DIV_ROUND_UP(bpp, 8);
1616 1617 1618
    pf.depth = bpp == 32 ? 24 : bpp;

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

G
Gerd Hoffmann 已提交
1682 1683 1684 1685 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
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;
    }
}

1714 1715
static void register_types(void)
{
G
Gerd Hoffmann 已提交
1716 1717
    register_char_driver_qapi("vc", CHARDEV_BACKEND_KIND_VC,
                              qemu_chr_parse_vc);
1718 1719 1720
}

type_init(register_types);