Statistics
| Branch: | Revision:

root / hw / omap_dss.c @ a8170e5e

History | View | Annotate | Download (31.9 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
    MemoryRegion iomem_diss1, iomem_disc1, iomem_rfbi1, iomem_venc1, iomem_im3;
29

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

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

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

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

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

    
63
            hwaddr addr[3];
64

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

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

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

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

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

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

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

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

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

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

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

    
171
static uint64_t omap_diss_read(void *opaque, hwaddr addr,
172
                               unsigned size)
173
{
174
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
175

    
176
    if (size != 4) {
177
        return omap_badwidth_read32(opaque, addr);
178
    }
179

    
180
    switch (addr) {
181
    case 0x00:        /* DSS_REVISIONNUMBER */
182
        return 0x20;
183

    
184
    case 0x10:        /* DSS_SYSCONFIG */
185
        return s->autoidle;
186

    
187
    case 0x14:        /* DSS_SYSSTATUS */
188
        return 1;                                                /* RESETDONE */
189

    
190
    case 0x40:        /* DSS_CONTROL */
191
        return s->control;
192

    
193
    case 0x50:        /* DSS_PSA_LCD_REG_1 */
194
    case 0x54:        /* DSS_PSA_LCD_REG_2 */
195
    case 0x58:        /* DSS_PSA_VIDEO_REG */
196
        /* TODO: fake some values when appropriate s->control bits are set */
197
        return 0;
198

    
199
    case 0x5c:        /* DSS_STATUS */
200
        return 1 + (s->control & 1);
201

    
202
    default:
203
        break;
204
    }
205
    OMAP_BAD_REG(addr);
206
    return 0;
207
}
208

    
209
static void omap_diss_write(void *opaque, hwaddr addr,
210
                            uint64_t value, unsigned size)
211
{
212
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
213

    
214
    if (size != 4) {
215
        return omap_badwidth_write32(opaque, addr, value);
216
    }
217

    
218
    switch (addr) {
219
    case 0x00:        /* DSS_REVISIONNUMBER */
220
    case 0x14:        /* DSS_SYSSTATUS */
221
    case 0x50:        /* DSS_PSA_LCD_REG_1 */
222
    case 0x54:        /* DSS_PSA_LCD_REG_2 */
223
    case 0x58:        /* DSS_PSA_VIDEO_REG */
224
    case 0x5c:        /* DSS_STATUS */
225
        OMAP_RO_REG(addr);
226
        break;
227

    
228
    case 0x10:        /* DSS_SYSCONFIG */
229
        if (value & 2)                                                /* SOFTRESET */
230
            omap_dss_reset(s);
231
        s->autoidle = value & 1;
232
        break;
233

    
234
    case 0x40:        /* DSS_CONTROL */
235
        s->control = value & 0x3dd;
236
        break;
237

    
238
    default:
239
        OMAP_BAD_REG(addr);
240
    }
241
}
242

    
243
static const MemoryRegionOps omap_diss_ops = {
244
    .read = omap_diss_read,
245
    .write = omap_diss_write,
246
    .endianness = DEVICE_NATIVE_ENDIAN,
247
};
248

    
249
static uint64_t omap_disc_read(void *opaque, hwaddr addr,
250
                               unsigned size)
251
{
252
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
253

    
254
    if (size != 4) {
255
        return omap_badwidth_read32(opaque, addr);
256
    }
257

    
258
    switch (addr) {
259
    case 0x000:        /* DISPC_REVISION */
260
        return 0x20;
261

    
262
    case 0x010:        /* DISPC_SYSCONFIG */
263
        return s->dispc.idlemode;
264

    
265
    case 0x014:        /* DISPC_SYSSTATUS */
266
        return 1;                                                /* RESETDONE */
267

    
268
    case 0x018:        /* DISPC_IRQSTATUS */
269
        return s->dispc.irqst;
270

    
271
    case 0x01c:        /* DISPC_IRQENABLE */
272
        return s->dispc.irqen;
273

    
274
    case 0x040:        /* DISPC_CONTROL */
275
        return s->dispc.control;
276

    
277
    case 0x044:        /* DISPC_CONFIG */
278
        return s->dispc.config;
279

    
280
    case 0x048:        /* DISPC_CAPABLE */
281
        return s->dispc.capable;
282

    
283
    case 0x04c:        /* DISPC_DEFAULT_COLOR0 */
284
        return s->dispc.bg[0];
285
    case 0x050:        /* DISPC_DEFAULT_COLOR1 */
286
        return s->dispc.bg[1];
287
    case 0x054:        /* DISPC_TRANS_COLOR0 */
288
        return s->dispc.trans[0];
289
    case 0x058:        /* DISPC_TRANS_COLOR1 */
290
        return s->dispc.trans[1];
291

    
292
    case 0x05c:        /* DISPC_LINE_STATUS */
293
        return 0x7ff;
294
    case 0x060:        /* DISPC_LINE_NUMBER */
295
        return s->dispc.line;
296

    
297
    case 0x064:        /* DISPC_TIMING_H */
298
        return s->dispc.timing[0];
299
    case 0x068:        /* DISPC_TIMING_V */
300
        return s->dispc.timing[1];
301
    case 0x06c:        /* DISPC_POL_FREQ */
302
        return s->dispc.timing[2];
303
    case 0x070:        /* DISPC_DIVISOR */
304
        return s->dispc.timing[3];
305

    
306
    case 0x078:        /* DISPC_SIZE_DIG */
307
        return ((s->dig.ny - 1) << 16) | (s->dig.nx - 1);
308
    case 0x07c:        /* DISPC_SIZE_LCD */
309
        return ((s->lcd.ny - 1) << 16) | (s->lcd.nx - 1);
310

    
311
    case 0x080:        /* DISPC_GFX_BA0 */
312
        return s->dispc.l[0].addr[0];
313
    case 0x084:        /* DISPC_GFX_BA1 */
314
        return s->dispc.l[0].addr[1];
315
    case 0x088:        /* DISPC_GFX_POSITION */
316
        return (s->dispc.l[0].posy << 16) | s->dispc.l[0].posx;
317
    case 0x08c:        /* DISPC_GFX_SIZE */
318
        return ((s->dispc.l[0].ny - 1) << 16) | (s->dispc.l[0].nx - 1);
319
    case 0x0a0:        /* DISPC_GFX_ATTRIBUTES */
320
        return s->dispc.l[0].attr;
321
    case 0x0a4:        /* DISPC_GFX_FIFO_TRESHOLD */
322
        return s->dispc.l[0].tresh;
323
    case 0x0a8:        /* DISPC_GFX_FIFO_SIZE_STATUS */
324
        return 256;
325
    case 0x0ac:        /* DISPC_GFX_ROW_INC */
326
        return s->dispc.l[0].rowinc;
327
    case 0x0b0:        /* DISPC_GFX_PIXEL_INC */
328
        return s->dispc.l[0].colinc;
329
    case 0x0b4:        /* DISPC_GFX_WINDOW_SKIP */
330
        return s->dispc.l[0].wininc;
331
    case 0x0b8:        /* DISPC_GFX_TABLE_BA */
332
        return s->dispc.l[0].addr[2];
333

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

    
367
    default:
368
        break;
369
    }
370
    OMAP_BAD_REG(addr);
371
    return 0;
372
}
373

    
374
static void omap_disc_write(void *opaque, hwaddr addr,
375
                            uint64_t value, unsigned size)
376
{
377
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
378

    
379
    if (size != 4) {
380
        return omap_badwidth_write32(opaque, addr, value);
381
    }
382

    
383
    switch (addr) {
384
    case 0x010:        /* DISPC_SYSCONFIG */
385
        if (value & 2)                                                /* SOFTRESET */
386
            omap_dss_reset(s);
387
        s->dispc.idlemode = value & 0x301b;
388
        break;
389

    
390
    case 0x018:        /* DISPC_IRQSTATUS */
391
        s->dispc.irqst &= ~value;
392
        omap_dispc_interrupt_update(s);
393
        break;
394

    
395
    case 0x01c:        /* DISPC_IRQENABLE */
396
        s->dispc.irqen = value & 0xffff;
397
        omap_dispc_interrupt_update(s);
398
        break;
399

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

    
447
    case 0x044:        /* DISPC_CONFIG */
448
        s->dispc.config = value & 0x3fff;
449
        /* XXX:
450
         * bits 2:1 (LOADMODE) reset to 0 after set to 1 and palette loaded
451
         * bits 2:1 (LOADMODE) reset to 2 after set to 3 and palette loaded
452
         */
453
        s->dispc.invalidate = 1;
454
        break;
455

    
456
    case 0x048:        /* DISPC_CAPABLE */
457
        s->dispc.capable = value & 0x3ff;
458
        break;
459

    
460
    case 0x04c:        /* DISPC_DEFAULT_COLOR0 */
461
        s->dispc.bg[0] = value & 0xffffff;
462
        s->dispc.invalidate = 1;
463
        break;
464
    case 0x050:        /* DISPC_DEFAULT_COLOR1 */
465
        s->dispc.bg[1] = value & 0xffffff;
466
        s->dispc.invalidate = 1;
467
        break;
468
    case 0x054:        /* DISPC_TRANS_COLOR0 */
469
        s->dispc.trans[0] = value & 0xffffff;
470
        s->dispc.invalidate = 1;
471
        break;
472
    case 0x058:        /* DISPC_TRANS_COLOR1 */
473
        s->dispc.trans[1] = value & 0xffffff;
474
        s->dispc.invalidate = 1;
475
        break;
476

    
477
    case 0x060:        /* DISPC_LINE_NUMBER */
478
        s->dispc.line = value & 0x7ff;
479
        break;
480

    
481
    case 0x064:        /* DISPC_TIMING_H */
482
        s->dispc.timing[0] = value & 0x0ff0ff3f;
483
        break;
484
    case 0x068:        /* DISPC_TIMING_V */
485
        s->dispc.timing[1] = value & 0x0ff0ff3f;
486
        break;
487
    case 0x06c:        /* DISPC_POL_FREQ */
488
        s->dispc.timing[2] = value & 0x0003ffff;
489
        break;
490
    case 0x070:        /* DISPC_DIVISOR */
491
        s->dispc.timing[3] = value & 0x00ff00ff;
492
        break;
493

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

    
550
    case 0x0bc:        /* DISPC_VID1_BA0 */
551
    case 0x0c0:        /* DISPC_VID1_BA1 */
552
    case 0x0c4:        /* DISPC_VID1_POSITION */
553
    case 0x0c8:        /* DISPC_VID1_SIZE */
554
    case 0x0cc:        /* DISPC_VID1_ATTRIBUTES */
555
    case 0x0d0:        /* DISPC_VID1_FIFO_TRESHOLD */
556
    case 0x0d8:        /* DISPC_VID1_ROW_INC */
557
    case 0x0dc:        /* DISPC_VID1_PIXEL_INC */
558
    case 0x0e0:        /* DISPC_VID1_FIR */
559
    case 0x0e4:        /* DISPC_VID1_PICTURE_SIZE */
560
    case 0x0e8:        /* DISPC_VID1_ACCU0 */
561
    case 0x0ec:        /* DISPC_VID1_ACCU1 */
562
    case 0x0f0 ... 0x140:        /* DISPC_VID1_FIR_COEF, DISPC_VID1_CONV_COEF */
563
    case 0x14c:        /* DISPC_VID2_BA0 */
564
    case 0x150:        /* DISPC_VID2_BA1 */
565
    case 0x154:        /* DISPC_VID2_POSITION */
566
    case 0x158:        /* DISPC_VID2_SIZE */
567
    case 0x15c:        /* DISPC_VID2_ATTRIBUTES */
568
    case 0x160:        /* DISPC_VID2_FIFO_TRESHOLD */
569
    case 0x168:        /* DISPC_VID2_ROW_INC */
570
    case 0x16c:        /* DISPC_VID2_PIXEL_INC */
571
    case 0x170:        /* DISPC_VID2_FIR */
572
    case 0x174:        /* DISPC_VID2_PICTURE_SIZE */
573
    case 0x178:        /* DISPC_VID2_ACCU0 */
574
    case 0x17c:        /* DISPC_VID2_ACCU1 */
575
    case 0x180 ... 0x1d0:        /* DISPC_VID2_FIR_COEF, DISPC_VID2_CONV_COEF */
576
    case 0x1d4:        /* DISPC_DATA_CYCLE1 */
577
    case 0x1d8:        /* DISPC_DATA_CYCLE2 */
578
    case 0x1dc:        /* DISPC_DATA_CYCLE3 */
579
        break;
580

    
581
    default:
582
        OMAP_BAD_REG(addr);
583
    }
584
}
585

    
586
static const MemoryRegionOps omap_disc_ops = {
587
    .read = omap_disc_read,
588
    .write = omap_disc_write,
589
    .endianness = DEVICE_NATIVE_ENDIAN,
590
};
591

    
592
static void omap_rfbi_transfer_stop(struct omap_dss_s *s)
593
{
594
    if (!s->rfbi.busy)
595
        return;
596

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

    
599
    s->rfbi.busy = 0;
600
}
601

    
602
static void omap_rfbi_transfer_start(struct omap_dss_s *s)
603
{
604
    void *data;
605
    hwaddr len;
606
    hwaddr data_addr;
607
    int pitch;
608
    static void *bounce_buffer;
609
    static hwaddr bounce_len;
610

    
611
    if (!s->rfbi.enable || s->rfbi.busy)
612
        return;
613

    
614
    if (s->rfbi.control & (1 << 1)) {                                /* BYPASS */
615
        /* TODO: in non-Bypass mode we probably need to just assert the
616
         * DRQ and wait for DMA to write the pixels.  */
617
        fprintf(stderr, "%s: Bypass mode unimplemented\n", __FUNCTION__);
618
        return;
619
    }
620

    
621
    if (!(s->dispc.control & (1 << 11)))                        /* RFBIMODE */
622
        return;
623
    /* TODO: check that LCD output is enabled in DISPC.  */
624

    
625
    s->rfbi.busy = 1;
626

    
627
    len = s->rfbi.pixels * 2;
628

    
629
    data_addr = s->dispc.l[0].addr[0];
630
    data = cpu_physical_memory_map(data_addr, &len, 0);
631
    if (data && len != s->rfbi.pixels * 2) {
632
        cpu_physical_memory_unmap(data, len, 0, 0);
633
        data = NULL;
634
        len = s->rfbi.pixels * 2;
635
    }
636
    if (!data) {
637
        if (len > bounce_len) {
638
            bounce_buffer = g_realloc(bounce_buffer, len);
639
        }
640
        data = bounce_buffer;
641
        cpu_physical_memory_read(data_addr, data, len);
642
    }
643

    
644
    /* TODO bpp */
645
    s->rfbi.pixels = 0;
646

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

    
650
    if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
651
        s->rfbi.chip[0]->block(s->rfbi.chip[0]->opaque, 1, data, len, pitch);
652
    if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
653
        s->rfbi.chip[1]->block(s->rfbi.chip[1]->opaque, 1, data, len, pitch);
654

    
655
    if (data != bounce_buffer) {
656
        cpu_physical_memory_unmap(data, len, 0, len);
657
    }
658

    
659
    omap_rfbi_transfer_stop(s);
660

    
661
    /* TODO */
662
    s->dispc.irqst |= 1;                                        /* FRAMEDONE */
663
    omap_dispc_interrupt_update(s);
664
}
665

    
666
static uint64_t omap_rfbi_read(void *opaque, hwaddr addr,
667
                               unsigned size)
668
{
669
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
670

    
671
    if (size != 4) {
672
        return omap_badwidth_read32(opaque, addr);
673
    }
674

    
675
    switch (addr) {
676
    case 0x00:        /* RFBI_REVISION */
677
        return 0x10;
678

    
679
    case 0x10:        /* RFBI_SYSCONFIG */
680
        return s->rfbi.idlemode;
681

    
682
    case 0x14:        /* RFBI_SYSSTATUS */
683
        return 1 | (s->rfbi.busy << 8);                                /* RESETDONE */
684

    
685
    case 0x40:        /* RFBI_CONTROL */
686
        return s->rfbi.control;
687

    
688
    case 0x44:        /* RFBI_PIXELCNT */
689
        return s->rfbi.pixels;
690

    
691
    case 0x48:        /* RFBI_LINE_NUMBER */
692
        return s->rfbi.skiplines;
693

    
694
    case 0x58:        /* RFBI_READ */
695
    case 0x5c:        /* RFBI_STATUS */
696
        return s->rfbi.rxbuf;
697

    
698
    case 0x60:        /* RFBI_CONFIG0 */
699
        return s->rfbi.config[0];
700
    case 0x64:        /* RFBI_ONOFF_TIME0 */
701
        return s->rfbi.time[0];
702
    case 0x68:        /* RFBI_CYCLE_TIME0 */
703
        return s->rfbi.time[1];
704
    case 0x6c:        /* RFBI_DATA_CYCLE1_0 */
705
        return s->rfbi.data[0];
706
    case 0x70:        /* RFBI_DATA_CYCLE2_0 */
707
        return s->rfbi.data[1];
708
    case 0x74:        /* RFBI_DATA_CYCLE3_0 */
709
        return s->rfbi.data[2];
710

    
711
    case 0x78:        /* RFBI_CONFIG1 */
712
        return s->rfbi.config[1];
713
    case 0x7c:        /* RFBI_ONOFF_TIME1 */
714
        return s->rfbi.time[2];
715
    case 0x80:        /* RFBI_CYCLE_TIME1 */
716
        return s->rfbi.time[3];
717
    case 0x84:        /* RFBI_DATA_CYCLE1_1 */
718
        return s->rfbi.data[3];
719
    case 0x88:        /* RFBI_DATA_CYCLE2_1 */
720
        return s->rfbi.data[4];
721
    case 0x8c:        /* RFBI_DATA_CYCLE3_1 */
722
        return s->rfbi.data[5];
723

    
724
    case 0x90:        /* RFBI_VSYNC_WIDTH */
725
        return s->rfbi.vsync;
726
    case 0x94:        /* RFBI_HSYNC_WIDTH */
727
        return s->rfbi.hsync;
728
    }
729
    OMAP_BAD_REG(addr);
730
    return 0;
731
}
732

    
733
static void omap_rfbi_write(void *opaque, hwaddr addr,
734
                            uint64_t value, unsigned size)
735
{
736
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
737

    
738
    if (size != 4) {
739
        return omap_badwidth_write32(opaque, addr, value);
740
    }
741

    
742
    switch (addr) {
743
    case 0x10:        /* RFBI_SYSCONFIG */
744
        if (value & 2)                                                /* SOFTRESET */
745
            omap_rfbi_reset(s);
746
        s->rfbi.idlemode = value & 0x19;
747
        break;
748

    
749
    case 0x40:        /* RFBI_CONTROL */
750
        s->rfbi.control = value & 0xf;
751
        s->rfbi.enable = value & 1;
752
        if (value & (1 << 4) &&                                        /* ITE */
753
                        !(s->rfbi.config[0] & s->rfbi.config[1] & 0xc))
754
            omap_rfbi_transfer_start(s);
755
        break;
756

    
757
    case 0x44:        /* RFBI_PIXELCNT */
758
        s->rfbi.pixels = value;
759
        break;
760

    
761
    case 0x48:        /* RFBI_LINE_NUMBER */
762
        s->rfbi.skiplines = value & 0x7ff;
763
        break;
764

    
765
    case 0x4c:        /* RFBI_CMD */
766
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
767
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 0, value & 0xffff);
768
        if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
769
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 0, value & 0xffff);
770
        break;
771
    case 0x50:        /* RFBI_PARAM */
772
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
773
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value & 0xffff);
774
        if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
775
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value & 0xffff);
776
        break;
777
    case 0x54:        /* RFBI_DATA */
778
        /* TODO: take into account the format set up in s->rfbi.config[?] and
779
         * s->rfbi.data[?], but special-case the most usual scenario so that
780
         * speed doesn't suffer.  */
781
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) {
782
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value & 0xffff);
783
            s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value >> 16);
784
        }
785
        if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) {
786
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value & 0xffff);
787
            s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value >> 16);
788
        }
789
        if (!-- s->rfbi.pixels)
790
            omap_rfbi_transfer_stop(s);
791
        break;
792
    case 0x58:        /* RFBI_READ */
793
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
794
            s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 1);
795
        else if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
796
            s->rfbi.rxbuf = s->rfbi.chip[1]->read(s->rfbi.chip[1]->opaque, 1);
797
        if (!-- s->rfbi.pixels)
798
            omap_rfbi_transfer_stop(s);
799
        break;
800

    
801
    case 0x5c:        /* RFBI_STATUS */
802
        if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0])
803
            s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 0);
804
        else if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1])
805
            s->rfbi.rxbuf = s->rfbi.chip[1]->read(s->rfbi.chip[1]->opaque, 0);
806
        if (!-- s->rfbi.pixels)
807
            omap_rfbi_transfer_stop(s);
808
        break;
809

    
810
    case 0x60:        /* RFBI_CONFIG0 */
811
        s->rfbi.config[0] = value & 0x003f1fff;
812
        break;
813

    
814
    case 0x64:        /* RFBI_ONOFF_TIME0 */
815
        s->rfbi.time[0] = value & 0x3fffffff;
816
        break;
817
    case 0x68:        /* RFBI_CYCLE_TIME0 */
818
        s->rfbi.time[1] = value & 0x0fffffff;
819
        break;
820
    case 0x6c:        /* RFBI_DATA_CYCLE1_0 */
821
        s->rfbi.data[0] = value & 0x0f1f0f1f;
822
        break;
823
    case 0x70:        /* RFBI_DATA_CYCLE2_0 */
824
        s->rfbi.data[1] = value & 0x0f1f0f1f;
825
        break;
826
    case 0x74:        /* RFBI_DATA_CYCLE3_0 */
827
        s->rfbi.data[2] = value & 0x0f1f0f1f;
828
        break;
829
    case 0x78:        /* RFBI_CONFIG1 */
830
        s->rfbi.config[1] = value & 0x003f1fff;
831
        break;
832

    
833
    case 0x7c:        /* RFBI_ONOFF_TIME1 */
834
        s->rfbi.time[2] = value & 0x3fffffff;
835
        break;
836
    case 0x80:        /* RFBI_CYCLE_TIME1 */
837
        s->rfbi.time[3] = value & 0x0fffffff;
838
        break;
839
    case 0x84:        /* RFBI_DATA_CYCLE1_1 */
840
        s->rfbi.data[3] = value & 0x0f1f0f1f;
841
        break;
842
    case 0x88:        /* RFBI_DATA_CYCLE2_1 */
843
        s->rfbi.data[4] = value & 0x0f1f0f1f;
844
        break;
845
    case 0x8c:        /* RFBI_DATA_CYCLE3_1 */
846
        s->rfbi.data[5] = value & 0x0f1f0f1f;
847
        break;
848

    
849
    case 0x90:        /* RFBI_VSYNC_WIDTH */
850
        s->rfbi.vsync = value & 0xffff;
851
        break;
852
    case 0x94:        /* RFBI_HSYNC_WIDTH */
853
        s->rfbi.hsync = value & 0xffff;
854
        break;
855

    
856
    default:
857
        OMAP_BAD_REG(addr);
858
    }
859
}
860

    
861
static const MemoryRegionOps omap_rfbi_ops = {
862
    .read = omap_rfbi_read,
863
    .write = omap_rfbi_write,
864
    .endianness = DEVICE_NATIVE_ENDIAN,
865
};
866

    
867
static uint64_t omap_venc_read(void *opaque, hwaddr addr,
868
                               unsigned size)
869
{
870
    if (size != 4) {
871
        return omap_badwidth_read32(opaque, addr);
872
    }
873

    
874
    switch (addr) {
875
    case 0x00:        /* REV_ID */
876
    case 0x04:        /* STATUS */
877
    case 0x08:        /* F_CONTROL */
878
    case 0x10:        /* VIDOUT_CTRL */
879
    case 0x14:        /* SYNC_CTRL */
880
    case 0x1c:        /* LLEN */
881
    case 0x20:        /* FLENS */
882
    case 0x24:        /* HFLTR_CTRL */
883
    case 0x28:        /* CC_CARR_WSS_CARR */
884
    case 0x2c:        /* C_PHASE */
885
    case 0x30:        /* GAIN_U */
886
    case 0x34:        /* GAIN_V */
887
    case 0x38:        /* GAIN_Y */
888
    case 0x3c:        /* BLACK_LEVEL */
889
    case 0x40:        /* BLANK_LEVEL */
890
    case 0x44:        /* X_COLOR */
891
    case 0x48:        /* M_CONTROL */
892
    case 0x4c:        /* BSTAMP_WSS_DATA */
893
    case 0x50:        /* S_CARR */
894
    case 0x54:        /* LINE21 */
895
    case 0x58:        /* LN_SEL */
896
    case 0x5c:        /* L21__WC_CTL */
897
    case 0x60:        /* HTRIGGER_VTRIGGER */
898
    case 0x64:        /* SAVID__EAVID */
899
    case 0x68:        /* FLEN__FAL */
900
    case 0x6c:        /* LAL__PHASE_RESET */
901
    case 0x70:        /* HS_INT_START_STOP_X */
902
    case 0x74:        /* HS_EXT_START_STOP_X */
903
    case 0x78:        /* VS_INT_START_X */
904
    case 0x7c:        /* VS_INT_STOP_X__VS_INT_START_Y */
905
    case 0x80:        /* VS_INT_STOP_Y__VS_INT_START_X */
906
    case 0x84:        /* VS_EXT_STOP_X__VS_EXT_START_Y */
907
    case 0x88:        /* VS_EXT_STOP_Y */
908
    case 0x90:        /* AVID_START_STOP_X */
909
    case 0x94:        /* AVID_START_STOP_Y */
910
    case 0xa0:        /* FID_INT_START_X__FID_INT_START_Y */
911
    case 0xa4:        /* FID_INT_OFFSET_Y__FID_EXT_START_X */
912
    case 0xa8:        /* FID_EXT_START_Y__FID_EXT_OFFSET_Y */
913
    case 0xb0:        /* TVDETGP_INT_START_STOP_X */
914
    case 0xb4:        /* TVDETGP_INT_START_STOP_Y */
915
    case 0xb8:        /* GEN_CTRL */
916
    case 0xc4:        /* DAC_TST__DAC_A */
917
    case 0xc8:        /* DAC_B__DAC_C */
918
        return 0;
919

    
920
    default:
921
        break;
922
    }
923
    OMAP_BAD_REG(addr);
924
    return 0;
925
}
926

    
927
static void omap_venc_write(void *opaque, hwaddr addr,
928
                            uint64_t value, unsigned size)
929
{
930
    if (size != 4) {
931
        return omap_badwidth_write32(opaque, addr, size);
932
    }
933

    
934
    switch (addr) {
935
    case 0x08:        /* F_CONTROL */
936
    case 0x10:        /* VIDOUT_CTRL */
937
    case 0x14:        /* SYNC_CTRL */
938
    case 0x1c:        /* LLEN */
939
    case 0x20:        /* FLENS */
940
    case 0x24:        /* HFLTR_CTRL */
941
    case 0x28:        /* CC_CARR_WSS_CARR */
942
    case 0x2c:        /* C_PHASE */
943
    case 0x30:        /* GAIN_U */
944
    case 0x34:        /* GAIN_V */
945
    case 0x38:        /* GAIN_Y */
946
    case 0x3c:        /* BLACK_LEVEL */
947
    case 0x40:        /* BLANK_LEVEL */
948
    case 0x44:        /* X_COLOR */
949
    case 0x48:        /* M_CONTROL */
950
    case 0x4c:        /* BSTAMP_WSS_DATA */
951
    case 0x50:        /* S_CARR */
952
    case 0x54:        /* LINE21 */
953
    case 0x58:        /* LN_SEL */
954
    case 0x5c:        /* L21__WC_CTL */
955
    case 0x60:        /* HTRIGGER_VTRIGGER */
956
    case 0x64:        /* SAVID__EAVID */
957
    case 0x68:        /* FLEN__FAL */
958
    case 0x6c:        /* LAL__PHASE_RESET */
959
    case 0x70:        /* HS_INT_START_STOP_X */
960
    case 0x74:        /* HS_EXT_START_STOP_X */
961
    case 0x78:        /* VS_INT_START_X */
962
    case 0x7c:        /* VS_INT_STOP_X__VS_INT_START_Y */
963
    case 0x80:        /* VS_INT_STOP_Y__VS_INT_START_X */
964
    case 0x84:        /* VS_EXT_STOP_X__VS_EXT_START_Y */
965
    case 0x88:        /* VS_EXT_STOP_Y */
966
    case 0x90:        /* AVID_START_STOP_X */
967
    case 0x94:        /* AVID_START_STOP_Y */
968
    case 0xa0:        /* FID_INT_START_X__FID_INT_START_Y */
969
    case 0xa4:        /* FID_INT_OFFSET_Y__FID_EXT_START_X */
970
    case 0xa8:        /* FID_EXT_START_Y__FID_EXT_OFFSET_Y */
971
    case 0xb0:        /* TVDETGP_INT_START_STOP_X */
972
    case 0xb4:        /* TVDETGP_INT_START_STOP_Y */
973
    case 0xb8:        /* GEN_CTRL */
974
    case 0xc4:        /* DAC_TST__DAC_A */
975
    case 0xc8:        /* DAC_B__DAC_C */
976
        break;
977

    
978
    default:
979
        OMAP_BAD_REG(addr);
980
    }
981
}
982

    
983
static const MemoryRegionOps omap_venc_ops = {
984
    .read = omap_venc_read,
985
    .write = omap_venc_write,
986
    .endianness = DEVICE_NATIVE_ENDIAN,
987
};
988

    
989
static uint64_t omap_im3_read(void *opaque, hwaddr addr,
990
                              unsigned size)
991
{
992
    if (size != 4) {
993
        return omap_badwidth_read32(opaque, addr);
994
    }
995

    
996
    switch (addr) {
997
    case 0x0a8:        /* SBIMERRLOGA */
998
    case 0x0b0:        /* SBIMERRLOG */
999
    case 0x190:        /* SBIMSTATE */
1000
    case 0x198:        /* SBTMSTATE_L */
1001
    case 0x19c:        /* SBTMSTATE_H */
1002
    case 0x1a8:        /* SBIMCONFIG_L */
1003
    case 0x1ac:        /* SBIMCONFIG_H */
1004
    case 0x1f8:        /* SBID_L */
1005
    case 0x1fc:        /* SBID_H */
1006
        return 0;
1007

    
1008
    default:
1009
        break;
1010
    }
1011
    OMAP_BAD_REG(addr);
1012
    return 0;
1013
}
1014

    
1015
static void omap_im3_write(void *opaque, hwaddr addr,
1016
                           uint64_t value, unsigned size)
1017
{
1018
    if (size != 4) {
1019
        return omap_badwidth_write32(opaque, addr, value);
1020
    }
1021

    
1022
    switch (addr) {
1023
    case 0x0b0:        /* SBIMERRLOG */
1024
    case 0x190:        /* SBIMSTATE */
1025
    case 0x198:        /* SBTMSTATE_L */
1026
    case 0x19c:        /* SBTMSTATE_H */
1027
    case 0x1a8:        /* SBIMCONFIG_L */
1028
    case 0x1ac:        /* SBIMCONFIG_H */
1029
        break;
1030

    
1031
    default:
1032
        OMAP_BAD_REG(addr);
1033
    }
1034
}
1035

    
1036
static const MemoryRegionOps omap_im3_ops = {
1037
    .read = omap_im3_read,
1038
    .write = omap_im3_write,
1039
    .endianness = DEVICE_NATIVE_ENDIAN,
1040
};
1041

    
1042
struct omap_dss_s *omap_dss_init(struct omap_target_agent_s *ta,
1043
                MemoryRegion *sysmem,
1044
                hwaddr l3_base,
1045
                qemu_irq irq, qemu_irq drq,
1046
                omap_clk fck1, omap_clk fck2, omap_clk ck54m,
1047
                omap_clk ick1, omap_clk ick2)
1048
{
1049
    struct omap_dss_s *s = (struct omap_dss_s *)
1050
            g_malloc0(sizeof(struct omap_dss_s));
1051

    
1052
    s->irq = irq;
1053
    s->drq = drq;
1054
    omap_dss_reset(s);
1055

    
1056
    memory_region_init_io(&s->iomem_diss1, &omap_diss_ops, s, "omap.diss1",
1057
                          omap_l4_region_size(ta, 0));
1058
    memory_region_init_io(&s->iomem_disc1, &omap_disc_ops, s, "omap.disc1",
1059
                          omap_l4_region_size(ta, 1));
1060
    memory_region_init_io(&s->iomem_rfbi1, &omap_rfbi_ops, s, "omap.rfbi1",
1061
                          omap_l4_region_size(ta, 2));
1062
    memory_region_init_io(&s->iomem_venc1, &omap_venc_ops, s, "omap.venc1",
1063
                          omap_l4_region_size(ta, 3));
1064
    memory_region_init_io(&s->iomem_im3, &omap_im3_ops, s,
1065
                          "omap.im3", 0x1000);
1066

    
1067
    omap_l4_attach(ta, 0, &s->iomem_diss1);
1068
    omap_l4_attach(ta, 1, &s->iomem_disc1);
1069
    omap_l4_attach(ta, 2, &s->iomem_rfbi1);
1070
    omap_l4_attach(ta, 3, &s->iomem_venc1);
1071
    memory_region_add_subregion(sysmem, l3_base, &s->iomem_im3);
1072

    
1073
#if 0
1074
    s->state = graphic_console_init(omap_update_display,
1075
                                    omap_invalidate_display, omap_screen_dump, s);
1076
#endif
1077

    
1078
    return s;
1079
}
1080

    
1081
void omap_rfbi_attach(struct omap_dss_s *s, int cs, struct rfbi_chip_s *chip)
1082
{
1083
    if (cs < 0 || cs > 1)
1084
        hw_error("%s: wrong CS %i\n", __FUNCTION__, cs);
1085
    s->rfbi.chip[cs] = chip;
1086
}