1
2
3
4
5
6
7
8
9
10
11
12
13#include "qemu/osdep.h"
14#include "hw/i2c/i2c.h"
15#include "ui/console.h"
16
17
18
19#ifdef DEBUG_SSD0303
20#define DPRINTF(fmt, ...) \
21do { printf("ssd0303: " fmt , ## __VA_ARGS__); } while (0)
22#define BADF(fmt, ...) \
23do { fprintf(stderr, "ssd0303: error: " fmt , ## __VA_ARGS__); exit(1);} while (0)
24#else
25#define DPRINTF(fmt, ...) do {} while(0)
26#define BADF(fmt, ...) \
27do { fprintf(stderr, "ssd0303: error: " fmt , ## __VA_ARGS__);} while (0)
28#endif
29
30
31#define MAGNIFY 4
32
33enum ssd0303_mode
34{
35 SSD0303_IDLE,
36 SSD0303_DATA,
37 SSD0303_CMD
38};
39
40enum ssd0303_cmd {
41 SSD0303_CMD_NONE,
42 SSD0303_CMD_SKIP1
43};
44
45#define TYPE_SSD0303 "ssd0303"
46#define SSD0303(obj) OBJECT_CHECK(ssd0303_state, (obj), TYPE_SSD0303)
47
48typedef struct {
49 I2CSlave parent_obj;
50
51 QemuConsole *con;
52 int row;
53 int col;
54 int start_line;
55 int mirror;
56 int flash;
57 int enabled;
58 int inverse;
59 int redraw;
60 enum ssd0303_mode mode;
61 enum ssd0303_cmd cmd_state;
62 uint8_t framebuffer[132*8];
63} ssd0303_state;
64
65static int ssd0303_recv(I2CSlave *i2c)
66{
67 BADF("Reads not implemented\n");
68 return -1;
69}
70
71static int ssd0303_send(I2CSlave *i2c, uint8_t data)
72{
73 ssd0303_state *s = SSD0303(i2c);
74 enum ssd0303_cmd old_cmd_state;
75
76 switch (s->mode) {
77 case SSD0303_IDLE:
78 DPRINTF("byte 0x%02x\n", data);
79 if (data == 0x80)
80 s->mode = SSD0303_CMD;
81 else if (data == 0x40)
82 s->mode = SSD0303_DATA;
83 else
84 BADF("Unexpected byte 0x%x\n", data);
85 break;
86 case SSD0303_DATA:
87 DPRINTF("data 0x%02x\n", data);
88 if (s->col < 132) {
89 s->framebuffer[s->col + s->row * 132] = data;
90 s->col++;
91 s->redraw = 1;
92 }
93 break;
94 case SSD0303_CMD:
95 old_cmd_state = s->cmd_state;
96 s->cmd_state = SSD0303_CMD_NONE;
97 switch (old_cmd_state) {
98 case SSD0303_CMD_NONE:
99 DPRINTF("cmd 0x%02x\n", data);
100 s->mode = SSD0303_IDLE;
101 switch (data) {
102 case 0x00 ... 0x0f:
103 s->col = (s->col & 0xf0) | (data & 0xf);
104 break;
105 case 0x10 ... 0x20:
106 s->col = (s->col & 0x0f) | ((data & 0xf) << 4);
107 break;
108 case 0x40 ... 0x7f:
109 s->start_line = 0;
110 break;
111 case 0x81:
112 s->cmd_state = SSD0303_CMD_SKIP1;
113 break;
114 case 0xa0:
115 s->mirror = 0;
116 break;
117 case 0xa1:
118 s->mirror = 1;
119 break;
120 case 0xa4:
121 s->flash = 0;
122 break;
123 case 0xa5:
124 s->flash = 1;
125 break;
126 case 0xa6:
127 s->inverse = 0;
128 break;
129 case 0xa7:
130 s->inverse = 1;
131 break;
132 case 0xa8:
133 s->cmd_state = SSD0303_CMD_SKIP1;
134 break;
135 case 0xad:
136 s->cmd_state = SSD0303_CMD_SKIP1;
137 break;
138 case 0xae:
139 s->enabled = 0;
140 break;
141 case 0xaf:
142 s->enabled = 1;
143 break;
144 case 0xb0 ... 0xbf:
145 s->row = data & 7;
146 break;
147 case 0xc0 ... 0xc8:
148 break;
149 case 0xd3:
150 s->cmd_state = SSD0303_CMD_SKIP1;
151 break;
152 case 0xd5:
153 s->cmd_state = SSD0303_CMD_SKIP1;
154 break;
155 case 0xd8:
156 s->cmd_state = SSD0303_CMD_SKIP1;
157 break;
158 case 0xd9:
159 s->cmd_state = SSD0303_CMD_SKIP1;
160 break;
161 case 0xda:
162 s->cmd_state = SSD0303_CMD_SKIP1;
163 break;
164 case 0xdb:
165 s->cmd_state = SSD0303_CMD_SKIP1;
166 break;
167 case 0xe3:
168 break;
169 default:
170 BADF("Unknown command: 0x%x\n", data);
171 }
172 break;
173 case SSD0303_CMD_SKIP1:
174 DPRINTF("skip 0x%02x\n", data);
175 break;
176 }
177 break;
178 }
179 return 0;
180}
181
182static void ssd0303_event(I2CSlave *i2c, enum i2c_event event)
183{
184 ssd0303_state *s = SSD0303(i2c);
185
186 switch (event) {
187 case I2C_FINISH:
188 s->mode = SSD0303_IDLE;
189 break;
190 case I2C_START_RECV:
191 case I2C_START_SEND:
192 case I2C_NACK:
193
194 break;
195 }
196}
197
198static void ssd0303_update_display(void *opaque)
199{
200 ssd0303_state *s = (ssd0303_state *)opaque;
201 DisplaySurface *surface = qemu_console_surface(s->con);
202 uint8_t *dest;
203 uint8_t *src;
204 int x;
205 int y;
206 int line;
207 char *colors[2];
208 char colortab[MAGNIFY * 8];
209 int dest_width;
210 uint8_t mask;
211
212 if (!s->redraw)
213 return;
214
215 switch (surface_bits_per_pixel(surface)) {
216 case 0:
217 return;
218 case 15:
219 dest_width = 2;
220 break;
221 case 16:
222 dest_width = 2;
223 break;
224 case 24:
225 dest_width = 3;
226 break;
227 case 32:
228 dest_width = 4;
229 break;
230 default:
231 BADF("Bad color depth\n");
232 return;
233 }
234 dest_width *= MAGNIFY;
235 memset(colortab, 0xff, dest_width);
236 memset(colortab + dest_width, 0, dest_width);
237 if (s->flash) {
238 colors[0] = colortab;
239 colors[1] = colortab;
240 } else if (s->inverse) {
241 colors[0] = colortab;
242 colors[1] = colortab + dest_width;
243 } else {
244 colors[0] = colortab + dest_width;
245 colors[1] = colortab;
246 }
247 dest = surface_data(surface);
248 for (y = 0; y < 16; y++) {
249 line = (y + s->start_line) & 63;
250 src = s->framebuffer + 132 * (line >> 3) + 36;
251 mask = 1 << (line & 7);
252 for (x = 0; x < 96; x++) {
253 memcpy(dest, colors[(*src & mask) != 0], dest_width);
254 dest += dest_width;
255 src++;
256 }
257 for (x = 1; x < MAGNIFY; x++) {
258 memcpy(dest, dest - dest_width * 96, dest_width * 96);
259 dest += dest_width * 96;
260 }
261 }
262 s->redraw = 0;
263 dpy_gfx_update(s->con, 0, 0, 96 * MAGNIFY, 16 * MAGNIFY);
264}
265
266static void ssd0303_invalidate_display(void * opaque)
267{
268 ssd0303_state *s = (ssd0303_state *)opaque;
269 s->redraw = 1;
270}
271
272static const VMStateDescription vmstate_ssd0303 = {
273 .name = "ssd0303_oled",
274 .version_id = 1,
275 .minimum_version_id = 1,
276 .fields = (VMStateField[]) {
277 VMSTATE_INT32(row, ssd0303_state),
278 VMSTATE_INT32(col, ssd0303_state),
279 VMSTATE_INT32(start_line, ssd0303_state),
280 VMSTATE_INT32(mirror, ssd0303_state),
281 VMSTATE_INT32(flash, ssd0303_state),
282 VMSTATE_INT32(enabled, ssd0303_state),
283 VMSTATE_INT32(inverse, ssd0303_state),
284 VMSTATE_INT32(redraw, ssd0303_state),
285 VMSTATE_UINT32(mode, ssd0303_state),
286 VMSTATE_UINT32(cmd_state, ssd0303_state),
287 VMSTATE_BUFFER(framebuffer, ssd0303_state),
288 VMSTATE_I2C_SLAVE(parent_obj, ssd0303_state),
289 VMSTATE_END_OF_LIST()
290 }
291};
292
293static const GraphicHwOps ssd0303_ops = {
294 .invalidate = ssd0303_invalidate_display,
295 .gfx_update = ssd0303_update_display,
296};
297
298static int ssd0303_init(I2CSlave *i2c)
299{
300 ssd0303_state *s = SSD0303(i2c);
301
302 s->con = graphic_console_init(DEVICE(i2c), 0, &ssd0303_ops, s);
303 qemu_console_resize(s->con, 96 * MAGNIFY, 16 * MAGNIFY);
304 return 0;
305}
306
307static void ssd0303_class_init(ObjectClass *klass, void *data)
308{
309 DeviceClass *dc = DEVICE_CLASS(klass);
310 I2CSlaveClass *k = I2C_SLAVE_CLASS(klass);
311
312 k->init = ssd0303_init;
313 k->event = ssd0303_event;
314 k->recv = ssd0303_recv;
315 k->send = ssd0303_send;
316 dc->vmsd = &vmstate_ssd0303;
317}
318
319static const TypeInfo ssd0303_info = {
320 .name = TYPE_SSD0303,
321 .parent = TYPE_I2C_SLAVE,
322 .instance_size = sizeof(ssd0303_state),
323 .class_init = ssd0303_class_init,
324};
325
326static void ssd0303_register_types(void)
327{
328 type_register_static(&ssd0303_info);
329}
330
331type_init(ssd0303_register_types)
332
