root / hw / ssd0323.c @ 9ee6e8bb
History | View | Annotate | Download (7.1 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 licenced 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 "vl.h" |
14 |
|
15 |
//#define DEBUG_SSD0323 1
|
16 |
|
17 |
#ifdef DEBUG_SSD0323
|
18 |
#define DPRINTF(fmt, args...) \
|
19 |
do { printf("ssd0323: " fmt , ##args); } while (0) |
20 |
#define BADF(fmt, args...) \
|
21 |
do { fprintf(stderr, "ssd0323: error: " fmt , ##args); exit(1);} while (0) |
22 |
#else
|
23 |
#define DPRINTF(fmt, args...) do {} while(0) |
24 |
#define BADF(fmt, args...) \
|
25 |
do { fprintf(stderr, "ssd0323: error: " fmt , ##args);} while (0) |
26 |
#endif
|
27 |
|
28 |
/* Scaling factor for pixels. */
|
29 |
#define MAGNIFY 4 |
30 |
|
31 |
enum ssd0323_mode
|
32 |
{ |
33 |
SSD0323_CMD, |
34 |
SSD0323_DATA |
35 |
}; |
36 |
|
37 |
typedef struct { |
38 |
DisplayState *ds; |
39 |
|
40 |
int cmd_len;
|
41 |
int cmd;
|
42 |
int cmd_data[8]; |
43 |
int row;
|
44 |
int row_start;
|
45 |
int row_end;
|
46 |
int col;
|
47 |
int col_start;
|
48 |
int col_end;
|
49 |
int redraw;
|
50 |
enum ssd0323_mode mode;
|
51 |
uint8_t framebuffer[128 * 80 / 2]; |
52 |
} ssd0323_state; |
53 |
|
54 |
int ssd0323_xfer_ssi(void *opaque, int data) |
55 |
{ |
56 |
ssd0323_state *s = (ssd0323_state *)opaque; |
57 |
switch (s->mode) {
|
58 |
case SSD0323_DATA:
|
59 |
DPRINTF("data 0x%02x\n", data);
|
60 |
s->framebuffer[s->col + s->row * 64] = data;
|
61 |
s->col++; |
62 |
if (s->col > s->col_end) {
|
63 |
s->row++; |
64 |
s->col = s->col_start; |
65 |
} |
66 |
if (s->row > s->row_end) {
|
67 |
s->row = s->row_start; |
68 |
} |
69 |
s->redraw = 1;
|
70 |
break;
|
71 |
case SSD0323_CMD:
|
72 |
DPRINTF("cmd 0x%02x\n", data);
|
73 |
if (s->cmd_len == 0) { |
74 |
s->cmd = data; |
75 |
} else {
|
76 |
s->cmd_data[s->cmd_len - 1] = data;
|
77 |
} |
78 |
s->cmd_len++; |
79 |
switch (s->cmd) {
|
80 |
#define DATA(x) if (s->cmd_len <= (x)) return 0 |
81 |
case 0x15: /* Set column. */ |
82 |
DATA(2);
|
83 |
s->col_start = s->cmd_data[0] % 64; |
84 |
s->col_end = s->cmd_data[1] % 64; |
85 |
break;
|
86 |
case 0x75: /* Set row. */ |
87 |
DATA(2);
|
88 |
s->row_start = s->cmd_data[0] % 80; |
89 |
s->row_end = s->cmd_data[1] % 80; |
90 |
break;
|
91 |
case 0x81: /* Set contrast */ |
92 |
DATA(1);
|
93 |
break;
|
94 |
case 0x84: case 0x85: case 0x86: /* Max current. */ |
95 |
DATA(0);
|
96 |
break;
|
97 |
case 0xa0: /* Set remapping. */ |
98 |
/* FIXME: Implement this. */
|
99 |
DATA(1);
|
100 |
break;
|
101 |
case 0xa1: /* Set display start line. */ |
102 |
case 0xa2: /* Set display offset. */ |
103 |
/* FIXME: Implement these. */
|
104 |
DATA(1);
|
105 |
break;
|
106 |
case 0xa4: /* Normal mode. */ |
107 |
case 0xa5: /* All on. */ |
108 |
case 0xa6: /* All off. */ |
109 |
case 0xa7: /* Inverse. */ |
110 |
/* FIXME: Implement these. */
|
111 |
DATA(0);
|
112 |
break;
|
113 |
case 0xa8: /* Set multiplex ratio. */ |
114 |
case 0xad: /* Set DC-DC converter. */ |
115 |
DATA(1);
|
116 |
/* Ignored. Don't care. */
|
117 |
break;
|
118 |
case 0xae: /* Display off. */ |
119 |
case 0xaf: /* Display on. */ |
120 |
DATA(0);
|
121 |
/* TODO: Implement power control. */
|
122 |
break;
|
123 |
case 0xb1: /* Set phase length. */ |
124 |
case 0xb2: /* Set row period. */ |
125 |
case 0xb3: /* Set clock rate. */ |
126 |
case 0xbc: /* Set precharge. */ |
127 |
case 0xbe: /* Set VCOMH. */ |
128 |
case 0xbf: /* Set segment low. */ |
129 |
DATA(1);
|
130 |
/* Ignored. Don't care. */
|
131 |
break;
|
132 |
case 0xb8: /* Set grey scale table. */ |
133 |
/* FIXME: Implement this. */
|
134 |
DATA(8);
|
135 |
break;
|
136 |
case 0xe3: /* NOP. */ |
137 |
DATA(0);
|
138 |
break;
|
139 |
default:
|
140 |
BADF("Unknown command: 0x%x\n", data);
|
141 |
} |
142 |
s->cmd_len = 0;
|
143 |
return 0; |
144 |
} |
145 |
return 0; |
146 |
} |
147 |
|
148 |
static void ssd0323_update_display(void *opaque) |
149 |
{ |
150 |
ssd0323_state *s = (ssd0323_state *)opaque; |
151 |
uint8_t *dest; |
152 |
uint8_t *src; |
153 |
int x;
|
154 |
int y;
|
155 |
int i;
|
156 |
int line;
|
157 |
char *colors[16]; |
158 |
char colortab[MAGNIFY * 64]; |
159 |
char *p;
|
160 |
int dest_width;
|
161 |
|
162 |
if (s->redraw) {
|
163 |
switch (s->ds->depth) {
|
164 |
case 0: |
165 |
return;
|
166 |
case 15: |
167 |
dest_width = 2;
|
168 |
break;
|
169 |
case 16: |
170 |
dest_width = 2;
|
171 |
break;
|
172 |
case 24: |
173 |
dest_width = 3;
|
174 |
break;
|
175 |
case 32: |
176 |
dest_width = 4;
|
177 |
break;
|
178 |
default:
|
179 |
BADF("Bad color depth\n");
|
180 |
return;
|
181 |
} |
182 |
p = colortab; |
183 |
for (i = 0; i < 16; i++) { |
184 |
int n;
|
185 |
colors[i] = p; |
186 |
switch (s->ds->depth) {
|
187 |
case 15: |
188 |
n = i * 2 + (i >> 3); |
189 |
p[0] = n | (n << 5); |
190 |
p[1] = (n << 2) | (n >> 3); |
191 |
break;
|
192 |
case 16: |
193 |
n = i * 2 + (i >> 3); |
194 |
p[0] = n | (n << 6) | ((n << 1) & 0x20); |
195 |
p[1] = (n << 3) | (n >> 2); |
196 |
break;
|
197 |
case 24: |
198 |
case 32: |
199 |
n = (i << 4) | i;
|
200 |
p[0] = p[1] = p[2] = n; |
201 |
break;
|
202 |
default:
|
203 |
BADF("Bad color depth\n");
|
204 |
return;
|
205 |
} |
206 |
p += dest_width; |
207 |
} |
208 |
dest = s->ds->data; |
209 |
for (y = 0; y < 64; y++) { |
210 |
line = y; |
211 |
src = s->framebuffer + 64 * line;
|
212 |
for (x = 0; x < 64; x++) { |
213 |
int val;
|
214 |
val = *src >> 4;
|
215 |
for (i = 0; i < MAGNIFY; i++) { |
216 |
memcpy(dest, colors[val], dest_width); |
217 |
dest += dest_width; |
218 |
} |
219 |
val = *src & 0xf;
|
220 |
for (i = 0; i < MAGNIFY; i++) { |
221 |
memcpy(dest, colors[val], dest_width); |
222 |
dest += dest_width; |
223 |
} |
224 |
src++; |
225 |
} |
226 |
for (i = 1; i < MAGNIFY; i++) { |
227 |
memcpy(dest, dest - dest_width * MAGNIFY * 128,
|
228 |
dest_width * 128 * MAGNIFY);
|
229 |
dest += dest_width * 128 * MAGNIFY;
|
230 |
} |
231 |
} |
232 |
} |
233 |
dpy_update(s->ds, 0, 0, 128 * MAGNIFY, 64 * MAGNIFY); |
234 |
} |
235 |
|
236 |
static void ssd0323_invalidate_display(void * opaque) |
237 |
{ |
238 |
ssd0323_state *s = (ssd0323_state *)opaque; |
239 |
s->redraw = 1;
|
240 |
} |
241 |
|
242 |
/* Command/data input. */
|
243 |
static void ssd0323_cd(void *opaque, int n, int level) |
244 |
{ |
245 |
ssd0323_state *s = (ssd0323_state *)opaque; |
246 |
DPRINTF("%s mode\n", level ? "Data" : "Command"); |
247 |
s->mode = level ? SSD0323_DATA : SSD0323_CMD; |
248 |
} |
249 |
|
250 |
void *ssd0323_init(DisplayState *ds, qemu_irq *cmd_p)
|
251 |
{ |
252 |
ssd0323_state *s; |
253 |
qemu_irq *cmd; |
254 |
|
255 |
s = (ssd0323_state *)qemu_mallocz(sizeof(ssd0323_state));
|
256 |
s->ds = ds; |
257 |
graphic_console_init(ds, ssd0323_update_display, ssd0323_invalidate_display, |
258 |
NULL, s);
|
259 |
dpy_resize(s->ds, 128 * MAGNIFY, 64 * MAGNIFY); |
260 |
s->col_end = 63;
|
261 |
s->row_end = 79;
|
262 |
|
263 |
cmd = qemu_allocate_irqs(ssd0323_cd, s, 1);
|
264 |
*cmd_p = *cmd; |
265 |
|
266 |
return s;
|
267 |
} |