Statistics
| Branch: | Revision:

root / hw / omap_dss.c @ 513f789f

History | View | Annotate | Download (31.2 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, write to the Free Software Foundation, Inc.,
19
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20
 */
21
#include "hw.h"
22
#include "console.h"
23
#include "omap.h"
24

    
25
struct omap_dss_s {
26
    qemu_irq irq;
27
    qemu_irq drq;
28
    DisplayState *state;
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
            target_phys_addr_t 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 uint32_t omap_diss_read(void *opaque, target_phys_addr_t addr)
172
{
173
    struct omap_dss_s *s = (struct omap_dss_s *) opaque;
174

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

    
388
    case 0x040:        /* DISPC_CONTROL */
389
        s->dispc.control = value & 0x07ff9fff;
390
        s->dig.enable = (value >> 1) & 1;
391
        s->lcd.enable = (value >> 0) & 1;
392
        if (value & (1 << 12))                        /* OVERLAY_OPTIMIZATION */
393
            if (~((s->dispc.l[1].attr | s->dispc.l[2].attr) & 1))
394
                 fprintf(stderr, "%s: Overlay Optimization when no overlay "
395
                                 "region effectively exists leads to "
396
                                 "unpredictable behaviour!\n", __FUNCTION__);
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 *omap_disc1_readfn[] = {
574
    omap_badwidth_read32,
575
    omap_badwidth_read32,
576
    omap_disc_read,
577
};
578

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

    
585
static void *omap_rfbi_get_buffer(struct omap_dss_s *s)
586
{
587
    target_phys_addr_t fb;
588
    uint32_t pd;
589

    
590
    /* TODO */
591
    fb = s->dispc.l[0].addr[0];
592

    
593
    pd = cpu_get_physical_page_desc(fb);
594
    if ((pd & ~TARGET_PAGE_MASK) != IO_MEM_RAM)
595
        /* TODO */
596
        cpu_abort(cpu_single_env, "%s: framebuffer outside RAM!\n",
597
                        __FUNCTION__);
598
    else
599
        return phys_ram_base +
600
                (pd & TARGET_PAGE_MASK) +
601
                (fb & ~TARGET_PAGE_MASK);
602
}
603

    
604
static void omap_rfbi_transfer_stop(struct omap_dss_s *s)
605
{
606
    if (!s->rfbi.busy)
607
        return;
608

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

    
611
    s->rfbi.busy = 0;
612
}
613

    
614
static void omap_rfbi_transfer_start(struct omap_dss_s *s)
615
{
616
    void *data;
617
    size_t len;
618
    int pitch;
619

    
620
    if (!s->rfbi.enable || s->rfbi.busy)
621
        return;
622

    
623
    if (s->rfbi.control & (1 << 1)) {                                /* BYPASS */
624
        /* TODO: in non-Bypass mode we probably need to just assert the
625
         * DRQ and wait for DMA to write the pixels.  */
626
        fprintf(stderr, "%s: Bypass mode unimplemented\n", __FUNCTION__);
627
        return;
628
    }
629

    
630
    if (!(s->dispc.control & (1 << 11)))                        /* RFBIMODE */
631
        return;
632
    /* TODO: check that LCD output is enabled in DISPC.  */
633

    
634
    s->rfbi.busy = 1;
635

    
636
    data = omap_rfbi_get_buffer(s);
637

    
638
    /* TODO bpp */
639
    len = s->rfbi.pixels * 2;
640
    s->rfbi.pixels = 0;
641

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

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

    
650
    omap_rfbi_transfer_stop(s);
651

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

    
838
    default:
839
        OMAP_BAD_REG(addr);
840
    }
841
}
842

    
843
static CPUReadMemoryFunc *omap_rfbi1_readfn[] = {
844
    omap_badwidth_read32,
845
    omap_badwidth_read32,
846
    omap_rfbi_read,
847
};
848

    
849
static CPUWriteMemoryFunc *omap_rfbi1_writefn[] = {
850
    omap_badwidth_write32,
851
    omap_badwidth_write32,
852
    omap_rfbi_write,
853
};
854

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

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

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

    
957
    default:
958
        OMAP_BAD_REG(addr);
959
    }
960
}
961

    
962
static CPUReadMemoryFunc *omap_venc1_readfn[] = {
963
    omap_badwidth_read32,
964
    omap_badwidth_read32,
965
    omap_venc_read,
966
};
967

    
968
static CPUWriteMemoryFunc *omap_venc1_writefn[] = {
969
    omap_badwidth_write32,
970
    omap_badwidth_write32,
971
    omap_venc_write,
972
};
973

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

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

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

    
1007
    default:
1008
        OMAP_BAD_REG(addr);
1009
    }
1010
}
1011

    
1012
static CPUReadMemoryFunc *omap_im3_readfn[] = {
1013
    omap_badwidth_read32,
1014
    omap_badwidth_read32,
1015
    omap_im3_read,
1016
};
1017

    
1018
static CPUWriteMemoryFunc *omap_im3_writefn[] = {
1019
    omap_badwidth_write32,
1020
    omap_badwidth_write32,
1021
    omap_im3_write,
1022
};
1023

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

    
1034
    s->irq = irq;
1035
    s->drq = drq;
1036
    omap_dss_reset(s);
1037

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

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

    
1059
    return s;
1060
}
1061

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