Statistics
| Branch: | Revision:

root / hw / omap2.c @ 011d87d0

History | View | Annotate | Download (115.6 kB)

1
/*
2
 * TI OMAP processors emulation.
3
 *
4
 * Copyright (C) 2007-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

    
21
#include "blockdev.h"
22
#include "hw.h"
23
#include "arm-misc.h"
24
#include "omap.h"
25
#include "sysemu.h"
26
#include "qemu-timer.h"
27
#include "qemu-char.h"
28
#include "flash.h"
29
#include "soc_dma.h"
30
#include "audio/audio.h"
31

    
32
/* Multichannel SPI */
33
struct omap_mcspi_s {
34
    qemu_irq irq;
35
    int chnum;
36

    
37
    uint32_t sysconfig;
38
    uint32_t systest;
39
    uint32_t irqst;
40
    uint32_t irqen;
41
    uint32_t wken;
42
    uint32_t control;
43

    
44
    struct omap_mcspi_ch_s {
45
        qemu_irq txdrq;
46
        qemu_irq rxdrq;
47
        uint32_t (*txrx)(void *opaque, uint32_t, int);
48
        void *opaque;
49

    
50
        uint32_t tx;
51
        uint32_t rx;
52

    
53
        uint32_t config;
54
        uint32_t status;
55
        uint32_t control;
56
    } ch[4];
57
};
58

    
59
static inline void omap_mcspi_interrupt_update(struct omap_mcspi_s *s)
60
{
61
    qemu_set_irq(s->irq, s->irqst & s->irqen);
62
}
63

    
64
static inline void omap_mcspi_dmarequest_update(struct omap_mcspi_ch_s *ch)
65
{
66
    qemu_set_irq(ch->txdrq,
67
                    (ch->control & 1) &&                /* EN */
68
                    (ch->config & (1 << 14)) &&                /* DMAW */
69
                    (ch->status & (1 << 1)) &&                /* TXS */
70
                    ((ch->config >> 12) & 3) != 1);        /* TRM */
71
    qemu_set_irq(ch->rxdrq,
72
                    (ch->control & 1) &&                /* EN */
73
                    (ch->config & (1 << 15)) &&                /* DMAW */
74
                    (ch->status & (1 << 0)) &&                /* RXS */
75
                    ((ch->config >> 12) & 3) != 2);        /* TRM */
76
}
77

    
78
static void omap_mcspi_transfer_run(struct omap_mcspi_s *s, int chnum)
79
{
80
    struct omap_mcspi_ch_s *ch = s->ch + chnum;
81

    
82
    if (!(ch->control & 1))                                /* EN */
83
        return;
84
    if ((ch->status & (1 << 0)) &&                        /* RXS */
85
                    ((ch->config >> 12) & 3) != 2 &&        /* TRM */
86
                    !(ch->config & (1 << 19)))                /* TURBO */
87
        goto intr_update;
88
    if ((ch->status & (1 << 1)) &&                        /* TXS */
89
                    ((ch->config >> 12) & 3) != 1)        /* TRM */
90
        goto intr_update;
91

    
92
    if (!(s->control & 1) ||                                /* SINGLE */
93
                    (ch->config & (1 << 20))) {                /* FORCE */
94
        if (ch->txrx)
95
            ch->rx = ch->txrx(ch->opaque, ch->tx,        /* WL */
96
                            1 + (0x1f & (ch->config >> 7)));
97
    }
98

    
99
    ch->tx = 0;
100
    ch->status |= 1 << 2;                                /* EOT */
101
    ch->status |= 1 << 1;                                /* TXS */
102
    if (((ch->config >> 12) & 3) != 2)                        /* TRM */
103
        ch->status |= 1 << 0;                                /* RXS */
104

    
105
intr_update:
106
    if ((ch->status & (1 << 0)) &&                        /* RXS */
107
                    ((ch->config >> 12) & 3) != 2 &&        /* TRM */
108
                    !(ch->config & (1 << 19)))                /* TURBO */
109
        s->irqst |= 1 << (2 + 4 * chnum);                /* RX_FULL */
110
    if ((ch->status & (1 << 1)) &&                        /* TXS */
111
                    ((ch->config >> 12) & 3) != 1)        /* TRM */
112
        s->irqst |= 1 << (0 + 4 * chnum);                /* TX_EMPTY */
113
    omap_mcspi_interrupt_update(s);
114
    omap_mcspi_dmarequest_update(ch);
115
}
116

    
117
static void omap_mcspi_reset(struct omap_mcspi_s *s)
118
{
119
    int ch;
120

    
121
    s->sysconfig = 0;
122
    s->systest = 0;
123
    s->irqst = 0;
124
    s->irqen = 0;
125
    s->wken = 0;
126
    s->control = 4;
127

    
128
    for (ch = 0; ch < 4; ch ++) {
129
        s->ch[ch].config = 0x060000;
130
        s->ch[ch].status = 2;                                /* TXS */
131
        s->ch[ch].control = 0;
132

    
133
        omap_mcspi_dmarequest_update(s->ch + ch);
134
    }
135

    
136
    omap_mcspi_interrupt_update(s);
137
}
138

    
139
static uint32_t omap_mcspi_read(void *opaque, target_phys_addr_t addr)
140
{
141
    struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
142
    int ch = 0;
143
    uint32_t ret;
144

    
145
    switch (addr) {
146
    case 0x00:        /* MCSPI_REVISION */
147
        return 0x91;
148

    
149
    case 0x10:        /* MCSPI_SYSCONFIG */
150
        return s->sysconfig;
151

    
152
    case 0x14:        /* MCSPI_SYSSTATUS */
153
        return 1;                                        /* RESETDONE */
154

    
155
    case 0x18:        /* MCSPI_IRQSTATUS */
156
        return s->irqst;
157

    
158
    case 0x1c:        /* MCSPI_IRQENABLE */
159
        return s->irqen;
160

    
161
    case 0x20:        /* MCSPI_WAKEUPENABLE */
162
        return s->wken;
163

    
164
    case 0x24:        /* MCSPI_SYST */
165
        return s->systest;
166

    
167
    case 0x28:        /* MCSPI_MODULCTRL */
168
        return s->control;
169

    
170
    case 0x68: ch ++;
171
    case 0x54: ch ++;
172
    case 0x40: ch ++;
173
    case 0x2c:        /* MCSPI_CHCONF */
174
        return s->ch[ch].config;
175

    
176
    case 0x6c: ch ++;
177
    case 0x58: ch ++;
178
    case 0x44: ch ++;
179
    case 0x30:        /* MCSPI_CHSTAT */
180
        return s->ch[ch].status;
181

    
182
    case 0x70: ch ++;
183
    case 0x5c: ch ++;
184
    case 0x48: ch ++;
185
    case 0x34:        /* MCSPI_CHCTRL */
186
        return s->ch[ch].control;
187

    
188
    case 0x74: ch ++;
189
    case 0x60: ch ++;
190
    case 0x4c: ch ++;
191
    case 0x38:        /* MCSPI_TX */
192
        return s->ch[ch].tx;
193

    
194
    case 0x78: ch ++;
195
    case 0x64: ch ++;
196
    case 0x50: ch ++;
197
    case 0x3c:        /* MCSPI_RX */
198
        s->ch[ch].status &= ~(1 << 0);                        /* RXS */
199
        ret = s->ch[ch].rx;
200
        omap_mcspi_transfer_run(s, ch);
201
        return ret;
202
    }
203

    
204
    OMAP_BAD_REG(addr);
205
    return 0;
206
}
207

    
208
static void omap_mcspi_write(void *opaque, target_phys_addr_t addr,
209
                uint32_t value)
210
{
211
    struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
212
    int ch = 0;
213

    
214
    switch (addr) {
215
    case 0x00:        /* MCSPI_REVISION */
216
    case 0x14:        /* MCSPI_SYSSTATUS */
217
    case 0x30:        /* MCSPI_CHSTAT0 */
218
    case 0x3c:        /* MCSPI_RX0 */
219
    case 0x44:        /* MCSPI_CHSTAT1 */
220
    case 0x50:        /* MCSPI_RX1 */
221
    case 0x58:        /* MCSPI_CHSTAT2 */
222
    case 0x64:        /* MCSPI_RX2 */
223
    case 0x6c:        /* MCSPI_CHSTAT3 */
224
    case 0x78:        /* MCSPI_RX3 */
225
        OMAP_RO_REG(addr);
226
        return;
227

    
228
    case 0x10:        /* MCSPI_SYSCONFIG */
229
        if (value & (1 << 1))                                /* SOFTRESET */
230
            omap_mcspi_reset(s);
231
        s->sysconfig = value & 0x31d;
232
        break;
233

    
234
    case 0x18:        /* MCSPI_IRQSTATUS */
235
        if (!((s->control & (1 << 3)) && (s->systest & (1 << 11)))) {
236
            s->irqst &= ~value;
237
            omap_mcspi_interrupt_update(s);
238
        }
239
        break;
240

    
241
    case 0x1c:        /* MCSPI_IRQENABLE */
242
        s->irqen = value & 0x1777f;
243
        omap_mcspi_interrupt_update(s);
244
        break;
245

    
246
    case 0x20:        /* MCSPI_WAKEUPENABLE */
247
        s->wken = value & 1;
248
        break;
249

    
250
    case 0x24:        /* MCSPI_SYST */
251
        if (s->control & (1 << 3))                        /* SYSTEM_TEST */
252
            if (value & (1 << 11)) {                        /* SSB */
253
                s->irqst |= 0x1777f;
254
                omap_mcspi_interrupt_update(s);
255
            }
256
        s->systest = value & 0xfff;
257
        break;
258

    
259
    case 0x28:        /* MCSPI_MODULCTRL */
260
        if (value & (1 << 3))                                /* SYSTEM_TEST */
261
            if (s->systest & (1 << 11)) {                /* SSB */
262
                s->irqst |= 0x1777f;
263
                omap_mcspi_interrupt_update(s);
264
            }
265
        s->control = value & 0xf;
266
        break;
267

    
268
    case 0x68: ch ++;
269
    case 0x54: ch ++;
270
    case 0x40: ch ++;
271
    case 0x2c:        /* MCSPI_CHCONF */
272
        if ((value ^ s->ch[ch].config) & (3 << 14))        /* DMAR | DMAW */
273
            omap_mcspi_dmarequest_update(s->ch + ch);
274
        if (((value >> 12) & 3) == 3)                        /* TRM */
275
            fprintf(stderr, "%s: invalid TRM value (3)\n", __FUNCTION__);
276
        if (((value >> 7) & 0x1f) < 3)                        /* WL */
277
            fprintf(stderr, "%s: invalid WL value (%i)\n",
278
                            __FUNCTION__, (value >> 7) & 0x1f);
279
        s->ch[ch].config = value & 0x7fffff;
280
        break;
281

    
282
    case 0x70: ch ++;
283
    case 0x5c: ch ++;
284
    case 0x48: ch ++;
285
    case 0x34:        /* MCSPI_CHCTRL */
286
        if (value & ~s->ch[ch].control & 1) {                /* EN */
287
            s->ch[ch].control |= 1;
288
            omap_mcspi_transfer_run(s, ch);
289
        } else
290
            s->ch[ch].control = value & 1;
291
        break;
292

    
293
    case 0x74: ch ++;
294
    case 0x60: ch ++;
295
    case 0x4c: ch ++;
296
    case 0x38:        /* MCSPI_TX */
297
        s->ch[ch].tx = value;
298
        s->ch[ch].status &= ~(1 << 1);                        /* TXS */
299
        omap_mcspi_transfer_run(s, ch);
300
        break;
301

    
302
    default:
303
        OMAP_BAD_REG(addr);
304
        return;
305
    }
306
}
307

    
308
static CPUReadMemoryFunc * const omap_mcspi_readfn[] = {
309
    omap_badwidth_read32,
310
    omap_badwidth_read32,
311
    omap_mcspi_read,
312
};
313

    
314
static CPUWriteMemoryFunc * const omap_mcspi_writefn[] = {
315
    omap_badwidth_write32,
316
    omap_badwidth_write32,
317
    omap_mcspi_write,
318
};
319

    
320
struct omap_mcspi_s *omap_mcspi_init(struct omap_target_agent_s *ta, int chnum,
321
                qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
322
{
323
    int iomemtype;
324
    struct omap_mcspi_s *s = (struct omap_mcspi_s *)
325
            qemu_mallocz(sizeof(struct omap_mcspi_s));
326
    struct omap_mcspi_ch_s *ch = s->ch;
327

    
328
    s->irq = irq;
329
    s->chnum = chnum;
330
    while (chnum --) {
331
        ch->txdrq = *drq ++;
332
        ch->rxdrq = *drq ++;
333
        ch ++;
334
    }
335
    omap_mcspi_reset(s);
336

    
337
    iomemtype = l4_register_io_memory(omap_mcspi_readfn,
338
                    omap_mcspi_writefn, s);
339
    omap_l4_attach(ta, 0, iomemtype);
340

    
341
    return s;
342
}
343

    
344
void omap_mcspi_attach(struct omap_mcspi_s *s,
345
                uint32_t (*txrx)(void *opaque, uint32_t, int), void *opaque,
346
                int chipselect)
347
{
348
    if (chipselect < 0 || chipselect >= s->chnum)
349
        hw_error("%s: Bad chipselect %i\n", __FUNCTION__, chipselect);
350

    
351
    s->ch[chipselect].txrx = txrx;
352
    s->ch[chipselect].opaque = opaque;
353
}
354

    
355
/* Enhanced Audio Controller (CODEC only) */
356
struct omap_eac_s {
357
    qemu_irq irq;
358

    
359
    uint16_t sysconfig;
360
    uint8_t config[4];
361
    uint8_t control;
362
    uint8_t address;
363
    uint16_t data;
364
    uint8_t vtol;
365
    uint8_t vtsl;
366
    uint16_t mixer;
367
    uint16_t gain[4];
368
    uint8_t att;
369
    uint16_t max[7];
370

    
371
    struct {
372
        qemu_irq txdrq;
373
        qemu_irq rxdrq;
374
        uint32_t (*txrx)(void *opaque, uint32_t, int);
375
        void *opaque;
376

    
377
#define EAC_BUF_LEN 1024
378
        uint32_t rxbuf[EAC_BUF_LEN];
379
        int rxoff;
380
        int rxlen;
381
        int rxavail;
382
        uint32_t txbuf[EAC_BUF_LEN];
383
        int txlen;
384
        int txavail;
385

    
386
        int enable;
387
        int rate;
388

    
389
        uint16_t config[4];
390

    
391
        /* These need to be moved to the actual codec */
392
        QEMUSoundCard card;
393
        SWVoiceIn *in_voice;
394
        SWVoiceOut *out_voice;
395
        int hw_enable;
396
    } codec;
397

    
398
    struct {
399
        uint8_t control;
400
        uint16_t config;
401
    } modem, bt;
402
};
403

    
404
static inline void omap_eac_interrupt_update(struct omap_eac_s *s)
405
{
406
    qemu_set_irq(s->irq, (s->codec.config[1] >> 14) & 1);        /* AURDI */
407
}
408

    
409
static inline void omap_eac_in_dmarequest_update(struct omap_eac_s *s)
410
{
411
    qemu_set_irq(s->codec.rxdrq, (s->codec.rxavail || s->codec.rxlen) &&
412
                    ((s->codec.config[1] >> 12) & 1));                /* DMAREN */
413
}
414

    
415
static inline void omap_eac_out_dmarequest_update(struct omap_eac_s *s)
416
{
417
    qemu_set_irq(s->codec.txdrq, s->codec.txlen < s->codec.txavail &&
418
                    ((s->codec.config[1] >> 11) & 1));                /* DMAWEN */
419
}
420

    
421
static inline void omap_eac_in_refill(struct omap_eac_s *s)
422
{
423
    int left = MIN(EAC_BUF_LEN - s->codec.rxlen, s->codec.rxavail) << 2;
424
    int start = ((s->codec.rxoff + s->codec.rxlen) & (EAC_BUF_LEN - 1)) << 2;
425
    int leftwrap = MIN(left, (EAC_BUF_LEN << 2) - start);
426
    int recv = 1;
427
    uint8_t *buf = (uint8_t *) s->codec.rxbuf + start;
428

    
429
    left -= leftwrap;
430
    start = 0;
431
    while (leftwrap && (recv = AUD_read(s->codec.in_voice, buf + start,
432
                                    leftwrap)) > 0) {        /* Be defensive */
433
        start += recv;
434
        leftwrap -= recv;
435
    }
436
    if (recv <= 0)
437
        s->codec.rxavail = 0;
438
    else
439
        s->codec.rxavail -= start >> 2;
440
    s->codec.rxlen += start >> 2;
441

    
442
    if (recv > 0 && left > 0) {
443
        start = 0;
444
        while (left && (recv = AUD_read(s->codec.in_voice,
445
                                        (uint8_t *) s->codec.rxbuf + start,
446
                                        left)) > 0) {        /* Be defensive */
447
            start += recv;
448
            left -= recv;
449
        }
450
        if (recv <= 0)
451
            s->codec.rxavail = 0;
452
        else
453
            s->codec.rxavail -= start >> 2;
454
        s->codec.rxlen += start >> 2;
455
    }
456
}
457

    
458
static inline void omap_eac_out_empty(struct omap_eac_s *s)
459
{
460
    int left = s->codec.txlen << 2;
461
    int start = 0;
462
    int sent = 1;
463

    
464
    while (left && (sent = AUD_write(s->codec.out_voice,
465
                                    (uint8_t *) s->codec.txbuf + start,
466
                                    left)) > 0) {        /* Be defensive */
467
        start += sent;
468
        left -= sent;
469
    }
470

    
471
    if (!sent) {
472
        s->codec.txavail = 0;
473
        omap_eac_out_dmarequest_update(s);
474
    }
475

    
476
    if (start)
477
        s->codec.txlen = 0;
478
}
479

    
480
static void omap_eac_in_cb(void *opaque, int avail_b)
481
{
482
    struct omap_eac_s *s = (struct omap_eac_s *) opaque;
483

    
484
    s->codec.rxavail = avail_b >> 2;
485
    omap_eac_in_refill(s);
486
    /* TODO: possibly discard current buffer if overrun */
487
    omap_eac_in_dmarequest_update(s);
488
}
489

    
490
static void omap_eac_out_cb(void *opaque, int free_b)
491
{
492
    struct omap_eac_s *s = (struct omap_eac_s *) opaque;
493

    
494
    s->codec.txavail = free_b >> 2;
495
    if (s->codec.txlen)
496
        omap_eac_out_empty(s);
497
    else
498
        omap_eac_out_dmarequest_update(s);
499
}
500

    
501
static void omap_eac_enable_update(struct omap_eac_s *s)
502
{
503
    s->codec.enable = !(s->codec.config[1] & 1) &&                /* EACPWD */
504
            (s->codec.config[1] & 2) &&                                /* AUDEN */
505
            s->codec.hw_enable;
506
}
507

    
508
static const int omap_eac_fsint[4] = {
509
    8000,
510
    11025,
511
    22050,
512
    44100,
513
};
514

    
515
static const int omap_eac_fsint2[8] = {
516
    8000,
517
    11025,
518
    22050,
519
    44100,
520
    48000,
521
    0, 0, 0,
522
};
523

    
524
static const int omap_eac_fsint3[16] = {
525
    8000,
526
    11025,
527
    16000,
528
    22050,
529
    24000,
530
    32000,
531
    44100,
532
    48000,
533
    0, 0, 0, 0, 0, 0, 0, 0,
534
};
535

    
536
static void omap_eac_rate_update(struct omap_eac_s *s)
537
{
538
    int fsint[3];
539

    
540
    fsint[2] = (s->codec.config[3] >> 9) & 0xf;
541
    fsint[1] = (s->codec.config[2] >> 0) & 0x7;
542
    fsint[0] = (s->codec.config[0] >> 6) & 0x3;
543
    if (fsint[2] < 0xf)
544
        s->codec.rate = omap_eac_fsint3[fsint[2]];
545
    else if (fsint[1] < 0x7)
546
        s->codec.rate = omap_eac_fsint2[fsint[1]];
547
    else
548
        s->codec.rate = omap_eac_fsint[fsint[0]];
549
}
550

    
551
static void omap_eac_volume_update(struct omap_eac_s *s)
552
{
553
    /* TODO */
554
}
555

    
556
static void omap_eac_format_update(struct omap_eac_s *s)
557
{
558
    struct audsettings fmt;
559

    
560
    /* The hardware buffers at most one sample */
561
    if (s->codec.rxlen)
562
        s->codec.rxlen = 1;
563

    
564
    if (s->codec.in_voice) {
565
        AUD_set_active_in(s->codec.in_voice, 0);
566
        AUD_close_in(&s->codec.card, s->codec.in_voice);
567
        s->codec.in_voice = NULL;
568
    }
569
    if (s->codec.out_voice) {
570
        omap_eac_out_empty(s);
571
        AUD_set_active_out(s->codec.out_voice, 0);
572
        AUD_close_out(&s->codec.card, s->codec.out_voice);
573
        s->codec.out_voice = NULL;
574
        s->codec.txavail = 0;
575
    }
576
    /* Discard what couldn't be written */
577
    s->codec.txlen = 0;
578

    
579
    omap_eac_enable_update(s);
580
    if (!s->codec.enable)
581
        return;
582

    
583
    omap_eac_rate_update(s);
584
    fmt.endianness = ((s->codec.config[0] >> 8) & 1);                /* LI_BI */
585
    fmt.nchannels = ((s->codec.config[0] >> 10) & 1) ? 2 : 1;        /* MN_ST */
586
    fmt.freq = s->codec.rate;
587
    /* TODO: signedness possibly depends on the CODEC hardware - or
588
     * does I2S specify it?  */
589
    /* All register writes are 16 bits so we we store 16-bit samples
590
     * in the buffers regardless of AGCFR[B8_16] value.  */
591
    fmt.fmt = AUD_FMT_U16;
592

    
593
    s->codec.in_voice = AUD_open_in(&s->codec.card, s->codec.in_voice,
594
                    "eac.codec.in", s, omap_eac_in_cb, &fmt);
595
    s->codec.out_voice = AUD_open_out(&s->codec.card, s->codec.out_voice,
596
                    "eac.codec.out", s, omap_eac_out_cb, &fmt);
597

    
598
    omap_eac_volume_update(s);
599

    
600
    AUD_set_active_in(s->codec.in_voice, 1);
601
    AUD_set_active_out(s->codec.out_voice, 1);
602
}
603

    
604
static void omap_eac_reset(struct omap_eac_s *s)
605
{
606
    s->sysconfig = 0;
607
    s->config[0] = 0x0c;
608
    s->config[1] = 0x09;
609
    s->config[2] = 0xab;
610
    s->config[3] = 0x03;
611
    s->control = 0x00;
612
    s->address = 0x00;
613
    s->data = 0x0000;
614
    s->vtol = 0x00;
615
    s->vtsl = 0x00;
616
    s->mixer = 0x0000;
617
    s->gain[0] = 0xe7e7;
618
    s->gain[1] = 0x6767;
619
    s->gain[2] = 0x6767;
620
    s->gain[3] = 0x6767;
621
    s->att = 0xce;
622
    s->max[0] = 0;
623
    s->max[1] = 0;
624
    s->max[2] = 0;
625
    s->max[3] = 0;
626
    s->max[4] = 0;
627
    s->max[5] = 0;
628
    s->max[6] = 0;
629

    
630
    s->modem.control = 0x00;
631
    s->modem.config = 0x0000;
632
    s->bt.control = 0x00;
633
    s->bt.config = 0x0000;
634
    s->codec.config[0] = 0x0649;
635
    s->codec.config[1] = 0x0000;
636
    s->codec.config[2] = 0x0007;
637
    s->codec.config[3] = 0x1ffc;
638
    s->codec.rxoff = 0;
639
    s->codec.rxlen = 0;
640
    s->codec.txlen = 0;
641
    s->codec.rxavail = 0;
642
    s->codec.txavail = 0;
643

    
644
    omap_eac_format_update(s);
645
    omap_eac_interrupt_update(s);
646
}
647

    
648
static uint32_t omap_eac_read(void *opaque, target_phys_addr_t addr)
649
{
650
    struct omap_eac_s *s = (struct omap_eac_s *) opaque;
651
    uint32_t ret;
652

    
653
    switch (addr) {
654
    case 0x000:        /* CPCFR1 */
655
        return s->config[0];
656
    case 0x004:        /* CPCFR2 */
657
        return s->config[1];
658
    case 0x008:        /* CPCFR3 */
659
        return s->config[2];
660
    case 0x00c:        /* CPCFR4 */
661
        return s->config[3];
662

    
663
    case 0x010:        /* CPTCTL */
664
        return s->control | ((s->codec.rxavail + s->codec.rxlen > 0) << 7) |
665
                ((s->codec.txlen < s->codec.txavail) << 5);
666

    
667
    case 0x014:        /* CPTTADR */
668
        return s->address;
669
    case 0x018:        /* CPTDATL */
670
        return s->data & 0xff;
671
    case 0x01c:        /* CPTDATH */
672
        return s->data >> 8;
673
    case 0x020:        /* CPTVSLL */
674
        return s->vtol;
675
    case 0x024:        /* CPTVSLH */
676
        return s->vtsl | (3 << 5);        /* CRDY1 | CRDY2 */
677
    case 0x040:        /* MPCTR */
678
        return s->modem.control;
679
    case 0x044:        /* MPMCCFR */
680
        return s->modem.config;
681
    case 0x060:        /* BPCTR */
682
        return s->bt.control;
683
    case 0x064:        /* BPMCCFR */
684
        return s->bt.config;
685
    case 0x080:        /* AMSCFR */
686
        return s->mixer;
687
    case 0x084:        /* AMVCTR */
688
        return s->gain[0];
689
    case 0x088:        /* AM1VCTR */
690
        return s->gain[1];
691
    case 0x08c:        /* AM2VCTR */
692
        return s->gain[2];
693
    case 0x090:        /* AM3VCTR */
694
        return s->gain[3];
695
    case 0x094:        /* ASTCTR */
696
        return s->att;
697
    case 0x098:        /* APD1LCR */
698
        return s->max[0];
699
    case 0x09c:        /* APD1RCR */
700
        return s->max[1];
701
    case 0x0a0:        /* APD2LCR */
702
        return s->max[2];
703
    case 0x0a4:        /* APD2RCR */
704
        return s->max[3];
705
    case 0x0a8:        /* APD3LCR */
706
        return s->max[4];
707
    case 0x0ac:        /* APD3RCR */
708
        return s->max[5];
709
    case 0x0b0:        /* APD4R */
710
        return s->max[6];
711
    case 0x0b4:        /* ADWR */
712
        /* This should be write-only?  Docs list it as read-only.  */
713
        return 0x0000;
714
    case 0x0b8:        /* ADRDR */
715
        if (likely(s->codec.rxlen > 1)) {
716
            ret = s->codec.rxbuf[s->codec.rxoff ++];
717
            s->codec.rxlen --;
718
            s->codec.rxoff &= EAC_BUF_LEN - 1;
719
            return ret;
720
        } else if (s->codec.rxlen) {
721
            ret = s->codec.rxbuf[s->codec.rxoff ++];
722
            s->codec.rxlen --;
723
            s->codec.rxoff &= EAC_BUF_LEN - 1;
724
            if (s->codec.rxavail)
725
                omap_eac_in_refill(s);
726
            omap_eac_in_dmarequest_update(s);
727
            return ret;
728
        }
729
        return 0x0000;
730
    case 0x0bc:        /* AGCFR */
731
        return s->codec.config[0];
732
    case 0x0c0:        /* AGCTR */
733
        return s->codec.config[1] | ((s->codec.config[1] & 2) << 14);
734
    case 0x0c4:        /* AGCFR2 */
735
        return s->codec.config[2];
736
    case 0x0c8:        /* AGCFR3 */
737
        return s->codec.config[3];
738
    case 0x0cc:        /* MBPDMACTR */
739
    case 0x0d0:        /* MPDDMARR */
740
    case 0x0d8:        /* MPUDMARR */
741
    case 0x0e4:        /* BPDDMARR */
742
    case 0x0ec:        /* BPUDMARR */
743
        return 0x0000;
744

    
745
    case 0x100:        /* VERSION_NUMBER */
746
        return 0x0010;
747

    
748
    case 0x104:        /* SYSCONFIG */
749
        return s->sysconfig;
750

    
751
    case 0x108:        /* SYSSTATUS */
752
        return 1 | 0xe;                                        /* RESETDONE | stuff */
753
    }
754

    
755
    OMAP_BAD_REG(addr);
756
    return 0;
757
}
758

    
759
static void omap_eac_write(void *opaque, target_phys_addr_t addr,
760
                uint32_t value)
761
{
762
    struct omap_eac_s *s = (struct omap_eac_s *) opaque;
763

    
764
    switch (addr) {
765
    case 0x098:        /* APD1LCR */
766
    case 0x09c:        /* APD1RCR */
767
    case 0x0a0:        /* APD2LCR */
768
    case 0x0a4:        /* APD2RCR */
769
    case 0x0a8:        /* APD3LCR */
770
    case 0x0ac:        /* APD3RCR */
771
    case 0x0b0:        /* APD4R */
772
    case 0x0b8:        /* ADRDR */
773
    case 0x0d0:        /* MPDDMARR */
774
    case 0x0d8:        /* MPUDMARR */
775
    case 0x0e4:        /* BPDDMARR */
776
    case 0x0ec:        /* BPUDMARR */
777
    case 0x100:        /* VERSION_NUMBER */
778
    case 0x108:        /* SYSSTATUS */
779
        OMAP_RO_REG(addr);
780
        return;
781

    
782
    case 0x000:        /* CPCFR1 */
783
        s->config[0] = value & 0xff;
784
        omap_eac_format_update(s);
785
        break;
786
    case 0x004:        /* CPCFR2 */
787
        s->config[1] = value & 0xff;
788
        omap_eac_format_update(s);
789
        break;
790
    case 0x008:        /* CPCFR3 */
791
        s->config[2] = value & 0xff;
792
        omap_eac_format_update(s);
793
        break;
794
    case 0x00c:        /* CPCFR4 */
795
        s->config[3] = value & 0xff;
796
        omap_eac_format_update(s);
797
        break;
798

    
799
    case 0x010:        /* CPTCTL */
800
        /* Assuming TXF and TXE bits are read-only... */
801
        s->control = value & 0x5f;
802
        omap_eac_interrupt_update(s);
803
        break;
804

    
805
    case 0x014:        /* CPTTADR */
806
        s->address = value & 0xff;
807
        break;
808
    case 0x018:        /* CPTDATL */
809
        s->data &= 0xff00;
810
        s->data |= value & 0xff;
811
        break;
812
    case 0x01c:        /* CPTDATH */
813
        s->data &= 0x00ff;
814
        s->data |= value << 8;
815
        break;
816
    case 0x020:        /* CPTVSLL */
817
        s->vtol = value & 0xf8;
818
        break;
819
    case 0x024:        /* CPTVSLH */
820
        s->vtsl = value & 0x9f;
821
        break;
822
    case 0x040:        /* MPCTR */
823
        s->modem.control = value & 0x8f;
824
        break;
825
    case 0x044:        /* MPMCCFR */
826
        s->modem.config = value & 0x7fff;
827
        break;
828
    case 0x060:        /* BPCTR */
829
        s->bt.control = value & 0x8f;
830
        break;
831
    case 0x064:        /* BPMCCFR */
832
        s->bt.config = value & 0x7fff;
833
        break;
834
    case 0x080:        /* AMSCFR */
835
        s->mixer = value & 0x0fff;
836
        break;
837
    case 0x084:        /* AMVCTR */
838
        s->gain[0] = value & 0xffff;
839
        break;
840
    case 0x088:        /* AM1VCTR */
841
        s->gain[1] = value & 0xff7f;
842
        break;
843
    case 0x08c:        /* AM2VCTR */
844
        s->gain[2] = value & 0xff7f;
845
        break;
846
    case 0x090:        /* AM3VCTR */
847
        s->gain[3] = value & 0xff7f;
848
        break;
849
    case 0x094:        /* ASTCTR */
850
        s->att = value & 0xff;
851
        break;
852

    
853
    case 0x0b4:        /* ADWR */
854
        s->codec.txbuf[s->codec.txlen ++] = value;
855
        if (unlikely(s->codec.txlen == EAC_BUF_LEN ||
856
                                s->codec.txlen == s->codec.txavail)) {
857
            if (s->codec.txavail)
858
                omap_eac_out_empty(s);
859
            /* Discard what couldn't be written */
860
            s->codec.txlen = 0;
861
        }
862
        break;
863

    
864
    case 0x0bc:        /* AGCFR */
865
        s->codec.config[0] = value & 0x07ff;
866
        omap_eac_format_update(s);
867
        break;
868
    case 0x0c0:        /* AGCTR */
869
        s->codec.config[1] = value & 0x780f;
870
        omap_eac_format_update(s);
871
        break;
872
    case 0x0c4:        /* AGCFR2 */
873
        s->codec.config[2] = value & 0x003f;
874
        omap_eac_format_update(s);
875
        break;
876
    case 0x0c8:        /* AGCFR3 */
877
        s->codec.config[3] = value & 0xffff;
878
        omap_eac_format_update(s);
879
        break;
880
    case 0x0cc:        /* MBPDMACTR */
881
    case 0x0d4:        /* MPDDMAWR */
882
    case 0x0e0:        /* MPUDMAWR */
883
    case 0x0e8:        /* BPDDMAWR */
884
    case 0x0f0:        /* BPUDMAWR */
885
        break;
886

    
887
    case 0x104:        /* SYSCONFIG */
888
        if (value & (1 << 1))                                /* SOFTRESET */
889
            omap_eac_reset(s);
890
        s->sysconfig = value & 0x31d;
891
        break;
892

    
893
    default:
894
        OMAP_BAD_REG(addr);
895
        return;
896
    }
897
}
898

    
899
static CPUReadMemoryFunc * const omap_eac_readfn[] = {
900
    omap_badwidth_read16,
901
    omap_eac_read,
902
    omap_badwidth_read16,
903
};
904

    
905
static CPUWriteMemoryFunc * const omap_eac_writefn[] = {
906
    omap_badwidth_write16,
907
    omap_eac_write,
908
    omap_badwidth_write16,
909
};
910

    
911
struct omap_eac_s *omap_eac_init(struct omap_target_agent_s *ta,
912
                qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
913
{
914
    int iomemtype;
915
    struct omap_eac_s *s = (struct omap_eac_s *)
916
            qemu_mallocz(sizeof(struct omap_eac_s));
917

    
918
    s->irq = irq;
919
    s->codec.rxdrq = *drq ++;
920
    s->codec.txdrq = *drq;
921
    omap_eac_reset(s);
922

    
923
    AUD_register_card("OMAP EAC", &s->codec.card);
924

    
925
    iomemtype = cpu_register_io_memory(omap_eac_readfn,
926
                    omap_eac_writefn, s);
927
    omap_l4_attach(ta, 0, iomemtype);
928

    
929
    return s;
930
}
931

    
932
/* STI/XTI (emulation interface) console - reverse engineered only */
933
struct omap_sti_s {
934
    qemu_irq irq;
935
    CharDriverState *chr;
936

    
937
    uint32_t sysconfig;
938
    uint32_t systest;
939
    uint32_t irqst;
940
    uint32_t irqen;
941
    uint32_t clkcontrol;
942
    uint32_t serial_config;
943
};
944

    
945
#define STI_TRACE_CONSOLE_CHANNEL        239
946
#define STI_TRACE_CONTROL_CHANNEL        253
947

    
948
static inline void omap_sti_interrupt_update(struct omap_sti_s *s)
949
{
950
    qemu_set_irq(s->irq, s->irqst & s->irqen);
951
}
952

    
953
static void omap_sti_reset(struct omap_sti_s *s)
954
{
955
    s->sysconfig = 0;
956
    s->irqst = 0;
957
    s->irqen = 0;
958
    s->clkcontrol = 0;
959
    s->serial_config = 0;
960

    
961
    omap_sti_interrupt_update(s);
962
}
963

    
964
static uint32_t omap_sti_read(void *opaque, target_phys_addr_t addr)
965
{
966
    struct omap_sti_s *s = (struct omap_sti_s *) opaque;
967

    
968
    switch (addr) {
969
    case 0x00:        /* STI_REVISION */
970
        return 0x10;
971

    
972
    case 0x10:        /* STI_SYSCONFIG */
973
        return s->sysconfig;
974

    
975
    case 0x14:        /* STI_SYSSTATUS / STI_RX_STATUS / XTI_SYSSTATUS */
976
        return 0x00;
977

    
978
    case 0x18:        /* STI_IRQSTATUS */
979
        return s->irqst;
980

    
981
    case 0x1c:        /* STI_IRQSETEN / STI_IRQCLREN */
982
        return s->irqen;
983

    
984
    case 0x24:        /* STI_ER / STI_DR / XTI_TRACESELECT */
985
    case 0x28:        /* STI_RX_DR / XTI_RXDATA */
986
        /* TODO */
987
        return 0;
988

    
989
    case 0x2c:        /* STI_CLK_CTRL / XTI_SCLKCRTL */
990
        return s->clkcontrol;
991

    
992
    case 0x30:        /* STI_SERIAL_CFG / XTI_SCONFIG */
993
        return s->serial_config;
994
    }
995

    
996
    OMAP_BAD_REG(addr);
997
    return 0;
998
}
999

    
1000
static void omap_sti_write(void *opaque, target_phys_addr_t addr,
1001
                uint32_t value)
1002
{
1003
    struct omap_sti_s *s = (struct omap_sti_s *) opaque;
1004

    
1005
    switch (addr) {
1006
    case 0x00:        /* STI_REVISION */
1007
    case 0x14:        /* STI_SYSSTATUS / STI_RX_STATUS / XTI_SYSSTATUS */
1008
        OMAP_RO_REG(addr);
1009
        return;
1010

    
1011
    case 0x10:        /* STI_SYSCONFIG */
1012
        if (value & (1 << 1))                                /* SOFTRESET */
1013
            omap_sti_reset(s);
1014
        s->sysconfig = value & 0xfe;
1015
        break;
1016

    
1017
    case 0x18:        /* STI_IRQSTATUS */
1018
        s->irqst &= ~value;
1019
        omap_sti_interrupt_update(s);
1020
        break;
1021

    
1022
    case 0x1c:        /* STI_IRQSETEN / STI_IRQCLREN */
1023
        s->irqen = value & 0xffff;
1024
        omap_sti_interrupt_update(s);
1025
        break;
1026

    
1027
    case 0x2c:        /* STI_CLK_CTRL / XTI_SCLKCRTL */
1028
        s->clkcontrol = value & 0xff;
1029
        break;
1030

    
1031
    case 0x30:        /* STI_SERIAL_CFG / XTI_SCONFIG */
1032
        s->serial_config = value & 0xff;
1033
        break;
1034

    
1035
    case 0x24:        /* STI_ER / STI_DR / XTI_TRACESELECT */
1036
    case 0x28:        /* STI_RX_DR / XTI_RXDATA */
1037
        /* TODO */
1038
        return;
1039

    
1040
    default:
1041
        OMAP_BAD_REG(addr);
1042
        return;
1043
    }
1044
}
1045

    
1046
static CPUReadMemoryFunc * const omap_sti_readfn[] = {
1047
    omap_badwidth_read32,
1048
    omap_badwidth_read32,
1049
    omap_sti_read,
1050
};
1051

    
1052
static CPUWriteMemoryFunc * const omap_sti_writefn[] = {
1053
    omap_badwidth_write32,
1054
    omap_badwidth_write32,
1055
    omap_sti_write,
1056
};
1057

    
1058
static uint32_t omap_sti_fifo_read(void *opaque, target_phys_addr_t addr)
1059
{
1060
    OMAP_BAD_REG(addr);
1061
    return 0;
1062
}
1063

    
1064
static void omap_sti_fifo_write(void *opaque, target_phys_addr_t addr,
1065
                uint32_t value)
1066
{
1067
    struct omap_sti_s *s = (struct omap_sti_s *) opaque;
1068
    int ch = addr >> 6;
1069
    uint8_t byte = value;
1070

    
1071
    if (ch == STI_TRACE_CONTROL_CHANNEL) {
1072
        /* Flush channel <i>value</i>.  */
1073
        qemu_chr_write(s->chr, (const uint8_t *) "\r", 1);
1074
    } else if (ch == STI_TRACE_CONSOLE_CHANNEL || 1) {
1075
        if (value == 0xc0 || value == 0xc3) {
1076
            /* Open channel <i>ch</i>.  */
1077
        } else if (value == 0x00)
1078
            qemu_chr_write(s->chr, (const uint8_t *) "\n", 1);
1079
        else
1080
            qemu_chr_write(s->chr, &byte, 1);
1081
    }
1082
}
1083

    
1084
static CPUReadMemoryFunc * const omap_sti_fifo_readfn[] = {
1085
    omap_sti_fifo_read,
1086
    omap_badwidth_read8,
1087
    omap_badwidth_read8,
1088
};
1089

    
1090
static CPUWriteMemoryFunc * const omap_sti_fifo_writefn[] = {
1091
    omap_sti_fifo_write,
1092
    omap_badwidth_write8,
1093
    omap_badwidth_write8,
1094
};
1095

    
1096
static struct omap_sti_s *omap_sti_init(struct omap_target_agent_s *ta,
1097
                target_phys_addr_t channel_base, qemu_irq irq, omap_clk clk,
1098
                CharDriverState *chr)
1099
{
1100
    int iomemtype;
1101
    struct omap_sti_s *s = (struct omap_sti_s *)
1102
            qemu_mallocz(sizeof(struct omap_sti_s));
1103

    
1104
    s->irq = irq;
1105
    omap_sti_reset(s);
1106

    
1107
    s->chr = chr ?: qemu_chr_open("null", "null", NULL);
1108

    
1109
    iomemtype = l4_register_io_memory(omap_sti_readfn,
1110
                    omap_sti_writefn, s);
1111
    omap_l4_attach(ta, 0, iomemtype);
1112

    
1113
    iomemtype = cpu_register_io_memory(omap_sti_fifo_readfn,
1114
                    omap_sti_fifo_writefn, s);
1115
    cpu_register_physical_memory(channel_base, 0x10000, iomemtype);
1116

    
1117
    return s;
1118
}
1119

    
1120
/* L4 Interconnect */
1121
struct omap_target_agent_s {
1122
    struct omap_l4_s *bus;
1123
    int regions;
1124
    struct omap_l4_region_s *start;
1125
    target_phys_addr_t base;
1126
    uint32_t component;
1127
    uint32_t control;
1128
    uint32_t status;
1129
};
1130

    
1131
struct omap_l4_s {
1132
    target_phys_addr_t base;
1133
    int ta_num;
1134
    struct omap_target_agent_s ta[0];
1135
};
1136

    
1137
#ifdef L4_MUX_HACK
1138
static int omap_l4_io_entries;
1139
static int omap_cpu_io_entry;
1140
static struct omap_l4_entry {
1141
        CPUReadMemoryFunc * const *mem_read;
1142
        CPUWriteMemoryFunc * const *mem_write;
1143
        void *opaque;
1144
} *omap_l4_io_entry;
1145
static CPUReadMemoryFunc * const *omap_l4_io_readb_fn;
1146
static CPUReadMemoryFunc * const *omap_l4_io_readh_fn;
1147
static CPUReadMemoryFunc * const *omap_l4_io_readw_fn;
1148
static CPUWriteMemoryFunc * const *omap_l4_io_writeb_fn;
1149
static CPUWriteMemoryFunc * const *omap_l4_io_writeh_fn;
1150
static CPUWriteMemoryFunc * const *omap_l4_io_writew_fn;
1151
static void **omap_l4_io_opaque;
1152

    
1153
int l4_register_io_memory(CPUReadMemoryFunc * const *mem_read,
1154
                CPUWriteMemoryFunc * const *mem_write, void *opaque)
1155
{
1156
    omap_l4_io_entry[omap_l4_io_entries].mem_read = mem_read;
1157
    omap_l4_io_entry[omap_l4_io_entries].mem_write = mem_write;
1158
    omap_l4_io_entry[omap_l4_io_entries].opaque = opaque;
1159

    
1160
    return omap_l4_io_entries ++;
1161
}
1162

    
1163
static uint32_t omap_l4_io_readb(void *opaque, target_phys_addr_t addr)
1164
{
1165
    unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
1166

    
1167
    return omap_l4_io_readb_fn[i](omap_l4_io_opaque[i], addr);
1168
}
1169

    
1170
static uint32_t omap_l4_io_readh(void *opaque, target_phys_addr_t addr)
1171
{
1172
    unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
1173

    
1174
    return omap_l4_io_readh_fn[i](omap_l4_io_opaque[i], addr);
1175
}
1176

    
1177
static uint32_t omap_l4_io_readw(void *opaque, target_phys_addr_t addr)
1178
{
1179
    unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
1180

    
1181
    return omap_l4_io_readw_fn[i](omap_l4_io_opaque[i], addr);
1182
}
1183

    
1184
static void omap_l4_io_writeb(void *opaque, target_phys_addr_t addr,
1185
                uint32_t value)
1186
{
1187
    unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
1188

    
1189
    return omap_l4_io_writeb_fn[i](omap_l4_io_opaque[i], addr, value);
1190
}
1191

    
1192
static void omap_l4_io_writeh(void *opaque, target_phys_addr_t addr,
1193
                uint32_t value)
1194
{
1195
    unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
1196

    
1197
    return omap_l4_io_writeh_fn[i](omap_l4_io_opaque[i], addr, value);
1198
}
1199

    
1200
static void omap_l4_io_writew(void *opaque, target_phys_addr_t addr,
1201
                uint32_t value)
1202
{
1203
    unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
1204

    
1205
    return omap_l4_io_writew_fn[i](omap_l4_io_opaque[i], addr, value);
1206
}
1207

    
1208
static CPUReadMemoryFunc * const omap_l4_io_readfn[] = {
1209
    omap_l4_io_readb,
1210
    omap_l4_io_readh,
1211
    omap_l4_io_readw,
1212
};
1213

    
1214
static CPUWriteMemoryFunc * const omap_l4_io_writefn[] = {
1215
    omap_l4_io_writeb,
1216
    omap_l4_io_writeh,
1217
    omap_l4_io_writew,
1218
};
1219
#endif
1220

    
1221
struct omap_l4_s *omap_l4_init(target_phys_addr_t base, int ta_num)
1222
{
1223
    struct omap_l4_s *bus = qemu_mallocz(
1224
                    sizeof(*bus) + ta_num * sizeof(*bus->ta));
1225

    
1226
    bus->ta_num = ta_num;
1227
    bus->base = base;
1228

    
1229
#ifdef L4_MUX_HACK
1230
    omap_l4_io_entries = 1;
1231
    omap_l4_io_entry = qemu_mallocz(125 * sizeof(*omap_l4_io_entry));
1232

    
1233
    omap_cpu_io_entry =
1234
            cpu_register_io_memory(omap_l4_io_readfn,
1235
                            omap_l4_io_writefn, bus);
1236
# define L4_PAGES        (0xb4000 / TARGET_PAGE_SIZE)
1237
    omap_l4_io_readb_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
1238
    omap_l4_io_readh_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
1239
    omap_l4_io_readw_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
1240
    omap_l4_io_writeb_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
1241
    omap_l4_io_writeh_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
1242
    omap_l4_io_writew_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
1243
    omap_l4_io_opaque = qemu_mallocz(sizeof(void *) * L4_PAGES);
1244
#endif
1245

    
1246
    return bus;
1247
}
1248

    
1249
static uint32_t omap_l4ta_read(void *opaque, target_phys_addr_t addr)
1250
{
1251
    struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque;
1252

    
1253
    switch (addr) {
1254
    case 0x00:        /* COMPONENT */
1255
        return s->component;
1256

    
1257
    case 0x20:        /* AGENT_CONTROL */
1258
        return s->control;
1259

    
1260
    case 0x28:        /* AGENT_STATUS */
1261
        return s->status;
1262
    }
1263

    
1264
    OMAP_BAD_REG(addr);
1265
    return 0;
1266
}
1267

    
1268
static void omap_l4ta_write(void *opaque, target_phys_addr_t addr,
1269
                uint32_t value)
1270
{
1271
    struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque;
1272

    
1273
    switch (addr) {
1274
    case 0x00:        /* COMPONENT */
1275
    case 0x28:        /* AGENT_STATUS */
1276
        OMAP_RO_REG(addr);
1277
        break;
1278

    
1279
    case 0x20:        /* AGENT_CONTROL */
1280
        s->control = value & 0x01000700;
1281
        if (value & 1)                                        /* OCP_RESET */
1282
            s->status &= ~1;                                /* REQ_TIMEOUT */
1283
        break;
1284

    
1285
    default:
1286
        OMAP_BAD_REG(addr);
1287
    }
1288
}
1289

    
1290
static CPUReadMemoryFunc * const omap_l4ta_readfn[] = {
1291
    omap_badwidth_read16,
1292
    omap_l4ta_read,
1293
    omap_badwidth_read16,
1294
};
1295

    
1296
static CPUWriteMemoryFunc * const omap_l4ta_writefn[] = {
1297
    omap_badwidth_write32,
1298
    omap_badwidth_write32,
1299
    omap_l4ta_write,
1300
};
1301

    
1302
#define L4TA(n)                (n)
1303
#define L4TAO(n)        ((n) + 39)
1304

    
1305
static struct omap_l4_region_s {
1306
    target_phys_addr_t offset;
1307
    size_t size;
1308
    int access;
1309
} omap_l4_region[125] = {
1310
    [  1] = { 0x40800,  0x800, 32          }, /* Initiator agent */
1311
    [  2] = { 0x41000, 0x1000, 32          }, /* Link agent */
1312
    [  0] = { 0x40000,  0x800, 32          }, /* Address and protection */
1313
    [  3] = { 0x00000, 0x1000, 32 | 16 | 8 }, /* System Control and Pinout */
1314
    [  4] = { 0x01000, 0x1000, 32 | 16 | 8 }, /* L4TAO1 */
1315
    [  5] = { 0x04000, 0x1000, 32 | 16     }, /* 32K Timer */
1316
    [  6] = { 0x05000, 0x1000, 32 | 16 | 8 }, /* L4TAO2 */
1317
    [  7] = { 0x08000,  0x800, 32          }, /* PRCM Region A */
1318
    [  8] = { 0x08800,  0x800, 32          }, /* PRCM Region B */
1319
    [  9] = { 0x09000, 0x1000, 32 | 16 | 8 }, /* L4TAO */
1320
    [ 10] = { 0x12000, 0x1000, 32 | 16 | 8 }, /* Test (BCM) */
1321
    [ 11] = { 0x13000, 0x1000, 32 | 16 | 8 }, /* L4TA1 */
1322
    [ 12] = { 0x14000, 0x1000, 32          }, /* Test/emulation (TAP) */
1323
    [ 13] = { 0x15000, 0x1000, 32 | 16 | 8 }, /* L4TA2 */
1324
    [ 14] = { 0x18000, 0x1000, 32 | 16 | 8 }, /* GPIO1 */
1325
    [ 16] = { 0x1a000, 0x1000, 32 | 16 | 8 }, /* GPIO2 */
1326
    [ 18] = { 0x1c000, 0x1000, 32 | 16 | 8 }, /* GPIO3 */
1327
    [ 19] = { 0x1e000, 0x1000, 32 | 16 | 8 }, /* GPIO4 */
1328
    [ 15] = { 0x19000, 0x1000, 32 | 16 | 8 }, /* Quad GPIO TOP */
1329
    [ 17] = { 0x1b000, 0x1000, 32 | 16 | 8 }, /* L4TA3 */
1330
    [ 20] = { 0x20000, 0x1000, 32 | 16 | 8 }, /* WD Timer 1 (Secure) */
1331
    [ 22] = { 0x22000, 0x1000, 32 | 16 | 8 }, /* WD Timer 2 (OMAP) */
1332
    [ 21] = { 0x21000, 0x1000, 32 | 16 | 8 }, /* Dual WD timer TOP */
1333
    [ 23] = { 0x23000, 0x1000, 32 | 16 | 8 }, /* L4TA4 */
1334
    [ 24] = { 0x28000, 0x1000, 32 | 16 | 8 }, /* GP Timer 1 */
1335
    [ 25] = { 0x29000, 0x1000, 32 | 16 | 8 }, /* L4TA7 */
1336
    [ 26] = { 0x48000, 0x2000, 32 | 16 | 8 }, /* Emulation (ARM11ETB) */
1337
    [ 27] = { 0x4a000, 0x1000, 32 | 16 | 8 }, /* L4TA9 */
1338
    [ 28] = { 0x50000,  0x400, 32 | 16 | 8 }, /* Display top */
1339
    [ 29] = { 0x50400,  0x400, 32 | 16 | 8 }, /* Display control */
1340
    [ 30] = { 0x50800,  0x400, 32 | 16 | 8 }, /* Display RFBI */
1341
    [ 31] = { 0x50c00,  0x400, 32 | 16 | 8 }, /* Display encoder */
1342
    [ 32] = { 0x51000, 0x1000, 32 | 16 | 8 }, /* L4TA10 */
1343
    [ 33] = { 0x52000,  0x400, 32 | 16 | 8 }, /* Camera top */
1344
    [ 34] = { 0x52400,  0x400, 32 | 16 | 8 }, /* Camera core */
1345
    [ 35] = { 0x52800,  0x400, 32 | 16 | 8 }, /* Camera DMA */
1346
    [ 36] = { 0x52c00,  0x400, 32 | 16 | 8 }, /* Camera MMU */
1347
    [ 37] = { 0x53000, 0x1000, 32 | 16 | 8 }, /* L4TA11 */
1348
    [ 38] = { 0x56000, 0x1000, 32 | 16 | 8 }, /* sDMA */
1349
    [ 39] = { 0x57000, 0x1000, 32 | 16 | 8 }, /* L4TA12 */
1350
    [ 40] = { 0x58000, 0x1000, 32 | 16 | 8 }, /* SSI top */
1351
    [ 41] = { 0x59000, 0x1000, 32 | 16 | 8 }, /* SSI GDD */
1352
    [ 42] = { 0x5a000, 0x1000, 32 | 16 | 8 }, /* SSI Port1 */
1353
    [ 43] = { 0x5b000, 0x1000, 32 | 16 | 8 }, /* SSI Port2 */
1354
    [ 44] = { 0x5c000, 0x1000, 32 | 16 | 8 }, /* L4TA13 */
1355
    [ 45] = { 0x5e000, 0x1000, 32 | 16 | 8 }, /* USB OTG */
1356
    [ 46] = { 0x5f000, 0x1000, 32 | 16 | 8 }, /* L4TAO4 */
1357
    [ 47] = { 0x60000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER1SDRC) */
1358
    [ 48] = { 0x61000, 0x1000, 32 | 16 | 8 }, /* L4TA14 */
1359
    [ 49] = { 0x62000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER2GPMC) */
1360
    [ 50] = { 0x63000, 0x1000, 32 | 16 | 8 }, /* L4TA15 */
1361
    [ 51] = { 0x64000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER3OCM) */
1362
    [ 52] = { 0x65000, 0x1000, 32 | 16 | 8 }, /* L4TA16 */
1363
    [ 53] = { 0x66000,  0x300, 32 | 16 | 8 }, /* Emulation (WIN_TRACER4L4) */
1364
    [ 54] = { 0x67000, 0x1000, 32 | 16 | 8 }, /* L4TA17 */
1365
    [ 55] = { 0x68000, 0x1000, 32 | 16 | 8 }, /* Emulation (XTI) */
1366
    [ 56] = { 0x69000, 0x1000, 32 | 16 | 8 }, /* L4TA18 */
1367
    [ 57] = { 0x6a000, 0x1000,      16 | 8 }, /* UART1 */
1368
    [ 58] = { 0x6b000, 0x1000, 32 | 16 | 8 }, /* L4TA19 */
1369
    [ 59] = { 0x6c000, 0x1000,      16 | 8 }, /* UART2 */
1370
    [ 60] = { 0x6d000, 0x1000, 32 | 16 | 8 }, /* L4TA20 */
1371
    [ 61] = { 0x6e000, 0x1000,      16 | 8 }, /* UART3 */
1372
    [ 62] = { 0x6f000, 0x1000, 32 | 16 | 8 }, /* L4TA21 */
1373
    [ 63] = { 0x70000, 0x1000,      16     }, /* I2C1 */
1374
    [ 64] = { 0x71000, 0x1000, 32 | 16 | 8 }, /* L4TAO5 */
1375
    [ 65] = { 0x72000, 0x1000,      16     }, /* I2C2 */
1376
    [ 66] = { 0x73000, 0x1000, 32 | 16 | 8 }, /* L4TAO6 */
1377
    [ 67] = { 0x74000, 0x1000,      16     }, /* McBSP1 */
1378
    [ 68] = { 0x75000, 0x1000, 32 | 16 | 8 }, /* L4TAO7 */
1379
    [ 69] = { 0x76000, 0x1000,      16     }, /* McBSP2 */
1380
    [ 70] = { 0x77000, 0x1000, 32 | 16 | 8 }, /* L4TAO8 */
1381
    [ 71] = { 0x24000, 0x1000, 32 | 16 | 8 }, /* WD Timer 3 (DSP) */
1382
    [ 72] = { 0x25000, 0x1000, 32 | 16 | 8 }, /* L4TA5 */
1383
    [ 73] = { 0x26000, 0x1000, 32 | 16 | 8 }, /* WD Timer 4 (IVA) */
1384
    [ 74] = { 0x27000, 0x1000, 32 | 16 | 8 }, /* L4TA6 */
1385
    [ 75] = { 0x2a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 2 */
1386
    [ 76] = { 0x2b000, 0x1000, 32 | 16 | 8 }, /* L4TA8 */
1387
    [ 77] = { 0x78000, 0x1000, 32 | 16 | 8 }, /* GP Timer 3 */
1388
    [ 78] = { 0x79000, 0x1000, 32 | 16 | 8 }, /* L4TA22 */
1389
    [ 79] = { 0x7a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 4 */
1390
    [ 80] = { 0x7b000, 0x1000, 32 | 16 | 8 }, /* L4TA23 */
1391
    [ 81] = { 0x7c000, 0x1000, 32 | 16 | 8 }, /* GP Timer 5 */
1392
    [ 82] = { 0x7d000, 0x1000, 32 | 16 | 8 }, /* L4TA24 */
1393
    [ 83] = { 0x7e000, 0x1000, 32 | 16 | 8 }, /* GP Timer 6 */
1394
    [ 84] = { 0x7f000, 0x1000, 32 | 16 | 8 }, /* L4TA25 */
1395
    [ 85] = { 0x80000, 0x1000, 32 | 16 | 8 }, /* GP Timer 7 */
1396
    [ 86] = { 0x81000, 0x1000, 32 | 16 | 8 }, /* L4TA26 */
1397
    [ 87] = { 0x82000, 0x1000, 32 | 16 | 8 }, /* GP Timer 8 */
1398
    [ 88] = { 0x83000, 0x1000, 32 | 16 | 8 }, /* L4TA27 */
1399
    [ 89] = { 0x84000, 0x1000, 32 | 16 | 8 }, /* GP Timer 9 */
1400
    [ 90] = { 0x85000, 0x1000, 32 | 16 | 8 }, /* L4TA28 */
1401
    [ 91] = { 0x86000, 0x1000, 32 | 16 | 8 }, /* GP Timer 10 */
1402
    [ 92] = { 0x87000, 0x1000, 32 | 16 | 8 }, /* L4TA29 */
1403
    [ 93] = { 0x88000, 0x1000, 32 | 16 | 8 }, /* GP Timer 11 */
1404
    [ 94] = { 0x89000, 0x1000, 32 | 16 | 8 }, /* L4TA30 */
1405
    [ 95] = { 0x8a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 12 */
1406
    [ 96] = { 0x8b000, 0x1000, 32 | 16 | 8 }, /* L4TA31 */
1407
    [ 97] = { 0x90000, 0x1000,      16     }, /* EAC */
1408
    [ 98] = { 0x91000, 0x1000, 32 | 16 | 8 }, /* L4TA32 */
1409
    [ 99] = { 0x92000, 0x1000,      16     }, /* FAC */
1410
    [100] = { 0x93000, 0x1000, 32 | 16 | 8 }, /* L4TA33 */
1411
    [101] = { 0x94000, 0x1000, 32 | 16 | 8 }, /* IPC (MAILBOX) */
1412
    [102] = { 0x95000, 0x1000, 32 | 16 | 8 }, /* L4TA34 */
1413
    [103] = { 0x98000, 0x1000, 32 | 16 | 8 }, /* SPI1 */
1414
    [104] = { 0x99000, 0x1000, 32 | 16 | 8 }, /* L4TA35 */
1415
    [105] = { 0x9a000, 0x1000, 32 | 16 | 8 }, /* SPI2 */
1416
    [106] = { 0x9b000, 0x1000, 32 | 16 | 8 }, /* L4TA36 */
1417
    [107] = { 0x9c000, 0x1000,      16 | 8 }, /* MMC SDIO */
1418
    [108] = { 0x9d000, 0x1000, 32 | 16 | 8 }, /* L4TAO9 */
1419
    [109] = { 0x9e000, 0x1000, 32 | 16 | 8 }, /* MS_PRO */
1420
    [110] = { 0x9f000, 0x1000, 32 | 16 | 8 }, /* L4TAO10 */
1421
    [111] = { 0xa0000, 0x1000, 32          }, /* RNG */
1422
    [112] = { 0xa1000, 0x1000, 32 | 16 | 8 }, /* L4TAO11 */
1423
    [113] = { 0xa2000, 0x1000, 32          }, /* DES3DES */
1424
    [114] = { 0xa3000, 0x1000, 32 | 16 | 8 }, /* L4TAO12 */
1425
    [115] = { 0xa4000, 0x1000, 32          }, /* SHA1MD5 */
1426
    [116] = { 0xa5000, 0x1000, 32 | 16 | 8 }, /* L4TAO13 */
1427
    [117] = { 0xa6000, 0x1000, 32          }, /* AES */
1428
    [118] = { 0xa7000, 0x1000, 32 | 16 | 8 }, /* L4TA37 */
1429
    [119] = { 0xa8000, 0x2000, 32          }, /* PKA */
1430
    [120] = { 0xaa000, 0x1000, 32 | 16 | 8 }, /* L4TA38 */
1431
    [121] = { 0xb0000, 0x1000, 32          }, /* MG */
1432
    [122] = { 0xb1000, 0x1000, 32 | 16 | 8 },
1433
    [123] = { 0xb2000, 0x1000, 32          }, /* HDQ/1-Wire */
1434
    [124] = { 0xb3000, 0x1000, 32 | 16 | 8 }, /* L4TA39 */
1435
};
1436

    
1437
static struct omap_l4_agent_info_s {
1438
    int ta;
1439
    int region;
1440
    int regions;
1441
    int ta_region;
1442
} omap_l4_agent_info[54] = {
1443
    { 0,           0, 3, 2 }, /* L4IA initiatior agent */
1444
    { L4TAO(1),    3, 2, 1 }, /* Control and pinout module */
1445
    { L4TAO(2),    5, 2, 1 }, /* 32K timer */
1446
    { L4TAO(3),    7, 3, 2 }, /* PRCM */
1447
    { L4TA(1),    10, 2, 1 }, /* BCM */
1448
    { L4TA(2),    12, 2, 1 }, /* Test JTAG */
1449
    { L4TA(3),    14, 6, 3 }, /* Quad GPIO */
1450
    { L4TA(4),    20, 4, 3 }, /* WD timer 1/2 */
1451
    { L4TA(7),    24, 2, 1 }, /* GP timer 1 */
1452
    { L4TA(9),    26, 2, 1 }, /* ATM11 ETB */
1453
    { L4TA(10),   28, 5, 4 }, /* Display subsystem */
1454
    { L4TA(11),   33, 5, 4 }, /* Camera subsystem */
1455
    { L4TA(12),   38, 2, 1 }, /* sDMA */
1456
    { L4TA(13),   40, 5, 4 }, /* SSI */
1457
    { L4TAO(4),   45, 2, 1 }, /* USB */
1458
    { L4TA(14),   47, 2, 1 }, /* Win Tracer1 */
1459
    { L4TA(15),   49, 2, 1 }, /* Win Tracer2 */
1460
    { L4TA(16),   51, 2, 1 }, /* Win Tracer3 */
1461
    { L4TA(17),   53, 2, 1 }, /* Win Tracer4 */
1462
    { L4TA(18),   55, 2, 1 }, /* XTI */
1463
    { L4TA(19),   57, 2, 1 }, /* UART1 */
1464
    { L4TA(20),   59, 2, 1 }, /* UART2 */
1465
    { L4TA(21),   61, 2, 1 }, /* UART3 */
1466
    { L4TAO(5),   63, 2, 1 }, /* I2C1 */
1467
    { L4TAO(6),   65, 2, 1 }, /* I2C2 */
1468
    { L4TAO(7),   67, 2, 1 }, /* McBSP1 */
1469
    { L4TAO(8),   69, 2, 1 }, /* McBSP2 */
1470
    { L4TA(5),    71, 2, 1 }, /* WD Timer 3 (DSP) */
1471
    { L4TA(6),    73, 2, 1 }, /* WD Timer 4 (IVA) */
1472
    { L4TA(8),    75, 2, 1 }, /* GP Timer 2 */
1473
    { L4TA(22),   77, 2, 1 }, /* GP Timer 3 */
1474
    { L4TA(23),   79, 2, 1 }, /* GP Timer 4 */
1475
    { L4TA(24),   81, 2, 1 }, /* GP Timer 5 */
1476
    { L4TA(25),   83, 2, 1 }, /* GP Timer 6 */
1477
    { L4TA(26),   85, 2, 1 }, /* GP Timer 7 */
1478
    { L4TA(27),   87, 2, 1 }, /* GP Timer 8 */
1479
    { L4TA(28),   89, 2, 1 }, /* GP Timer 9 */
1480
    { L4TA(29),   91, 2, 1 }, /* GP Timer 10 */
1481
    { L4TA(30),   93, 2, 1 }, /* GP Timer 11 */
1482
    { L4TA(31),   95, 2, 1 }, /* GP Timer 12 */
1483
    { L4TA(32),   97, 2, 1 }, /* EAC */
1484
    { L4TA(33),   99, 2, 1 }, /* FAC */
1485
    { L4TA(34),  101, 2, 1 }, /* IPC */
1486
    { L4TA(35),  103, 2, 1 }, /* SPI1 */
1487
    { L4TA(36),  105, 2, 1 }, /* SPI2 */
1488
    { L4TAO(9),  107, 2, 1 }, /* MMC SDIO */
1489
    { L4TAO(10), 109, 2, 1 },
1490
    { L4TAO(11), 111, 2, 1 }, /* RNG */
1491
    { L4TAO(12), 113, 2, 1 }, /* DES3DES */
1492
    { L4TAO(13), 115, 2, 1 }, /* SHA1MD5 */
1493
    { L4TA(37),  117, 2, 1 }, /* AES */
1494
    { L4TA(38),  119, 2, 1 }, /* PKA */
1495
    { -1,        121, 2, 1 },
1496
    { L4TA(39),  123, 2, 1 }, /* HDQ/1-Wire */
1497
};
1498

    
1499
#define omap_l4ta(bus, cs)        omap_l4ta_get(bus, L4TA(cs))
1500
#define omap_l4tao(bus, cs)        omap_l4ta_get(bus, L4TAO(cs))
1501

    
1502
struct omap_target_agent_s *omap_l4ta_get(struct omap_l4_s *bus, int cs)
1503
{
1504
    int i, iomemtype;
1505
    struct omap_target_agent_s *ta = NULL;
1506
    struct omap_l4_agent_info_s *info = NULL;
1507

    
1508
    for (i = 0; i < bus->ta_num; i ++)
1509
        if (omap_l4_agent_info[i].ta == cs) {
1510
            ta = &bus->ta[i];
1511
            info = &omap_l4_agent_info[i];
1512
            break;
1513
        }
1514
    if (!ta) {
1515
        fprintf(stderr, "%s: bad target agent (%i)\n", __FUNCTION__, cs);
1516
        exit(-1);
1517
    }
1518

    
1519
    ta->bus = bus;
1520
    ta->start = &omap_l4_region[info->region];
1521
    ta->regions = info->regions;
1522

    
1523
    ta->component = ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1524
    ta->status = 0x00000000;
1525
    ta->control = 0x00000200;        /* XXX 01000200 for L4TAO */
1526

    
1527
    iomemtype = l4_register_io_memory(omap_l4ta_readfn,
1528
                    omap_l4ta_writefn, ta);
1529
    ta->base = omap_l4_attach(ta, info->ta_region, iomemtype);
1530

    
1531
    return ta;
1532
}
1533

    
1534
target_phys_addr_t omap_l4_attach(struct omap_target_agent_s *ta, int region,
1535
                int iotype)
1536
{
1537
    target_phys_addr_t base;
1538
    ssize_t size;
1539
#ifdef L4_MUX_HACK
1540
    int i;
1541
#endif
1542

    
1543
    if (region < 0 || region >= ta->regions) {
1544
        fprintf(stderr, "%s: bad io region (%i)\n", __FUNCTION__, region);
1545
        exit(-1);
1546
    }
1547

    
1548
    base = ta->bus->base + ta->start[region].offset;
1549
    size = ta->start[region].size;
1550
    if (iotype) {
1551
#ifndef L4_MUX_HACK
1552
        cpu_register_physical_memory(base, size, iotype);
1553
#else
1554
        cpu_register_physical_memory(base, size, omap_cpu_io_entry);
1555
        i = (base - ta->bus->base) / TARGET_PAGE_SIZE;
1556
        for (; size > 0; size -= TARGET_PAGE_SIZE, i ++) {
1557
            omap_l4_io_readb_fn[i] = omap_l4_io_entry[iotype].mem_read[0];
1558
            omap_l4_io_readh_fn[i] = omap_l4_io_entry[iotype].mem_read[1];
1559
            omap_l4_io_readw_fn[i] = omap_l4_io_entry[iotype].mem_read[2];
1560
            omap_l4_io_writeb_fn[i] = omap_l4_io_entry[iotype].mem_write[0];
1561
            omap_l4_io_writeh_fn[i] = omap_l4_io_entry[iotype].mem_write[1];
1562
            omap_l4_io_writew_fn[i] = omap_l4_io_entry[iotype].mem_write[2];
1563
            omap_l4_io_opaque[i] = omap_l4_io_entry[iotype].opaque;
1564
        }
1565
#endif
1566
    }
1567

    
1568
    return base;
1569
}
1570

    
1571
/* TEST-Chip-level TAP */
1572
static uint32_t omap_tap_read(void *opaque, target_phys_addr_t addr)
1573
{
1574
    struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque;
1575

    
1576
    switch (addr) {
1577
    case 0x204:        /* IDCODE_reg */
1578
        switch (s->mpu_model) {
1579
        case omap2420:
1580
        case omap2422:
1581
        case omap2423:
1582
            return 0x5b5d902f;        /* ES 2.2 */
1583
        case omap2430:
1584
            return 0x5b68a02f;        /* ES 2.2 */
1585
        case omap3430:
1586
            return 0x1b7ae02f;        /* ES 2 */
1587
        default:
1588
            hw_error("%s: Bad mpu model\n", __FUNCTION__);
1589
        }
1590

    
1591
    case 0x208:        /* PRODUCTION_ID_reg for OMAP2 */
1592
    case 0x210:        /* PRODUCTION_ID_reg for OMAP3 */
1593
        switch (s->mpu_model) {
1594
        case omap2420:
1595
            return 0x000254f0;        /* POP ESHS2.1.1 in N91/93/95, ES2 in N800 */
1596
        case omap2422:
1597
            return 0x000400f0;
1598
        case omap2423:
1599
            return 0x000800f0;
1600
        case omap2430:
1601
            return 0x000000f0;
1602
        case omap3430:
1603
            return 0x000000f0;
1604
        default:
1605
            hw_error("%s: Bad mpu model\n", __FUNCTION__);
1606
        }
1607

    
1608
    case 0x20c:
1609
        switch (s->mpu_model) {
1610
        case omap2420:
1611
        case omap2422:
1612
        case omap2423:
1613
            return 0xcafeb5d9;        /* ES 2.2 */
1614
        case omap2430:
1615
            return 0xcafeb68a;        /* ES 2.2 */
1616
        case omap3430:
1617
            return 0xcafeb7ae;        /* ES 2 */
1618
        default:
1619
            hw_error("%s: Bad mpu model\n", __FUNCTION__);
1620
        }
1621

    
1622
    case 0x218:        /* DIE_ID_reg */
1623
        return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1624
    case 0x21c:        /* DIE_ID_reg */
1625
        return 0x54 << 24;
1626
    case 0x220:        /* DIE_ID_reg */
1627
        return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1628
    case 0x224:        /* DIE_ID_reg */
1629
        return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1630
    }
1631

    
1632
    OMAP_BAD_REG(addr);
1633
    return 0;
1634
}
1635

    
1636
static void omap_tap_write(void *opaque, target_phys_addr_t addr,
1637
                uint32_t value)
1638
{
1639
    OMAP_BAD_REG(addr);
1640
}
1641

    
1642
static CPUReadMemoryFunc * const omap_tap_readfn[] = {
1643
    omap_badwidth_read32,
1644
    omap_badwidth_read32,
1645
    omap_tap_read,
1646
};
1647

    
1648
static CPUWriteMemoryFunc * const omap_tap_writefn[] = {
1649
    omap_badwidth_write32,
1650
    omap_badwidth_write32,
1651
    omap_tap_write,
1652
};
1653

    
1654
void omap_tap_init(struct omap_target_agent_s *ta,
1655
                struct omap_mpu_state_s *mpu)
1656
{
1657
    omap_l4_attach(ta, 0, l4_register_io_memory(
1658
                            omap_tap_readfn, omap_tap_writefn, mpu));
1659
}
1660

    
1661
/* Power, Reset, and Clock Management */
1662
struct omap_prcm_s {
1663
    qemu_irq irq[3];
1664
    struct omap_mpu_state_s *mpu;
1665

    
1666
    uint32_t irqst[3];
1667
    uint32_t irqen[3];
1668

    
1669
    uint32_t sysconfig;
1670
    uint32_t voltctrl;
1671
    uint32_t scratch[20];
1672

    
1673
    uint32_t clksrc[1];
1674
    uint32_t clkout[1];
1675
    uint32_t clkemul[1];
1676
    uint32_t clkpol[1];
1677
    uint32_t clksel[8];
1678
    uint32_t clken[12];
1679
    uint32_t clkctrl[4];
1680
    uint32_t clkidle[7];
1681
    uint32_t setuptime[2];
1682

    
1683
    uint32_t wkup[3];
1684
    uint32_t wken[3];
1685
    uint32_t wkst[3];
1686
    uint32_t rst[4];
1687
    uint32_t rstctrl[1];
1688
    uint32_t power[4];
1689
    uint32_t rsttime_wkup;
1690

    
1691
    uint32_t ev;
1692
    uint32_t evtime[2];
1693

    
1694
    int dpll_lock, apll_lock[2];
1695
};
1696

    
1697
static void omap_prcm_int_update(struct omap_prcm_s *s, int dom)
1698
{
1699
    qemu_set_irq(s->irq[dom], s->irqst[dom] & s->irqen[dom]);
1700
    /* XXX or is the mask applied before PRCM_IRQSTATUS_* ? */
1701
}
1702

    
1703
static uint32_t omap_prcm_read(void *opaque, target_phys_addr_t addr)
1704
{
1705
    struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
1706
    uint32_t ret;
1707

    
1708
    switch (addr) {
1709
    case 0x000:        /* PRCM_REVISION */
1710
        return 0x10;
1711

    
1712
    case 0x010:        /* PRCM_SYSCONFIG */
1713
        return s->sysconfig;
1714

    
1715
    case 0x018:        /* PRCM_IRQSTATUS_MPU */
1716
        return s->irqst[0];
1717

    
1718
    case 0x01c:        /* PRCM_IRQENABLE_MPU */
1719
        return s->irqen[0];
1720

    
1721
    case 0x050:        /* PRCM_VOLTCTRL */
1722
        return s->voltctrl;
1723
    case 0x054:        /* PRCM_VOLTST */
1724
        return s->voltctrl & 3;
1725

    
1726
    case 0x060:        /* PRCM_CLKSRC_CTRL */
1727
        return s->clksrc[0];
1728
    case 0x070:        /* PRCM_CLKOUT_CTRL */
1729
        return s->clkout[0];
1730
    case 0x078:        /* PRCM_CLKEMUL_CTRL */
1731
        return s->clkemul[0];
1732
    case 0x080:        /* PRCM_CLKCFG_CTRL */
1733
    case 0x084:        /* PRCM_CLKCFG_STATUS */
1734
        return 0;
1735

    
1736
    case 0x090:        /* PRCM_VOLTSETUP */
1737
        return s->setuptime[0];
1738

    
1739
    case 0x094:        /* PRCM_CLKSSETUP */
1740
        return s->setuptime[1];
1741

    
1742
    case 0x098:        /* PRCM_POLCTRL */
1743
        return s->clkpol[0];
1744

    
1745
    case 0x0b0:        /* GENERAL_PURPOSE1 */
1746
    case 0x0b4:        /* GENERAL_PURPOSE2 */
1747
    case 0x0b8:        /* GENERAL_PURPOSE3 */
1748
    case 0x0bc:        /* GENERAL_PURPOSE4 */
1749
    case 0x0c0:        /* GENERAL_PURPOSE5 */
1750
    case 0x0c4:        /* GENERAL_PURPOSE6 */
1751
    case 0x0c8:        /* GENERAL_PURPOSE7 */
1752
    case 0x0cc:        /* GENERAL_PURPOSE8 */
1753
    case 0x0d0:        /* GENERAL_PURPOSE9 */
1754
    case 0x0d4:        /* GENERAL_PURPOSE10 */
1755
    case 0x0d8:        /* GENERAL_PURPOSE11 */
1756
    case 0x0dc:        /* GENERAL_PURPOSE12 */
1757
    case 0x0e0:        /* GENERAL_PURPOSE13 */
1758
    case 0x0e4:        /* GENERAL_PURPOSE14 */
1759
    case 0x0e8:        /* GENERAL_PURPOSE15 */
1760
    case 0x0ec:        /* GENERAL_PURPOSE16 */
1761
    case 0x0f0:        /* GENERAL_PURPOSE17 */
1762
    case 0x0f4:        /* GENERAL_PURPOSE18 */
1763
    case 0x0f8:        /* GENERAL_PURPOSE19 */
1764
    case 0x0fc:        /* GENERAL_PURPOSE20 */
1765
        return s->scratch[(addr - 0xb0) >> 2];
1766

    
1767
    case 0x140:        /* CM_CLKSEL_MPU */
1768
        return s->clksel[0];
1769
    case 0x148:        /* CM_CLKSTCTRL_MPU */
1770
        return s->clkctrl[0];
1771

    
1772
    case 0x158:        /* RM_RSTST_MPU */
1773
        return s->rst[0];
1774
    case 0x1c8:        /* PM_WKDEP_MPU */
1775
        return s->wkup[0];
1776
    case 0x1d4:        /* PM_EVGENCTRL_MPU */
1777
        return s->ev;
1778
    case 0x1d8:        /* PM_EVEGENONTIM_MPU */
1779
        return s->evtime[0];
1780
    case 0x1dc:        /* PM_EVEGENOFFTIM_MPU */
1781
        return s->evtime[1];
1782
    case 0x1e0:        /* PM_PWSTCTRL_MPU */
1783
        return s->power[0];
1784
    case 0x1e4:        /* PM_PWSTST_MPU */
1785
        return 0;
1786

    
1787
    case 0x200:        /* CM_FCLKEN1_CORE */
1788
        return s->clken[0];
1789
    case 0x204:        /* CM_FCLKEN2_CORE */
1790
        return s->clken[1];
1791
    case 0x210:        /* CM_ICLKEN1_CORE */
1792
        return s->clken[2];
1793
    case 0x214:        /* CM_ICLKEN2_CORE */
1794
        return s->clken[3];
1795
    case 0x21c:        /* CM_ICLKEN4_CORE */
1796
        return s->clken[4];
1797

    
1798
    case 0x220:        /* CM_IDLEST1_CORE */
1799
        /* TODO: check the actual iclk status */
1800
        return 0x7ffffff9;
1801
    case 0x224:        /* CM_IDLEST2_CORE */
1802
        /* TODO: check the actual iclk status */
1803
        return 0x00000007;
1804
    case 0x22c:        /* CM_IDLEST4_CORE */
1805
        /* TODO: check the actual iclk status */
1806
        return 0x0000001f;
1807

    
1808
    case 0x230:        /* CM_AUTOIDLE1_CORE */
1809
        return s->clkidle[0];
1810
    case 0x234:        /* CM_AUTOIDLE2_CORE */
1811
        return s->clkidle[1];
1812
    case 0x238:        /* CM_AUTOIDLE3_CORE */
1813
        return s->clkidle[2];
1814
    case 0x23c:        /* CM_AUTOIDLE4_CORE */
1815
        return s->clkidle[3];
1816

    
1817
    case 0x240:        /* CM_CLKSEL1_CORE */
1818
        return s->clksel[1];
1819
    case 0x244:        /* CM_CLKSEL2_CORE */
1820
        return s->clksel[2];
1821

    
1822
    case 0x248:        /* CM_CLKSTCTRL_CORE */
1823
        return s->clkctrl[1];
1824

    
1825
    case 0x2a0:        /* PM_WKEN1_CORE */
1826
        return s->wken[0];
1827
    case 0x2a4:        /* PM_WKEN2_CORE */
1828
        return s->wken[1];
1829

    
1830
    case 0x2b0:        /* PM_WKST1_CORE */
1831
        return s->wkst[0];
1832
    case 0x2b4:        /* PM_WKST2_CORE */
1833
        return s->wkst[1];
1834
    case 0x2c8:        /* PM_WKDEP_CORE */
1835
        return 0x1e;
1836

    
1837
    case 0x2e0:        /* PM_PWSTCTRL_CORE */
1838
        return s->power[1];
1839
    case 0x2e4:        /* PM_PWSTST_CORE */
1840
        return 0x000030 | (s->power[1] & 0xfc00);
1841

    
1842
    case 0x300:        /* CM_FCLKEN_GFX */
1843
        return s->clken[5];
1844
    case 0x310:        /* CM_ICLKEN_GFX */
1845
        return s->clken[6];
1846
    case 0x320:        /* CM_IDLEST_GFX */
1847
        /* TODO: check the actual iclk status */
1848
        return 0x00000001;
1849
    case 0x340:        /* CM_CLKSEL_GFX */
1850
        return s->clksel[3];
1851
    case 0x348:        /* CM_CLKSTCTRL_GFX */
1852
        return s->clkctrl[2];
1853
    case 0x350:        /* RM_RSTCTRL_GFX */
1854
        return s->rstctrl[0];
1855
    case 0x358:        /* RM_RSTST_GFX */
1856
        return s->rst[1];
1857
    case 0x3c8:        /* PM_WKDEP_GFX */
1858
        return s->wkup[1];
1859

    
1860
    case 0x3e0:        /* PM_PWSTCTRL_GFX */
1861
        return s->power[2];
1862
    case 0x3e4:        /* PM_PWSTST_GFX */
1863
        return s->power[2] & 3;
1864

    
1865
    case 0x400:        /* CM_FCLKEN_WKUP */
1866
        return s->clken[7];
1867
    case 0x410:        /* CM_ICLKEN_WKUP */
1868
        return s->clken[8];
1869
    case 0x420:        /* CM_IDLEST_WKUP */
1870
        /* TODO: check the actual iclk status */
1871
        return 0x0000003f;
1872
    case 0x430:        /* CM_AUTOIDLE_WKUP */
1873
        return s->clkidle[4];
1874
    case 0x440:        /* CM_CLKSEL_WKUP */
1875
        return s->clksel[4];
1876
    case 0x450:        /* RM_RSTCTRL_WKUP */
1877
        return 0;
1878
    case 0x454:        /* RM_RSTTIME_WKUP */
1879
        return s->rsttime_wkup;
1880
    case 0x458:        /* RM_RSTST_WKUP */
1881
        return s->rst[2];
1882
    case 0x4a0:        /* PM_WKEN_WKUP */
1883
        return s->wken[2];
1884
    case 0x4b0:        /* PM_WKST_WKUP */
1885
        return s->wkst[2];
1886

    
1887
    case 0x500:        /* CM_CLKEN_PLL */
1888
        return s->clken[9];
1889
    case 0x520:        /* CM_IDLEST_CKGEN */
1890
        ret = 0x0000070 | (s->apll_lock[0] << 9) | (s->apll_lock[1] << 8);
1891
        if (!(s->clksel[6] & 3))
1892
            /* Core uses 32-kHz clock */
1893
            ret |= 3 << 0;
1894
        else if (!s->dpll_lock)
1895
            /* DPLL not locked, core uses ref_clk */
1896
            ret |= 1 << 0;
1897
        else
1898
            /* Core uses DPLL */
1899
            ret |= 2 << 0;
1900
        return ret;
1901
    case 0x530:        /* CM_AUTOIDLE_PLL */
1902
        return s->clkidle[5];
1903
    case 0x540:        /* CM_CLKSEL1_PLL */
1904
        return s->clksel[5];
1905
    case 0x544:        /* CM_CLKSEL2_PLL */
1906
        return s->clksel[6];
1907

    
1908
    case 0x800:        /* CM_FCLKEN_DSP */
1909
        return s->clken[10];
1910
    case 0x810:        /* CM_ICLKEN_DSP */
1911
        return s->clken[11];
1912
    case 0x820:        /* CM_IDLEST_DSP */
1913
        /* TODO: check the actual iclk status */
1914
        return 0x00000103;
1915
    case 0x830:        /* CM_AUTOIDLE_DSP */
1916
        return s->clkidle[6];
1917
    case 0x840:        /* CM_CLKSEL_DSP */
1918
        return s->clksel[7];
1919
    case 0x848:        /* CM_CLKSTCTRL_DSP */
1920
        return s->clkctrl[3];
1921
    case 0x850:        /* RM_RSTCTRL_DSP */
1922
        return 0;
1923
    case 0x858:        /* RM_RSTST_DSP */
1924
        return s->rst[3];
1925
    case 0x8c8:        /* PM_WKDEP_DSP */
1926
        return s->wkup[2];
1927
    case 0x8e0:        /* PM_PWSTCTRL_DSP */
1928
        return s->power[3];
1929
    case 0x8e4:        /* PM_PWSTST_DSP */
1930
        return 0x008030 | (s->power[3] & 0x3003);
1931

    
1932
    case 0x8f0:        /* PRCM_IRQSTATUS_DSP */
1933
        return s->irqst[1];
1934
    case 0x8f4:        /* PRCM_IRQENABLE_DSP */
1935
        return s->irqen[1];
1936

    
1937
    case 0x8f8:        /* PRCM_IRQSTATUS_IVA */
1938
        return s->irqst[2];
1939
    case 0x8fc:        /* PRCM_IRQENABLE_IVA */
1940
        return s->irqen[2];
1941
    }
1942

    
1943
    OMAP_BAD_REG(addr);
1944
    return 0;
1945
}
1946

    
1947
static void omap_prcm_apll_update(struct omap_prcm_s *s)
1948
{
1949
    int mode[2];
1950

    
1951
    mode[0] = (s->clken[9] >> 6) & 3;
1952
    s->apll_lock[0] = (mode[0] == 3);
1953
    mode[1] = (s->clken[9] >> 2) & 3;
1954
    s->apll_lock[1] = (mode[1] == 3);
1955
    /* TODO: update clocks */
1956

    
1957
    if (mode[0] == 1 || mode[0] == 2 || mode[1] == 1 || mode[1] == 2)
1958
        fprintf(stderr, "%s: bad EN_54M_PLL or bad EN_96M_PLL\n",
1959
                        __FUNCTION__);
1960
}
1961

    
1962
static void omap_prcm_dpll_update(struct omap_prcm_s *s)
1963
{
1964
    omap_clk dpll = omap_findclk(s->mpu, "dpll");
1965
    omap_clk dpll_x2 = omap_findclk(s->mpu, "dpll");
1966
    omap_clk core = omap_findclk(s->mpu, "core_clk");
1967
    int mode = (s->clken[9] >> 0) & 3;
1968
    int mult, div;
1969

    
1970
    mult = (s->clksel[5] >> 12) & 0x3ff;
1971
    div = (s->clksel[5] >> 8) & 0xf;
1972
    if (mult == 0 || mult == 1)
1973
        mode = 1;        /* Bypass */
1974

    
1975
    s->dpll_lock = 0;
1976
    switch (mode) {
1977
    case 0:
1978
        fprintf(stderr, "%s: bad EN_DPLL\n", __FUNCTION__);
1979
        break;
1980
    case 1:        /* Low-power bypass mode (Default) */
1981
    case 2:        /* Fast-relock bypass mode */
1982
        omap_clk_setrate(dpll, 1, 1);
1983
        omap_clk_setrate(dpll_x2, 1, 1);
1984
        break;
1985
    case 3:        /* Lock mode */
1986
        s->dpll_lock = 1; /* After 20 FINT cycles (ref_clk / (div + 1)).  */
1987

    
1988
        omap_clk_setrate(dpll, div + 1, mult);
1989
        omap_clk_setrate(dpll_x2, div + 1, mult * 2);
1990
        break;
1991
    }
1992

    
1993
    switch ((s->clksel[6] >> 0) & 3) {
1994
    case 0:
1995
        omap_clk_reparent(core, omap_findclk(s->mpu, "clk32-kHz"));
1996
        break;
1997
    case 1:
1998
        omap_clk_reparent(core, dpll);
1999
        break;
2000
    case 2:
2001
        /* Default */
2002
        omap_clk_reparent(core, dpll_x2);
2003
        break;
2004
    case 3:
2005
        fprintf(stderr, "%s: bad CORE_CLK_SRC\n", __FUNCTION__);
2006
        break;
2007
    }
2008
}
2009

    
2010
static void omap_prcm_write(void *opaque, target_phys_addr_t addr,
2011
                uint32_t value)
2012
{
2013
    struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
2014

    
2015
    switch (addr) {
2016
    case 0x000:        /* PRCM_REVISION */
2017
    case 0x054:        /* PRCM_VOLTST */
2018
    case 0x084:        /* PRCM_CLKCFG_STATUS */
2019
    case 0x1e4:        /* PM_PWSTST_MPU */
2020
    case 0x220:        /* CM_IDLEST1_CORE */
2021
    case 0x224:        /* CM_IDLEST2_CORE */
2022
    case 0x22c:        /* CM_IDLEST4_CORE */
2023
    case 0x2c8:        /* PM_WKDEP_CORE */
2024
    case 0x2e4:        /* PM_PWSTST_CORE */
2025
    case 0x320:        /* CM_IDLEST_GFX */
2026
    case 0x3e4:        /* PM_PWSTST_GFX */
2027
    case 0x420:        /* CM_IDLEST_WKUP */
2028
    case 0x520:        /* CM_IDLEST_CKGEN */
2029
    case 0x820:        /* CM_IDLEST_DSP */
2030
    case 0x8e4:        /* PM_PWSTST_DSP */
2031
        OMAP_RO_REG(addr);
2032
        return;
2033

    
2034
    case 0x010:        /* PRCM_SYSCONFIG */
2035
        s->sysconfig = value & 1;
2036
        break;
2037

    
2038
    case 0x018:        /* PRCM_IRQSTATUS_MPU */
2039
        s->irqst[0] &= ~value;
2040
        omap_prcm_int_update(s, 0);
2041
        break;
2042
    case 0x01c:        /* PRCM_IRQENABLE_MPU */
2043
        s->irqen[0] = value & 0x3f;
2044
        omap_prcm_int_update(s, 0);
2045
        break;
2046

    
2047
    case 0x050:        /* PRCM_VOLTCTRL */
2048
        s->voltctrl = value & 0xf1c3;
2049
        break;
2050

    
2051
    case 0x060:        /* PRCM_CLKSRC_CTRL */
2052
        s->clksrc[0] = value & 0xdb;
2053
        /* TODO update clocks */
2054
        break;
2055

    
2056
    case 0x070:        /* PRCM_CLKOUT_CTRL */
2057
        s->clkout[0] = value & 0xbbbb;
2058
        /* TODO update clocks */
2059
        break;
2060

    
2061
    case 0x078:        /* PRCM_CLKEMUL_CTRL */
2062
        s->clkemul[0] = value & 1;
2063
        /* TODO update clocks */
2064
        break;
2065

    
2066
    case 0x080:        /* PRCM_CLKCFG_CTRL */
2067
        break;
2068

    
2069
    case 0x090:        /* PRCM_VOLTSETUP */
2070
        s->setuptime[0] = value & 0xffff;
2071
        break;
2072
    case 0x094:        /* PRCM_CLKSSETUP */
2073
        s->setuptime[1] = value & 0xffff;
2074
        break;
2075

    
2076
    case 0x098:        /* PRCM_POLCTRL */
2077
        s->clkpol[0] = value & 0x701;
2078
        break;
2079

    
2080
    case 0x0b0:        /* GENERAL_PURPOSE1 */
2081
    case 0x0b4:        /* GENERAL_PURPOSE2 */
2082
    case 0x0b8:        /* GENERAL_PURPOSE3 */
2083
    case 0x0bc:        /* GENERAL_PURPOSE4 */
2084
    case 0x0c0:        /* GENERAL_PURPOSE5 */
2085
    case 0x0c4:        /* GENERAL_PURPOSE6 */
2086
    case 0x0c8:        /* GENERAL_PURPOSE7 */
2087
    case 0x0cc:        /* GENERAL_PURPOSE8 */
2088
    case 0x0d0:        /* GENERAL_PURPOSE9 */
2089
    case 0x0d4:        /* GENERAL_PURPOSE10 */
2090
    case 0x0d8:        /* GENERAL_PURPOSE11 */
2091
    case 0x0dc:        /* GENERAL_PURPOSE12 */
2092
    case 0x0e0:        /* GENERAL_PURPOSE13 */
2093
    case 0x0e4:        /* GENERAL_PURPOSE14 */
2094
    case 0x0e8:        /* GENERAL_PURPOSE15 */
2095
    case 0x0ec:        /* GENERAL_PURPOSE16 */
2096
    case 0x0f0:        /* GENERAL_PURPOSE17 */
2097
    case 0x0f4:        /* GENERAL_PURPOSE18 */
2098
    case 0x0f8:        /* GENERAL_PURPOSE19 */
2099
    case 0x0fc:        /* GENERAL_PURPOSE20 */
2100
        s->scratch[(addr - 0xb0) >> 2] = value;
2101
        break;
2102

    
2103
    case 0x140:        /* CM_CLKSEL_MPU */
2104
        s->clksel[0] = value & 0x1f;
2105
        /* TODO update clocks */
2106
        break;
2107
    case 0x148:        /* CM_CLKSTCTRL_MPU */
2108
        s->clkctrl[0] = value & 0x1f;
2109
        break;
2110

    
2111
    case 0x158:        /* RM_RSTST_MPU */
2112
        s->rst[0] &= ~value;
2113
        break;
2114
    case 0x1c8:        /* PM_WKDEP_MPU */
2115
        s->wkup[0] = value & 0x15;
2116
        break;
2117

    
2118
    case 0x1d4:        /* PM_EVGENCTRL_MPU */
2119
        s->ev = value & 0x1f;
2120
        break;
2121
    case 0x1d8:        /* PM_EVEGENONTIM_MPU */
2122
        s->evtime[0] = value;
2123
        break;
2124
    case 0x1dc:        /* PM_EVEGENOFFTIM_MPU */
2125
        s->evtime[1] = value;
2126
        break;
2127

    
2128
    case 0x1e0:        /* PM_PWSTCTRL_MPU */
2129
        s->power[0] = value & 0xc0f;
2130
        break;
2131

    
2132
    case 0x200:        /* CM_FCLKEN1_CORE */
2133
        s->clken[0] = value & 0xbfffffff;
2134
        /* TODO update clocks */
2135
        /* The EN_EAC bit only gets/puts func_96m_clk.  */
2136
        break;
2137
    case 0x204:        /* CM_FCLKEN2_CORE */
2138
        s->clken[1] = value & 0x00000007;
2139
        /* TODO update clocks */
2140
        break;
2141
    case 0x210:        /* CM_ICLKEN1_CORE */
2142
        s->clken[2] = value & 0xfffffff9;
2143
        /* TODO update clocks */
2144
        /* The EN_EAC bit only gets/puts core_l4_iclk.  */
2145
        break;
2146
    case 0x214:        /* CM_ICLKEN2_CORE */
2147
        s->clken[3] = value & 0x00000007;
2148
        /* TODO update clocks */
2149
        break;
2150
    case 0x21c:        /* CM_ICLKEN4_CORE */
2151
        s->clken[4] = value & 0x0000001f;
2152
        /* TODO update clocks */
2153
        break;
2154

    
2155
    case 0x230:        /* CM_AUTOIDLE1_CORE */
2156
        s->clkidle[0] = value & 0xfffffff9;
2157
        /* TODO update clocks */
2158
        break;
2159
    case 0x234:        /* CM_AUTOIDLE2_CORE */
2160
        s->clkidle[1] = value & 0x00000007;
2161
        /* TODO update clocks */
2162
        break;
2163
    case 0x238:        /* CM_AUTOIDLE3_CORE */
2164
        s->clkidle[2] = value & 0x00000007;
2165
        /* TODO update clocks */
2166
        break;
2167
    case 0x23c:        /* CM_AUTOIDLE4_CORE */
2168
        s->clkidle[3] = value & 0x0000001f;
2169
        /* TODO update clocks */
2170
        break;
2171

    
2172
    case 0x240:        /* CM_CLKSEL1_CORE */
2173
        s->clksel[1] = value & 0x0fffbf7f;
2174
        /* TODO update clocks */
2175
        break;
2176

    
2177
    case 0x244:        /* CM_CLKSEL2_CORE */
2178
        s->clksel[2] = value & 0x00fffffc;
2179
        /* TODO update clocks */
2180
        break;
2181

    
2182
    case 0x248:        /* CM_CLKSTCTRL_CORE */
2183
        s->clkctrl[1] = value & 0x7;
2184
        break;
2185

    
2186
    case 0x2a0:        /* PM_WKEN1_CORE */
2187
        s->wken[0] = value & 0x04667ff8;
2188
        break;
2189
    case 0x2a4:        /* PM_WKEN2_CORE */
2190
        s->wken[1] = value & 0x00000005;
2191
        break;
2192

    
2193
    case 0x2b0:        /* PM_WKST1_CORE */
2194
        s->wkst[0] &= ~value;
2195
        break;
2196
    case 0x2b4:        /* PM_WKST2_CORE */
2197
        s->wkst[1] &= ~value;
2198
        break;
2199

    
2200
    case 0x2e0:        /* PM_PWSTCTRL_CORE */
2201
        s->power[1] = (value & 0x00fc3f) | (1 << 2);
2202
        break;
2203

    
2204
    case 0x300:        /* CM_FCLKEN_GFX */
2205
        s->clken[5] = value & 6;
2206
        /* TODO update clocks */
2207
        break;
2208
    case 0x310:        /* CM_ICLKEN_GFX */
2209
        s->clken[6] = value & 1;
2210
        /* TODO update clocks */
2211
        break;
2212
    case 0x340:        /* CM_CLKSEL_GFX */
2213
        s->clksel[3] = value & 7;
2214
        /* TODO update clocks */
2215
        break;
2216
    case 0x348:        /* CM_CLKSTCTRL_GFX */
2217
        s->clkctrl[2] = value & 1;
2218
        break;
2219
    case 0x350:        /* RM_RSTCTRL_GFX */
2220
        s->rstctrl[0] = value & 1;
2221
        /* TODO: reset */
2222
        break;
2223
    case 0x358:        /* RM_RSTST_GFX */
2224
        s->rst[1] &= ~value;
2225
        break;
2226
    case 0x3c8:        /* PM_WKDEP_GFX */
2227
        s->wkup[1] = value & 0x13;
2228
        break;
2229
    case 0x3e0:        /* PM_PWSTCTRL_GFX */
2230
        s->power[2] = (value & 0x00c0f) | (3 << 2);
2231
        break;
2232

    
2233
    case 0x400:        /* CM_FCLKEN_WKUP */
2234
        s->clken[7] = value & 0xd;
2235
        /* TODO update clocks */
2236
        break;
2237
    case 0x410:        /* CM_ICLKEN_WKUP */
2238
        s->clken[8] = value & 0x3f;
2239
        /* TODO update clocks */
2240
        break;
2241
    case 0x430:        /* CM_AUTOIDLE_WKUP */
2242
        s->clkidle[4] = value & 0x0000003f;
2243
        /* TODO update clocks */
2244
        break;
2245
    case 0x440:        /* CM_CLKSEL_WKUP */
2246
        s->clksel[4] = value & 3;
2247
        /* TODO update clocks */
2248
        break;
2249
    case 0x450:        /* RM_RSTCTRL_WKUP */
2250
        /* TODO: reset */
2251
        if (value & 2)
2252
            qemu_system_reset_request();
2253
        break;
2254
    case 0x454:        /* RM_RSTTIME_WKUP */
2255
        s->rsttime_wkup = value & 0x1fff;
2256
        break;
2257
    case 0x458:        /* RM_RSTST_WKUP */
2258
        s->rst[2] &= ~value;
2259
        break;
2260
    case 0x4a0:        /* PM_WKEN_WKUP */
2261
        s->wken[2] = value & 0x00000005;
2262
        break;
2263
    case 0x4b0:        /* PM_WKST_WKUP */
2264
        s->wkst[2] &= ~value;
2265
        break;
2266

    
2267
    case 0x500:        /* CM_CLKEN_PLL */
2268
        if (value & 0xffffff30)
2269
            fprintf(stderr, "%s: write 0s in CM_CLKEN_PLL for "
2270
                            "future compatiblity\n", __FUNCTION__);
2271
        if ((s->clken[9] ^ value) & 0xcc) {
2272
            s->clken[9] &= ~0xcc;
2273
            s->clken[9] |= value & 0xcc;
2274
            omap_prcm_apll_update(s);
2275
        }
2276
        if ((s->clken[9] ^ value) & 3) {
2277
            s->clken[9] &= ~3;
2278
            s->clken[9] |= value & 3;
2279
            omap_prcm_dpll_update(s);
2280
        }
2281
        break;
2282
    case 0x530:        /* CM_AUTOIDLE_PLL */
2283
        s->clkidle[5] = value & 0x000000cf;
2284
        /* TODO update clocks */
2285
        break;
2286
    case 0x540:        /* CM_CLKSEL1_PLL */
2287
        if (value & 0xfc4000d7)
2288
            fprintf(stderr, "%s: write 0s in CM_CLKSEL1_PLL for "
2289
                            "future compatiblity\n", __FUNCTION__);
2290
        if ((s->clksel[5] ^ value) & 0x003fff00) {
2291
            s->clksel[5] = value & 0x03bfff28;
2292
            omap_prcm_dpll_update(s);
2293
        }
2294
        /* TODO update the other clocks */
2295

    
2296
        s->clksel[5] = value & 0x03bfff28;
2297
        break;
2298
    case 0x544:        /* CM_CLKSEL2_PLL */
2299
        if (value & ~3)
2300
            fprintf(stderr, "%s: write 0s in CM_CLKSEL2_PLL[31:2] for "
2301
                            "future compatiblity\n", __FUNCTION__);
2302
        if (s->clksel[6] != (value & 3)) {
2303
            s->clksel[6] = value & 3;
2304
            omap_prcm_dpll_update(s);
2305
        }
2306
        break;
2307

    
2308
    case 0x800:        /* CM_FCLKEN_DSP */
2309
        s->clken[10] = value & 0x501;
2310
        /* TODO update clocks */
2311
        break;
2312
    case 0x810:        /* CM_ICLKEN_DSP */
2313
        s->clken[11] = value & 0x2;
2314
        /* TODO update clocks */
2315
        break;
2316
    case 0x830:        /* CM_AUTOIDLE_DSP */
2317
        s->clkidle[6] = value & 0x2;
2318
        /* TODO update clocks */
2319
        break;
2320
    case 0x840:        /* CM_CLKSEL_DSP */
2321
        s->clksel[7] = value & 0x3fff;
2322
        /* TODO update clocks */
2323
        break;
2324
    case 0x848:        /* CM_CLKSTCTRL_DSP */
2325
        s->clkctrl[3] = value & 0x101;
2326
        break;
2327
    case 0x850:        /* RM_RSTCTRL_DSP */
2328
        /* TODO: reset */
2329
        break;
2330
    case 0x858:        /* RM_RSTST_DSP */
2331
        s->rst[3] &= ~value;
2332
        break;
2333
    case 0x8c8:        /* PM_WKDEP_DSP */
2334
        s->wkup[2] = value & 0x13;
2335
        break;
2336
    case 0x8e0:        /* PM_PWSTCTRL_DSP */
2337
        s->power[3] = (value & 0x03017) | (3 << 2);
2338
        break;
2339

    
2340
    case 0x8f0:        /* PRCM_IRQSTATUS_DSP */
2341
        s->irqst[1] &= ~value;
2342
        omap_prcm_int_update(s, 1);
2343
        break;
2344
    case 0x8f4:        /* PRCM_IRQENABLE_DSP */
2345
        s->irqen[1] = value & 0x7;
2346
        omap_prcm_int_update(s, 1);
2347
        break;
2348

    
2349
    case 0x8f8:        /* PRCM_IRQSTATUS_IVA */
2350
        s->irqst[2] &= ~value;
2351
        omap_prcm_int_update(s, 2);
2352
        break;
2353
    case 0x8fc:        /* PRCM_IRQENABLE_IVA */
2354
        s->irqen[2] = value & 0x7;
2355
        omap_prcm_int_update(s, 2);
2356
        break;
2357

    
2358
    default:
2359
        OMAP_BAD_REG(addr);
2360
        return;
2361
    }
2362
}
2363

    
2364
static CPUReadMemoryFunc * const omap_prcm_readfn[] = {
2365
    omap_badwidth_read32,
2366
    omap_badwidth_read32,
2367
    omap_prcm_read,
2368
};
2369

    
2370
static CPUWriteMemoryFunc * const omap_prcm_writefn[] = {
2371
    omap_badwidth_write32,
2372
    omap_badwidth_write32,
2373
    omap_prcm_write,
2374
};
2375

    
2376
static void omap_prcm_reset(struct omap_prcm_s *s)
2377
{
2378
    s->sysconfig = 0;
2379
    s->irqst[0] = 0;
2380
    s->irqst[1] = 0;
2381
    s->irqst[2] = 0;
2382
    s->irqen[0] = 0;
2383
    s->irqen[1] = 0;
2384
    s->irqen[2] = 0;
2385
    s->voltctrl = 0x1040;
2386
    s->ev = 0x14;
2387
    s->evtime[0] = 0;
2388
    s->evtime[1] = 0;
2389
    s->clkctrl[0] = 0;
2390
    s->clkctrl[1] = 0;
2391
    s->clkctrl[2] = 0;
2392
    s->clkctrl[3] = 0;
2393
    s->clken[1] = 7;
2394
    s->clken[3] = 7;
2395
    s->clken[4] = 0;
2396
    s->clken[5] = 0;
2397
    s->clken[6] = 0;
2398
    s->clken[7] = 0xc;
2399
    s->clken[8] = 0x3e;
2400
    s->clken[9] = 0x0d;
2401
    s->clken[10] = 0;
2402
    s->clken[11] = 0;
2403
    s->clkidle[0] = 0;
2404
    s->clkidle[2] = 7;
2405
    s->clkidle[3] = 0;
2406
    s->clkidle[4] = 0;
2407
    s->clkidle[5] = 0x0c;
2408
    s->clkidle[6] = 0;
2409
    s->clksel[0] = 0x01;
2410
    s->clksel[1] = 0x02100121;
2411
    s->clksel[2] = 0x00000000;
2412
    s->clksel[3] = 0x01;
2413
    s->clksel[4] = 0;
2414
    s->clksel[7] = 0x0121;
2415
    s->wkup[0] = 0x15;
2416
    s->wkup[1] = 0x13;
2417
    s->wkup[2] = 0x13;
2418
    s->wken[0] = 0x04667ff8;
2419
    s->wken[1] = 0x00000005;
2420
    s->wken[2] = 5;
2421
    s->wkst[0] = 0;
2422
    s->wkst[1] = 0;
2423
    s->wkst[2] = 0;
2424
    s->power[0] = 0x00c;
2425
    s->power[1] = 4;
2426
    s->power[2] = 0x0000c;
2427
    s->power[3] = 0x14;
2428
    s->rstctrl[0] = 1;
2429
    s->rst[3] = 1;
2430
    omap_prcm_apll_update(s);
2431
    omap_prcm_dpll_update(s);
2432
}
2433

    
2434
static void omap_prcm_coldreset(struct omap_prcm_s *s)
2435
{
2436
    s->setuptime[0] = 0;
2437
    s->setuptime[1] = 0;
2438
    memset(&s->scratch, 0, sizeof(s->scratch));
2439
    s->rst[0] = 0x01;
2440
    s->rst[1] = 0x00;
2441
    s->rst[2] = 0x01;
2442
    s->clken[0] = 0;
2443
    s->clken[2] = 0;
2444
    s->clkidle[1] = 0;
2445
    s->clksel[5] = 0;
2446
    s->clksel[6] = 2;
2447
    s->clksrc[0] = 0x43;
2448
    s->clkout[0] = 0x0303;
2449
    s->clkemul[0] = 0;
2450
    s->clkpol[0] = 0x100;
2451
    s->rsttime_wkup = 0x1002;
2452

    
2453
    omap_prcm_reset(s);
2454
}
2455

    
2456
struct omap_prcm_s *omap_prcm_init(struct omap_target_agent_s *ta,
2457
                qemu_irq mpu_int, qemu_irq dsp_int, qemu_irq iva_int,
2458
                struct omap_mpu_state_s *mpu)
2459
{
2460
    int iomemtype;
2461
    struct omap_prcm_s *s = (struct omap_prcm_s *)
2462
            qemu_mallocz(sizeof(struct omap_prcm_s));
2463

    
2464
    s->irq[0] = mpu_int;
2465
    s->irq[1] = dsp_int;
2466
    s->irq[2] = iva_int;
2467
    s->mpu = mpu;
2468
    omap_prcm_coldreset(s);
2469

    
2470
    iomemtype = l4_register_io_memory(omap_prcm_readfn,
2471
                    omap_prcm_writefn, s);
2472
    omap_l4_attach(ta, 0, iomemtype);
2473
    omap_l4_attach(ta, 1, iomemtype);
2474

    
2475
    return s;
2476
}
2477

    
2478
/* System and Pinout control */
2479
struct omap_sysctl_s {
2480
    struct omap_mpu_state_s *mpu;
2481

    
2482
    uint32_t sysconfig;
2483
    uint32_t devconfig;
2484
    uint32_t psaconfig;
2485
    uint32_t padconf[0x45];
2486
    uint8_t obs;
2487
    uint32_t msuspendmux[5];
2488
};
2489

    
2490
static uint32_t omap_sysctl_read8(void *opaque, target_phys_addr_t addr)
2491
{
2492

    
2493
    struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
2494
    int pad_offset, byte_offset;
2495
    int value;
2496

    
2497
    switch (addr) {
2498
    case 0x030 ... 0x140:        /* CONTROL_PADCONF - only used in the POP */
2499
        pad_offset = (addr - 0x30) >> 2;
2500
        byte_offset = (addr - 0x30) & (4 - 1);
2501

    
2502
        value = s->padconf[pad_offset];
2503
        value = (value >> (byte_offset * 8)) & 0xff;
2504

    
2505
        return value;
2506

    
2507
    default:
2508
        break;
2509
    }
2510

    
2511
    OMAP_BAD_REG(addr);
2512
    return 0;
2513
}
2514

    
2515
static uint32_t omap_sysctl_read(void *opaque, target_phys_addr_t addr)
2516
{
2517
    struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
2518

    
2519
    switch (addr) {
2520
    case 0x000:        /* CONTROL_REVISION */
2521
        return 0x20;
2522

    
2523
    case 0x010:        /* CONTROL_SYSCONFIG */
2524
        return s->sysconfig;
2525

    
2526
    case 0x030 ... 0x140:        /* CONTROL_PADCONF - only used in the POP */
2527
        return s->padconf[(addr - 0x30) >> 2];
2528

    
2529
    case 0x270:        /* CONTROL_DEBOBS */
2530
        return s->obs;
2531

    
2532
    case 0x274:        /* CONTROL_DEVCONF */
2533
        return s->devconfig;
2534

    
2535
    case 0x28c:        /* CONTROL_EMU_SUPPORT */
2536
        return 0;
2537

    
2538
    case 0x290:        /* CONTROL_MSUSPENDMUX_0 */
2539
        return s->msuspendmux[0];
2540
    case 0x294:        /* CONTROL_MSUSPENDMUX_1 */
2541
        return s->msuspendmux[1];
2542
    case 0x298:        /* CONTROL_MSUSPENDMUX_2 */
2543
        return s->msuspendmux[2];
2544
    case 0x29c:        /* CONTROL_MSUSPENDMUX_3 */
2545
        return s->msuspendmux[3];
2546
    case 0x2a0:        /* CONTROL_MSUSPENDMUX_4 */
2547
        return s->msuspendmux[4];
2548
    case 0x2a4:        /* CONTROL_MSUSPENDMUX_5 */
2549
        return 0;
2550

    
2551
    case 0x2b8:        /* CONTROL_PSA_CTRL */
2552
        return s->psaconfig;
2553
    case 0x2bc:        /* CONTROL_PSA_CMD */
2554
    case 0x2c0:        /* CONTROL_PSA_VALUE */
2555
        return 0;
2556

    
2557
    case 0x2b0:        /* CONTROL_SEC_CTRL */
2558
        return 0x800000f1;
2559
    case 0x2d0:        /* CONTROL_SEC_EMU */
2560
        return 0x80000015;
2561
    case 0x2d4:        /* CONTROL_SEC_TAP */
2562
        return 0x8000007f;
2563
    case 0x2b4:        /* CONTROL_SEC_TEST */
2564
    case 0x2f0:        /* CONTROL_SEC_STATUS */
2565
    case 0x2f4:        /* CONTROL_SEC_ERR_STATUS */
2566
        /* Secure mode is not present on general-pusrpose device.  Outside
2567
         * secure mode these values cannot be read or written.  */
2568
        return 0;
2569

    
2570
    case 0x2d8:        /* CONTROL_OCM_RAM_PERM */
2571
        return 0xff;
2572
    case 0x2dc:        /* CONTROL_OCM_PUB_RAM_ADD */
2573
    case 0x2e0:        /* CONTROL_EXT_SEC_RAM_START_ADD */
2574
    case 0x2e4:        /* CONTROL_EXT_SEC_RAM_STOP_ADD */
2575
        /* No secure mode so no Extended Secure RAM present.  */
2576
        return 0;
2577

    
2578
    case 0x2f8:        /* CONTROL_STATUS */
2579
        /* Device Type => General-purpose */
2580
        return 0x0300;
2581
    case 0x2fc:        /* CONTROL_GENERAL_PURPOSE_STATUS */
2582

    
2583
    case 0x300:        /* CONTROL_RPUB_KEY_H_0 */
2584
    case 0x304:        /* CONTROL_RPUB_KEY_H_1 */
2585
    case 0x308:        /* CONTROL_RPUB_KEY_H_2 */
2586
    case 0x30c:        /* CONTROL_RPUB_KEY_H_3 */
2587
        return 0xdecafbad;
2588

    
2589
    case 0x310:        /* CONTROL_RAND_KEY_0 */
2590
    case 0x314:        /* CONTROL_RAND_KEY_1 */
2591
    case 0x318:        /* CONTROL_RAND_KEY_2 */
2592
    case 0x31c:        /* CONTROL_RAND_KEY_3 */
2593
    case 0x320:        /* CONTROL_CUST_KEY_0 */
2594
    case 0x324:        /* CONTROL_CUST_KEY_1 */
2595
    case 0x330:        /* CONTROL_TEST_KEY_0 */
2596
    case 0x334:        /* CONTROL_TEST_KEY_1 */
2597
    case 0x338:        /* CONTROL_TEST_KEY_2 */
2598
    case 0x33c:        /* CONTROL_TEST_KEY_3 */
2599
    case 0x340:        /* CONTROL_TEST_KEY_4 */
2600
    case 0x344:        /* CONTROL_TEST_KEY_5 */
2601
    case 0x348:        /* CONTROL_TEST_KEY_6 */
2602
    case 0x34c:        /* CONTROL_TEST_KEY_7 */
2603
    case 0x350:        /* CONTROL_TEST_KEY_8 */
2604
    case 0x354:        /* CONTROL_TEST_KEY_9 */
2605
        /* Can only be accessed in secure mode and when C_FieldAccEnable
2606
         * bit is set in CONTROL_SEC_CTRL.
2607
         * TODO: otherwise an interconnect access error is generated.  */
2608
        return 0;
2609
    }
2610

    
2611
    OMAP_BAD_REG(addr);
2612
    return 0;
2613
}
2614

    
2615
static void omap_sysctl_write8(void *opaque, target_phys_addr_t addr,
2616
                uint32_t value)
2617
{
2618
    struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
2619
    int pad_offset, byte_offset;
2620
    int prev_value;
2621

    
2622
    switch (addr) {
2623
    case 0x030 ... 0x140:        /* CONTROL_PADCONF - only used in the POP */
2624
        pad_offset = (addr - 0x30) >> 2;
2625
        byte_offset = (addr - 0x30) & (4 - 1);
2626

    
2627
        prev_value = s->padconf[pad_offset];
2628
        prev_value &= ~(0xff << (byte_offset * 8));
2629
        prev_value |= ((value & 0x1f1f1f1f) << (byte_offset * 8)) & 0x1f1f1f1f;
2630
        s->padconf[pad_offset] = prev_value;
2631
        break;
2632

    
2633
    default:
2634
        OMAP_BAD_REG(addr);
2635
        break;
2636
    }
2637
}
2638

    
2639
static void omap_sysctl_write(void *opaque, target_phys_addr_t addr,
2640
                uint32_t value)
2641
{
2642
    struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
2643

    
2644
    switch (addr) {
2645
    case 0x000:        /* CONTROL_REVISION */
2646
    case 0x2a4:        /* CONTROL_MSUSPENDMUX_5 */
2647
    case 0x2c0:        /* CONTROL_PSA_VALUE */
2648
    case 0x2f8:        /* CONTROL_STATUS */
2649
    case 0x2fc:        /* CONTROL_GENERAL_PURPOSE_STATUS */
2650
    case 0x300:        /* CONTROL_RPUB_KEY_H_0 */
2651
    case 0x304:        /* CONTROL_RPUB_KEY_H_1 */
2652
    case 0x308:        /* CONTROL_RPUB_KEY_H_2 */
2653
    case 0x30c:        /* CONTROL_RPUB_KEY_H_3 */
2654
    case 0x310:        /* CONTROL_RAND_KEY_0 */
2655
    case 0x314:        /* CONTROL_RAND_KEY_1 */
2656
    case 0x318:        /* CONTROL_RAND_KEY_2 */
2657
    case 0x31c:        /* CONTROL_RAND_KEY_3 */
2658
    case 0x320:        /* CONTROL_CUST_KEY_0 */
2659
    case 0x324:        /* CONTROL_CUST_KEY_1 */
2660
    case 0x330:        /* CONTROL_TEST_KEY_0 */
2661
    case 0x334:        /* CONTROL_TEST_KEY_1 */
2662
    case 0x338:        /* CONTROL_TEST_KEY_2 */
2663
    case 0x33c:        /* CONTROL_TEST_KEY_3 */
2664
    case 0x340:        /* CONTROL_TEST_KEY_4 */
2665
    case 0x344:        /* CONTROL_TEST_KEY_5 */
2666
    case 0x348:        /* CONTROL_TEST_KEY_6 */
2667
    case 0x34c:        /* CONTROL_TEST_KEY_7 */
2668
    case 0x350:        /* CONTROL_TEST_KEY_8 */
2669
    case 0x354:        /* CONTROL_TEST_KEY_9 */
2670
        OMAP_RO_REG(addr);
2671
        return;
2672

    
2673
    case 0x010:        /* CONTROL_SYSCONFIG */
2674
        s->sysconfig = value & 0x1e;
2675
        break;
2676

    
2677
    case 0x030 ... 0x140:        /* CONTROL_PADCONF - only used in the POP */
2678
        /* XXX: should check constant bits */
2679
        s->padconf[(addr - 0x30) >> 2] = value & 0x1f1f1f1f;
2680
        break;
2681

    
2682
    case 0x270:        /* CONTROL_DEBOBS */
2683
        s->obs = value & 0xff;
2684
        break;
2685

    
2686
    case 0x274:        /* CONTROL_DEVCONF */
2687
        s->devconfig = value & 0xffffc7ff;
2688
        break;
2689

    
2690
    case 0x28c:        /* CONTROL_EMU_SUPPORT */
2691
        break;
2692

    
2693
    case 0x290:        /* CONTROL_MSUSPENDMUX_0 */
2694
        s->msuspendmux[0] = value & 0x3fffffff;
2695
        break;
2696
    case 0x294:        /* CONTROL_MSUSPENDMUX_1 */
2697
        s->msuspendmux[1] = value & 0x3fffffff;
2698
        break;
2699
    case 0x298:        /* CONTROL_MSUSPENDMUX_2 */
2700
        s->msuspendmux[2] = value & 0x3fffffff;
2701
        break;
2702
    case 0x29c:        /* CONTROL_MSUSPENDMUX_3 */
2703
        s->msuspendmux[3] = value & 0x3fffffff;
2704
        break;
2705
    case 0x2a0:        /* CONTROL_MSUSPENDMUX_4 */
2706
        s->msuspendmux[4] = value & 0x3fffffff;
2707
        break;
2708

    
2709
    case 0x2b8:        /* CONTROL_PSA_CTRL */
2710
        s->psaconfig = value & 0x1c;
2711
        s->psaconfig |= (value & 0x20) ? 2 : 1;
2712
        break;
2713
    case 0x2bc:        /* CONTROL_PSA_CMD */
2714
        break;
2715

    
2716
    case 0x2b0:        /* CONTROL_SEC_CTRL */
2717
    case 0x2b4:        /* CONTROL_SEC_TEST */
2718
    case 0x2d0:        /* CONTROL_SEC_EMU */
2719
    case 0x2d4:        /* CONTROL_SEC_TAP */
2720
    case 0x2d8:        /* CONTROL_OCM_RAM_PERM */
2721
    case 0x2dc:        /* CONTROL_OCM_PUB_RAM_ADD */
2722
    case 0x2e0:        /* CONTROL_EXT_SEC_RAM_START_ADD */
2723
    case 0x2e4:        /* CONTROL_EXT_SEC_RAM_STOP_ADD */
2724
    case 0x2f0:        /* CONTROL_SEC_STATUS */
2725
    case 0x2f4:        /* CONTROL_SEC_ERR_STATUS */
2726
        break;
2727

    
2728
    default:
2729
        OMAP_BAD_REG(addr);
2730
        return;
2731
    }
2732
}
2733

    
2734
static CPUReadMemoryFunc * const omap_sysctl_readfn[] = {
2735
    omap_sysctl_read8,
2736
    omap_badwidth_read32,        /* TODO */
2737
    omap_sysctl_read,
2738
};
2739

    
2740
static CPUWriteMemoryFunc * const omap_sysctl_writefn[] = {
2741
    omap_sysctl_write8,
2742
    omap_badwidth_write32,        /* TODO */
2743
    omap_sysctl_write,
2744
};
2745

    
2746
static void omap_sysctl_reset(struct omap_sysctl_s *s)
2747
{
2748
    /* (power-on reset) */
2749
    s->sysconfig = 0;
2750
    s->obs = 0;
2751
    s->devconfig = 0x0c000000;
2752
    s->msuspendmux[0] = 0x00000000;
2753
    s->msuspendmux[1] = 0x00000000;
2754
    s->msuspendmux[2] = 0x00000000;
2755
    s->msuspendmux[3] = 0x00000000;
2756
    s->msuspendmux[4] = 0x00000000;
2757
    s->psaconfig = 1;
2758

    
2759
    s->padconf[0x00] = 0x000f0f0f;
2760
    s->padconf[0x01] = 0x00000000;
2761
    s->padconf[0x02] = 0x00000000;
2762
    s->padconf[0x03] = 0x00000000;
2763
    s->padconf[0x04] = 0x00000000;
2764
    s->padconf[0x05] = 0x00000000;
2765
    s->padconf[0x06] = 0x00000000;
2766
    s->padconf[0x07] = 0x00000000;
2767
    s->padconf[0x08] = 0x08080800;
2768
    s->padconf[0x09] = 0x08080808;
2769
    s->padconf[0x0a] = 0x08080808;
2770
    s->padconf[0x0b] = 0x08080808;
2771
    s->padconf[0x0c] = 0x08080808;
2772
    s->padconf[0x0d] = 0x08080800;
2773
    s->padconf[0x0e] = 0x08080808;
2774
    s->padconf[0x0f] = 0x08080808;
2775
    s->padconf[0x10] = 0x18181808;        /* | 0x07070700 if SBoot3 */
2776
    s->padconf[0x11] = 0x18181818;        /* | 0x07070707 if SBoot3 */
2777
    s->padconf[0x12] = 0x18181818;        /* | 0x07070707 if SBoot3 */
2778
    s->padconf[0x13] = 0x18181818;        /* | 0x07070707 if SBoot3 */
2779
    s->padconf[0x14] = 0x18181818;        /* | 0x00070707 if SBoot3 */
2780
    s->padconf[0x15] = 0x18181818;
2781
    s->padconf[0x16] = 0x18181818;        /* | 0x07000000 if SBoot3 */
2782
    s->padconf[0x17] = 0x1f001f00;
2783
    s->padconf[0x18] = 0x1f1f1f1f;
2784
    s->padconf[0x19] = 0x00000000;
2785
    s->padconf[0x1a] = 0x1f180000;
2786
    s->padconf[0x1b] = 0x00001f1f;
2787
    s->padconf[0x1c] = 0x1f001f00;
2788
    s->padconf[0x1d] = 0x00000000;
2789
    s->padconf[0x1e] = 0x00000000;
2790
    s->padconf[0x1f] = 0x08000000;
2791
    s->padconf[0x20] = 0x08080808;
2792
    s->padconf[0x21] = 0x08080808;
2793
    s->padconf[0x22] = 0x0f080808;
2794
    s->padconf[0x23] = 0x0f0f0f0f;
2795
    s->padconf[0x24] = 0x000f0f0f;
2796
    s->padconf[0x25] = 0x1f1f1f0f;
2797
    s->padconf[0x26] = 0x080f0f1f;
2798
    s->padconf[0x27] = 0x070f1808;
2799
    s->padconf[0x28] = 0x0f070707;
2800
    s->padconf[0x29] = 0x000f0f1f;
2801
    s->padconf[0x2a] = 0x0f0f0f1f;
2802
    s->padconf[0x2b] = 0x08000000;
2803
    s->padconf[0x2c] = 0x0000001f;
2804
    s->padconf[0x2d] = 0x0f0f1f00;
2805
    s->padconf[0x2e] = 0x1f1f0f0f;
2806
    s->padconf[0x2f] = 0x0f1f1f1f;
2807
    s->padconf[0x30] = 0x0f0f0f0f;
2808
    s->padconf[0x31] = 0x0f1f0f1f;
2809
    s->padconf[0x32] = 0x0f0f0f0f;
2810
    s->padconf[0x33] = 0x0f1f0f1f;
2811
    s->padconf[0x34] = 0x1f1f0f0f;
2812
    s->padconf[0x35] = 0x0f0f1f1f;
2813
    s->padconf[0x36] = 0x0f0f1f0f;
2814
    s->padconf[0x37] = 0x0f0f0f0f;
2815
    s->padconf[0x38] = 0x1f18180f;
2816
    s->padconf[0x39] = 0x1f1f1f1f;
2817
    s->padconf[0x3a] = 0x00001f1f;
2818
    s->padconf[0x3b] = 0x00000000;
2819
    s->padconf[0x3c] = 0x00000000;
2820
    s->padconf[0x3d] = 0x0f0f0f0f;
2821
    s->padconf[0x3e] = 0x18000f0f;
2822
    s->padconf[0x3f] = 0x00070000;
2823
    s->padconf[0x40] = 0x00000707;
2824
    s->padconf[0x41] = 0x0f1f0700;
2825
    s->padconf[0x42] = 0x1f1f070f;
2826
    s->padconf[0x43] = 0x0008081f;
2827
    s->padconf[0x44] = 0x00000800;
2828
}
2829

    
2830
struct omap_sysctl_s *omap_sysctl_init(struct omap_target_agent_s *ta,
2831
                omap_clk iclk, struct omap_mpu_state_s *mpu)
2832
{
2833
    int iomemtype;
2834
    struct omap_sysctl_s *s = (struct omap_sysctl_s *)
2835
            qemu_mallocz(sizeof(struct omap_sysctl_s));
2836

    
2837
    s->mpu = mpu;
2838
    omap_sysctl_reset(s);
2839

    
2840
    iomemtype = l4_register_io_memory(omap_sysctl_readfn,
2841
                    omap_sysctl_writefn, s);
2842
    omap_l4_attach(ta, 0, iomemtype);
2843

    
2844
    return s;
2845
}
2846

    
2847
/* SDRAM Controller Subsystem */
2848
struct omap_sdrc_s {
2849
    uint8_t config;
2850
};
2851

    
2852
static void omap_sdrc_reset(struct omap_sdrc_s *s)
2853
{
2854
    s->config = 0x10;
2855
}
2856

    
2857
static uint32_t omap_sdrc_read(void *opaque, target_phys_addr_t addr)
2858
{
2859
    struct omap_sdrc_s *s = (struct omap_sdrc_s *) opaque;
2860

    
2861
    switch (addr) {
2862
    case 0x00:        /* SDRC_REVISION */
2863
        return 0x20;
2864

    
2865
    case 0x10:        /* SDRC_SYSCONFIG */
2866
        return s->config;
2867

    
2868
    case 0x14:        /* SDRC_SYSSTATUS */
2869
        return 1;                                                /* RESETDONE */
2870

    
2871
    case 0x40:        /* SDRC_CS_CFG */
2872
    case 0x44:        /* SDRC_SHARING */
2873
    case 0x48:        /* SDRC_ERR_ADDR */
2874
    case 0x4c:        /* SDRC_ERR_TYPE */
2875
    case 0x60:        /* SDRC_DLLA_SCTRL */
2876
    case 0x64:        /* SDRC_DLLA_STATUS */
2877
    case 0x68:        /* SDRC_DLLB_CTRL */
2878
    case 0x6c:        /* SDRC_DLLB_STATUS */
2879
    case 0x70:        /* SDRC_POWER */
2880
    case 0x80:        /* SDRC_MCFG_0 */
2881
    case 0x84:        /* SDRC_MR_0 */
2882
    case 0x88:        /* SDRC_EMR1_0 */
2883
    case 0x8c:        /* SDRC_EMR2_0 */
2884
    case 0x90:        /* SDRC_EMR3_0 */
2885
    case 0x94:        /* SDRC_DCDL1_CTRL */
2886
    case 0x98:        /* SDRC_DCDL2_CTRL */
2887
    case 0x9c:        /* SDRC_ACTIM_CTRLA_0 */
2888
    case 0xa0:        /* SDRC_ACTIM_CTRLB_0 */
2889
    case 0xa4:        /* SDRC_RFR_CTRL_0 */
2890
    case 0xa8:        /* SDRC_MANUAL_0 */
2891
    case 0xb0:        /* SDRC_MCFG_1 */
2892
    case 0xb4:        /* SDRC_MR_1 */
2893
    case 0xb8:        /* SDRC_EMR1_1 */
2894
    case 0xbc:        /* SDRC_EMR2_1 */
2895
    case 0xc0:        /* SDRC_EMR3_1 */
2896
    case 0xc4:        /* SDRC_ACTIM_CTRLA_1 */
2897
    case 0xc8:        /* SDRC_ACTIM_CTRLB_1 */
2898
    case 0xd4:        /* SDRC_RFR_CTRL_1 */
2899
    case 0xd8:        /* SDRC_MANUAL_1 */
2900
        return 0x00;
2901
    }
2902

    
2903
    OMAP_BAD_REG(addr);
2904
    return 0;
2905
}
2906

    
2907
static void omap_sdrc_write(void *opaque, target_phys_addr_t addr,
2908
                uint32_t value)
2909
{
2910
    struct omap_sdrc_s *s = (struct omap_sdrc_s *) opaque;
2911

    
2912
    switch (addr) {
2913
    case 0x00:        /* SDRC_REVISION */
2914
    case 0x14:        /* SDRC_SYSSTATUS */
2915
    case 0x48:        /* SDRC_ERR_ADDR */
2916
    case 0x64:        /* SDRC_DLLA_STATUS */
2917
    case 0x6c:        /* SDRC_DLLB_STATUS */
2918
        OMAP_RO_REG(addr);
2919
        return;
2920

    
2921
    case 0x10:        /* SDRC_SYSCONFIG */
2922
        if ((value >> 3) != 0x2)
2923
            fprintf(stderr, "%s: bad SDRAM idle mode %i\n",
2924
                            __FUNCTION__, value >> 3);
2925
        if (value & 2)
2926
            omap_sdrc_reset(s);
2927
        s->config = value & 0x18;
2928
        break;
2929

    
2930
    case 0x40:        /* SDRC_CS_CFG */
2931
    case 0x44:        /* SDRC_SHARING */
2932
    case 0x4c:        /* SDRC_ERR_TYPE */
2933
    case 0x60:        /* SDRC_DLLA_SCTRL */
2934
    case 0x68:        /* SDRC_DLLB_CTRL */
2935
    case 0x70:        /* SDRC_POWER */
2936
    case 0x80:        /* SDRC_MCFG_0 */
2937
    case 0x84:        /* SDRC_MR_0 */
2938
    case 0x88:        /* SDRC_EMR1_0 */
2939
    case 0x8c:        /* SDRC_EMR2_0 */
2940
    case 0x90:        /* SDRC_EMR3_0 */
2941
    case 0x94:        /* SDRC_DCDL1_CTRL */
2942
    case 0x98:        /* SDRC_DCDL2_CTRL */
2943
    case 0x9c:        /* SDRC_ACTIM_CTRLA_0 */
2944
    case 0xa0:        /* SDRC_ACTIM_CTRLB_0 */
2945
    case 0xa4:        /* SDRC_RFR_CTRL_0 */
2946
    case 0xa8:        /* SDRC_MANUAL_0 */
2947
    case 0xb0:        /* SDRC_MCFG_1 */
2948
    case 0xb4:        /* SDRC_MR_1 */
2949
    case 0xb8:        /* SDRC_EMR1_1 */
2950
    case 0xbc:        /* SDRC_EMR2_1 */
2951
    case 0xc0:        /* SDRC_EMR3_1 */
2952
    case 0xc4:        /* SDRC_ACTIM_CTRLA_1 */
2953
    case 0xc8:        /* SDRC_ACTIM_CTRLB_1 */
2954
    case 0xd4:        /* SDRC_RFR_CTRL_1 */
2955
    case 0xd8:        /* SDRC_MANUAL_1 */
2956
        break;
2957

    
2958
    default:
2959
        OMAP_BAD_REG(addr);
2960
        return;
2961
    }
2962
}
2963

    
2964
static CPUReadMemoryFunc * const omap_sdrc_readfn[] = {
2965
    omap_badwidth_read32,
2966
    omap_badwidth_read32,
2967
    omap_sdrc_read,
2968
};
2969

    
2970
static CPUWriteMemoryFunc * const omap_sdrc_writefn[] = {
2971
    omap_badwidth_write32,
2972
    omap_badwidth_write32,
2973
    omap_sdrc_write,
2974
};
2975

    
2976
struct omap_sdrc_s *omap_sdrc_init(target_phys_addr_t base)
2977
{
2978
    int iomemtype;
2979
    struct omap_sdrc_s *s = (struct omap_sdrc_s *)
2980
            qemu_mallocz(sizeof(struct omap_sdrc_s));
2981

    
2982
    omap_sdrc_reset(s);
2983

    
2984
    iomemtype = cpu_register_io_memory(omap_sdrc_readfn,
2985
                    omap_sdrc_writefn, s);
2986
    cpu_register_physical_memory(base, 0x1000, iomemtype);
2987

    
2988
    return s;
2989
}
2990

    
2991
/* General-Purpose Memory Controller */
2992
struct omap_gpmc_s {
2993
    qemu_irq irq;
2994

    
2995
    uint8_t sysconfig;
2996
    uint16_t irqst;
2997
    uint16_t irqen;
2998
    uint16_t timeout;
2999
    uint16_t config;
3000
    uint32_t prefconfig[2];
3001
    int prefcontrol;
3002
    int preffifo;
3003
    int prefcount;
3004
    struct omap_gpmc_cs_file_s {
3005
        uint32_t config[7];
3006
        target_phys_addr_t base;
3007
        size_t size;
3008
        int iomemtype;
3009
        void (*base_update)(void *opaque, target_phys_addr_t new);
3010
        void (*unmap)(void *opaque);
3011
        void *opaque;
3012
    } cs_file[8];
3013
    int ecc_cs;
3014
    int ecc_ptr;
3015
    uint32_t ecc_cfg;
3016
    ECCState ecc[9];
3017
};
3018

    
3019
static void omap_gpmc_int_update(struct omap_gpmc_s *s)
3020
{
3021
    qemu_set_irq(s->irq, s->irqen & s->irqst);
3022
}
3023

    
3024
static void omap_gpmc_cs_map(struct omap_gpmc_cs_file_s *f, int base, int mask)
3025
{
3026
    /* TODO: check for overlapping regions and report access errors */
3027
    if ((mask != 0x8 && mask != 0xc && mask != 0xe && mask != 0xf) ||
3028
                    (base < 0 || base >= 0x40) ||
3029
                    (base & 0x0f & ~mask)) {
3030
        fprintf(stderr, "%s: wrong cs address mapping/decoding!\n",
3031
                        __FUNCTION__);
3032
        return;
3033
    }
3034

    
3035
    if (!f->opaque)
3036
        return;
3037

    
3038
    f->base = base << 24;
3039
    f->size = (0x0fffffff & ~(mask << 24)) + 1;
3040
    /* TODO: rather than setting the size of the mapping (which should be
3041
     * constant), the mask should cause wrapping of the address space, so
3042
     * that the same memory becomes accessible at every <i>size</i> bytes
3043
     * starting from <i>base</i>.  */
3044
    if (f->iomemtype)
3045
        cpu_register_physical_memory(f->base, f->size, f->iomemtype);
3046

    
3047
    if (f->base_update)
3048
        f->base_update(f->opaque, f->base);
3049
}
3050

    
3051
static void omap_gpmc_cs_unmap(struct omap_gpmc_cs_file_s *f)
3052
{
3053
    if (f->size) {
3054
        if (f->unmap)
3055
            f->unmap(f->opaque);
3056
        if (f->iomemtype)
3057
            cpu_register_physical_memory(f->base, f->size, IO_MEM_UNASSIGNED);
3058
        f->base = 0;
3059
        f->size = 0;
3060
    }
3061
}
3062

    
3063
static void omap_gpmc_reset(struct omap_gpmc_s *s)
3064
{
3065
    int i;
3066

    
3067
    s->sysconfig = 0;
3068
    s->irqst = 0;
3069
    s->irqen = 0;
3070
    omap_gpmc_int_update(s);
3071
    s->timeout = 0;
3072
    s->config = 0xa00;
3073
    s->prefconfig[0] = 0x00004000;
3074
    s->prefconfig[1] = 0x00000000;
3075
    s->prefcontrol = 0;
3076
    s->preffifo = 0;
3077
    s->prefcount = 0;
3078
    for (i = 0; i < 8; i ++) {
3079
        if (s->cs_file[i].config[6] & (1 << 6))                        /* CSVALID */
3080
            omap_gpmc_cs_unmap(s->cs_file + i);
3081
        s->cs_file[i].config[0] = i ? 1 << 12 : 0;
3082
        s->cs_file[i].config[1] = 0x101001;
3083
        s->cs_file[i].config[2] = 0x020201;
3084
        s->cs_file[i].config[3] = 0x10031003;
3085
        s->cs_file[i].config[4] = 0x10f1111;
3086
        s->cs_file[i].config[5] = 0;
3087
        s->cs_file[i].config[6] = 0xf00 | (i ? 0 : 1 << 6);
3088
        if (s->cs_file[i].config[6] & (1 << 6))                        /* CSVALID */
3089
            omap_gpmc_cs_map(&s->cs_file[i],
3090
                            s->cs_file[i].config[6] & 0x1f,        /* MASKADDR */
3091
                        (s->cs_file[i].config[6] >> 8 & 0xf));        /* BASEADDR */
3092
    }
3093
    omap_gpmc_cs_map(s->cs_file, 0, 0xf);
3094
    s->ecc_cs = 0;
3095
    s->ecc_ptr = 0;
3096
    s->ecc_cfg = 0x3fcff000;
3097
    for (i = 0; i < 9; i ++)
3098
        ecc_reset(&s->ecc[i]);
3099
}
3100

    
3101
static uint32_t omap_gpmc_read(void *opaque, target_phys_addr_t addr)
3102
{
3103
    struct omap_gpmc_s *s = (struct omap_gpmc_s *) opaque;
3104
    int cs;
3105
    struct omap_gpmc_cs_file_s *f;
3106

    
3107
    switch (addr) {
3108
    case 0x000:        /* GPMC_REVISION */
3109
        return 0x20;
3110

    
3111
    case 0x010:        /* GPMC_SYSCONFIG */
3112
        return s->sysconfig;
3113

    
3114
    case 0x014:        /* GPMC_SYSSTATUS */
3115
        return 1;                                                /* RESETDONE */
3116

    
3117
    case 0x018:        /* GPMC_IRQSTATUS */
3118
        return s->irqst;
3119

    
3120
    case 0x01c:        /* GPMC_IRQENABLE */
3121
        return s->irqen;
3122

    
3123
    case 0x040:        /* GPMC_TIMEOUT_CONTROL */
3124
        return s->timeout;
3125

    
3126
    case 0x044:        /* GPMC_ERR_ADDRESS */
3127
    case 0x048:        /* GPMC_ERR_TYPE */
3128
        return 0;
3129

    
3130
    case 0x050:        /* GPMC_CONFIG */
3131
        return s->config;
3132

    
3133
    case 0x054:        /* GPMC_STATUS */
3134
        return 0x001;
3135

    
3136
    case 0x060 ... 0x1d4:
3137
        cs = (addr - 0x060) / 0x30;
3138
        addr -= cs * 0x30;
3139
        f = s->cs_file + cs;
3140
        switch (addr) {
3141
            case 0x60:        /* GPMC_CONFIG1 */
3142
                return f->config[0];
3143
            case 0x64:        /* GPMC_CONFIG2 */
3144
                return f->config[1];
3145
            case 0x68:        /* GPMC_CONFIG3 */
3146
                return f->config[2];
3147
            case 0x6c:        /* GPMC_CONFIG4 */
3148
                return f->config[3];
3149
            case 0x70:        /* GPMC_CONFIG5 */
3150
                return f->config[4];
3151
            case 0x74:        /* GPMC_CONFIG6 */
3152
                return f->config[5];
3153
            case 0x78:        /* GPMC_CONFIG7 */
3154
                return f->config[6];
3155
            case 0x84:        /* GPMC_NAND_DATA */
3156
                return 0;
3157
        }
3158
        break;
3159

    
3160
    case 0x1e0:        /* GPMC_PREFETCH_CONFIG1 */
3161
        return s->prefconfig[0];
3162
    case 0x1e4:        /* GPMC_PREFETCH_CONFIG2 */
3163
        return s->prefconfig[1];
3164
    case 0x1ec:        /* GPMC_PREFETCH_CONTROL */
3165
        return s->prefcontrol;
3166
    case 0x1f0:        /* GPMC_PREFETCH_STATUS */
3167
        return (s->preffifo << 24) |
3168
                ((s->preffifo >
3169
                  ((s->prefconfig[0] >> 8) & 0x7f) ? 1 : 0) << 16) |
3170
                s->prefcount;
3171

    
3172
    case 0x1f4:        /* GPMC_ECC_CONFIG */
3173
        return s->ecc_cs;
3174
    case 0x1f8:        /* GPMC_ECC_CONTROL */
3175
        return s->ecc_ptr;
3176
    case 0x1fc:        /* GPMC_ECC_SIZE_CONFIG */
3177
        return s->ecc_cfg;
3178
    case 0x200 ... 0x220:        /* GPMC_ECC_RESULT */
3179
        cs = (addr & 0x1f) >> 2;
3180
        /* TODO: check correctness */
3181
        return
3182
                ((s->ecc[cs].cp    &  0x07) <<  0) |
3183
                ((s->ecc[cs].cp    &  0x38) << 13) |
3184
                ((s->ecc[cs].lp[0] & 0x1ff) <<  3) |
3185
                ((s->ecc[cs].lp[1] & 0x1ff) << 19);
3186

    
3187
    case 0x230:        /* GPMC_TESTMODE_CTRL */
3188
        return 0;
3189
    case 0x234:        /* GPMC_PSA_LSB */
3190
    case 0x238:        /* GPMC_PSA_MSB */
3191
        return 0x00000000;
3192
    }
3193

    
3194
    OMAP_BAD_REG(addr);
3195
    return 0;
3196
}
3197

    
3198
static void omap_gpmc_write(void *opaque, target_phys_addr_t addr,
3199
                uint32_t value)
3200
{
3201
    struct omap_gpmc_s *s = (struct omap_gpmc_s *) opaque;
3202
    int cs;
3203
    struct omap_gpmc_cs_file_s *f;
3204

    
3205
    switch (addr) {
3206
    case 0x000:        /* GPMC_REVISION */
3207
    case 0x014:        /* GPMC_SYSSTATUS */
3208
    case 0x054:        /* GPMC_STATUS */
3209
    case 0x1f0:        /* GPMC_PREFETCH_STATUS */
3210
    case 0x200 ... 0x220:        /* GPMC_ECC_RESULT */
3211
    case 0x234:        /* GPMC_PSA_LSB */
3212
    case 0x238:        /* GPMC_PSA_MSB */
3213
        OMAP_RO_REG(addr);
3214
        break;
3215

    
3216
    case 0x010:        /* GPMC_SYSCONFIG */
3217
        if ((value >> 3) == 0x3)
3218
            fprintf(stderr, "%s: bad SDRAM idle mode %i\n",
3219
                            __FUNCTION__, value >> 3);
3220
        if (value & 2)
3221
            omap_gpmc_reset(s);
3222
        s->sysconfig = value & 0x19;
3223
        break;
3224

    
3225
    case 0x018:        /* GPMC_IRQSTATUS */
3226
        s->irqen = ~value;
3227
        omap_gpmc_int_update(s);
3228
        break;
3229

    
3230
    case 0x01c:        /* GPMC_IRQENABLE */
3231
        s->irqen = value & 0xf03;
3232
        omap_gpmc_int_update(s);
3233
        break;
3234

    
3235
    case 0x040:        /* GPMC_TIMEOUT_CONTROL */
3236
        s->timeout = value & 0x1ff1;
3237
        break;
3238

    
3239
    case 0x044:        /* GPMC_ERR_ADDRESS */
3240
    case 0x048:        /* GPMC_ERR_TYPE */
3241
        break;
3242

    
3243
    case 0x050:        /* GPMC_CONFIG */
3244
        s->config = value & 0xf13;
3245
        break;
3246

    
3247
    case 0x060 ... 0x1d4:
3248
        cs = (addr - 0x060) / 0x30;
3249
        addr -= cs * 0x30;
3250
        f = s->cs_file + cs;
3251
        switch (addr) {
3252
            case 0x60:        /* GPMC_CONFIG1 */
3253
                f->config[0] = value & 0xffef3e13;
3254
                break;
3255
            case 0x64:        /* GPMC_CONFIG2 */
3256
                f->config[1] = value & 0x001f1f8f;
3257
                break;
3258
            case 0x68:        /* GPMC_CONFIG3 */
3259
                f->config[2] = value & 0x001f1f8f;
3260
                break;
3261
            case 0x6c:        /* GPMC_CONFIG4 */
3262
                f->config[3] = value & 0x1f8f1f8f;
3263
                break;
3264
            case 0x70:        /* GPMC_CONFIG5 */
3265
                f->config[4] = value & 0x0f1f1f1f;
3266
                break;
3267
            case 0x74:        /* GPMC_CONFIG6 */
3268
                f->config[5] = value & 0x00000fcf;
3269
                break;
3270
            case 0x78:        /* GPMC_CONFIG7 */
3271
                if ((f->config[6] ^ value) & 0xf7f) {
3272
                    if (f->config[6] & (1 << 6))                /* CSVALID */
3273
                        omap_gpmc_cs_unmap(f);
3274
                    if (value & (1 << 6))                        /* CSVALID */
3275
                        omap_gpmc_cs_map(f, value & 0x1f,        /* MASKADDR */
3276
                                        (value >> 8 & 0xf));        /* BASEADDR */
3277
                }
3278
                f->config[6] = value & 0x00000f7f;
3279
                break;
3280
            case 0x7c:        /* GPMC_NAND_COMMAND */
3281
            case 0x80:        /* GPMC_NAND_ADDRESS */
3282
            case 0x84:        /* GPMC_NAND_DATA */
3283
                break;
3284

    
3285
            default:
3286
                goto bad_reg;
3287
        }
3288
        break;
3289

    
3290
    case 0x1e0:        /* GPMC_PREFETCH_CONFIG1 */
3291
        s->prefconfig[0] = value & 0x7f8f7fbf;
3292
        /* TODO: update interrupts, fifos, dmas */
3293
        break;
3294

    
3295
    case 0x1e4:        /* GPMC_PREFETCH_CONFIG2 */
3296
        s->prefconfig[1] = value & 0x3fff;
3297
        break;
3298

    
3299
    case 0x1ec:        /* GPMC_PREFETCH_CONTROL */
3300
        s->prefcontrol = value & 1;
3301
        if (s->prefcontrol) {
3302
            if (s->prefconfig[0] & 1)
3303
                s->preffifo = 0x40;
3304
            else
3305
                s->preffifo = 0x00;
3306
        }
3307
        /* TODO: start */
3308
        break;
3309

    
3310
    case 0x1f4:        /* GPMC_ECC_CONFIG */
3311
        s->ecc_cs = 0x8f;
3312
        break;
3313
    case 0x1f8:        /* GPMC_ECC_CONTROL */
3314
        if (value & (1 << 8))
3315
            for (cs = 0; cs < 9; cs ++)
3316
                ecc_reset(&s->ecc[cs]);
3317
        s->ecc_ptr = value & 0xf;
3318
        if (s->ecc_ptr == 0 || s->ecc_ptr > 9) {
3319
            s->ecc_ptr = 0;
3320
            s->ecc_cs &= ~1;
3321
        }
3322
        break;
3323
    case 0x1fc:        /* GPMC_ECC_SIZE_CONFIG */
3324
        s->ecc_cfg = value & 0x3fcff1ff;
3325
        break;
3326
    case 0x230:        /* GPMC_TESTMODE_CTRL */
3327
        if (value & 7)
3328
            fprintf(stderr, "%s: test mode enable attempt\n", __FUNCTION__);
3329
        break;
3330

    
3331
    default:
3332
    bad_reg:
3333
        OMAP_BAD_REG(addr);
3334
        return;
3335
    }
3336
}
3337

    
3338
static CPUReadMemoryFunc * const omap_gpmc_readfn[] = {
3339
    omap_badwidth_read32,        /* TODO */
3340
    omap_badwidth_read32,        /* TODO */
3341
    omap_gpmc_read,
3342
};
3343

    
3344
static CPUWriteMemoryFunc * const omap_gpmc_writefn[] = {
3345
    omap_badwidth_write32,        /* TODO */
3346
    omap_badwidth_write32,        /* TODO */
3347
    omap_gpmc_write,
3348
};
3349

    
3350
struct omap_gpmc_s *omap_gpmc_init(target_phys_addr_t base, qemu_irq irq)
3351
{
3352
    int iomemtype;
3353
    struct omap_gpmc_s *s = (struct omap_gpmc_s *)
3354
            qemu_mallocz(sizeof(struct omap_gpmc_s));
3355

    
3356
    omap_gpmc_reset(s);
3357

    
3358
    iomemtype = cpu_register_io_memory(omap_gpmc_readfn,
3359
                    omap_gpmc_writefn, s);
3360
    cpu_register_physical_memory(base, 0x1000, iomemtype);
3361

    
3362
    return s;
3363
}
3364

    
3365
void omap_gpmc_attach(struct omap_gpmc_s *s, int cs, int iomemtype,
3366
                void (*base_upd)(void *opaque, target_phys_addr_t new),
3367
                void (*unmap)(void *opaque), void *opaque)
3368
{
3369
    struct omap_gpmc_cs_file_s *f;
3370

    
3371
    if (cs < 0 || cs >= 8) {
3372
        fprintf(stderr, "%s: bad chip-select %i\n", __FUNCTION__, cs);
3373
        exit(-1);
3374
    }
3375
    f = &s->cs_file[cs];
3376

    
3377
    f->iomemtype = iomemtype;
3378
    f->base_update = base_upd;
3379
    f->unmap = unmap;
3380
    f->opaque = opaque;
3381

    
3382
    if (f->config[6] & (1 << 6))                                /* CSVALID */
3383
        omap_gpmc_cs_map(f, f->config[6] & 0x1f,                /* MASKADDR */
3384
                        (f->config[6] >> 8 & 0xf));                /* BASEADDR */
3385
}
3386

    
3387
/* General chip reset */
3388
static void omap2_mpu_reset(void *opaque)
3389
{
3390
    struct omap_mpu_state_s *mpu = (struct omap_mpu_state_s *) opaque;
3391

    
3392
    omap_inth_reset(mpu->ih[0]);
3393
    omap_dma_reset(mpu->dma);
3394
    omap_prcm_reset(mpu->prcm);
3395
    omap_sysctl_reset(mpu->sysc);
3396
    omap_gp_timer_reset(mpu->gptimer[0]);
3397
    omap_gp_timer_reset(mpu->gptimer[1]);
3398
    omap_gp_timer_reset(mpu->gptimer[2]);
3399
    omap_gp_timer_reset(mpu->gptimer[3]);
3400
    omap_gp_timer_reset(mpu->gptimer[4]);
3401
    omap_gp_timer_reset(mpu->gptimer[5]);
3402
    omap_gp_timer_reset(mpu->gptimer[6]);
3403
    omap_gp_timer_reset(mpu->gptimer[7]);
3404
    omap_gp_timer_reset(mpu->gptimer[8]);
3405
    omap_gp_timer_reset(mpu->gptimer[9]);
3406
    omap_gp_timer_reset(mpu->gptimer[10]);
3407
    omap_gp_timer_reset(mpu->gptimer[11]);
3408
    omap_synctimer_reset(mpu->synctimer);
3409
    omap_sdrc_reset(mpu->sdrc);
3410
    omap_gpmc_reset(mpu->gpmc);
3411
    omap_dss_reset(mpu->dss);
3412
    omap_uart_reset(mpu->uart[0]);
3413
    omap_uart_reset(mpu->uart[1]);
3414
    omap_uart_reset(mpu->uart[2]);
3415
    omap_mmc_reset(mpu->mmc);
3416
    omap_gpif_reset(mpu->gpif);
3417
    omap_mcspi_reset(mpu->mcspi[0]);
3418
    omap_mcspi_reset(mpu->mcspi[1]);
3419
    omap_i2c_reset(mpu->i2c[0]);
3420
    omap_i2c_reset(mpu->i2c[1]);
3421
    cpu_reset(mpu->env);
3422
}
3423

    
3424
static int omap2_validate_addr(struct omap_mpu_state_s *s,
3425
                target_phys_addr_t addr)
3426
{
3427
    return 1;
3428
}
3429

    
3430
static const struct dma_irq_map omap2_dma_irq_map[] = {
3431
    { 0, OMAP_INT_24XX_SDMA_IRQ0 },
3432
    { 0, OMAP_INT_24XX_SDMA_IRQ1 },
3433
    { 0, OMAP_INT_24XX_SDMA_IRQ2 },
3434
    { 0, OMAP_INT_24XX_SDMA_IRQ3 },
3435
};
3436

    
3437
struct omap_mpu_state_s *omap2420_mpu_init(unsigned long sdram_size,
3438
                const char *core)
3439
{
3440
    struct omap_mpu_state_s *s = (struct omap_mpu_state_s *)
3441
            qemu_mallocz(sizeof(struct omap_mpu_state_s));
3442
    ram_addr_t sram_base, q2_base;
3443
    qemu_irq *cpu_irq;
3444
    qemu_irq dma_irqs[4];
3445
    omap_clk gpio_clks[4];
3446
    DriveInfo *dinfo;
3447
    int i;
3448

    
3449
    /* Core */
3450
    s->mpu_model = omap2420;
3451
    s->env = cpu_init(core ?: "arm1136-r2");
3452
    if (!s->env) {
3453
        fprintf(stderr, "Unable to find CPU definition\n");
3454
        exit(1);
3455
    }
3456
    s->sdram_size = sdram_size;
3457
    s->sram_size = OMAP242X_SRAM_SIZE;
3458

    
3459
    s->wakeup = qemu_allocate_irqs(omap_mpu_wakeup, s, 1)[0];
3460

    
3461
    /* Clocks */
3462
    omap_clk_init(s);
3463

    
3464
    /* Memory-mapped stuff */
3465
    cpu_register_physical_memory(OMAP2_Q2_BASE, s->sdram_size,
3466
                    (q2_base = qemu_ram_alloc(s->sdram_size)) | IO_MEM_RAM);
3467
    cpu_register_physical_memory(OMAP2_SRAM_BASE, s->sram_size,
3468
                    (sram_base = qemu_ram_alloc(s->sram_size)) | IO_MEM_RAM);
3469

    
3470
    s->l4 = omap_l4_init(OMAP2_L4_BASE, 54);
3471

    
3472
    /* Actually mapped at any 2K boundary in the ARM11 private-peripheral if */
3473
    cpu_irq = arm_pic_init_cpu(s->env);
3474
    s->ih[0] = omap2_inth_init(0x480fe000, 0x1000, 3, &s->irq[0],
3475
                    cpu_irq[ARM_PIC_CPU_IRQ], cpu_irq[ARM_PIC_CPU_FIQ],
3476
                    omap_findclk(s, "mpu_intc_fclk"),
3477
                    omap_findclk(s, "mpu_intc_iclk"));
3478

    
3479
    s->prcm = omap_prcm_init(omap_l4tao(s->l4, 3),
3480
                    s->irq[0][OMAP_INT_24XX_PRCM_MPU_IRQ], NULL, NULL, s);
3481

    
3482
    s->sysc = omap_sysctl_init(omap_l4tao(s->l4, 1),
3483
                    omap_findclk(s, "omapctrl_iclk"), s);
3484

    
3485
    for (i = 0; i < 4; i ++)
3486
        dma_irqs[i] =
3487
                s->irq[omap2_dma_irq_map[i].ih][omap2_dma_irq_map[i].intr];
3488
    s->dma = omap_dma4_init(0x48056000, dma_irqs, s, 256, 32,
3489
                    omap_findclk(s, "sdma_iclk"),
3490
                    omap_findclk(s, "sdma_fclk"));
3491
    s->port->addr_valid = omap2_validate_addr;
3492

    
3493
    /* Register SDRAM and SRAM ports for fast DMA transfers.  */
3494
    soc_dma_port_add_mem_ram(s->dma, q2_base, OMAP2_Q2_BASE, s->sdram_size);
3495
    soc_dma_port_add_mem_ram(s->dma, sram_base, OMAP2_SRAM_BASE, s->sram_size);
3496

    
3497
    s->uart[0] = omap2_uart_init(omap_l4ta(s->l4, 19),
3498
                    s->irq[0][OMAP_INT_24XX_UART1_IRQ],
3499
                    omap_findclk(s, "uart1_fclk"),
3500
                    omap_findclk(s, "uart1_iclk"),
3501
                    s->drq[OMAP24XX_DMA_UART1_TX],
3502
                    s->drq[OMAP24XX_DMA_UART1_RX], serial_hds[0]);
3503
    s->uart[1] = omap2_uart_init(omap_l4ta(s->l4, 20),
3504
                    s->irq[0][OMAP_INT_24XX_UART2_IRQ],
3505
                    omap_findclk(s, "uart2_fclk"),
3506
                    omap_findclk(s, "uart2_iclk"),
3507
                    s->drq[OMAP24XX_DMA_UART2_TX],
3508
                    s->drq[OMAP24XX_DMA_UART2_RX],
3509
                    serial_hds[0] ? serial_hds[1] : NULL);
3510
    s->uart[2] = omap2_uart_init(omap_l4ta(s->l4, 21),
3511
                    s->irq[0][OMAP_INT_24XX_UART3_IRQ],
3512
                    omap_findclk(s, "uart3_fclk"),
3513
                    omap_findclk(s, "uart3_iclk"),
3514
                    s->drq[OMAP24XX_DMA_UART3_TX],
3515
                    s->drq[OMAP24XX_DMA_UART3_RX],
3516
                    serial_hds[0] && serial_hds[1] ? serial_hds[2] : NULL);
3517

    
3518
    s->gptimer[0] = omap_gp_timer_init(omap_l4ta(s->l4, 7),
3519
                    s->irq[0][OMAP_INT_24XX_GPTIMER1],
3520
                    omap_findclk(s, "wu_gpt1_clk"),
3521
                    omap_findclk(s, "wu_l4_iclk"));
3522
    s->gptimer[1] = omap_gp_timer_init(omap_l4ta(s->l4, 8),
3523
                    s->irq[0][OMAP_INT_24XX_GPTIMER2],
3524
                    omap_findclk(s, "core_gpt2_clk"),
3525
                    omap_findclk(s, "core_l4_iclk"));
3526
    s->gptimer[2] = omap_gp_timer_init(omap_l4ta(s->l4, 22),
3527
                    s->irq[0][OMAP_INT_24XX_GPTIMER3],
3528
                    omap_findclk(s, "core_gpt3_clk"),
3529
                    omap_findclk(s, "core_l4_iclk"));
3530
    s->gptimer[3] = omap_gp_timer_init(omap_l4ta(s->l4, 23),
3531
                    s->irq[0][OMAP_INT_24XX_GPTIMER4],
3532
                    omap_findclk(s, "core_gpt4_clk"),
3533
                    omap_findclk(s, "core_l4_iclk"));
3534
    s->gptimer[4] = omap_gp_timer_init(omap_l4ta(s->l4, 24),
3535
                    s->irq[0][OMAP_INT_24XX_GPTIMER5],
3536
                    omap_findclk(s, "core_gpt5_clk"),
3537
                    omap_findclk(s, "core_l4_iclk"));
3538
    s->gptimer[5] = omap_gp_timer_init(omap_l4ta(s->l4, 25),
3539
                    s->irq[0][OMAP_INT_24XX_GPTIMER6],
3540
                    omap_findclk(s, "core_gpt6_clk"),
3541
                    omap_findclk(s, "core_l4_iclk"));
3542
    s->gptimer[6] = omap_gp_timer_init(omap_l4ta(s->l4, 26),
3543
                    s->irq[0][OMAP_INT_24XX_GPTIMER7],
3544
                    omap_findclk(s, "core_gpt7_clk"),
3545
                    omap_findclk(s, "core_l4_iclk"));
3546
    s->gptimer[7] = omap_gp_timer_init(omap_l4ta(s->l4, 27),
3547
                    s->irq[0][OMAP_INT_24XX_GPTIMER8],
3548
                    omap_findclk(s, "core_gpt8_clk"),
3549
                    omap_findclk(s, "core_l4_iclk"));
3550
    s->gptimer[8] = omap_gp_timer_init(omap_l4ta(s->l4, 28),
3551
                    s->irq[0][OMAP_INT_24XX_GPTIMER9],
3552
                    omap_findclk(s, "core_gpt9_clk"),
3553
                    omap_findclk(s, "core_l4_iclk"));
3554
    s->gptimer[9] = omap_gp_timer_init(omap_l4ta(s->l4, 29),
3555
                    s->irq[0][OMAP_INT_24XX_GPTIMER10],
3556
                    omap_findclk(s, "core_gpt10_clk"),
3557
                    omap_findclk(s, "core_l4_iclk"));
3558
    s->gptimer[10] = omap_gp_timer_init(omap_l4ta(s->l4, 30),
3559
                    s->irq[0][OMAP_INT_24XX_GPTIMER11],
3560
                    omap_findclk(s, "core_gpt11_clk"),
3561
                    omap_findclk(s, "core_l4_iclk"));
3562
    s->gptimer[11] = omap_gp_timer_init(omap_l4ta(s->l4, 31),
3563
                    s->irq[0][OMAP_INT_24XX_GPTIMER12],
3564
                    omap_findclk(s, "core_gpt12_clk"),
3565
                    omap_findclk(s, "core_l4_iclk"));
3566

    
3567
    omap_tap_init(omap_l4ta(s->l4, 2), s);
3568

    
3569
    s->synctimer = omap_synctimer_init(omap_l4tao(s->l4, 2), s,
3570
                    omap_findclk(s, "clk32-kHz"),
3571
                    omap_findclk(s, "core_l4_iclk"));
3572

    
3573
    s->i2c[0] = omap2_i2c_init(omap_l4tao(s->l4, 5),
3574
                    s->irq[0][OMAP_INT_24XX_I2C1_IRQ],
3575
                    &s->drq[OMAP24XX_DMA_I2C1_TX],
3576
                    omap_findclk(s, "i2c1.fclk"),
3577
                    omap_findclk(s, "i2c1.iclk"));
3578
    s->i2c[1] = omap2_i2c_init(omap_l4tao(s->l4, 6),
3579
                    s->irq[0][OMAP_INT_24XX_I2C2_IRQ],
3580
                    &s->drq[OMAP24XX_DMA_I2C2_TX],
3581
                    omap_findclk(s, "i2c2.fclk"),
3582
                    omap_findclk(s, "i2c2.iclk"));
3583

    
3584
    gpio_clks[0] = omap_findclk(s, "gpio1_dbclk");
3585
    gpio_clks[1] = omap_findclk(s, "gpio2_dbclk");
3586
    gpio_clks[2] = omap_findclk(s, "gpio3_dbclk");
3587
    gpio_clks[3] = omap_findclk(s, "gpio4_dbclk");
3588
    s->gpif = omap2_gpio_init(omap_l4ta(s->l4, 3),
3589
                    &s->irq[0][OMAP_INT_24XX_GPIO_BANK1],
3590
                    gpio_clks, omap_findclk(s, "gpio_iclk"), 4);
3591

    
3592
    s->sdrc = omap_sdrc_init(0x68009000);
3593
    s->gpmc = omap_gpmc_init(0x6800a000, s->irq[0][OMAP_INT_24XX_GPMC_IRQ]);
3594

    
3595
    dinfo = drive_get(IF_SD, 0, 0);
3596
    if (!dinfo) {
3597
        fprintf(stderr, "qemu: missing SecureDigital device\n");
3598
        exit(1);
3599
    }
3600
    s->mmc = omap2_mmc_init(omap_l4tao(s->l4, 9), dinfo->bdrv,
3601
                    s->irq[0][OMAP_INT_24XX_MMC_IRQ],
3602
                    &s->drq[OMAP24XX_DMA_MMC1_TX],
3603
                    omap_findclk(s, "mmc_fclk"), omap_findclk(s, "mmc_iclk"));
3604

    
3605
    s->mcspi[0] = omap_mcspi_init(omap_l4ta(s->l4, 35), 4,
3606
                    s->irq[0][OMAP_INT_24XX_MCSPI1_IRQ],
3607
                    &s->drq[OMAP24XX_DMA_SPI1_TX0],
3608
                    omap_findclk(s, "spi1_fclk"),
3609
                    omap_findclk(s, "spi1_iclk"));
3610
    s->mcspi[1] = omap_mcspi_init(omap_l4ta(s->l4, 36), 2,
3611
                    s->irq[0][OMAP_INT_24XX_MCSPI2_IRQ],
3612
                    &s->drq[OMAP24XX_DMA_SPI2_TX0],
3613
                    omap_findclk(s, "spi2_fclk"),
3614
                    omap_findclk(s, "spi2_iclk"));
3615

    
3616
    s->dss = omap_dss_init(omap_l4ta(s->l4, 10), 0x68000800,
3617
                    /* XXX wire M_IRQ_25, D_L2_IRQ_30 and I_IRQ_13 together */
3618
                    s->irq[0][OMAP_INT_24XX_DSS_IRQ], s->drq[OMAP24XX_DMA_DSS],
3619
                    omap_findclk(s, "dss_clk1"), omap_findclk(s, "dss_clk2"),
3620
                    omap_findclk(s, "dss_54m_clk"),
3621
                    omap_findclk(s, "dss_l3_iclk"),
3622
                    omap_findclk(s, "dss_l4_iclk"));
3623

    
3624
    omap_sti_init(omap_l4ta(s->l4, 18), 0x54000000,
3625
                    s->irq[0][OMAP_INT_24XX_STI], omap_findclk(s, "emul_ck"),
3626
                    serial_hds[0] && serial_hds[1] && serial_hds[2] ?
3627
                    serial_hds[3] : NULL);
3628

    
3629
    s->eac = omap_eac_init(omap_l4ta(s->l4, 32),
3630
                    s->irq[0][OMAP_INT_24XX_EAC_IRQ],
3631
                    /* Ten consecutive lines */
3632
                    &s->drq[OMAP24XX_DMA_EAC_AC_RD],
3633
                    omap_findclk(s, "func_96m_clk"),
3634
                    omap_findclk(s, "core_l4_iclk"));
3635

    
3636
    /* All register mappings (includin those not currenlty implemented):
3637
     * SystemControlMod        48000000 - 48000fff
3638
     * SystemControlL4        48001000 - 48001fff
3639
     * 32kHz Timer Mod        48004000 - 48004fff
3640
     * 32kHz Timer L4        48005000 - 48005fff
3641
     * PRCM ModA        48008000 - 480087ff
3642
     * PRCM ModB        48008800 - 48008fff
3643
     * PRCM L4                48009000 - 48009fff
3644
     * TEST-BCM Mod        48012000 - 48012fff
3645
     * TEST-BCM L4        48013000 - 48013fff
3646
     * TEST-TAP Mod        48014000 - 48014fff
3647
     * TEST-TAP L4        48015000 - 48015fff
3648
     * GPIO1 Mod        48018000 - 48018fff
3649
     * GPIO Top                48019000 - 48019fff
3650
     * GPIO2 Mod        4801a000 - 4801afff
3651
     * GPIO L4                4801b000 - 4801bfff
3652
     * GPIO3 Mod        4801c000 - 4801cfff
3653
     * GPIO4 Mod        4801e000 - 4801efff
3654
     * WDTIMER1 Mod        48020000 - 48010fff
3655
     * WDTIMER Top        48021000 - 48011fff
3656
     * WDTIMER2 Mod        48022000 - 48012fff
3657
     * WDTIMER L4        48023000 - 48013fff
3658
     * WDTIMER3 Mod        48024000 - 48014fff
3659
     * WDTIMER3 L4        48025000 - 48015fff
3660
     * WDTIMER4 Mod        48026000 - 48016fff
3661
     * WDTIMER4 L4        48027000 - 48017fff
3662
     * GPTIMER1 Mod        48028000 - 48018fff
3663
     * GPTIMER1 L4        48029000 - 48019fff
3664
     * GPTIMER2 Mod        4802a000 - 4801afff
3665
     * GPTIMER2 L4        4802b000 - 4801bfff
3666
     * L4-Config AP        48040000 - 480407ff
3667
     * L4-Config IP        48040800 - 48040fff
3668
     * L4-Config LA        48041000 - 48041fff
3669
     * ARM11ETB Mod        48048000 - 48049fff
3670
     * ARM11ETB L4        4804a000 - 4804afff
3671
     * DISPLAY Top        48050000 - 480503ff
3672
     * DISPLAY DISPC        48050400 - 480507ff
3673
     * DISPLAY RFBI        48050800 - 48050bff
3674
     * DISPLAY VENC        48050c00 - 48050fff
3675
     * DISPLAY L4        48051000 - 48051fff
3676
     * CAMERA Top        48052000 - 480523ff
3677
     * CAMERA core        48052400 - 480527ff
3678
     * CAMERA DMA        48052800 - 48052bff
3679
     * CAMERA MMU        48052c00 - 48052fff
3680
     * CAMERA L4        48053000 - 48053fff
3681
     * SDMA Mod                48056000 - 48056fff
3682
     * SDMA L4                48057000 - 48057fff
3683
     * SSI Top                48058000 - 48058fff
3684
     * SSI GDD                48059000 - 48059fff
3685
     * SSI Port1        4805a000 - 4805afff
3686
     * SSI Port2        4805b000 - 4805bfff
3687
     * SSI L4                4805c000 - 4805cfff
3688
     * USB Mod                4805e000 - 480fefff
3689
     * USB L4                4805f000 - 480fffff
3690
     * WIN_TRACER1 Mod        48060000 - 48060fff
3691
     * WIN_TRACER1 L4        48061000 - 48061fff
3692
     * WIN_TRACER2 Mod        48062000 - 48062fff
3693
     * WIN_TRACER2 L4        48063000 - 48063fff
3694
     * WIN_TRACER3 Mod        48064000 - 48064fff
3695
     * WIN_TRACER3 L4        48065000 - 48065fff
3696
     * WIN_TRACER4 Top        48066000 - 480660ff
3697
     * WIN_TRACER4 ETT        48066100 - 480661ff
3698
     * WIN_TRACER4 WT        48066200 - 480662ff
3699
     * WIN_TRACER4 L4        48067000 - 48067fff
3700
     * XTI Mod                48068000 - 48068fff
3701
     * XTI L4                48069000 - 48069fff
3702
     * UART1 Mod        4806a000 - 4806afff
3703
     * UART1 L4                4806b000 - 4806bfff
3704
     * UART2 Mod        4806c000 - 4806cfff
3705
     * UART2 L4                4806d000 - 4806dfff
3706
     * UART3 Mod        4806e000 - 4806efff
3707
     * UART3 L4                4806f000 - 4806ffff
3708
     * I2C1 Mod                48070000 - 48070fff
3709
     * I2C1 L4                48071000 - 48071fff
3710
     * I2C2 Mod                48072000 - 48072fff
3711
     * I2C2 L4                48073000 - 48073fff
3712
     * McBSP1 Mod        48074000 - 48074fff
3713
     * McBSP1 L4        48075000 - 48075fff
3714
     * McBSP2 Mod        48076000 - 48076fff
3715
     * McBSP2 L4        48077000 - 48077fff
3716
     * GPTIMER3 Mod        48078000 - 48078fff
3717
     * GPTIMER3 L4        48079000 - 48079fff
3718
     * GPTIMER4 Mod        4807a000 - 4807afff
3719
     * GPTIMER4 L4        4807b000 - 4807bfff
3720
     * GPTIMER5 Mod        4807c000 - 4807cfff
3721
     * GPTIMER5 L4        4807d000 - 4807dfff
3722
     * GPTIMER6 Mod        4807e000 - 4807efff
3723
     * GPTIMER6 L4        4807f000 - 4807ffff
3724
     * GPTIMER7 Mod        48080000 - 48080fff
3725
     * GPTIMER7 L4        48081000 - 48081fff
3726
     * GPTIMER8 Mod        48082000 - 48082fff
3727
     * GPTIMER8 L4        48083000 - 48083fff
3728
     * GPTIMER9 Mod        48084000 - 48084fff
3729
     * GPTIMER9 L4        48085000 - 48085fff
3730
     * GPTIMER10 Mod        48086000 - 48086fff
3731
     * GPTIMER10 L4        48087000 - 48087fff
3732
     * GPTIMER11 Mod        48088000 - 48088fff
3733
     * GPTIMER11 L4        48089000 - 48089fff
3734
     * GPTIMER12 Mod        4808a000 - 4808afff
3735
     * GPTIMER12 L4        4808b000 - 4808bfff
3736
     * EAC Mod                48090000 - 48090fff
3737
     * EAC L4                48091000 - 48091fff
3738
     * FAC Mod                48092000 - 48092fff
3739
     * FAC L4                48093000 - 48093fff
3740
     * MAILBOX Mod        48094000 - 48094fff
3741
     * MAILBOX L4        48095000 - 48095fff
3742
     * SPI1 Mod                48098000 - 48098fff
3743
     * SPI1 L4                48099000 - 48099fff
3744
     * SPI2 Mod                4809a000 - 4809afff
3745
     * SPI2 L4                4809b000 - 4809bfff
3746
     * MMC/SDIO Mod        4809c000 - 4809cfff
3747
     * MMC/SDIO L4        4809d000 - 4809dfff
3748
     * MS_PRO Mod        4809e000 - 4809efff
3749
     * MS_PRO L4        4809f000 - 4809ffff
3750
     * RNG Mod                480a0000 - 480a0fff
3751
     * RNG L4                480a1000 - 480a1fff
3752
     * DES3DES Mod        480a2000 - 480a2fff
3753
     * DES3DES L4        480a3000 - 480a3fff
3754
     * SHA1MD5 Mod        480a4000 - 480a4fff
3755
     * SHA1MD5 L4        480a5000 - 480a5fff
3756
     * AES Mod                480a6000 - 480a6fff
3757
     * AES L4                480a7000 - 480a7fff
3758
     * PKA Mod                480a8000 - 480a9fff
3759
     * PKA L4                480aa000 - 480aafff
3760
     * MG Mod                480b0000 - 480b0fff
3761
     * MG L4                480b1000 - 480b1fff
3762
     * HDQ/1-wire Mod        480b2000 - 480b2fff
3763
     * HDQ/1-wire L4        480b3000 - 480b3fff
3764
     * MPU interrupt        480fe000 - 480fefff
3765
     * STI channel base        54000000 - 5400ffff
3766
     * IVA RAM                5c000000 - 5c01ffff
3767
     * IVA ROM                5c020000 - 5c027fff
3768
     * IMG_BUF_A        5c040000 - 5c040fff
3769
     * IMG_BUF_B        5c042000 - 5c042fff
3770
     * VLCDS                5c048000 - 5c0487ff
3771
     * IMX_COEF                5c049000 - 5c04afff
3772
     * IMX_CMD                5c051000 - 5c051fff
3773
     * VLCDQ                5c053000 - 5c0533ff
3774
     * VLCDH                5c054000 - 5c054fff
3775
     * SEQ_CMD                5c055000 - 5c055fff
3776
     * IMX_REG                5c056000 - 5c0560ff
3777
     * VLCD_REG                5c056100 - 5c0561ff
3778
     * SEQ_REG                5c056200 - 5c0562ff
3779
     * IMG_BUF_REG        5c056300 - 5c0563ff
3780
     * SEQIRQ_REG        5c056400 - 5c0564ff
3781
     * OCP_REG                5c060000 - 5c060fff
3782
     * SYSC_REG                5c070000 - 5c070fff
3783
     * MMU_REG                5d000000 - 5d000fff
3784
     * sDMA R                68000400 - 680005ff
3785
     * sDMA W                68000600 - 680007ff
3786
     * Display Control        68000800 - 680009ff
3787
     * DSP subsystem        68000a00 - 68000bff
3788
     * MPU subsystem        68000c00 - 68000dff
3789
     * IVA subsystem        68001000 - 680011ff
3790
     * USB                68001200 - 680013ff
3791
     * Camera                68001400 - 680015ff
3792
     * VLYNQ (firewall)        68001800 - 68001bff
3793
     * VLYNQ                68001e00 - 68001fff
3794
     * SSI                68002000 - 680021ff
3795
     * L4                68002400 - 680025ff
3796
     * DSP (firewall)        68002800 - 68002bff
3797
     * DSP subsystem        68002e00 - 68002fff
3798
     * IVA (firewall)        68003000 - 680033ff
3799
     * IVA                68003600 - 680037ff
3800
     * GFX                68003a00 - 68003bff
3801
     * CMDWR emulation        68003c00 - 68003dff
3802
     * SMS                68004000 - 680041ff
3803
     * OCM                68004200 - 680043ff
3804
     * GPMC                68004400 - 680045ff
3805
     * RAM (firewall)        68005000 - 680053ff
3806
     * RAM (err login)        68005400 - 680057ff
3807
     * ROM (firewall)        68005800 - 68005bff
3808
     * ROM (err login)        68005c00 - 68005fff
3809
     * GPMC (firewall)        68006000 - 680063ff
3810
     * GPMC (err login)        68006400 - 680067ff
3811
     * SMS (err login)        68006c00 - 68006fff
3812
     * SMS registers        68008000 - 68008fff
3813
     * SDRC registers        68009000 - 68009fff
3814
     * GPMC registers        6800a000   6800afff
3815
     */
3816

    
3817
    qemu_register_reset(omap2_mpu_reset, s);
3818

    
3819
    return s;
3820
}