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

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

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
    /* Graphic console state.  */
121 122 123 124
    graphic_hw_update_ptr hw_update;
    graphic_hw_invalidate_ptr hw_invalidate;
    graphic_hw_screen_dump_ptr hw_screen_dump;
    graphic_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;

166 167
static void text_console_do_init(CharDriverState *chr, DisplayState *ds);

168
void graphic_hw_update(QemuConsole *con)
P
pbrook 已提交
169
{
170 171 172 173 174 175
    if (!con) {
        con = active_console;
    }
    if (con && con->hw_update) {
        con->hw_update(con->hw);
    }
P
pbrook 已提交
176 177
}

178
void graphic_hw_invalidate(QemuConsole *con)
P
pbrook 已提交
179
{
180 181 182 183 184 185
    if (!con) {
        con = active_console;
    }
    if (con && con->hw_invalidate) {
        con->hw_invalidate(con->hw);
    }
P
pbrook 已提交
186 187
}

L
Luiz Capitulino 已提交
188
void qmp_screendump(const char *filename, Error **errp)
P
pbrook 已提交
189
{
190
    QemuConsole *previous_active_console;
191
    bool cswitch;
192 193

    previous_active_console = active_console;
194
    cswitch = previous_active_console && previous_active_console->index != 0;
195

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

207
    if (cswitch) {
208 209
        console_select(previous_active_console->index);
    }
P
pbrook 已提交
210 211
}

212
void graphic_hw_text_update(QemuConsole *con, console_ch_t *chardata)
B
balrog 已提交
213
{
214 215 216 217 218
    if (!con) {
        con = active_console;
    }
    if (con && con->hw_text_update)
        con->hw_text_update(con->hw, chardata);
B
balrog 已提交
219 220
}

221 222
static void vga_fill_rect(QemuConsole *con,
                          int posx, int posy, int width, int height,
223
                          pixman_color_t color)
B
bellard 已提交
224
{
225
    DisplaySurface *surface = qemu_console_surface(con);
226 227 228 229 230
    pixman_rectangle16_t rect = {
        .x = posx, .y = posy, .width = width, .height = height
    };

    pixman_image_fill_rectangles(PIXMAN_OP_SRC, surface->image,
231
                                 &color, 1, &rect);
B
bellard 已提交
232 233 234
}

/* copy from (xs, ys) to (xd, yd) a rectangle of size (w, h) */
235 236
static void vga_bitblt(QemuConsole *con,
                       int xs, int ys, int xd, int yd, int w, int h)
B
bellard 已提交
237
{
238
    DisplaySurface *surface = qemu_console_surface(con);
239 240 241 242

    pixman_image_composite(PIXMAN_OP_SRC,
                           surface->image, NULL, surface->image,
                           xs, ys, 0, 0, xd, yd, w, h);
B
bellard 已提交
243 244 245 246 247 248 249 250 251 252
}

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

#define FONT_HEIGHT 16
#define FONT_WIDTH 8

#include "vgafont.h"

253
#ifndef CONFIG_CURSES
254 255 256 257 258 259 260 261 262 263
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
};
264
#endif
265

266 267 268 269
#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] = {
270
    {   /* dark */
B
bellard 已提交
271 272 273 274 275 276 277 278
        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 */
279 280
    },
    {   /* bright */
B
bellard 已提交
281 282 283 284 285 286 287 288
        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 */
289
    }
B
bellard 已提交
290 291
};

292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323
#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 已提交
324

325
static void vga_putcharxy(QemuConsole *s, int x, int y, int ch,
326
                          TextAttributes *t_attrib)
B
bellard 已提交
327
{
328
    static pixman_image_t *glyphs[256];
329
    DisplaySurface *surface = qemu_console_surface(s);
330
    pixman_color_t fgcol, bgcol;
331 332

    if (t_attrib->invers) {
G
Gerd Hoffmann 已提交
333 334
        bgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
        fgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
335
    } else {
G
Gerd Hoffmann 已提交
336 337
        fgcol = color_table_rgb[t_attrib->bold][t_attrib->fgcol];
        bgcol = color_table_rgb[t_attrib->bold][t_attrib->bgcol];
338
    }
B
bellard 已提交
339

340 341
    if (!glyphs[ch]) {
        glyphs[ch] = qemu_pixman_glyph_from_vgafont(FONT_HEIGHT, vgafont16, ch);
B
bellard 已提交
342
    }
343
    qemu_pixman_glyph_render(glyphs[ch], surface->image,
344
                             &fgcol, &bgcol, x, y, FONT_WIDTH, FONT_HEIGHT);
B
bellard 已提交
345 346
}

347
static void text_console_resize(QemuConsole *s)
B
bellard 已提交
348 349 350 351 352 353 354 355 356 357 358 359
{
    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;

360
    cells = g_malloc(s->width * s->total_height * sizeof(TextCell));
B
bellard 已提交
361 362 363 364 365 366 367 368 369 370
    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 = ' ';
371
            c->t_attrib = s->t_attrib_default;
B
bellard 已提交
372 373 374
            c++;
        }
    }
375
    g_free(s->cells);
B
bellard 已提交
376 377 378
    s->cells = cells;
}

379
static inline void text_update_xy(QemuConsole *s, int x, int y)
B
balrog 已提交
380 381 382 383 384 385 386
{
    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);
}

387
static void invalidate_xy(QemuConsole *s, int x, int y)
388 389 390 391 392 393 394 395 396 397 398
{
    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;
}

399
static void update_xy(QemuConsole *s, int x, int y)
B
bellard 已提交
400 401 402 403
{
    TextCell *c;
    int y1, y2;

404 405 406 407 408 409 410
    if (s != active_console) {
        return;
    }

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

412
    if (s->ds->have_gfx) {
B
bellard 已提交
413 414 415 416 417 418
        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];
419
            vga_putcharxy(s, x, y2, c->ch,
420
                          &(c->t_attrib));
421
            invalidate_xy(s, x, y2);
B
bellard 已提交
422 423 424 425
        }
    }
}

426
static void console_show_cursor(QemuConsole *s, int show)
B
bellard 已提交
427 428 429
{
    TextCell *c;
    int y, y1;
430
    int x = s->x;
B
bellard 已提交
431

432 433 434
    if (s != active_console) {
        return;
    }
B
balrog 已提交
435

436 437 438
    if (s->ds->have_text) {
        s->cursor_invalidate = 1;
    }
B
balrog 已提交
439

440
    if (s->ds->have_gfx) {
441 442 443
        if (x >= s->width) {
            x = s->width - 1;
        }
B
bellard 已提交
444 445 446 447 448
        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) {
449
            c = &s->cells[y1 * s->width + x];
450
            if (show && s->cursor_visible_phase) {
451 452
                TextAttributes t_attrib = s->t_attrib_default;
                t_attrib.invers = !(t_attrib.invers); /* invert fg and bg */
453
                vga_putcharxy(s, x, y, c->ch, &t_attrib);
B
bellard 已提交
454
            } else {
455
                vga_putcharxy(s, x, y, c->ch, &(c->t_attrib));
B
bellard 已提交
456
            }
457
            invalidate_xy(s, x, y);
B
bellard 已提交
458 459 460 461
        }
    }
}

462
static void console_refresh(QemuConsole *s)
B
bellard 已提交
463
{
464
    DisplaySurface *surface = qemu_console_surface(s);
B
bellard 已提交
465 466 467
    TextCell *c;
    int x, y, y1;

468
    if (s != active_console)
B
bellard 已提交
469
        return;
470 471

    if (s->ds->have_text) {
B
balrog 已提交
472 473 474 475 476 477
        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 已提交
478

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

static void console_scroll(int ydelta)
{
502
    QemuConsole *s;
B
bellard 已提交
503
    int i, y1;
504

B
bellard 已提交
505
    s = active_console;
506
    if (!s || (s->console_type == GRAPHIC_CONSOLE))
B
bellard 已提交
507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
        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);
}

534
static void console_put_lf(QemuConsole *s)
B
bellard 已提交
535 536 537 538 539 540 541
{
    TextCell *c;
    int x, y1;

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

B
bellard 已提交
543 544 545 546 547 548 549 550 551 552 553 554
        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 = ' ';
555
            c->t_attrib = s->t_attrib_default;
B
bellard 已提交
556 557 558
            c++;
        }
        if (s == active_console && s->y_displayed == s->y_base) {
559
            if (s->ds->have_text) {
B
balrog 已提交
560 561 562 563 564 565
                s->text_x[0] = 0;
                s->text_y[0] = 0;
                s->text_x[1] = s->width - 1;
                s->text_y[1] = s->height - 1;
            }

566 567 568 569 570 571 572 573 574 575 576 577
            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 已提交
578 579 580 581
        }
    }
}

582 583 584 585
/* 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.
 */
586
static void console_handle_escape(QemuConsole *s)
587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678
{
    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;
        }
    }
}

679
static void console_clear_xy(QemuConsole *s, int x, int y)
680 681 682 683 684 685 686 687
{
    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);
}

688
/* set cursor, checking bounds */
689
static void set_cursor(QemuConsole *s, int x, int y)
690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707
{
    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;
}

708
static void console_putchar(QemuConsole *s, int ch)
B
bellard 已提交
709 710
{
    TextCell *c;
711 712
    int y1, i;
    int x, y;
B
bellard 已提交
713 714 715 716

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

void console_select(unsigned int index)
{
915
    DisplaySurface *surface;
916
    QemuConsole *s;
917

B
bellard 已提交
918 919
    if (index >= MAX_CONSOLES)
        return;
G
Gerd Hoffmann 已提交
920 921

    trace_console_select(index);
922
    if (active_console) {
923 924 925
        surface = qemu_console_surface(active_console);
        active_console->g_width = surface_width(surface);
        active_console->g_height = surface_height(surface);
926
    }
B
bellard 已提交
927 928
    s = consoles[index];
    if (s) {
929
        DisplayState *ds = s->ds;
930

931
        if (active_console && active_console->cursor_timer) {
932 933
            qemu_del_timer(active_console->cursor_timer);
        }
B
bellard 已提交
934
        active_console = s;
935
        if (ds->have_gfx) {
936
            surface = qemu_create_displaysurface(s->g_width, s->g_height);
937
            dpy_gfx_replace_surface(s, surface);
938 939
        }
        if (ds->have_text) {
940
            dpy_text_resize(s, s->width, s->height);
941
        }
942 943 944 945
        if (s->cursor_timer) {
            qemu_mod_timer(s->cursor_timer,
                   qemu_get_clock_ms(rt_clock) + CONSOLE_CURSOR_PERIOD / 2);
        }
946
        graphic_hw_invalidate(s);
B
bellard 已提交
947 948 949 950 951
    }
}

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

955 956 957 958
    s->update_x0 = s->width * FONT_WIDTH;
    s->update_y0 = s->height * FONT_HEIGHT;
    s->update_x1 = 0;
    s->update_y1 = 0;
B
bellard 已提交
959 960 961 962 963
    console_show_cursor(s, 0);
    for(i = 0; i < len; i++) {
        console_putchar(s, buf[i]);
    }
    console_show_cursor(s, 1);
964
    if (s->ds->have_gfx && s->update_x0 < s->update_x1) {
965
        dpy_gfx_update(s, s->update_x0, s->update_y0,
966 967
                       s->update_x1 - s->update_x0,
                       s->update_y1 - s->update_y0);
968
    }
B
bellard 已提交
969 970 971
    return len;
}

972 973
static void kbd_send_chars(void *opaque)
{
974
    QemuConsole *s = opaque;
975 976
    int len;
    uint8_t buf[16];
977

978
    len = qemu_chr_be_can_write(s->chr);
979 980 981 982 983 984
    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);
985
        qemu_chr_be_write(s->chr, buf, len);
986 987 988 989
    }
    /* characters are pending: we send them a bit later (XXX:
       horrible, should change char device API) */
    if (s->out_fifo.count > 0) {
990
        qemu_mod_timer(s->kbd_timer, qemu_get_clock_ms(rt_clock) + 1);
991 992 993
    }
}

B
bellard 已提交
994 995 996
/* called when an ascii key is pressed */
void kbd_put_keysym(int keysym)
{
997
    QemuConsole *s;
B
bellard 已提交
998 999 1000 1001
    uint8_t buf[16], *q;
    int c;

    s = active_console;
1002
    if (!s || (s->console_type == GRAPHIC_CONSOLE))
B
bellard 已提交
1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018
        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:
1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032
        /* 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;
1033 1034 1035
        } else if (s->echo && (keysym == '\r' || keysym == '\n')) {
            console_puts(s->chr, (const uint8_t *) "\r", 1);
            *q++ = '\n';
1036
        } else {
1037 1038 1039 1040
            *q++ = keysym;
        }
        if (s->echo) {
            console_puts(s->chr, buf, q - buf);
1041
        }
1042
        if (s->chr->chr_read) {
1043 1044
            qemu_fifo_write(&s->out_fifo, buf, q - buf);
            kbd_send_chars(s);
B
bellard 已提交
1045 1046 1047 1048 1049
        }
        break;
    }
}

B
balrog 已提交
1050 1051
static void text_console_invalidate(void *opaque)
{
1052
    QemuConsole *s = (QemuConsole *) opaque;
1053 1054 1055 1056 1057
    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);
1058 1059
        text_console_resize(s);
    }
B
balrog 已提交
1060 1061 1062
    console_refresh(s);
}

A
Anthony Liguori 已提交
1063
static void text_console_update(void *opaque, console_ch_t *chardata)
B
balrog 已提交
1064
{
1065
    QemuConsole *s = (QemuConsole *) opaque;
B
balrog 已提交
1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
    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));
1077
        dpy_text_update(s, s->text_x[0], s->text_y[0],
1078
                        s->text_x[1] - s->text_x[0], i - s->text_y[0]);
B
balrog 已提交
1079 1080 1081 1082 1083 1084
        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) {
1085
        dpy_text_cursor(s, s->x, s->y);
B
balrog 已提交
1086 1087 1088 1089
        s->cursor_invalidate = 0;
    }
}

1090
static QemuConsole *new_console(DisplayState *ds, console_type_t console_type)
B
bellard 已提交
1091
{
1092
    QemuConsole *s;
P
pbrook 已提交
1093
    int i;
B
bellard 已提交
1094 1095 1096

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

1122 1123
static void qemu_alloc_display(DisplaySurface *surface, int width, int height,
                               int linesize, PixelFormat pf, int newflags)
1124 1125
{
    surface->pf = pf;
1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136

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

1137
    surface->flags = newflags | QEMU_ALLOCATED_FLAG;
1138
#ifdef HOST_WORDS_BIGENDIAN
1139
    surface->flags |= QEMU_BIG_ENDIAN_FLAG;
1140 1141 1142
#endif
}

1143
DisplaySurface *qemu_create_displaysurface(int width, int height)
1144 1145 1146
{
    DisplaySurface *surface = g_new0(DisplaySurface, 1);
    int linesize = width * 4;
1147 1148

    trace_displaysurface_create(surface, width, height);
1149 1150 1151 1152 1153
    qemu_alloc_display(surface, width, height, linesize,
                       qemu_default_pixelformat(32), 0);
    return surface;
}

G
Gerd Hoffmann 已提交
1154
DisplaySurface *qemu_create_displaysurface_from(int width, int height, int bpp,
G
Gerd Hoffmann 已提交
1155 1156
                                                int linesize, uint8_t *data,
                                                bool byteswap)
1157
{
1158
    DisplaySurface *surface = g_new0(DisplaySurface, 1);
1159

1160
    trace_displaysurface_create_from(surface, width, height, bpp, byteswap);
G
Gerd Hoffmann 已提交
1161 1162 1163 1164 1165
    if (byteswap) {
        surface->pf = qemu_different_endianness_pixelformat(bpp);
    } else {
        surface->pf = qemu_default_pixelformat(bpp);
    }
1166 1167 1168 1169 1170 1171 1172 1173

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

1174 1175 1176 1177 1178 1179 1180
#ifdef HOST_WORDS_BIGENDIAN
    surface->flags = QEMU_BIG_ENDIAN_FLAG;
#endif

    return surface;
}

1181
void qemu_free_displaysurface(DisplaySurface *surface)
1182
{
1183
    if (surface == NULL) {
1184
        return;
G
Gerd Hoffmann 已提交
1185
    }
1186 1187 1188
    trace_displaysurface_free(surface);
    qemu_pixman_image_unref(surface->image);
    g_free(surface);
1189 1190
}

1191 1192 1193 1194 1195 1196 1197
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);
1198
    if (dcl->ops->dpy_gfx_switch) {
1199
        dcl->ops->dpy_gfx_switch(dcl, ds->surface);
1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210
    }
}

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

1211
void dpy_gfx_update(QemuConsole *con, int x, int y, int w, int h)
1212
{
1213
    DisplayState *s = con->ds;
1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
    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) {
1227
            dcl->ops->dpy_gfx_update(dcl, x, y, w, h);
1228 1229 1230 1231
        }
    }
}

1232
void dpy_gfx_replace_surface(QemuConsole *con,
1233
                             DisplaySurface *surface)
1234
{
1235
    DisplayState *s = con->ds;
1236
    DisplaySurface *old_surface = s->surface;
1237
    struct DisplayChangeListener *dcl;
1238 1239

    s->surface = surface;
1240
    QLIST_FOREACH(dcl, &s->listeners, next) {
1241
        if (dcl->ops->dpy_gfx_switch) {
1242
            dcl->ops->dpy_gfx_switch(dcl, surface);
1243 1244
        }
    }
1245
    qemu_free_displaysurface(old_surface);
1246 1247 1248 1249 1250 1251 1252
}

void dpy_refresh(DisplayState *s)
{
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_refresh) {
1253
            dcl->ops->dpy_refresh(dcl);
1254 1255 1256 1257
        }
    }
}

1258 1259
void dpy_gfx_copy(QemuConsole *con, int src_x, int src_y,
                  int dst_x, int dst_y, int w, int h)
1260
{
1261
    DisplayState *s = con->ds;
1262 1263 1264
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_gfx_copy) {
1265
            dcl->ops->dpy_gfx_copy(dcl, src_x, src_y, dst_x, dst_y, w, h);
1266
        } else { /* TODO */
1267
            dcl->ops->dpy_gfx_update(dcl, dst_x, dst_y, w, h);
1268 1269 1270 1271
        }
    }
}

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

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

1294
void dpy_text_resize(QemuConsole *con, int w, int h)
1295
{
1296
    DisplayState *s = con->ds;
1297 1298 1299
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_text_resize) {
1300
            dcl->ops->dpy_text_resize(dcl, w, h);
1301 1302 1303 1304
        }
    }
}

1305
void dpy_mouse_set(QemuConsole *con, int x, int y, int on)
1306
{
1307
    DisplayState *s = con->ds;
1308 1309 1310
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_mouse_set) {
1311
            dcl->ops->dpy_mouse_set(dcl, x, y, on);
1312 1313 1314 1315
        }
    }
}

1316
void dpy_cursor_define(QemuConsole *con, QEMUCursor *cursor)
1317
{
1318
    DisplayState *s = con->ds;
1319 1320 1321
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_cursor_define) {
1322
            dcl->ops->dpy_cursor_define(dcl, cursor);
1323 1324 1325 1326
        }
    }
}

1327
bool dpy_cursor_define_supported(QemuConsole *con)
1328
{
1329
    DisplayState *s = con->ds;
1330 1331 1332 1333 1334 1335 1336 1337 1338
    struct DisplayChangeListener *dcl;
    QLIST_FOREACH(dcl, &s->listeners, next) {
        if (dcl->ops->dpy_cursor_define) {
            return true;
        }
    }
    return false;
}

1339 1340 1341
/***********************************************************/
/* register display */

1342 1343
/* console.c internal use only */
static DisplayState *get_alloc_displaystate(void)
1344
{
1345 1346 1347 1348
    if (!display_state) {
        display_state = g_new0(DisplayState, 1);
    }
    return display_state;
1349 1350
}

1351 1352 1353 1354 1355
/*
 * Called by main(), after creating QemuConsoles
 * and before initializing ui (sdl/vnc/...).
 */
DisplayState *init_displaystate(void)
1356
{
1357 1358
    int i;

1359
    if (!display_state) {
1360
        display_state = g_new0(DisplayState, 1);
1361
    }
1362 1363 1364 1365 1366 1367 1368 1369

    for (i = 0; i < nb_consoles; i++) {
        if (consoles[i]->console_type != GRAPHIC_CONSOLE &&
            consoles[i]->ds == NULL) {
            text_console_do_init(consoles[i]->chr, display_state);
        }
    }

1370 1371 1372
    return display_state;
}

1373 1374 1375 1376
QemuConsole *graphic_console_init(graphic_hw_update_ptr update,
                                  graphic_hw_invalidate_ptr invalidate,
                                  graphic_hw_screen_dump_ptr screen_dump,
                                  graphic_hw_text_update_ptr text_update,
1377
                                  void *opaque)
P
pbrook 已提交
1378
{
1379 1380
    int width = 640;
    int height = 480;
1381
    QemuConsole *s;
1382
    DisplayState *ds;
A
aurel32 已提交
1383

1384
    ds = get_alloc_displaystate();
G
Gerd Hoffmann 已提交
1385
    trace_console_gfx_new();
1386
    s = new_console(ds, GRAPHIC_CONSOLE);
P
pbrook 已提交
1387 1388 1389
    s->hw_update = update;
    s->hw_invalidate = invalidate;
    s->hw_screen_dump = screen_dump;
B
balrog 已提交
1390
    s->hw_text_update = text_update;
P
pbrook 已提交
1391
    s->hw = opaque;
1392

1393 1394 1395
    if (!ds->surface) {
        ds->surface = qemu_create_displaysurface(width, height);
    }
1396
    return s;
B
bellard 已提交
1397 1398
}

P
pbrook 已提交
1399
int is_graphic_console(void)
B
bellard 已提交
1400
{
B
balrog 已提交
1401
    return active_console && active_console->console_type == GRAPHIC_CONSOLE;
B
bellard 已提交
1402 1403
}

1404 1405 1406 1407 1408
int is_fixedsize_console(void)
{
    return active_console && active_console->console_type != TEXT_CONSOLE;
}

1409 1410
static void text_console_set_echo(CharDriverState *chr, bool echo)
{
1411
    QemuConsole *s = chr->opaque;
1412 1413 1414 1415

    s->echo = echo;
}

1416 1417
static void text_console_update_cursor(void *opaque)
{
1418
    QemuConsole *s = opaque;
1419 1420

    s->cursor_visible_phase = !s->cursor_visible_phase;
1421
    graphic_hw_invalidate(s);
1422 1423 1424 1425
    qemu_mod_timer(s->cursor_timer,
                   qemu_get_clock_ms(rt_clock) + CONSOLE_CURSOR_PERIOD / 2);
}

P
Paolo Bonzini 已提交
1426
static void text_console_do_init(CharDriverState *chr, DisplayState *ds)
B
bellard 已提交
1427
{
1428
    QemuConsole *s;
1429

1430
    s = chr->opaque;
G
Gerd Hoffmann 已提交
1431

B
bellard 已提交
1432
    chr->chr_write = console_puts;
B
bellard 已提交
1433

1434 1435
    s->out_fifo.buf = s->out_fifo_buf;
    s->out_fifo.buf_size = sizeof(s->out_fifo_buf);
1436
    s->kbd_timer = qemu_new_timer_ms(rt_clock, kbd_send_chars, s);
1437
    s->ds = ds;
1438

B
bellard 已提交
1439 1440 1441 1442 1443
    s->y_displayed = 0;
    s->y_base = 0;
    s->total_height = DEFAULT_BACKSCROLL;
    s->x = 0;
    s->y = 0;
1444
    if (s->console_type == TEXT_CONSOLE) {
1445 1446
        s->g_width = surface_width(s->ds->surface);
        s->g_height = surface_height(s->ds->surface);
1447
    }
1448

1449 1450 1451
    s->cursor_timer =
        qemu_new_timer_ms(rt_clock, text_console_update_cursor, s);

B
balrog 已提交
1452 1453 1454 1455
    s->hw_invalidate = text_console_invalidate;
    s->hw_text_update = text_console_update;
    s->hw = s;

1456 1457 1458 1459 1460 1461 1462 1463 1464 1465
    /* 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 已提交
1466 1467
    text_console_resize(s);

1468 1469 1470 1471
    if (chr->label) {
        char msg[128];
        int len;

1472
        s->t_attrib.bgcol = COLOR_BLUE;
1473 1474
        len = snprintf(msg, sizeof(msg), "%s console\r\n", chr->label);
        console_puts(chr, (uint8_t*)msg, len);
1475
        s->t_attrib = s->t_attrib_default;
1476 1477
    }

1478
    qemu_chr_be_generic_open(chr);
1479 1480
    if (chr->init)
        chr->init(chr);
B
bellard 已提交
1481
}
1482

G
Gerd Hoffmann 已提交
1483
static CharDriverState *text_console_init(ChardevVC *vc)
1484 1485
{
    CharDriverState *chr;
1486
    QemuConsole *s;
G
Gerd Hoffmann 已提交
1487 1488
    unsigned width = 0;
    unsigned height = 0;
1489

1490
    chr = g_malloc0(sizeof(CharDriverState));
1491

G
Gerd Hoffmann 已提交
1492 1493 1494 1495 1496
    if (vc->has_width) {
        width = vc->width;
    } else if (vc->has_cols) {
        width = vc->cols * FONT_WIDTH;
    }
1497

G
Gerd Hoffmann 已提交
1498 1499 1500 1501 1502
    if (vc->has_height) {
        height = vc->height;
    } else if (vc->has_rows) {
        height = vc->rows * FONT_HEIGHT;
    }
1503

G
Gerd Hoffmann 已提交
1504
    trace_console_txt_new(width, height);
1505 1506 1507 1508 1509 1510 1511
    if (width == 0 || height == 0) {
        s = new_console(NULL, TEXT_CONSOLE);
    } else {
        s = new_console(NULL, TEXT_CONSOLE_FIXED_SIZE);
    }

    if (!s) {
1512
        g_free(chr);
1513
        return NULL;
1514 1515 1516 1517 1518 1519
    }

    s->chr = chr;
    s->g_width = width;
    s->g_height = height;
    chr->opaque = s;
1520
    chr->chr_set_echo = text_console_set_echo;
1521 1522 1523 1524

    if (display_state) {
        text_console_do_init(chr, display_state);
    }
1525
    return chr;
1526 1527
}

1528 1529
static VcHandler *vc_handler = text_console_init;

G
Gerd Hoffmann 已提交
1530
CharDriverState *vc_init(ChardevVC *vc)
1531
{
G
Gerd Hoffmann 已提交
1532
    return vc_handler(vc);
1533 1534 1535 1536 1537 1538 1539
}

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

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

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

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

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

1569
PixelFormat qemu_different_endianness_pixelformat(int bpp)
1570 1571 1572 1573 1574 1575
{
    PixelFormat pf;

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

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

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

PixelFormat qemu_default_pixelformat(int bpp)
{
    PixelFormat pf;

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

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

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

G
Gerd Hoffmann 已提交
1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723
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;
    }
}

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

type_init(register_types);