root / hw / display / ssd0323.c @ 49ab747f
History | View | Annotate | Download (9.8 kB)
1 |
/*
|
---|---|
2 |
* SSD0323 OLED controller with OSRAM Pictiva 128x64 display.
|
3 |
*
|
4 |
* Copyright (c) 2006-2007 CodeSourcery.
|
5 |
* Written by Paul Brook
|
6 |
*
|
7 |
* This code is licensed under the GPL.
|
8 |
*/
|
9 |
|
10 |
/* The controller can support a variety of different displays, but we only
|
11 |
implement one. Most of the commends relating to brightness and geometry
|
12 |
setup are ignored. */
|
13 |
#include "hw/ssi.h" |
14 |
#include "ui/console.h" |
15 |
|
16 |
//#define DEBUG_SSD0323 1
|
17 |
|
18 |
#ifdef DEBUG_SSD0323
|
19 |
#define DPRINTF(fmt, ...) \
|
20 |
do { printf("ssd0323: " fmt , ## __VA_ARGS__); } while (0) |
21 |
#define BADF(fmt, ...) \
|
22 |
do { \
|
23 |
fprintf(stderr, "ssd0323: error: " fmt , ## __VA_ARGS__); abort(); \ |
24 |
} while (0) |
25 |
#else
|
26 |
#define DPRINTF(fmt, ...) do {} while(0) |
27 |
#define BADF(fmt, ...) \
|
28 |
do { fprintf(stderr, "ssd0323: error: " fmt , ## __VA_ARGS__);} while (0) |
29 |
#endif
|
30 |
|
31 |
/* Scaling factor for pixels. */
|
32 |
#define MAGNIFY 4 |
33 |
|
34 |
#define REMAP_SWAP_COLUMN 0x01 |
35 |
#define REMAP_SWAP_NYBBLE 0x02 |
36 |
#define REMAP_VERTICAL 0x04 |
37 |
#define REMAP_SWAP_COM 0x10 |
38 |
#define REMAP_SPLIT_COM 0x40 |
39 |
|
40 |
enum ssd0323_mode
|
41 |
{ |
42 |
SSD0323_CMD, |
43 |
SSD0323_DATA |
44 |
}; |
45 |
|
46 |
typedef struct { |
47 |
SSISlave ssidev; |
48 |
QemuConsole *con; |
49 |
|
50 |
int cmd_len;
|
51 |
int cmd;
|
52 |
int cmd_data[8]; |
53 |
int row;
|
54 |
int row_start;
|
55 |
int row_end;
|
56 |
int col;
|
57 |
int col_start;
|
58 |
int col_end;
|
59 |
int redraw;
|
60 |
int remap;
|
61 |
enum ssd0323_mode mode;
|
62 |
uint8_t framebuffer[128 * 80 / 2]; |
63 |
} ssd0323_state; |
64 |
|
65 |
static uint32_t ssd0323_transfer(SSISlave *dev, uint32_t data)
|
66 |
{ |
67 |
ssd0323_state *s = FROM_SSI_SLAVE(ssd0323_state, dev); |
68 |
|
69 |
switch (s->mode) {
|
70 |
case SSD0323_DATA:
|
71 |
DPRINTF("data 0x%02x\n", data);
|
72 |
s->framebuffer[s->col + s->row * 64] = data;
|
73 |
if (s->remap & REMAP_VERTICAL) {
|
74 |
s->row++; |
75 |
if (s->row > s->row_end) {
|
76 |
s->row = s->row_start; |
77 |
s->col++; |
78 |
} |
79 |
if (s->col > s->col_end) {
|
80 |
s->col = s->col_start; |
81 |
} |
82 |
} else {
|
83 |
s->col++; |
84 |
if (s->col > s->col_end) {
|
85 |
s->row++; |
86 |
s->col = s->col_start; |
87 |
} |
88 |
if (s->row > s->row_end) {
|
89 |
s->row = s->row_start; |
90 |
} |
91 |
} |
92 |
s->redraw = 1;
|
93 |
break;
|
94 |
case SSD0323_CMD:
|
95 |
DPRINTF("cmd 0x%02x\n", data);
|
96 |
if (s->cmd_len == 0) { |
97 |
s->cmd = data; |
98 |
} else {
|
99 |
s->cmd_data[s->cmd_len - 1] = data;
|
100 |
} |
101 |
s->cmd_len++; |
102 |
switch (s->cmd) {
|
103 |
#define DATA(x) if (s->cmd_len <= (x)) return 0 |
104 |
case 0x15: /* Set column. */ |
105 |
DATA(2);
|
106 |
s->col = s->col_start = s->cmd_data[0] % 64; |
107 |
s->col_end = s->cmd_data[1] % 64; |
108 |
break;
|
109 |
case 0x75: /* Set row. */ |
110 |
DATA(2);
|
111 |
s->row = s->row_start = s->cmd_data[0] % 80; |
112 |
s->row_end = s->cmd_data[1] % 80; |
113 |
break;
|
114 |
case 0x81: /* Set contrast */ |
115 |
DATA(1);
|
116 |
break;
|
117 |
case 0x84: case 0x85: case 0x86: /* Max current. */ |
118 |
DATA(0);
|
119 |
break;
|
120 |
case 0xa0: /* Set remapping. */ |
121 |
/* FIXME: Implement this. */
|
122 |
DATA(1);
|
123 |
s->remap = s->cmd_data[0];
|
124 |
break;
|
125 |
case 0xa1: /* Set display start line. */ |
126 |
case 0xa2: /* Set display offset. */ |
127 |
/* FIXME: Implement these. */
|
128 |
DATA(1);
|
129 |
break;
|
130 |
case 0xa4: /* Normal mode. */ |
131 |
case 0xa5: /* All on. */ |
132 |
case 0xa6: /* All off. */ |
133 |
case 0xa7: /* Inverse. */ |
134 |
/* FIXME: Implement these. */
|
135 |
DATA(0);
|
136 |
break;
|
137 |
case 0xa8: /* Set multiplex ratio. */ |
138 |
case 0xad: /* Set DC-DC converter. */ |
139 |
DATA(1);
|
140 |
/* Ignored. Don't care. */
|
141 |
break;
|
142 |
case 0xae: /* Display off. */ |
143 |
case 0xaf: /* Display on. */ |
144 |
DATA(0);
|
145 |
/* TODO: Implement power control. */
|
146 |
break;
|
147 |
case 0xb1: /* Set phase length. */ |
148 |
case 0xb2: /* Set row period. */ |
149 |
case 0xb3: /* Set clock rate. */ |
150 |
case 0xbc: /* Set precharge. */ |
151 |
case 0xbe: /* Set VCOMH. */ |
152 |
case 0xbf: /* Set segment low. */ |
153 |
DATA(1);
|
154 |
/* Ignored. Don't care. */
|
155 |
break;
|
156 |
case 0xb8: /* Set grey scale table. */ |
157 |
/* FIXME: Implement this. */
|
158 |
DATA(8);
|
159 |
break;
|
160 |
case 0xe3: /* NOP. */ |
161 |
DATA(0);
|
162 |
break;
|
163 |
case 0xff: /* Nasty hack because we don't handle chip selects |
164 |
properly. */
|
165 |
break;
|
166 |
default:
|
167 |
BADF("Unknown command: 0x%x\n", data);
|
168 |
} |
169 |
s->cmd_len = 0;
|
170 |
return 0; |
171 |
} |
172 |
return 0; |
173 |
} |
174 |
|
175 |
static void ssd0323_update_display(void *opaque) |
176 |
{ |
177 |
ssd0323_state *s = (ssd0323_state *)opaque; |
178 |
DisplaySurface *surface = qemu_console_surface(s->con); |
179 |
uint8_t *dest; |
180 |
uint8_t *src; |
181 |
int x;
|
182 |
int y;
|
183 |
int i;
|
184 |
int line;
|
185 |
char *colors[16]; |
186 |
char colortab[MAGNIFY * 64]; |
187 |
char *p;
|
188 |
int dest_width;
|
189 |
|
190 |
if (!s->redraw)
|
191 |
return;
|
192 |
|
193 |
switch (surface_bits_per_pixel(surface)) {
|
194 |
case 0: |
195 |
return;
|
196 |
case 15: |
197 |
dest_width = 2;
|
198 |
break;
|
199 |
case 16: |
200 |
dest_width = 2;
|
201 |
break;
|
202 |
case 24: |
203 |
dest_width = 3;
|
204 |
break;
|
205 |
case 32: |
206 |
dest_width = 4;
|
207 |
break;
|
208 |
default:
|
209 |
BADF("Bad color depth\n");
|
210 |
return;
|
211 |
} |
212 |
p = colortab; |
213 |
for (i = 0; i < 16; i++) { |
214 |
int n;
|
215 |
colors[i] = p; |
216 |
switch (surface_bits_per_pixel(surface)) {
|
217 |
case 15: |
218 |
n = i * 2 + (i >> 3); |
219 |
p[0] = n | (n << 5); |
220 |
p[1] = (n << 2) | (n >> 3); |
221 |
break;
|
222 |
case 16: |
223 |
n = i * 2 + (i >> 3); |
224 |
p[0] = n | (n << 6) | ((n << 1) & 0x20); |
225 |
p[1] = (n << 3) | (n >> 2); |
226 |
break;
|
227 |
case 24: |
228 |
case 32: |
229 |
n = (i << 4) | i;
|
230 |
p[0] = p[1] = p[2] = n; |
231 |
break;
|
232 |
default:
|
233 |
BADF("Bad color depth\n");
|
234 |
return;
|
235 |
} |
236 |
p += dest_width; |
237 |
} |
238 |
/* TODO: Implement row/column remapping. */
|
239 |
dest = surface_data(surface); |
240 |
for (y = 0; y < 64; y++) { |
241 |
line = y; |
242 |
src = s->framebuffer + 64 * line;
|
243 |
for (x = 0; x < 64; x++) { |
244 |
int val;
|
245 |
val = *src >> 4;
|
246 |
for (i = 0; i < MAGNIFY; i++) { |
247 |
memcpy(dest, colors[val], dest_width); |
248 |
dest += dest_width; |
249 |
} |
250 |
val = *src & 0xf;
|
251 |
for (i = 0; i < MAGNIFY; i++) { |
252 |
memcpy(dest, colors[val], dest_width); |
253 |
dest += dest_width; |
254 |
} |
255 |
src++; |
256 |
} |
257 |
for (i = 1; i < MAGNIFY; i++) { |
258 |
memcpy(dest, dest - dest_width * MAGNIFY * 128,
|
259 |
dest_width * 128 * MAGNIFY);
|
260 |
dest += dest_width * 128 * MAGNIFY;
|
261 |
} |
262 |
} |
263 |
s->redraw = 0;
|
264 |
dpy_gfx_update(s->con, 0, 0, 128 * MAGNIFY, 64 * MAGNIFY); |
265 |
} |
266 |
|
267 |
static void ssd0323_invalidate_display(void * opaque) |
268 |
{ |
269 |
ssd0323_state *s = (ssd0323_state *)opaque; |
270 |
s->redraw = 1;
|
271 |
} |
272 |
|
273 |
/* Command/data input. */
|
274 |
static void ssd0323_cd(void *opaque, int n, int level) |
275 |
{ |
276 |
ssd0323_state *s = (ssd0323_state *)opaque; |
277 |
DPRINTF("%s mode\n", level ? "Data" : "Command"); |
278 |
s->mode = level ? SSD0323_DATA : SSD0323_CMD; |
279 |
} |
280 |
|
281 |
static void ssd0323_save(QEMUFile *f, void *opaque) |
282 |
{ |
283 |
SSISlave *ss = SSI_SLAVE(opaque); |
284 |
ssd0323_state *s = (ssd0323_state *)opaque; |
285 |
int i;
|
286 |
|
287 |
qemu_put_be32(f, s->cmd_len); |
288 |
qemu_put_be32(f, s->cmd); |
289 |
for (i = 0; i < 8; i++) |
290 |
qemu_put_be32(f, s->cmd_data[i]); |
291 |
qemu_put_be32(f, s->row); |
292 |
qemu_put_be32(f, s->row_start); |
293 |
qemu_put_be32(f, s->row_end); |
294 |
qemu_put_be32(f, s->col); |
295 |
qemu_put_be32(f, s->col_start); |
296 |
qemu_put_be32(f, s->col_end); |
297 |
qemu_put_be32(f, s->redraw); |
298 |
qemu_put_be32(f, s->remap); |
299 |
qemu_put_be32(f, s->mode); |
300 |
qemu_put_buffer(f, s->framebuffer, sizeof(s->framebuffer));
|
301 |
|
302 |
qemu_put_be32(f, ss->cs); |
303 |
} |
304 |
|
305 |
static int ssd0323_load(QEMUFile *f, void *opaque, int version_id) |
306 |
{ |
307 |
SSISlave *ss = SSI_SLAVE(opaque); |
308 |
ssd0323_state *s = (ssd0323_state *)opaque; |
309 |
int i;
|
310 |
|
311 |
if (version_id != 1) |
312 |
return -EINVAL;
|
313 |
|
314 |
s->cmd_len = qemu_get_be32(f); |
315 |
s->cmd = qemu_get_be32(f); |
316 |
for (i = 0; i < 8; i++) |
317 |
s->cmd_data[i] = qemu_get_be32(f); |
318 |
s->row = qemu_get_be32(f); |
319 |
s->row_start = qemu_get_be32(f); |
320 |
s->row_end = qemu_get_be32(f); |
321 |
s->col = qemu_get_be32(f); |
322 |
s->col_start = qemu_get_be32(f); |
323 |
s->col_end = qemu_get_be32(f); |
324 |
s->redraw = qemu_get_be32(f); |
325 |
s->remap = qemu_get_be32(f); |
326 |
s->mode = qemu_get_be32(f); |
327 |
qemu_get_buffer(f, s->framebuffer, sizeof(s->framebuffer));
|
328 |
|
329 |
ss->cs = qemu_get_be32(f); |
330 |
|
331 |
return 0; |
332 |
} |
333 |
|
334 |
static int ssd0323_init(SSISlave *dev) |
335 |
{ |
336 |
ssd0323_state *s = FROM_SSI_SLAVE(ssd0323_state, dev); |
337 |
|
338 |
s->col_end = 63;
|
339 |
s->row_end = 79;
|
340 |
s->con = graphic_console_init(ssd0323_update_display, |
341 |
ssd0323_invalidate_display, |
342 |
NULL, NULL, s); |
343 |
qemu_console_resize(s->con, 128 * MAGNIFY, 64 * MAGNIFY); |
344 |
|
345 |
qdev_init_gpio_in(&dev->qdev, ssd0323_cd, 1);
|
346 |
|
347 |
register_savevm(&dev->qdev, "ssd0323_oled", -1, 1, |
348 |
ssd0323_save, ssd0323_load, s); |
349 |
return 0; |
350 |
} |
351 |
|
352 |
static void ssd0323_class_init(ObjectClass *klass, void *data) |
353 |
{ |
354 |
SSISlaveClass *k = SSI_SLAVE_CLASS(klass); |
355 |
|
356 |
k->init = ssd0323_init; |
357 |
k->transfer = ssd0323_transfer; |
358 |
k->cs_polarity = SSI_CS_HIGH; |
359 |
} |
360 |
|
361 |
static const TypeInfo ssd0323_info = { |
362 |
.name = "ssd0323",
|
363 |
.parent = TYPE_SSI_SLAVE, |
364 |
.instance_size = sizeof(ssd0323_state),
|
365 |
.class_init = ssd0323_class_init, |
366 |
}; |
367 |
|
368 |
static void ssd03232_register_types(void) |
369 |
{ |
370 |
type_register_static(&ssd0323_info); |
371 |
} |
372 |
|
373 |
type_init(ssd03232_register_types) |