tc6393xb: non-accelerated FB support (Dmitry Baryshkov).
[qemu] / hw / tc6393xb_template.h
1 /*
2  * Toshiba TC6393XB I/O Controller.
3  * Found in Sharp Zaurus SL-6000 (tosa) or some
4  * Toshiba e-Series PDAs.
5  *
6  * FB support code. Based on G364 fb emulator
7  *
8  * Copyright (c) 2007 HervĂ© Poussineau
9  *
10  * This program is free software; you can redistribute it and/or
11  * modify it under the terms of the GNU General Public License as
12  * published by the Free Software Foundation; either version 2 of
13  * the License, or (at your option) any later version.
14  *
15  * This program is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  * GNU General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
23  * MA 02111-1307 USA
24  */
25
26 #if BITS == 8
27 # define SET_PIXEL(addr, color) *(uint8_t*)addr = color;
28 #elif BITS == 15 || BITS == 16
29 # define SET_PIXEL(addr, color) *(uint16_t*)addr = color;
30 #elif BITS == 24
31 # define SET_PIXEL(addr, color) \
32     addr[0] = color; addr[1] = (color) >> 8; addr[2] = (color) >> 16;
33 #elif BITS == 32
34 # define SET_PIXEL(addr, color) *(uint32_t*)addr = color;
35 #else
36 # error unknown bit depth
37 #endif
38
39
40 static void glue(tc6393xb_draw_graphic, BITS)(struct tc6393xb_s *s)
41 {
42     int i;
43     int w_display;
44     uint16_t *data_buffer;
45     uint8_t *data_display;
46
47     data_buffer = (uint16_t*)(phys_ram_base + s->vram_addr);
48     w_display = s->scr_width * BITS / 8;
49     data_display = s->ds->data;
50     for(i = 0; i < s->scr_height; i++) {
51 #if (BITS == 16)
52         memcpy(data_display, data_buffer, s->scr_width * 2);
53         data_buffer += s->scr_width;
54         data_display += s->ds->linesize;
55 #else
56         int j;
57         for (j = 0; j < s->scr_width; j++, data_display += BITS / 8, data_buffer++) {
58             uint16_t color = *data_buffer;
59             uint32_t dest_color = glue(rgb_to_pixel, BITS)(
60                            ((color & 0xf800) * 0x108) >> 11,
61                            ((color & 0x7e0) * 0x41) >> 9,
62                            ((color & 0x1f) * 0x21) >> 2
63                            );
64             SET_PIXEL(data_display, dest_color);
65         }
66 #endif
67     }
68 }
69
70 #undef BITS
71 #undef SET_PIXEL
72