Statistics
| Branch: | Revision:

root / hw / omap_dss.c @ f5654039

History | View | Annotate | Download (31.3 kB)

1
/*
2
 * OMAP2 Display Subsystem.
3
 *
4
 * Copyright (C) 2008 Nokia Corporation
5
 * Written by Andrzej Zaborowski <andrew@openedhand.com>
6
 *
7
 * This program is free software; you can redistribute it and/or
8
 * modify it under the terms of the GNU General Public License as
9
 * published by the Free Software Foundation; either version 2 or
10
 * (at your option) version 3 of the License.
11
 *
12
 * This program is distributed in the hope that it will be useful,
13
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15
 * GNU General Public License for more details.
16
 *
17
 * You should have received a copy of the GNU General Public License along
18
 * with this program; if not, see <http://www.gnu.org/licenses/>.
19
 */
20
#include "hw.h"
21
#include "console.h"
22
#include "omap.h"
23

    
24
struct omap_dss_s {
25
    qemu_irq irq;
26
    qemu_irq drq;
27
    DisplayState *state;
28

    
29
    int autoidle;
30
    int control;
31
    int enable;
32

    
33
    struct omap_dss_panel_s {
34
        int enable;
35
        int nx;
36
        int ny;
37

    
38
        int x;
39
        int y;
40
    } dig, lcd;
41

    
42
    struct {
43
        uint32_t idlemode;
44
        uint32_t irqst;
45
        uint32_t irqen;
46
        uint32_t control;
47
        uint32_t config;
48
        uint32_t capable;
49
        uint32_t timing[4];
50
        int line;
51
        uint32_t bg[2];
52
        uint32_t trans[2];
53

    
54
        struct omap_dss_plane_s {
55
            int enable;
56
            int bpp;
57
            int posx;
58
            int posy;
59
            int nx;
60
            int ny;
61

    
62
            target_phys_addr_t addr[3];
63

    
64
            uint32_t attr;
65
            uint32_t tresh;
66
            int rowinc;
67
            int colinc;
68
            int wininc;
69
        } l[3];
70

    
71
        int invalidate;
72
        uint16_t palette[256];
73
    } dispc;
74

    
75
    struct {
76
        int idlemode;
77
        uint32_t control;
78
        int enable;
79
        int pixels;
80
        int busy;
81
        int skiplines;
82
        uint16_t rxbuf;
83
        uint32_t config[2];
84
        uint32_t time[4];
85
        uint32_t data[6];
86
        uint16_t vsync;
87
        uint16_t hsync;
88
        struct rfbi_chip_s *chip[2];
89
    } rfbi;
90
};
91

    
92
static void omap_dispc_interrupt_update(struct omap_dss_s *s)
93
{
94
    qemu_set_irq(s->irq, s->dispc.irqst & s->dispc.irqen);
95
}
96

    
97
static void omap_rfbi_reset(struct omap_dss_s *s)
98
{
99
    s->rfbi.idlemode = 0;
100
    s->rfbi.control = 2;
101
    s->rfbi.enable = 0;
102
    s->rfbi.pixels = 0;
103
    s->rfbi.skiplines = 0;
104
    s->rfbi.busy = 0;
105
    s->rfbi.config[0] = 0x00310000;
106
    s->rfbi.config[1] = 0x00310000;
107
    s->rfbi.time[0] = 0;
108
    s->rfbi.time[1] = 0;
109
    s->rfbi.time[2] = 0;
110
    s->rfbi.time[3] = 0;
111
    s->rfbi.data[0] = 0;
112
    s->rfbi.data[1] = 0;
113
    s->rfbi.data[2] = 0;
114
    s->rfbi.data[3] = 0;
115
    s->rfbi.data[4] = 0;
116
    s->rfbi.data[5] = 0;
117
    s->rfbi.vsync = 0;
118
    s->rfbi.hsync = 0;
119
}
120

    
121
void omap_dss_reset(struct omap_dss_s *s)
122
{
123
    s->autoidle = 0;
124
    s->control = 0;
125
    s->enable = 0;
126

    
127
    s->dig.enable = 0;
128
    s->dig.nx = 1;
129
    s->dig.ny = 1;
130

    
131
    s->lcd.enable = 0;
132
    s->lcd.nx = 1;
133
    s->lcd.ny = 1;
134

    
135
    s->dispc.idlemode = 0;
136
    s->dispc.irqst = 0;
137
    s->dispc.irqen = 0;
138
    s->dispc.control = 0;
139
    s->dispc.config = 0;
140
    s->dispc.capable = 0x161;
141
    s->dispc.timing[0] = 0;
142
    s->dispc.timing[1] = 0;
143
    s->dispc.timing[2] = 0;
144
    s->dispc.timing[3] = 0;
145
    s->dispc.line = 0;
146
    s->dispc.bg[0] = 0;
147
    s->dispc.bg[1] = 0;
148
    s->dispc.trans[0] = 0;
149
    s->dispc.trans[1] = 0;
150

    
151
    s->dispc.l[0].enable = 0;
152
    s->dispc.l[0].bpp = 0;
153
    s->dispc.l[0].addr[0] = 0;
154
    s->dispc.l[0].addr[1] = 0;
155
    s->dispc.l[0].addr[2] = 0;
156
    s->dispc.l[0].posx = 0;
157
    s->dispc.l[0].posy = 0;
158
    s->dispc.l[0].nx = 1;
159
    s->dispc.l[0].ny = 1;
160
    s->dispc.l[0].attr = 0;
161
    s->dispc.l[0].tresh = 0;
162
    s->dispc.l[0].rowinc = 1;
163
    s->dispc.l[0].colinc = 1;
164
    s->dispc.l[0].wininc = 0;
165

    
166
    omap_rfbi_reset(s);
167
    omap_dispc_interrupt_update(s);
168
}
169

    
170
static uint32_t omap_diss_read(void *opaque, target_phys_addr_t addr)
171
{
172
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
173

    
174
    switch (addr) {
175
    case 0x00:        /* DSS_REVISIONNUMBER */
176
        return 0x20;
177

    
178
    case 0x10:        /* DSS_SYSCONFIG */
179
        return s->autoidle;
180

    
181
    case 0x14:        /* DSS_SYSSTATUS */
182
        return 1;                                                /* RESETDONE */
183

    
184
    case 0x40:        /* DSS_CONTROL */
185
        return s->control;
186

    
187
    case 0x50:        /* DSS_PSA_LCD_REG_1 */
188
    case 0x54:        /* DSS_PSA_LCD_REG_2 */
189
    case 0x58:        /* DSS_PSA_VIDEO_REG */
190
        /* TODO: fake some values when appropriate s->control bits are set */
191
        return 0;
192

    
193
    case 0x5c:        /* DSS_STATUS */
194
        return 1 + (s->control & 1);
195

    
196
    default:
197
        break;
198
    }
199
    OMAP_BAD_REG(addr);
200
    return 0;
201
}
202

    
203
static void omap_diss_write(void *opaque, target_phys_addr_t addr,
204
                uint32_t value)
205
{
206
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
207

    
208
    switch (addr) {
209
    case 0x00:        /* DSS_REVISIONNUMBER */
210
    case 0x14:        /* DSS_SYSSTATUS */
211
    case 0x50:        /* DSS_PSA_LCD_REG_1 */
212
    case 0x54:        /* DSS_PSA_LCD_REG_2 */
213
    case 0x58:        /* DSS_PSA_VIDEO_REG */
214
    case 0x5c:        /* DSS_STATUS */
215
        OMAP_RO_REG(addr);
216
        break;
217

    
218
    case 0x10:        /* DSS_SYSCONFIG */
219
        if (value & 2)                                                /* SOFTRESET */
220
            omap_dss_reset(s);
221
        s->autoidle = value & 1;
222
        break;
223

    
224
    case 0x40:        /* DSS_CONTROL */
225
        s->control = value & 0x3dd;
226
        break;
227

    
228
    default:
229
        OMAP_BAD_REG(addr);
230
    }
231
}
232

    
233
static CPUReadMemoryFunc * const omap_diss1_readfn[] = {
234
    omap_badwidth_read32,
235
    omap_badwidth_read32,
236
    omap_diss_read,
237
};
238

    
239
static CPUWriteMemoryFunc * const omap_diss1_writefn[] = {
240
    omap_badwidth_write32,
241
    omap_badwidth_write32,
242
    omap_diss_write,
243
};
244

    
245
static uint32_t omap_disc_read(void *opaque, target_phys_addr_t addr)
246
{
247
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
248

    
249
    switch (addr) {
250
    case 0x000:        /* DISPC_REVISION */
251
        return 0x20;
252

    
253
    case 0x010:        /* DISPC_SYSCONFIG */
254
        return s->dispc.idlemode;
255

    
256
    case 0x014:        /* DISPC_SYSSTATUS */
257
        return 1;                                                /* RESETDONE */
258

    
259
    case 0x018:        /* DISPC_IRQSTATUS */
260
        return s->dispc.irqst;
261

    
262
    case 0x01c:        /* DISPC_IRQENABLE */
263
        return s->dispc.irqen;
264

    
265
    case 0x040:        /* DISPC_CONTROL */
266
        return s->dispc.control;
267

    
268
    case 0x044:        /* DISPC_CONFIG */
269
        return s->dispc.config;
270

    
271
    case 0x048:        /* DISPC_CAPABLE */
272
        return s->dispc.capable;
273

    
274
    case 0x04c:        /* DISPC_DEFAULT_COLOR0 */
275
        return s->dispc.bg[0];
276
    case 0x050:        /* DISPC_DEFAULT_COLOR1 */
277
        return s->dispc.bg[1];
278
    case 0x054:        /* DISPC_TRANS_COLOR0 */
279
        return s->dispc.trans[0];
280
    case 0x058:        /* DISPC_TRANS_COLOR1 */
281
        return s->dispc.trans[1];
282

    
283
    case 0x05c:        /* DISPC_LINE_STATUS */
284
        return 0x7ff;
285
    case 0x060:        /* DISPC_LINE_NUMBER */
286
        return s->dispc.line;
287

    
288
    case 0x064:        /* DISPC_TIMING_H */
289
        return s->dispc.timing[0];
290
    case 0x068:        /* DISPC_TIMING_V */
291
        return s->dispc.timing[1];
292
    case 0x06c:        /* DISPC_POL_FREQ */
293
        return s->dispc.timing[2];
294
    case 0x070:        /* DISPC_DIVISOR */
295
        return s->dispc.timing[3];
296

    
297
    case 0x078:        /* DISPC_SIZE_DIG */
298
        return ((s->dig.ny - 1) << 16) | (s->dig.nx - 1);
299
    case 0x07c:        /* DISPC_SIZE_LCD */
300
        return ((s->lcd.ny - 1) << 16) | (s->lcd.nx - 1);
301

    
302
    case 0x080:        /* DISPC_GFX_BA0 */
303
        return s->dispc.l[0].addr[0];
304
    case 0x084:        /* DISPC_GFX_BA1 */
305
        return s->dispc.l[0].addr[1];
306
    case 0x088:        /* DISPC_GFX_POSITION */
307
        return (s->dispc.l[0].posy << 16) | s->dispc.l[0].posx;
308
    case 0x08c:        /* DISPC_GFX_SIZE */
309
        return ((s->dispc.l[0].ny - 1) << 16) | (s->dispc.l[0].nx - 1);
310
    case 0x0a0:        /* DISPC_GFX_ATTRIBUTES */
311
        return s->dispc.l[0].attr;
312
    case 0x0a4:        /* DISPC_GFX_FIFO_TRESHOLD */
313
        return s->dispc.l[0].tresh;
314
    case 0x0a8:        /* DISPC_GFX_FIFO_SIZE_STATUS */
315
        return 256;
316
    case 0x0ac:        /* DISPC_GFX_ROW_INC */
317
        return s->dispc.l[0].rowinc;
318
    case 0x0b0:        /* DISPC_GFX_PIXEL_INC */
319
        return s->dispc.l[0].colinc;
320
    case 0x0b4:        /* DISPC_GFX_WINDOW_SKIP */
321
        return s->dispc.l[0].wininc;
322
    case 0x0b8:        /* DISPC_GFX_TABLE_BA */
323
        return s->dispc.l[0].addr[2];
324

    
325
    case 0x0bc:        /* DISPC_VID1_BA0 */
326
    case 0x0c0:        /* DISPC_VID1_BA1 */
327
    case 0x0c4:        /* DISPC_VID1_POSITION */
328
    case 0x0c8:        /* DISPC_VID1_SIZE */
329
    case 0x0cc:        /* DISPC_VID1_ATTRIBUTES */
330
    case 0x0d0:        /* DISPC_VID1_FIFO_TRESHOLD */
331
    case 0x0d4:        /* DISPC_VID1_FIFO_SIZE_STATUS */
332
    case 0x0d8:        /* DISPC_VID1_ROW_INC */
333
    case 0x0dc:        /* DISPC_VID1_PIXEL_INC */
334
    case 0x0e0:        /* DISPC_VID1_FIR */
335
    case 0x0e4:        /* DISPC_VID1_PICTURE_SIZE */
336
    case 0x0e8:        /* DISPC_VID1_ACCU0 */
337
    case 0x0ec:        /* DISPC_VID1_ACCU1 */
338
    case 0x0f0 ... 0x140:        /* DISPC_VID1_FIR_COEF, DISPC_VID1_CONV_COEF */
339
    case 0x14c:        /* DISPC_VID2_BA0 */
340
    case 0x150:        /* DISPC_VID2_BA1 */
341
    case 0x154:        /* DISPC_VID2_POSITION */
342
    case 0x158:        /* DISPC_VID2_SIZE */
343
    case 0x15c:        /* DISPC_VID2_ATTRIBUTES */
344
    case 0x160:        /* DISPC_VID2_FIFO_TRESHOLD */
345
    case 0x164:        /* DISPC_VID2_FIFO_SIZE_STATUS */
346
    case 0x168:        /* DISPC_VID2_ROW_INC */
347
    case 0x16c:        /* DISPC_VID2_PIXEL_INC */
348
    case 0x170:        /* DISPC_VID2_FIR */
349
    case 0x174:        /* DISPC_VID2_PICTURE_SIZE */
350
    case 0x178:        /* DISPC_VID2_ACCU0 */
351
    case 0x17c:        /* DISPC_VID2_ACCU1 */
352
    case 0x180 ... 0x1d0:        /* DISPC_VID2_FIR_COEF, DISPC_VID2_CONV_COEF */
353
    case 0x1d4:        /* DISPC_DATA_CYCLE1 */
354
    case 0x1d8:        /* DISPC_DATA_CYCLE2 */
355
    case 0x1dc:        /* DISPC_DATA_CYCLE3 */
356
        return 0;
357

    
358
    default:
359
        break;
360
    }
361
    OMAP_BAD_REG(addr);
362
    return 0;
363
}
364

    
365
static void omap_disc_write(void *opaque, target_phys_addr_t addr,
366
                uint32_t value)
367
{
368
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
369

    
370
    switch (addr) {
371
    case 0x010:        /* DISPC_SYSCONFIG */
372
        if (value & 2)                                                /* SOFTRESET */
373
            omap_dss_reset(s);
374
        s->dispc.idlemode = value & 0x301b;
375
        break;
376

    
377
    case 0x018:        /* DISPC_IRQSTATUS */
378
        s->dispc.irqst &= ~value;
379
        omap_dispc_interrupt_update(s);
380
        break;
381

    
382
    case 0x01c:        /* DISPC_IRQENABLE */
383
        s->dispc.irqen = value & 0xffff;
384
        omap_dispc_interrupt_update(s);
385
        break;
386

    
387
    case 0x040:        /* DISPC_CONTROL */
388
        s->dispc.control = value & 0x07ff9fff;
389
        s->dig.enable = (value >> 1) & 1;
390
        s->lcd.enable = (value >> 0) & 1;
391
        if (value & (1 << 12))                        /* OVERLAY_OPTIMIZATION */
392
            if (!((s->dispc.l[1].attr | s->dispc.l[2].attr) & 1)) {
393
                fprintf(stderr, "%s: Overlay Optimization when no overlay "
394
                        "region effectively exists leads to "
395
                        "unpredictable behaviour!\n", __func__);
396
            }
397
        if (value & (1 << 6)) {                                /* GODIGITAL */
398
            /* XXX: Shadowed fields are:
399
             * s->dispc.config
400
             * s->dispc.capable
401
             * s->dispc.bg[0]
402
             * s->dispc.bg[1]
403
             * s->dispc.trans[0]
404
             * s->dispc.trans[1]
405
             * s->dispc.line
406
             * s->dispc.timing[0]
407
             * s->dispc.timing[1]
408
             * s->dispc.timing[2]
409
             * s->dispc.timing[3]
410
             * s->lcd.nx
411
             * s->lcd.ny
412
             * s->dig.nx
413
             * s->dig.ny
414
             * s->dispc.l[0].addr[0]
415
             * s->dispc.l[0].addr[1]
416
             * s->dispc.l[0].addr[2]
417
             * s->dispc.l[0].posx
418
             * s->dispc.l[0].posy
419
             * s->dispc.l[0].nx
420
             * s->dispc.l[0].ny
421
             * s->dispc.l[0].tresh
422
             * s->dispc.l[0].rowinc
423
             * s->dispc.l[0].colinc
424
             * s->dispc.l[0].wininc
425
             * All they need to be loaded here from their shadow registers.
426
             */
427
        }
428
        if (value & (1 << 5)) {                                /* GOLCD */
429
             /* XXX: Likewise for LCD here.  */
430
        }
431
        s->dispc.invalidate = 1;
432
        break;
433

    
434
    case 0x044:        /* DISPC_CONFIG */
435
        s->dispc.config = value & 0x3fff;
436
        /* XXX:
437
         * bits 2:1 (LOADMODE) reset to 0 after set to 1 and palette loaded
438
         * bits 2:1 (LOADMODE) reset to 2 after set to 3 and palette loaded
439
         */
440
        s->dispc.invalidate = 1;
441
        break;
442

    
443
    case 0x048:        /* DISPC_CAPABLE */
444
        s->dispc.capable = value & 0x3ff;
445
        break;
446

    
447
    case 0x04c:        /* DISPC_DEFAULT_COLOR0 */
448
        s->dispc.bg[0] = value & 0xffffff;
449
        s->dispc.invalidate = 1;
450
        break;
451
    case 0x050:        /* DISPC_DEFAULT_COLOR1 */
452
        s->dispc.bg[1] = value & 0xffffff;
453
        s->dispc.invalidate = 1;
454
        break;
455
    case 0x054:        /* DISPC_TRANS_COLOR0 */
456
        s->dispc.trans[0] = value & 0xffffff;
457
        s->dispc.invalidate = 1;
458
        break;
459
    case 0x058:        /* DISPC_TRANS_COLOR1 */
460
        s->dispc.trans[1] = value & 0xffffff;
461
        s->dispc.invalidate = 1;
462
        break;
463

    
464
    case 0x060:        /* DISPC_LINE_NUMBER */
465
        s->dispc.line = value & 0x7ff;
466
        break;
467

    
468
    case 0x064:        /* DISPC_TIMING_H */
469
        s->dispc.timing[0] = value & 0x0ff0ff3f;
470
        break;
471
    case 0x068:        /* DISPC_TIMING_V */
472
        s->dispc.timing[1] = value & 0x0ff0ff3f;
473
        break;
474
    case 0x06c:        /* DISPC_POL_FREQ */
475
        s->dispc.timing[2] = value & 0x0003ffff;
476
        break;
477
    case 0x070:        /* DISPC_DIVISOR */
478
        s->dispc.timing[3] = value & 0x00ff00ff;
479
        break;
480

    
481
    case 0x078:        /* DISPC_SIZE_DIG */
482
        s->dig.nx = ((value >>  0) & 0x7ff) + 1;                /* PPL */
483
        s->dig.ny = ((value >> 16) & 0x7ff) + 1;                /* LPP */
484
        s->dispc.invalidate = 1;
485
        break;
486
    case 0x07c:        /* DISPC_SIZE_LCD */
487
        s->lcd.nx = ((value >>  0) & 0x7ff) + 1;                /* PPL */
488
        s->lcd.ny = ((value >> 16) & 0x7ff) + 1;                /* LPP */
489
        s->dispc.invalidate = 1;
490
        break;
491
    case 0x080:        /* DISPC_GFX_BA0 */
492
        s->dispc.l[0].addr[0] = (target_phys_addr_t) value;
493
        s->dispc.invalidate = 1;
494
        break;
495
    case 0x084:        /* DISPC_GFX_BA1 */
496
        s->dispc.l[0].addr[1] = (target_phys_addr_t) value;
497
        s->dispc.invalidate = 1;
498
        break;
499
    case 0x088:        /* DISPC_GFX_POSITION */
500
        s->dispc.l[0].posx = ((value >>  0) & 0x7ff);                /* GFXPOSX */
501
        s->dispc.l[0].posy = ((value >> 16) & 0x7ff);                /* GFXPOSY */
502
        s->dispc.invalidate = 1;
503
        break;
504
    case 0x08c:        /* DISPC_GFX_SIZE */
505
        s->dispc.l[0].nx = ((value >>  0) & 0x7ff) + 1;                /* GFXSIZEX */
506
        s->dispc.l[0].ny = ((value >> 16) & 0x7ff) + 1;                /* GFXSIZEY */
507
        s->dispc.invalidate = 1;
508
        break;
509
    case 0x0a0:        /* DISPC_GFX_ATTRIBUTES */
510
        s->dispc.l[0].attr = value & 0x7ff;
511
        if (value & (3 << 9))
512
            fprintf(stderr, "%s: Big-endian pixel format not supported\n",
513
                            __FUNCTION__);
514
        s->dispc.l[0].enable = value & 1;
515
        s->dispc.l[0].bpp = (value >> 1) & 0xf;
516
        s->dispc.invalidate = 1;
517
        break;
518
    case 0x0a4:        /* DISPC_GFX_FIFO_TRESHOLD */
519
        s->dispc.l[0].tresh = value & 0x01ff01ff;
520
        break;
521
    case 0x0ac:        /* DISPC_GFX_ROW_INC */
522
        s->dispc.l[0].rowinc = value;
523
        s->dispc.invalidate = 1;
524
        break;
525
    case 0x0b0:        /* DISPC_GFX_PIXEL_INC */
526
        s->dispc.l[0].colinc = value;
527
        s->dispc.invalidate = 1;
528
        break;
529
    case 0x0b4:        /* DISPC_GFX_WINDOW_SKIP */
530
        s->dispc.l[0].wininc = value;
531
        break;
532
    case 0x0b8:        /* DISPC_GFX_TABLE_BA */
533
        s->dispc.l[0].addr[2] = (target_phys_addr_t) value;
534
        s->dispc.invalidate = 1;
535
        break;
536

    
537
    case 0x0bc:        /* DISPC_VID1_BA0 */
538
    case 0x0c0:        /* DISPC_VID1_BA1 */
539
    case 0x0c4:        /* DISPC_VID1_POSITION */
540
    case 0x0c8:        /* DISPC_VID1_SIZE */
541
    case 0x0cc:        /* DISPC_VID1_ATTRIBUTES */
542
    case 0x0d0:        /* DISPC_VID1_FIFO_TRESHOLD */
543
    case 0x0d8:        /* DISPC_VID1_ROW_INC */
544
    case 0x0dc:        /* DISPC_VID1_PIXEL_INC */
545
    case 0x0e0:        /* DISPC_VID1_FIR */
546
    case 0x0e4:        /* DISPC_VID1_PICTURE_SIZE */
547
    case 0x0e8:        /* DISPC_VID1_ACCU0 */
548
    case 0x0ec:        /* DISPC_VID1_ACCU1 */
549
    case 0x0f0 ... 0x140:        /* DISPC_VID1_FIR_COEF, DISPC_VID1_CONV_COEF */
550
    case 0x14c:        /* DISPC_VID2_BA0 */
551
    case 0x150:        /* DISPC_VID2_BA1 */
552
    case 0x154:        /* DISPC_VID2_POSITION */
553
    case 0x158:        /* DISPC_VID2_SIZE */
554
    case 0x15c:        /* DISPC_VID2_ATTRIBUTES */
555
    case 0x160:        /* DISPC_VID2_FIFO_TRESHOLD */
556
    case 0x168:        /* DISPC_VID2_ROW_INC */
557
    case 0x16c:        /* DISPC_VID2_PIXEL_INC */
558
    case 0x170:        /* DISPC_VID2_FIR */
559
    case 0x174:        /* DISPC_VID2_PICTURE_SIZE */
560
    case 0x178:        /* DISPC_VID2_ACCU0 */
561
    case 0x17c:        /* DISPC_VID2_ACCU1 */
562
    case 0x180 ... 0x1d0:        /* DISPC_VID2_FIR_COEF, DISPC_VID2_CONV_COEF */
563
    case 0x1d4:        /* DISPC_DATA_CYCLE1 */
564
    case 0x1d8:        /* DISPC_DATA_CYCLE2 */
565
    case 0x1dc:        /* DISPC_DATA_CYCLE3 */
566
        break;
567

    
568
    default:
569
        OMAP_BAD_REG(addr);
570
    }
571
}
572

    
573
static CPUReadMemoryFunc * const omap_disc1_readfn[] = {
574
    omap_badwidth_read32,
575
    omap_badwidth_read32,
576
    omap_disc_read,
577
};
578

    
579
static CPUWriteMemoryFunc * const omap_disc1_writefn[] = {
580
    omap_badwidth_write32,
581
    omap_badwidth_write32,
582
    omap_disc_write,
583
};
584

    
585
static void omap_rfbi_transfer_stop(struct omap_dss_s *s)
586
{
587
    if (!s->rfbi.busy)
588
        return;
589

    
590
    /* TODO: in non-Bypass mode we probably need to just deassert the DRQ.  */
591

    
592
    s->rfbi.busy = 0;
593
}
594

    
595
static void omap_rfbi_transfer_start(struct omap_dss_s *s)
596
{
597
    void *data;
598
    target_phys_addr_t len;
599
    target_phys_addr_t data_addr;
600
    int pitch;
601
    static void *bounce_buffer;
602
    static target_phys_addr_t bounce_len;
603

    
604
    if (!s->rfbi.enable || s->rfbi.busy)
605
        return;
606

    
607
    if (s->rfbi.control & (1 << 1)) {                                /* BYPASS */
608
        /* TODO: in non-Bypass mode we probably need to just assert the
609
         * DRQ and wait for DMA to write the pixels.  */
610
        fprintf(stderr, "%s: Bypass mode unimplemented\n", __FUNCTION__);
611
        return;
612
    }
613

    
614
    if (!(s->dispc.control & (1 << 11)))                        /* RFBIMODE */
615
        return;
616
    /* TODO: check that LCD output is enabled in DISPC.  */
617

    
618
    s->rfbi.busy = 1;
619

    
620
    len = s->rfbi.pixels * 2;
621

    
622
    data_addr = s->dispc.l[0].addr[0];
623
    data = cpu_physical_memory_map(data_addr, &len, 0);
624
    if (data && len != s->rfbi.pixels * 2) {
625
        cpu_physical_memory_unmap(data, len, 0, 0);
626
        data = NULL;
627
        len = s->rfbi.pixels * 2;
628
    }
629
    if (!data) {
630
        if (len > bounce_len) {
631
            bounce_buffer = g_realloc(bounce_buffer, len);
632
        }
633
        data = bounce_buffer;
634
        cpu_physical_memory_read(data_addr, data, len);
635
    }
636

    
637
    /* TODO bpp */
638
    s->rfbi.pixels = 0;
639

    
640
    /* TODO: negative values */
641
    pitch = s->dispc.l[0].nx + (s->dispc.l[0].rowinc - 1) / 2;
642

    
643
    if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
644
        s->rfbi.chip[0]->block(s->rfbi.chip[0]->opaque, 1, data, len, pitch);
645
    if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
646
        s->rfbi.chip[1]->block(s->rfbi.chip[1]->opaque, 1, data, len, pitch);
647

    
648
    if (data != bounce_buffer) {
649
        cpu_physical_memory_unmap(data, len, 0, len);
650
    }
651

    
652
    omap_rfbi_transfer_stop(s);
653

    
654
    /* TODO */
655
    s->dispc.irqst |= 1;                                        /* FRAMEDONE */
656
    omap_dispc_interrupt_update(s);
657
}
658

    
659
static uint32_t omap_rfbi_read(void *opaque, target_phys_addr_t addr)
660
{
661
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
662

    
663
    switch (addr) {
664
    case 0x00:        /* RFBI_REVISION */
665
        return 0x10;
666

    
667
    case 0x10:        /* RFBI_SYSCONFIG */
668
        return s->rfbi.idlemode;
669

    
670
    case 0x14:        /* RFBI_SYSSTATUS */
671
        return 1 | (s->rfbi.busy << 8);                                /* RESETDONE */
672

    
673
    case 0x40:        /* RFBI_CONTROL */
674
        return s->rfbi.control;
675

    
676
    case 0x44:        /* RFBI_PIXELCNT */
677
        return s->rfbi.pixels;
678

    
679
    case 0x48:        /* RFBI_LINE_NUMBER */
680
        return s->rfbi.skiplines;
681

    
682
    case 0x58:        /* RFBI_READ */
683
    case 0x5c:        /* RFBI_STATUS */
684
        return s->rfbi.rxbuf;
685

    
686
    case 0x60:        /* RFBI_CONFIG0 */
687
        return s->rfbi.config[0];
688
    case 0x64:        /* RFBI_ONOFF_TIME0 */
689
        return s->rfbi.time[0];
690
    case 0x68:        /* RFBI_CYCLE_TIME0 */
691
        return s->rfbi.time[1];
692
    case 0x6c:        /* RFBI_DATA_CYCLE1_0 */
693
        return s->rfbi.data[0];
694
    case 0x70:        /* RFBI_DATA_CYCLE2_0 */
695
        return s->rfbi.data[1];
696
    case 0x74:        /* RFBI_DATA_CYCLE3_0 */
697
        return s->rfbi.data[2];
698

    
699
    case 0x78:        /* RFBI_CONFIG1 */
700
        return s->rfbi.config[1];
701
    case 0x7c:        /* RFBI_ONOFF_TIME1 */
702
        return s->rfbi.time[2];
703
    case 0x80:        /* RFBI_CYCLE_TIME1 */
704
        return s->rfbi.time[3];
705
    case 0x84:        /* RFBI_DATA_CYCLE1_1 */
706
        return s->rfbi.data[3];
707
    case 0x88:        /* RFBI_DATA_CYCLE2_1 */
708
        return s->rfbi.data[4];
709
    case 0x8c:        /* RFBI_DATA_CYCLE3_1 */
710
        return s->rfbi.data[5];
711

    
712
    case 0x90:        /* RFBI_VSYNC_WIDTH */
713
        return s->rfbi.vsync;
714
    case 0x94:        /* RFBI_HSYNC_WIDTH */
715
        return s->rfbi.hsync;
716
    }
717
    OMAP_BAD_REG(addr);
718
    return 0;
719
}
720

    
721
static void omap_rfbi_write(void *opaque, target_phys_addr_t addr,
722
                uint32_t value)
723
{
724
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
725

    
726
    switch (addr) {
727
    case 0x10:        /* RFBI_SYSCONFIG */
728
        if (value & 2)                                                /* SOFTRESET */
729
            omap_rfbi_reset(s);
730
        s->rfbi.idlemode = value & 0x19;
731
        break;
732

    
733
    case 0x40:        /* RFBI_CONTROL */
734
        s->rfbi.control = value & 0xf;
735
        s->rfbi.enable = value & 1;
736
        if (value & (1 << 4) &&                                        /* ITE */
737
                        !(s->rfbi.config[0] & s->rfbi.config[1] & 0xc))
738
            omap_rfbi_transfer_start(s);
739
        break;
740

    
741
    case 0x44:        /* RFBI_PIXELCNT */
742
        s->rfbi.pixels = value;
743
        break;
744

    
745
    case 0x48:        /* RFBI_LINE_NUMBER */
746
        s->rfbi.skiplines = value & 0x7ff;
747
        break;
748

    
749
    case 0x4c:        /* RFBI_CMD */
750
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
751
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 0, value & 0xffff);
752
        if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
753
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 0, value & 0xffff);
754
        break;
755
    case 0x50:        /* RFBI_PARAM */
756
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
757
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value & 0xffff);
758
        if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
759
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value & 0xffff);
760
        break;
761
    case 0x54:        /* RFBI_DATA */
762
        /* TODO: take into account the format set up in s->rfbi.config[?] and
763
         * s->rfbi.data[?], but special-case the most usual scenario so that
764
         * speed doesn't suffer.  */
765
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) {
766
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value & 0xffff);
767
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value >> 16);
768
        }
769
        if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) {
770
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value & 0xffff);
771
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value >> 16);
772
        }
773
        if (!-- s->rfbi.pixels)
774
            omap_rfbi_transfer_stop(s);
775
        break;
776
    case 0x58:        /* RFBI_READ */
777
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
778
            s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 1);
779
        else if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
780
            s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 1);
781
        if (!-- s->rfbi.pixels)
782
            omap_rfbi_transfer_stop(s);
783
        break;
784

    
785
    case 0x5c:        /* RFBI_STATUS */
786
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
787
            s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 0);
788
        else if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
789
            s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 0);
790
        if (!-- s->rfbi.pixels)
791
            omap_rfbi_transfer_stop(s);
792
        break;
793

    
794
    case 0x60:        /* RFBI_CONFIG0 */
795
        s->rfbi.config[0] = value & 0x003f1fff;
796
        break;
797

    
798
    case 0x64:        /* RFBI_ONOFF_TIME0 */
799
        s->rfbi.time[0] = value & 0x3fffffff;
800
        break;
801
    case 0x68:        /* RFBI_CYCLE_TIME0 */
802
        s->rfbi.time[1] = value & 0x0fffffff;
803
        break;
804
    case 0x6c:        /* RFBI_DATA_CYCLE1_0 */
805
        s->rfbi.data[0] = value & 0x0f1f0f1f;
806
        break;
807
    case 0x70:        /* RFBI_DATA_CYCLE2_0 */
808
        s->rfbi.data[1] = value & 0x0f1f0f1f;
809
        break;
810
    case 0x74:        /* RFBI_DATA_CYCLE3_0 */
811
        s->rfbi.data[2] = value & 0x0f1f0f1f;
812
        break;
813
    case 0x78:        /* RFBI_CONFIG1 */
814
        s->rfbi.config[1] = value & 0x003f1fff;
815
        break;
816

    
817
    case 0x7c:        /* RFBI_ONOFF_TIME1 */
818
        s->rfbi.time[2] = value & 0x3fffffff;
819
        break;
820
    case 0x80:        /* RFBI_CYCLE_TIME1 */
821
        s->rfbi.time[3] = value & 0x0fffffff;
822
        break;
823
    case 0x84:        /* RFBI_DATA_CYCLE1_1 */
824
        s->rfbi.data[3] = value & 0x0f1f0f1f;
825
        break;
826
    case 0x88:        /* RFBI_DATA_CYCLE2_1 */
827
        s->rfbi.data[4] = value & 0x0f1f0f1f;
828
        break;
829
    case 0x8c:        /* RFBI_DATA_CYCLE3_1 */
830
        s->rfbi.data[5] = value & 0x0f1f0f1f;
831
        break;
832

    
833
    case 0x90:        /* RFBI_VSYNC_WIDTH */
834
        s->rfbi.vsync = value & 0xffff;
835
        break;
836
    case 0x94:        /* RFBI_HSYNC_WIDTH */
837
        s->rfbi.hsync = value & 0xffff;
838
        break;
839

    
840
    default:
841
        OMAP_BAD_REG(addr);
842
    }
843
}
844

    
845
static CPUReadMemoryFunc * const omap_rfbi1_readfn[] = {
846
    omap_badwidth_read32,
847
    omap_badwidth_read32,
848
    omap_rfbi_read,
849
};
850

    
851
static CPUWriteMemoryFunc * const omap_rfbi1_writefn[] = {
852
    omap_badwidth_write32,
853
    omap_badwidth_write32,
854
    omap_rfbi_write,
855
};
856

    
857
static uint32_t omap_venc_read(void *opaque, target_phys_addr_t addr)
858
{
859
    switch (addr) {
860
    case 0x00:        /* REV_ID */
861
    case 0x04:        /* STATUS */
862
    case 0x08:        /* F_CONTROL */
863
    case 0x10:        /* VIDOUT_CTRL */
864
    case 0x14:        /* SYNC_CTRL */
865
    case 0x1c:        /* LLEN */
866
    case 0x20:        /* FLENS */
867
    case 0x24:        /* HFLTR_CTRL */
868
    case 0x28:        /* CC_CARR_WSS_CARR */
869
    case 0x2c:        /* C_PHASE */
870
    case 0x30:        /* GAIN_U */
871
    case 0x34:        /* GAIN_V */
872
    case 0x38:        /* GAIN_Y */
873
    case 0x3c:        /* BLACK_LEVEL */
874
    case 0x40:        /* BLANK_LEVEL */
875
    case 0x44:        /* X_COLOR */
876
    case 0x48:        /* M_CONTROL */
877
    case 0x4c:        /* BSTAMP_WSS_DATA */
878
    case 0x50:        /* S_CARR */
879
    case 0x54:        /* LINE21 */
880
    case 0x58:        /* LN_SEL */
881
    case 0x5c:        /* L21__WC_CTL */
882
    case 0x60:        /* HTRIGGER_VTRIGGER */
883
    case 0x64:        /* SAVID__EAVID */
884
    case 0x68:        /* FLEN__FAL */
885
    case 0x6c:        /* LAL__PHASE_RESET */
886
    case 0x70:        /* HS_INT_START_STOP_X */
887
    case 0x74:        /* HS_EXT_START_STOP_X */
888
    case 0x78:        /* VS_INT_START_X */
889
    case 0x7c:        /* VS_INT_STOP_X__VS_INT_START_Y */
890
    case 0x80:        /* VS_INT_STOP_Y__VS_INT_START_X */
891
    case 0x84:        /* VS_EXT_STOP_X__VS_EXT_START_Y */
892
    case 0x88:        /* VS_EXT_STOP_Y */
893
    case 0x90:        /* AVID_START_STOP_X */
894
    case 0x94:        /* AVID_START_STOP_Y */
895
    case 0xa0:        /* FID_INT_START_X__FID_INT_START_Y */
896
    case 0xa4:        /* FID_INT_OFFSET_Y__FID_EXT_START_X */
897
    case 0xa8:        /* FID_EXT_START_Y__FID_EXT_OFFSET_Y */
898
    case 0xb0:        /* TVDETGP_INT_START_STOP_X */
899
    case 0xb4:        /* TVDETGP_INT_START_STOP_Y */
900
    case 0xb8:        /* GEN_CTRL */
901
    case 0xc4:        /* DAC_TST__DAC_A */
902
    case 0xc8:        /* DAC_B__DAC_C */
903
        return 0;
904

    
905
    default:
906
        break;
907
    }
908
    OMAP_BAD_REG(addr);
909
    return 0;
910
}
911

    
912
static void omap_venc_write(void *opaque, target_phys_addr_t addr,
913
                uint32_t value)
914
{
915
    switch (addr) {
916
    case 0x08:        /* F_CONTROL */
917
    case 0x10:        /* VIDOUT_CTRL */
918
    case 0x14:        /* SYNC_CTRL */
919
    case 0x1c:        /* LLEN */
920
    case 0x20:        /* FLENS */
921
    case 0x24:        /* HFLTR_CTRL */
922
    case 0x28:        /* CC_CARR_WSS_CARR */
923
    case 0x2c:        /* C_PHASE */
924
    case 0x30:        /* GAIN_U */
925
    case 0x34:        /* GAIN_V */
926
    case 0x38:        /* GAIN_Y */
927
    case 0x3c:        /* BLACK_LEVEL */
928
    case 0x40:        /* BLANK_LEVEL */
929
    case 0x44:        /* X_COLOR */
930
    case 0x48:        /* M_CONTROL */
931
    case 0x4c:        /* BSTAMP_WSS_DATA */
932
    case 0x50:        /* S_CARR */
933
    case 0x54:        /* LINE21 */
934
    case 0x58:        /* LN_SEL */
935
    case 0x5c:        /* L21__WC_CTL */
936
    case 0x60:        /* HTRIGGER_VTRIGGER */
937
    case 0x64:        /* SAVID__EAVID */
938
    case 0x68:        /* FLEN__FAL */
939
    case 0x6c:        /* LAL__PHASE_RESET */
940
    case 0x70:        /* HS_INT_START_STOP_X */
941
    case 0x74:        /* HS_EXT_START_STOP_X */
942
    case 0x78:        /* VS_INT_START_X */
943
    case 0x7c:        /* VS_INT_STOP_X__VS_INT_START_Y */
944
    case 0x80:        /* VS_INT_STOP_Y__VS_INT_START_X */
945
    case 0x84:        /* VS_EXT_STOP_X__VS_EXT_START_Y */
946
    case 0x88:        /* VS_EXT_STOP_Y */
947
    case 0x90:        /* AVID_START_STOP_X */
948
    case 0x94:        /* AVID_START_STOP_Y */
949
    case 0xa0:        /* FID_INT_START_X__FID_INT_START_Y */
950
    case 0xa4:        /* FID_INT_OFFSET_Y__FID_EXT_START_X */
951
    case 0xa8:        /* FID_EXT_START_Y__FID_EXT_OFFSET_Y */
952
    case 0xb0:        /* TVDETGP_INT_START_STOP_X */
953
    case 0xb4:        /* TVDETGP_INT_START_STOP_Y */
954
    case 0xb8:        /* GEN_CTRL */
955
    case 0xc4:        /* DAC_TST__DAC_A */
956
    case 0xc8:        /* DAC_B__DAC_C */
957
        break;
958

    
959
    default:
960
        OMAP_BAD_REG(addr);
961
    }
962
}
963

    
964
static CPUReadMemoryFunc * const omap_venc1_readfn[] = {
965
    omap_badwidth_read32,
966
    omap_badwidth_read32,
967
    omap_venc_read,
968
};
969

    
970
static CPUWriteMemoryFunc * const omap_venc1_writefn[] = {
971
    omap_badwidth_write32,
972
    omap_badwidth_write32,
973
    omap_venc_write,
974
};
975

    
976
static uint32_t omap_im3_read(void *opaque, target_phys_addr_t addr)
977
{
978
    switch (addr) {
979
    case 0x0a8:        /* SBIMERRLOGA */
980
    case 0x0b0:        /* SBIMERRLOG */
981
    case 0x190:        /* SBIMSTATE */
982
    case 0x198:        /* SBTMSTATE_L */
983
    case 0x19c:        /* SBTMSTATE_H */
984
    case 0x1a8:        /* SBIMCONFIG_L */
985
    case 0x1ac:        /* SBIMCONFIG_H */
986
    case 0x1f8:        /* SBID_L */
987
    case 0x1fc:        /* SBID_H */
988
        return 0;
989

    
990
    default:
991
        break;
992
    }
993
    OMAP_BAD_REG(addr);
994
    return 0;
995
}
996

    
997
static void omap_im3_write(void *opaque, target_phys_addr_t addr,
998
                uint32_t value)
999
{
1000
    switch (addr) {
1001
    case 0x0b0:        /* SBIMERRLOG */
1002
    case 0x190:        /* SBIMSTATE */
1003
    case 0x198:        /* SBTMSTATE_L */
1004
    case 0x19c:        /* SBTMSTATE_H */
1005
    case 0x1a8:        /* SBIMCONFIG_L */
1006
    case 0x1ac:        /* SBIMCONFIG_H */
1007
        break;
1008

    
1009
    default:
1010
        OMAP_BAD_REG(addr);
1011
    }
1012
}
1013

    
1014
static CPUReadMemoryFunc * const omap_im3_readfn[] = {
1015
    omap_badwidth_read32,
1016
    omap_badwidth_read32,
1017
    omap_im3_read,
1018
};
1019

    
1020
static CPUWriteMemoryFunc * const omap_im3_writefn[] = {
1021
    omap_badwidth_write32,
1022
    omap_badwidth_write32,
1023
    omap_im3_write,
1024
};
1025

    
1026
struct omap_dss_s *omap_dss_init(struct omap_target_agent_s *ta,
1027
                target_phys_addr_t l3_base,
1028
                qemu_irq irq, qemu_irq drq,
1029
                omap_clk fck1, omap_clk fck2, omap_clk ck54m,
1030
                omap_clk ick1, omap_clk ick2)
1031
{
1032
    int iomemtype[5];
1033
    struct omap_dss_s *s = (struct omap_dss_s *)
1034
            g_malloc0(sizeof(struct omap_dss_s));
1035

    
1036
    s->irq = irq;
1037
    s->drq = drq;
1038
    omap_dss_reset(s);
1039

    
1040
    iomemtype[0] = l4_register_io_memory(omap_diss1_readfn,
1041
                    omap_diss1_writefn, s);
1042
    iomemtype[1] = l4_register_io_memory(omap_disc1_readfn,
1043
                    omap_disc1_writefn, s);
1044
    iomemtype[2] = l4_register_io_memory(omap_rfbi1_readfn,
1045
                    omap_rfbi1_writefn, s);
1046
    iomemtype[3] = l4_register_io_memory(omap_venc1_readfn,
1047
                    omap_venc1_writefn, s);
1048
    iomemtype[4] = cpu_register_io_memory(omap_im3_readfn,
1049
                    omap_im3_writefn, s, DEVICE_NATIVE_ENDIAN);
1050
    omap_l4_attach(ta, 0, iomemtype[0]);
1051
    omap_l4_attach(ta, 1, iomemtype[1]);
1052
    omap_l4_attach(ta, 2, iomemtype[2]);
1053
    omap_l4_attach(ta, 3, iomemtype[3]);
1054
    cpu_register_physical_memory(l3_base, 0x1000, iomemtype[4]);
1055

    
1056
#if 0
1057
    s->state = graphic_console_init(omap_update_display,
1058
                                    omap_invalidate_display, omap_screen_dump, s);
1059
#endif
1060

    
1061
    return s;
1062
}
1063

    
1064
void omap_rfbi_attach(struct omap_dss_s *s, int cs, struct rfbi_chip_s *chip)
1065
{
1066
    if (cs < 0 || cs > 1)
1067
        hw_error("%s: wrong CS %i\n", __FUNCTION__, cs);
1068
    s->rfbi.chip[cs] = chip;
1069
}