1
2
3
4
5
6
7
8
9
10
11
12
13
14#include "qemu/osdep.h"
15#include "hw/ssi/ssi.h"
16#include "migration/vmstate.h"
17#include "qemu/module.h"
18#include "ui/console.h"
19
20
21
22#ifdef DEBUG_SSD0323
23#define DPRINTF(fmt, ...) \
24do { printf("ssd0323: " fmt , ## __VA_ARGS__); } while (0)
25#define BADF(fmt, ...) \
26do { \
27 fprintf(stderr, "ssd0323: error: " fmt , ## __VA_ARGS__); abort(); \
28} while (0)
29#else
30#define DPRINTF(fmt, ...) do {} while(0)
31#define BADF(fmt, ...) \
32do { fprintf(stderr, "ssd0323: error: " fmt , ## __VA_ARGS__);} while (0)
33#endif
34
35
36#define MAGNIFY 4
37
38#define REMAP_SWAP_COLUMN 0x01
39#define REMAP_SWAP_NYBBLE 0x02
40#define REMAP_VERTICAL 0x04
41#define REMAP_SWAP_COM 0x10
42#define REMAP_SPLIT_COM 0x40
43
44enum ssd0323_mode
45{
46 SSD0323_CMD,
47 SSD0323_DATA
48};
49
50typedef struct {
51 SSISlave ssidev;
52 QemuConsole *con;
53
54 uint32_t cmd_len;
55 int32_t cmd;
56 int32_t cmd_data[8];
57 int32_t row;
58 int32_t row_start;
59 int32_t row_end;
60 int32_t col;
61 int32_t col_start;
62 int32_t col_end;
63 int32_t redraw;
64 int32_t remap;
65 uint32_t mode;
66 uint8_t framebuffer[128 * 80 / 2];
67} ssd0323_state;
68
69static uint32_t ssd0323_transfer(SSISlave *dev, uint32_t data)
70{
71 ssd0323_state *s = FROM_SSI_SLAVE(ssd0323_state, dev);
72
73 switch (s->mode) {
74 case SSD0323_DATA:
75 DPRINTF("data 0x%02x\n", data);
76 s->framebuffer[s->col + s->row * 64] = data;
77 if (s->remap & REMAP_VERTICAL) {
78 s->row++;
79 if (s->row > s->row_end) {
80 s->row = s->row_start;
81 s->col++;
82 }
83 if (s->col > s->col_end) {
84 s->col = s->col_start;
85 }
86 } else {
87 s->col++;
88 if (s->col > s->col_end) {
89 s->row++;
90 s->col = s->col_start;
91 }
92 if (s->row > s->row_end) {
93 s->row = s->row_start;
94 }
95 }
96 s->redraw = 1;
97 break;
98 case SSD0323_CMD:
99 DPRINTF("cmd 0x%02x\n", data);
100 if (s->cmd_len == 0) {
101 s->cmd = data;
102 } else {
103 s->cmd_data[s->cmd_len - 1] = data;
104 }
105 s->cmd_len++;
106 switch (s->cmd) {
107#define DATA(x) if (s->cmd_len <= (x)) return 0
108 case 0x15:
109 DATA(2);
110 s->col = s->col_start = s->cmd_data[0] % 64;
111 s->col_end = s->cmd_data[1] % 64;
112 break;
113 case 0x75:
114 DATA(2);
115 s->row = s->row_start = s->cmd_data[0] % 80;
116 s->row_end = s->cmd_data[1] % 80;
117 break;
118 case 0x81:
119 DATA(1);
120 break;
121 case 0x84: case 0x85: case 0x86:
122 DATA(0);
123 break;
124 case 0xa0:
125
126 DATA(1);
127 s->remap = s->cmd_data[0];
128 break;
129 case 0xa1:
130 case 0xa2:
131
132 DATA(1);
133 break;
134 case 0xa4:
135 case 0xa5:
136 case 0xa6:
137 case 0xa7:
138
139 DATA(0);
140 break;
141 case 0xa8:
142 case 0xad:
143 DATA(1);
144
145 break;
146 case 0xae:
147 case 0xaf:
148 DATA(0);
149
150 break;
151 case 0xb1:
152 case 0xb2:
153 case 0xb3:
154 case 0xbc:
155 case 0xbe:
156 case 0xbf:
157 DATA(1);
158
159 break;
160 case 0xb8:
161
162 DATA(8);
163 break;
164 case 0xe3:
165 DATA(0);
166 break;
167 case 0xff:
168
169 break;
170 default:
171 BADF("Unknown command: 0x%x\n", data);
172 }
173 s->cmd_len = 0;
174 return 0;
175 }
176 return 0;
177}
178
179static void ssd0323_update_display(void *opaque)
180{
181 ssd0323_state *s = (ssd0323_state *)opaque;
182 DisplaySurface *surface = qemu_console_surface(s->con);
183 uint8_t *dest;
184 uint8_t *src;
185 int x;
186 int y;
187 int i;
188 int line;
189 char *colors[16];
190 char colortab[MAGNIFY * 64];
191 char *p;
192 int dest_width;
193
194 if (!s->redraw)
195 return;
196
197 switch (surface_bits_per_pixel(surface)) {
198 case 0:
199 return;
200 case 15:
201 dest_width = 2;
202 break;
203 case 16:
204 dest_width = 2;
205 break;
206 case 24:
207 dest_width = 3;
208 break;
209 case 32:
210 dest_width = 4;
211 break;
212 default:
213 BADF("Bad color depth\n");
214 return;
215 }
216 p = colortab;
217 for (i = 0; i < 16; i++) {
218 int n;
219 colors[i] = p;
220 switch (surface_bits_per_pixel(surface)) {
221 case 15:
222 n = i * 2 + (i >> 3);
223 p[0] = n | (n << 5);
224 p[1] = (n << 2) | (n >> 3);
225 break;
226 case 16:
227 n = i * 2 + (i >> 3);
228 p[0] = n | (n << 6) | ((n << 1) & 0x20);
229 p[1] = (n << 3) | (n >> 2);
230 break;
231 case 24:
232 case 32:
233 n = (i << 4) | i;
234 p[0] = p[1] = p[2] = n;
235 break;
236 default:
237 BADF("Bad color depth\n");
238 return;
239 }
240 p += dest_width;
241 }
242
243 dest = surface_data(surface);
244 for (y = 0; y < 64; y++) {
245 line = y;
246 src = s->framebuffer + 64 * line;
247 for (x = 0; x < 64; x++) {
248 int val;
249 val = *src >> 4;
250 for (i = 0; i < MAGNIFY; i++) {
251 memcpy(dest, colors[val], dest_width);
252 dest += dest_width;
253 }
254 val = *src & 0xf;
255 for (i = 0; i < MAGNIFY; i++) {
256 memcpy(dest, colors[val], dest_width);
257 dest += dest_width;
258 }
259 src++;
260 }
261 for (i = 1; i < MAGNIFY; i++) {
262 memcpy(dest, dest - dest_width * MAGNIFY * 128,
263 dest_width * 128 * MAGNIFY);
264 dest += dest_width * 128 * MAGNIFY;
265 }
266 }
267 s->redraw = 0;
268 dpy_gfx_update(s->con, 0, 0, 128 * MAGNIFY, 64 * MAGNIFY);
269}
270
271static void ssd0323_invalidate_display(void * opaque)
272{
273 ssd0323_state *s = (ssd0323_state *)opaque;
274 s->redraw = 1;
275}
276
277
278static void ssd0323_cd(void *opaque, int n, int level)
279{
280 ssd0323_state *s = (ssd0323_state *)opaque;
281 DPRINTF("%s mode\n", level ? "Data" : "Command");
282 s->mode = level ? SSD0323_DATA : SSD0323_CMD;
283}
284
285static int ssd0323_post_load(void *opaque, int version_id)
286{
287 ssd0323_state *s = (ssd0323_state *)opaque;
288
289 if (s->cmd_len > ARRAY_SIZE(s->cmd_data)) {
290 return -EINVAL;
291 }
292 if (s->row < 0 || s->row >= 80) {
293 return -EINVAL;
294 }
295 if (s->row_start < 0 || s->row_start >= 80) {
296 return -EINVAL;
297 }
298 if (s->row_end < 0 || s->row_end >= 80) {
299 return -EINVAL;
300 }
301 if (s->col < 0 || s->col >= 64) {
302 return -EINVAL;
303 }
304 if (s->col_start < 0 || s->col_start >= 64) {
305 return -EINVAL;
306 }
307 if (s->col_end < 0 || s->col_end >= 64) {
308 return -EINVAL;
309 }
310 if (s->mode != SSD0323_CMD && s->mode != SSD0323_DATA) {
311 return -EINVAL;
312 }
313
314 return 0;
315}
316
317static const VMStateDescription vmstate_ssd0323 = {
318 .name = "ssd0323_oled",
319 .version_id = 2,
320 .minimum_version_id = 2,
321 .post_load = ssd0323_post_load,
322 .fields = (VMStateField []) {
323 VMSTATE_UINT32(cmd_len, ssd0323_state),
324 VMSTATE_INT32(cmd, ssd0323_state),
325 VMSTATE_INT32_ARRAY(cmd_data, ssd0323_state, 8),
326 VMSTATE_INT32(row, ssd0323_state),
327 VMSTATE_INT32(row_start, ssd0323_state),
328 VMSTATE_INT32(row_end, ssd0323_state),
329 VMSTATE_INT32(col, ssd0323_state),
330 VMSTATE_INT32(col_start, ssd0323_state),
331 VMSTATE_INT32(col_end, ssd0323_state),
332 VMSTATE_INT32(redraw, ssd0323_state),
333 VMSTATE_INT32(remap, ssd0323_state),
334 VMSTATE_UINT32(mode, ssd0323_state),
335 VMSTATE_BUFFER(framebuffer, ssd0323_state),
336 VMSTATE_SSI_SLAVE(ssidev, ssd0323_state),
337 VMSTATE_END_OF_LIST()
338 }
339};
340
341static const GraphicHwOps ssd0323_ops = {
342 .invalidate = ssd0323_invalidate_display,
343 .gfx_update = ssd0323_update_display,
344};
345
346static void ssd0323_realize(SSISlave *d, Error **errp)
347{
348 DeviceState *dev = DEVICE(d);
349 ssd0323_state *s = FROM_SSI_SLAVE(ssd0323_state, d);
350
351 s->col_end = 63;
352 s->row_end = 79;
353 s->con = graphic_console_init(dev, 0, &ssd0323_ops, s);
354 qemu_console_resize(s->con, 128 * MAGNIFY, 64 * MAGNIFY);
355
356 qdev_init_gpio_in(dev, ssd0323_cd, 1);
357}
358
359static void ssd0323_class_init(ObjectClass *klass, void *data)
360{
361 DeviceClass *dc = DEVICE_CLASS(klass);
362 SSISlaveClass *k = SSI_SLAVE_CLASS(klass);
363
364 k->realize = ssd0323_realize;
365 k->transfer = ssd0323_transfer;
366 k->cs_polarity = SSI_CS_HIGH;
367 dc->vmsd = &vmstate_ssd0323;
368}
369
370static const TypeInfo ssd0323_info = {
371 .name = "ssd0323",
372 .parent = TYPE_SSI_SLAVE,
373 .instance_size = sizeof(ssd0323_state),
374 .class_init = ssd0323_class_init,
375};
376
377static void ssd03232_register_types(void)
378{
379 type_register_static(&ssd0323_info);
380}
381
382type_init(ssd03232_register_types)
383
