Statistics
| Branch: | Revision:

root / hw / omap2.c @ 7e7c5e4c

History | View | Annotate | Download (114.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
18
 * along with this program; if not, write to the Free Software
19
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
20
 * MA 02111-1307 USA
21
 */
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

    
30
/* GP timers */
31
struct omap_gp_timer_s {
32
    qemu_irq irq;
33
    qemu_irq wkup;
34
    qemu_irq in;
35
    qemu_irq out;
36
    omap_clk clk;
37
    target_phys_addr_t base;
38
    QEMUTimer *timer;
39
    QEMUTimer *match;
40
    struct omap_target_agent_s *ta;
41

    
42
    int in_val;
43
    int out_val;
44
    int64_t time;
45
    int64_t rate;
46
    int64_t ticks_per_sec;
47

    
48
    int16_t config;
49
    int status;
50
    int it_ena;
51
    int wu_ena;
52
    int enable;
53
    int inout;
54
    int capt2;
55
    int pt;
56
    enum {
57
        gpt_trigger_none, gpt_trigger_overflow, gpt_trigger_both
58
    } trigger;
59
    enum {
60
        gpt_capture_none, gpt_capture_rising,
61
        gpt_capture_falling, gpt_capture_both
62
    } capture;
63
    int scpwm;
64
    int ce;
65
    int pre;
66
    int ptv;
67
    int ar;
68
    int st;
69
    int posted;
70
    uint32_t val;
71
    uint32_t load_val;
72
    uint32_t capture_val[2];
73
    uint32_t match_val;
74
    int capt_num;
75

    
76
    uint16_t writeh;        /* LSB */
77
    uint16_t readh;        /* MSB */
78
};
79

    
80
#define GPT_TCAR_IT        (1 << 2)
81
#define GPT_OVF_IT        (1 << 1)
82
#define GPT_MAT_IT        (1 << 0)
83

    
84
static inline void omap_gp_timer_intr(struct omap_gp_timer_s *timer, int it)
85
{
86
    if (timer->it_ena & it) {
87
        if (!timer->status)
88
            qemu_irq_raise(timer->irq);
89

    
90
        timer->status |= it;
91
        /* Or are the status bits set even when masked?
92
         * i.e. is masking applied before or after the status register?  */
93
    }
94

    
95
    if (timer->wu_ena & it)
96
        qemu_irq_pulse(timer->wkup);
97
}
98

    
99
static inline void omap_gp_timer_out(struct omap_gp_timer_s *timer, int level)
100
{
101
    if (!timer->inout && timer->out_val != level) {
102
        timer->out_val = level;
103
        qemu_set_irq(timer->out, level);
104
    }
105
}
106

    
107
static inline uint32_t omap_gp_timer_read(struct omap_gp_timer_s *timer)
108
{
109
    uint64_t distance;
110

    
111
    if (timer->st && timer->rate) {
112
        distance = qemu_get_clock(vm_clock) - timer->time;
113
        distance = muldiv64(distance, timer->rate, timer->ticks_per_sec);
114

    
115
        if (distance >= 0xffffffff - timer->val)
116
            return 0xffffffff;
117
        else
118
            return timer->val + distance;
119
    } else
120
        return timer->val;
121
}
122

    
123
static inline void omap_gp_timer_sync(struct omap_gp_timer_s *timer)
124
{
125
    if (timer->st) {
126
        timer->val = omap_gp_timer_read(timer);
127
        timer->time = qemu_get_clock(vm_clock);
128
    }
129
}
130

    
131
static inline void omap_gp_timer_update(struct omap_gp_timer_s *timer)
132
{
133
    int64_t expires, matches;
134

    
135
    if (timer->st && timer->rate) {
136
        expires = muldiv64(0x100000000ll - timer->val,
137
                        timer->ticks_per_sec, timer->rate);
138
        qemu_mod_timer(timer->timer, timer->time + expires);
139

    
140
        if (timer->ce && timer->match_val >= timer->val) {
141
            matches = muldiv64(timer->match_val - timer->val,
142
                            timer->ticks_per_sec, timer->rate);
143
            qemu_mod_timer(timer->match, timer->time + matches);
144
        } else
145
            qemu_del_timer(timer->match);
146
    } else {
147
        qemu_del_timer(timer->timer);
148
        qemu_del_timer(timer->match);
149
        omap_gp_timer_out(timer, timer->scpwm);
150
    }
151
}
152

    
153
static inline void omap_gp_timer_trigger(struct omap_gp_timer_s *timer)
154
{
155
    if (timer->pt)
156
        /* TODO in overflow-and-match mode if the first event to
157
         * occurs is the match, don't toggle.  */
158
        omap_gp_timer_out(timer, !timer->out_val);
159
    else
160
        /* TODO inverted pulse on timer->out_val == 1?  */
161
        qemu_irq_pulse(timer->out);
162
}
163

    
164
static void omap_gp_timer_tick(void *opaque)
165
{
166
    struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;
167

    
168
    if (!timer->ar) {
169
        timer->st = 0;
170
        timer->val = 0;
171
    } else {
172
        timer->val = timer->load_val;
173
        timer->time = qemu_get_clock(vm_clock);
174
    }
175

    
176
    if (timer->trigger == gpt_trigger_overflow ||
177
                    timer->trigger == gpt_trigger_both)
178
        omap_gp_timer_trigger(timer);
179

    
180
    omap_gp_timer_intr(timer, GPT_OVF_IT);
181
    omap_gp_timer_update(timer);
182
}
183

    
184
static void omap_gp_timer_match(void *opaque)
185
{
186
    struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;
187

    
188
    if (timer->trigger == gpt_trigger_both)
189
        omap_gp_timer_trigger(timer);
190

    
191
    omap_gp_timer_intr(timer, GPT_MAT_IT);
192
}
193

    
194
static void omap_gp_timer_input(void *opaque, int line, int on)
195
{
196
    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
197
    int trigger;
198

    
199
    switch (s->capture) {
200
    default:
201
    case gpt_capture_none:
202
        trigger = 0;
203
        break;
204
    case gpt_capture_rising:
205
        trigger = !s->in_val && on;
206
        break;
207
    case gpt_capture_falling:
208
        trigger = s->in_val && !on;
209
        break;
210
    case gpt_capture_both:
211
        trigger = (s->in_val == !on);
212
        break;
213
    }
214
    s->in_val = on;
215

    
216
    if (s->inout && trigger && s->capt_num < 2) {
217
        s->capture_val[s->capt_num] = omap_gp_timer_read(s);
218

    
219
        if (s->capt2 == s->capt_num ++)
220
            omap_gp_timer_intr(s, GPT_TCAR_IT);
221
    }
222
}
223

    
224
static void omap_gp_timer_clk_update(void *opaque, int line, int on)
225
{
226
    struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;
227

    
228
    omap_gp_timer_sync(timer);
229
    timer->rate = on ? omap_clk_getrate(timer->clk) : 0;
230
    omap_gp_timer_update(timer);
231
}
232

    
233
static void omap_gp_timer_clk_setup(struct omap_gp_timer_s *timer)
234
{
235
    omap_clk_adduser(timer->clk,
236
                    qemu_allocate_irqs(omap_gp_timer_clk_update, timer, 1)[0]);
237
    timer->rate = omap_clk_getrate(timer->clk);
238
}
239

    
240
static void omap_gp_timer_reset(struct omap_gp_timer_s *s)
241
{
242
    s->config = 0x000;
243
    s->status = 0;
244
    s->it_ena = 0;
245
    s->wu_ena = 0;
246
    s->inout = 0;
247
    s->capt2 = 0;
248
    s->capt_num = 0;
249
    s->pt = 0;
250
    s->trigger = gpt_trigger_none;
251
    s->capture = gpt_capture_none;
252
    s->scpwm = 0;
253
    s->ce = 0;
254
    s->pre = 0;
255
    s->ptv = 0;
256
    s->ar = 0;
257
    s->st = 0;
258
    s->posted = 1;
259
    s->val = 0x00000000;
260
    s->load_val = 0x00000000;
261
    s->capture_val[0] = 0x00000000;
262
    s->capture_val[1] = 0x00000000;
263
    s->match_val = 0x00000000;
264
    omap_gp_timer_update(s);
265
}
266

    
267
static uint32_t omap_gp_timer_readw(void *opaque, target_phys_addr_t addr)
268
{
269
    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
270
    int offset = addr - s->base;
271

    
272
    switch (offset) {
273
    case 0x00:        /* TIDR */
274
        return 0x21;
275

    
276
    case 0x10:        /* TIOCP_CFG */
277
        return s->config;
278

    
279
    case 0x14:        /* TISTAT */
280
        /* ??? When's this bit reset? */
281
        return 1;                                                /* RESETDONE */
282

    
283
    case 0x18:        /* TISR */
284
        return s->status;
285

    
286
    case 0x1c:        /* TIER */
287
        return s->it_ena;
288

    
289
    case 0x20:        /* TWER */
290
        return s->wu_ena;
291

    
292
    case 0x24:        /* TCLR */
293
        return (s->inout << 14) |
294
                (s->capt2 << 13) |
295
                (s->pt << 12) |
296
                (s->trigger << 10) |
297
                (s->capture << 8) |
298
                (s->scpwm << 7) |
299
                (s->ce << 6) |
300
                (s->pre << 5) |
301
                (s->ptv << 2) |
302
                (s->ar << 1) |
303
                (s->st << 0);
304

    
305
    case 0x28:        /* TCRR */
306
        return omap_gp_timer_read(s);
307

    
308
    case 0x2c:        /* TLDR */
309
        return s->load_val;
310

    
311
    case 0x30:        /* TTGR */
312
        return 0xffffffff;
313

    
314
    case 0x34:        /* TWPS */
315
        return 0x00000000;        /* No posted writes pending.  */
316

    
317
    case 0x38:        /* TMAR */
318
        return s->match_val;
319

    
320
    case 0x3c:        /* TCAR1 */
321
        return s->capture_val[0];
322

    
323
    case 0x40:        /* TSICR */
324
        return s->posted << 2;
325

    
326
    case 0x44:        /* TCAR2 */
327
        return s->capture_val[1];
328
    }
329

    
330
    OMAP_BAD_REG(addr);
331
    return 0;
332
}
333

    
334
static uint32_t omap_gp_timer_readh(void *opaque, target_phys_addr_t addr)
335
{
336
    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
337
    uint32_t ret;
338

    
339
    if (addr & 2)
340
        return s->readh;
341
    else {
342
        ret = omap_gp_timer_readw(opaque, addr);
343
        s->readh = ret >> 16;
344
        return ret & 0xffff;
345
    }
346
}
347

    
348
static CPUReadMemoryFunc *omap_gp_timer_readfn[] = {
349
    omap_badwidth_read32,
350
    omap_gp_timer_readh,
351
    omap_gp_timer_readw,
352
};
353

    
354
static void omap_gp_timer_write(void *opaque, target_phys_addr_t addr,
355
                uint32_t value)
356
{
357
    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
358
    int offset = addr - s->base;
359

    
360
    switch (offset) {
361
    case 0x00:        /* TIDR */
362
    case 0x14:        /* TISTAT */
363
    case 0x34:        /* TWPS */
364
    case 0x3c:        /* TCAR1 */
365
    case 0x44:        /* TCAR2 */
366
        OMAP_RO_REG(addr);
367
        break;
368

    
369
    case 0x10:        /* TIOCP_CFG */
370
        s->config = value & 0x33d;
371
        if (((value >> 3) & 3) == 3)                                /* IDLEMODE */
372
            fprintf(stderr, "%s: illegal IDLEMODE value in TIOCP_CFG\n",
373
                            __FUNCTION__);
374
        if (value & 2)                                                /* SOFTRESET */
375
            omap_gp_timer_reset(s);
376
        break;
377

    
378
    case 0x18:        /* TISR */
379
        if (value & GPT_TCAR_IT)
380
            s->capt_num = 0;
381
        if (s->status && !(s->status &= ~value))
382
            qemu_irq_lower(s->irq);
383
        break;
384

    
385
    case 0x1c:        /* TIER */
386
        s->it_ena = value & 7;
387
        break;
388

    
389
    case 0x20:        /* TWER */
390
        s->wu_ena = value & 7;
391
        break;
392

    
393
    case 0x24:        /* TCLR */
394
        omap_gp_timer_sync(s);
395
        s->inout = (value >> 14) & 1;
396
        s->capt2 = (value >> 13) & 1;
397
        s->pt = (value >> 12) & 1;
398
        s->trigger = (value >> 10) & 3;
399
        if (s->capture == gpt_capture_none &&
400
                        ((value >> 8) & 3) != gpt_capture_none)
401
            s->capt_num = 0;
402
        s->capture = (value >> 8) & 3;
403
        s->scpwm = (value >> 7) & 1;
404
        s->ce = (value >> 6) & 1;
405
        s->pre = (value >> 5) & 1;
406
        s->ptv = (value >> 2) & 7;
407
        s->ar = (value >> 1) & 1;
408
        s->st = (value >> 0) & 1;
409
        if (s->inout && s->trigger != gpt_trigger_none)
410
            fprintf(stderr, "%s: GP timer pin must be an output "
411
                            "for this trigger mode\n", __FUNCTION__);
412
        if (!s->inout && s->capture != gpt_capture_none)
413
            fprintf(stderr, "%s: GP timer pin must be an input "
414
                            "for this capture mode\n", __FUNCTION__);
415
        if (s->trigger == gpt_trigger_none)
416
            omap_gp_timer_out(s, s->scpwm);
417
        /* TODO: make sure this doesn't overflow 32-bits */
418
        s->ticks_per_sec = ticks_per_sec << (s->pre ? s->ptv + 1 : 0);
419
        omap_gp_timer_update(s);
420
        break;
421

    
422
    case 0x28:        /* TCRR */
423
        s->time = qemu_get_clock(vm_clock);
424
        s->val = value;
425
        omap_gp_timer_update(s);
426
        break;
427

    
428
    case 0x2c:        /* TLDR */
429
        s->load_val = value;
430
        break;
431

    
432
    case 0x30:        /* TTGR */
433
        s->time = qemu_get_clock(vm_clock);
434
        s->val = s->load_val;
435
        omap_gp_timer_update(s);
436
        break;
437

    
438
    case 0x38:        /* TMAR */
439
        omap_gp_timer_sync(s);
440
        s->match_val = value;
441
        omap_gp_timer_update(s);
442
        break;
443

    
444
    case 0x40:        /* TSICR */
445
        s->posted = (value >> 2) & 1;
446
        if (value & 2)        /* How much exactly are we supposed to reset? */
447
            omap_gp_timer_reset(s);
448
        break;
449

    
450
    default:
451
        OMAP_BAD_REG(addr);
452
    }
453
}
454

    
455
static void omap_gp_timer_writeh(void *opaque, target_phys_addr_t addr,
456
                uint32_t value)
457
{
458
    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
459

    
460
    if (addr & 2)
461
        return omap_gp_timer_write(opaque, addr, (value << 16) | s->writeh);
462
    else
463
        s->writeh = (uint16_t) value;
464
}
465

    
466
static CPUWriteMemoryFunc *omap_gp_timer_writefn[] = {
467
    omap_badwidth_write32,
468
    omap_gp_timer_writeh,
469
    omap_gp_timer_write,
470
};
471

    
472
struct omap_gp_timer_s *omap_gp_timer_init(struct omap_target_agent_s *ta,
473
                qemu_irq irq, omap_clk fclk, omap_clk iclk)
474
{
475
    int iomemtype;
476
    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *)
477
            qemu_mallocz(sizeof(struct omap_gp_timer_s));
478

    
479
    s->ta = ta;
480
    s->irq = irq;
481
    s->clk = fclk;
482
    s->timer = qemu_new_timer(vm_clock, omap_gp_timer_tick, s);
483
    s->match = qemu_new_timer(vm_clock, omap_gp_timer_match, s);
484
    s->in = qemu_allocate_irqs(omap_gp_timer_input, s, 1)[0];
485
    omap_gp_timer_reset(s);
486
    omap_gp_timer_clk_setup(s);
487

    
488
    iomemtype = cpu_register_io_memory(0, omap_gp_timer_readfn,
489
                    omap_gp_timer_writefn, s);
490
    s->base = omap_l4_attach(ta, 0, iomemtype);
491

    
492
    return s;
493
}
494

    
495
/* 32-kHz Sync Timer of the OMAP2 */
496
static uint32_t omap_synctimer_read(struct omap_synctimer_s *s) {
497
    return muldiv64(qemu_get_clock(vm_clock), 0x8000, ticks_per_sec);
498
}
499

    
500
static void omap_synctimer_reset(struct omap_synctimer_s *s)
501
{
502
    s->val = omap_synctimer_read(s);
503
}
504

    
505
static uint32_t omap_synctimer_readw(void *opaque, target_phys_addr_t addr)
506
{
507
    struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;
508
    int offset = addr - s->base;
509

    
510
    switch (offset) {
511
    case 0x00:        /* 32KSYNCNT_REV */
512
        return 0x21;
513

    
514
    case 0x10:        /* CR */
515
        return omap_synctimer_read(s) - s->val;
516
    }
517

    
518
    OMAP_BAD_REG(addr);
519
    return 0;
520
}
521

    
522
static uint32_t omap_synctimer_readh(void *opaque, target_phys_addr_t addr)
523
{
524
    struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;
525
    uint32_t ret;
526

    
527
    if (addr & 2)
528
        return s->readh;
529
    else {
530
        ret = omap_synctimer_readw(opaque, addr);
531
        s->readh = ret >> 16;
532
        return ret & 0xffff;
533
    }
534
}
535

    
536
static CPUReadMemoryFunc *omap_synctimer_readfn[] = {
537
    omap_badwidth_read32,
538
    omap_synctimer_readh,
539
    omap_synctimer_readw,
540
};
541

    
542
static void omap_synctimer_write(void *opaque, target_phys_addr_t addr,
543
                uint32_t value)
544
{
545
    OMAP_BAD_REG(addr);
546
}
547

    
548
static CPUWriteMemoryFunc *omap_synctimer_writefn[] = {
549
    omap_badwidth_write32,
550
    omap_synctimer_write,
551
    omap_synctimer_write,
552
};
553

    
554
void omap_synctimer_init(struct omap_target_agent_s *ta,
555
                struct omap_mpu_state_s *mpu, omap_clk fclk, omap_clk iclk)
556
{
557
    struct omap_synctimer_s *s = &mpu->synctimer;
558

    
559
    omap_synctimer_reset(s);
560
    s->base = omap_l4_attach(ta, 0, cpu_register_io_memory(0,
561
                            omap_synctimer_readfn, omap_synctimer_writefn, s));
562
}
563

    
564
/* General-Purpose Interface of OMAP2 */
565
struct omap2_gpio_s {
566
    target_phys_addr_t base;
567
    qemu_irq irq[2];
568
    qemu_irq wkup;
569
    qemu_irq *in;
570
    qemu_irq handler[32];
571

    
572
    uint8_t config[2];
573
    uint32_t inputs;
574
    uint32_t outputs;
575
    uint32_t dir;
576
    uint32_t level[2];
577
    uint32_t edge[2];
578
    uint32_t mask[2];
579
    uint32_t wumask;
580
    uint32_t ints[2];
581
    uint32_t debounce;
582
    uint8_t delay;
583
};
584

    
585
static inline void omap_gpio_module_int_update(struct omap2_gpio_s *s,
586
                int line)
587
{
588
    qemu_set_irq(s->irq[line], s->ints[line] & s->mask[line]);
589
}
590

    
591
static void omap_gpio_module_wake(struct omap2_gpio_s *s, int line)
592
{
593
    if (!(s->config[0] & (1 << 2)))                        /* ENAWAKEUP */
594
        return;
595
    if (!(s->config[0] & (3 << 3)))                        /* Force Idle */
596
        return;
597
    if (!(s->wumask & (1 << line)))
598
        return;
599

    
600
    qemu_irq_raise(s->wkup);
601
}
602

    
603
static inline void omap_gpio_module_out_update(struct omap2_gpio_s *s,
604
                uint32_t diff)
605
{
606
    int ln;
607

    
608
    s->outputs ^= diff;
609
    diff &= ~s->dir;
610
    while ((ln = ffs(diff))) {
611
        ln --;
612
        qemu_set_irq(s->handler[ln], (s->outputs >> ln) & 1);
613
        diff &= ~(1 << ln);
614
    }
615
}
616

    
617
static void omap_gpio_module_level_update(struct omap2_gpio_s *s, int line)
618
{
619
    s->ints[line] |= s->dir &
620
            ((s->inputs & s->level[1]) | (~s->inputs & s->level[0]));
621
    omap_gpio_module_int_update(s, line);
622
}
623

    
624
static inline void omap_gpio_module_int(struct omap2_gpio_s *s, int line)
625
{
626
    s->ints[0] |= 1 << line;
627
    omap_gpio_module_int_update(s, 0);
628
    s->ints[1] |= 1 << line;
629
    omap_gpio_module_int_update(s, 1);
630
    omap_gpio_module_wake(s, line);
631
}
632

    
633
static void omap_gpio_module_set(void *opaque, int line, int level)
634
{
635
    struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
636

    
637
    if (level) {
638
        if (s->dir & (1 << line) & ((~s->inputs & s->edge[0]) | s->level[1]))
639
            omap_gpio_module_int(s, line);
640
        s->inputs |= 1 << line;
641
    } else {
642
        if (s->dir & (1 << line) & ((s->inputs & s->edge[1]) | s->level[0]))
643
            omap_gpio_module_int(s, line);
644
        s->inputs &= ~(1 << line);
645
    }
646
}
647

    
648
static void omap_gpio_module_reset(struct omap2_gpio_s *s)
649
{
650
    s->config[0] = 0;
651
    s->config[1] = 2;
652
    s->ints[0] = 0;
653
    s->ints[1] = 0;
654
    s->mask[0] = 0;
655
    s->mask[1] = 0;
656
    s->wumask = 0;
657
    s->dir = ~0;
658
    s->level[0] = 0;
659
    s->level[1] = 0;
660
    s->edge[0] = 0;
661
    s->edge[1] = 0;
662
    s->debounce = 0;
663
    s->delay = 0;
664
}
665

    
666
static uint32_t omap_gpio_module_read(void *opaque, target_phys_addr_t addr)
667
{
668
    struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
669
    int offset = addr - s->base;
670

    
671
    switch (offset) {
672
    case 0x00:        /* GPIO_REVISION */
673
        return 0x18;
674

    
675
    case 0x10:        /* GPIO_SYSCONFIG */
676
        return s->config[0];
677

    
678
    case 0x14:        /* GPIO_SYSSTATUS */
679
        return 0x01;
680

    
681
    case 0x18:        /* GPIO_IRQSTATUS1 */
682
        return s->ints[0];
683

    
684
    case 0x1c:        /* GPIO_IRQENABLE1 */
685
    case 0x60:        /* GPIO_CLEARIRQENABLE1 */
686
    case 0x64:        /* GPIO_SETIRQENABLE1 */
687
        return s->mask[0];
688

    
689
    case 0x20:        /* GPIO_WAKEUPENABLE */
690
    case 0x80:        /* GPIO_CLEARWKUENA */
691
    case 0x84:        /* GPIO_SETWKUENA */
692
        return s->wumask;
693

    
694
    case 0x28:        /* GPIO_IRQSTATUS2 */
695
        return s->ints[1];
696

    
697
    case 0x2c:        /* GPIO_IRQENABLE2 */
698
    case 0x70:        /* GPIO_CLEARIRQENABLE2 */
699
    case 0x74:        /* GPIO_SETIREQNEABLE2 */
700
        return s->mask[1];
701

    
702
    case 0x30:        /* GPIO_CTRL */
703
        return s->config[1];
704

    
705
    case 0x34:        /* GPIO_OE */
706
        return s->dir;
707

    
708
    case 0x38:        /* GPIO_DATAIN */
709
        return s->inputs;
710

    
711
    case 0x3c:        /* GPIO_DATAOUT */
712
    case 0x90:        /* GPIO_CLEARDATAOUT */
713
    case 0x94:        /* GPIO_SETDATAOUT */
714
        return s->outputs;
715

    
716
    case 0x40:        /* GPIO_LEVELDETECT0 */
717
        return s->level[0];
718

    
719
    case 0x44:        /* GPIO_LEVELDETECT1 */
720
        return s->level[1];
721

    
722
    case 0x48:        /* GPIO_RISINGDETECT */
723
        return s->edge[0];
724

    
725
    case 0x4c:        /* GPIO_FALLINGDETECT */
726
        return s->edge[1];
727

    
728
    case 0x50:        /* GPIO_DEBOUNCENABLE */
729
        return s->debounce;
730

    
731
    case 0x54:        /* GPIO_DEBOUNCINGTIME */
732
        return s->delay;
733
    }
734

    
735
    OMAP_BAD_REG(addr);
736
    return 0;
737
}
738

    
739
static void omap_gpio_module_write(void *opaque, target_phys_addr_t addr,
740
                uint32_t value)
741
{
742
    struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
743
    int offset = addr - s->base;
744
    uint32_t diff;
745
    int ln;
746

    
747
    switch (offset) {
748
    case 0x00:        /* GPIO_REVISION */
749
    case 0x14:        /* GPIO_SYSSTATUS */
750
    case 0x38:        /* GPIO_DATAIN */
751
        OMAP_RO_REG(addr);
752
        break;
753

    
754
    case 0x10:        /* GPIO_SYSCONFIG */
755
        if (((value >> 3) & 3) == 3)
756
            fprintf(stderr, "%s: bad IDLEMODE value\n", __FUNCTION__);
757
        if (value & 2)
758
            omap_gpio_module_reset(s);
759
        s->config[0] = value & 0x1d;
760
        break;
761

    
762
    case 0x18:        /* GPIO_IRQSTATUS1 */
763
        if (s->ints[0] & value) {
764
            s->ints[0] &= ~value;
765
            omap_gpio_module_level_update(s, 0);
766
        }
767
        break;
768

    
769
    case 0x1c:        /* GPIO_IRQENABLE1 */
770
        s->mask[0] = value;
771
        omap_gpio_module_int_update(s, 0);
772
        break;
773

    
774
    case 0x20:        /* GPIO_WAKEUPENABLE */
775
        s->wumask = value;
776
        break;
777

    
778
    case 0x28:        /* GPIO_IRQSTATUS2 */
779
        if (s->ints[1] & value) {
780
            s->ints[1] &= ~value;
781
            omap_gpio_module_level_update(s, 1);
782
        }
783
        break;
784

    
785
    case 0x2c:        /* GPIO_IRQENABLE2 */
786
        s->mask[1] = value;
787
        omap_gpio_module_int_update(s, 1);
788
        break;
789

    
790
    case 0x30:        /* GPIO_CTRL */
791
        s->config[1] = value & 7;
792
        break;
793

    
794
    case 0x34:        /* GPIO_OE */
795
        diff = s->outputs & (s->dir ^ value);
796
        s->dir = value;
797

    
798
        value = s->outputs & ~s->dir;
799
        while ((ln = ffs(diff))) {
800
            diff &= ~(1 <<-- ln);
801
            qemu_set_irq(s->handler[ln], (value >> ln) & 1);
802
        }
803

    
804
        omap_gpio_module_level_update(s, 0);
805
        omap_gpio_module_level_update(s, 1);
806
        break;
807

    
808
    case 0x3c:        /* GPIO_DATAOUT */
809
        omap_gpio_module_out_update(s, s->outputs ^ value);
810
        break;
811

    
812
    case 0x40:        /* GPIO_LEVELDETECT0 */
813
        s->level[0] = value;
814
        omap_gpio_module_level_update(s, 0);
815
        omap_gpio_module_level_update(s, 1);
816
        break;
817

    
818
    case 0x44:        /* GPIO_LEVELDETECT1 */
819
        s->level[1] = value;
820
        omap_gpio_module_level_update(s, 0);
821
        omap_gpio_module_level_update(s, 1);
822
        break;
823

    
824
    case 0x48:        /* GPIO_RISINGDETECT */
825
        s->edge[0] = value;
826
        break;
827

    
828
    case 0x4c:        /* GPIO_FALLINGDETECT */
829
        s->edge[1] = value;
830
        break;
831

    
832
    case 0x50:        /* GPIO_DEBOUNCENABLE */
833
        s->debounce = value;
834
        break;
835

    
836
    case 0x54:        /* GPIO_DEBOUNCINGTIME */
837
        s->delay = value;
838
        break;
839

    
840
    case 0x60:        /* GPIO_CLEARIRQENABLE1 */
841
        s->mask[0] &= ~value;
842
        omap_gpio_module_int_update(s, 0);
843
        break;
844

    
845
    case 0x64:        /* GPIO_SETIRQENABLE1 */
846
        s->mask[0] |= value;
847
        omap_gpio_module_int_update(s, 0);
848
        break;
849

    
850
    case 0x70:        /* GPIO_CLEARIRQENABLE2 */
851
        s->mask[1] &= ~value;
852
        omap_gpio_module_int_update(s, 1);
853
        break;
854

    
855
    case 0x74:        /* GPIO_SETIREQNEABLE2 */
856
        s->mask[1] |= value;
857
        omap_gpio_module_int_update(s, 1);
858
        break;
859

    
860
    case 0x80:        /* GPIO_CLEARWKUENA */
861
        s->wumask &= ~value;
862
        break;
863

    
864
    case 0x84:        /* GPIO_SETWKUENA */
865
        s->wumask |= value;
866
        break;
867

    
868
    case 0x90:        /* GPIO_CLEARDATAOUT */
869
        omap_gpio_module_out_update(s, s->outputs & value);
870
        break;
871

    
872
    case 0x94:        /* GPIO_SETDATAOUT */
873
        omap_gpio_module_out_update(s, ~s->outputs & value);
874
        break;
875

    
876
    default:
877
        OMAP_BAD_REG(addr);
878
        return;
879
    }
880
}
881

    
882
static uint32_t omap_gpio_module_readp(void *opaque, target_phys_addr_t addr)
883
{
884
    return omap_gpio_module_readp(opaque, addr) >> ((addr & 3) << 3);
885
}
886

    
887
static void omap_gpio_module_writep(void *opaque, target_phys_addr_t addr,
888
                uint32_t value)
889
{
890
    struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
891
    int offset = addr - s->base;
892
    uint32_t cur = 0;
893
    uint32_t mask = 0xffff;
894

    
895
    switch (offset & ~3) {
896
    case 0x00:        /* GPIO_REVISION */
897
    case 0x14:        /* GPIO_SYSSTATUS */
898
    case 0x38:        /* GPIO_DATAIN */
899
        OMAP_RO_REG(addr);
900
        break;
901

    
902
    case 0x10:        /* GPIO_SYSCONFIG */
903
    case 0x1c:        /* GPIO_IRQENABLE1 */
904
    case 0x20:        /* GPIO_WAKEUPENABLE */
905
    case 0x2c:        /* GPIO_IRQENABLE2 */
906
    case 0x30:        /* GPIO_CTRL */
907
    case 0x34:        /* GPIO_OE */
908
    case 0x3c:        /* GPIO_DATAOUT */
909
    case 0x40:        /* GPIO_LEVELDETECT0 */
910
    case 0x44:        /* GPIO_LEVELDETECT1 */
911
    case 0x48:        /* GPIO_RISINGDETECT */
912
    case 0x4c:        /* GPIO_FALLINGDETECT */
913
    case 0x50:        /* GPIO_DEBOUNCENABLE */
914
    case 0x54:        /* GPIO_DEBOUNCINGTIME */
915
        cur = omap_gpio_module_read(opaque, addr & ~3) &
916
                ~(mask << ((addr & 3) << 3));
917

    
918
        /* Fall through.  */
919
    case 0x18:        /* GPIO_IRQSTATUS1 */
920
    case 0x28:        /* GPIO_IRQSTATUS2 */
921
    case 0x60:        /* GPIO_CLEARIRQENABLE1 */
922
    case 0x64:        /* GPIO_SETIRQENABLE1 */
923
    case 0x70:        /* GPIO_CLEARIRQENABLE2 */
924
    case 0x74:        /* GPIO_SETIREQNEABLE2 */
925
    case 0x80:        /* GPIO_CLEARWKUENA */
926
    case 0x84:        /* GPIO_SETWKUENA */
927
    case 0x90:        /* GPIO_CLEARDATAOUT */
928
    case 0x94:        /* GPIO_SETDATAOUT */
929
        value <<= (addr & 3) << 3;
930
        omap_gpio_module_write(opaque, addr, cur | value);
931
        break;
932

    
933
    default:
934
        OMAP_BAD_REG(addr);
935
        return;
936
    }
937
}
938

    
939
static CPUReadMemoryFunc *omap_gpio_module_readfn[] = {
940
    omap_gpio_module_readp,
941
    omap_gpio_module_readp,
942
    omap_gpio_module_read,
943
};
944

    
945
static CPUWriteMemoryFunc *omap_gpio_module_writefn[] = {
946
    omap_gpio_module_writep,
947
    omap_gpio_module_writep,
948
    omap_gpio_module_write,
949
};
950

    
951
static void omap_gpio_module_init(struct omap2_gpio_s *s,
952
                struct omap_target_agent_s *ta, int region,
953
                qemu_irq mpu, qemu_irq dsp, qemu_irq wkup,
954
                omap_clk fclk, omap_clk iclk)
955
{
956
    int iomemtype;
957

    
958
    s->irq[0] = mpu;
959
    s->irq[1] = dsp;
960
    s->wkup = wkup;
961
    s->in = qemu_allocate_irqs(omap_gpio_module_set, s, 32);
962

    
963
    iomemtype = cpu_register_io_memory(0, omap_gpio_module_readfn,
964
                    omap_gpio_module_writefn, s);
965
    s->base = omap_l4_attach(ta, region, iomemtype);
966
}
967

    
968
struct omap_gpif_s {
969
    struct omap2_gpio_s module[5];
970
    int modules;
971

    
972
    target_phys_addr_t topbase;
973
    int autoidle;
974
    int gpo;
975
};
976

    
977
static void omap_gpif_reset(struct omap_gpif_s *s)
978
{
979
    int i;
980

    
981
    for (i = 0; i < s->modules; i ++)
982
        omap_gpio_module_reset(s->module + i);
983

    
984
    s->autoidle = 0;
985
    s->gpo = 0;
986
}
987

    
988
static uint32_t omap_gpif_top_read(void *opaque, target_phys_addr_t addr)
989
{
990
    struct omap_gpif_s *s = (struct omap_gpif_s *) opaque;
991
    int offset = addr - s->topbase;
992

    
993
    switch (offset) {
994
    case 0x00:        /* IPGENERICOCPSPL_REVISION */
995
        return 0x18;
996

    
997
    case 0x10:        /* IPGENERICOCPSPL_SYSCONFIG */
998
        return s->autoidle;
999

    
1000
    case 0x14:        /* IPGENERICOCPSPL_SYSSTATUS */
1001
        return 0x01;
1002

    
1003
    case 0x18:        /* IPGENERICOCPSPL_IRQSTATUS */
1004
        return 0x00;
1005

    
1006
    case 0x40:        /* IPGENERICOCPSPL_GPO */
1007
        return s->gpo;
1008

    
1009
    case 0x50:        /* IPGENERICOCPSPL_GPI */
1010
        return 0x00;
1011
    }
1012

    
1013
    OMAP_BAD_REG(addr);
1014
    return 0;
1015
}
1016

    
1017
static void omap_gpif_top_write(void *opaque, target_phys_addr_t addr,
1018
                uint32_t value)
1019
{
1020
    struct omap_gpif_s *s = (struct omap_gpif_s *) opaque;
1021
    int offset = addr - s->topbase;
1022

    
1023
    switch (offset) {
1024
    case 0x00:        /* IPGENERICOCPSPL_REVISION */
1025
    case 0x14:        /* IPGENERICOCPSPL_SYSSTATUS */
1026
    case 0x18:        /* IPGENERICOCPSPL_IRQSTATUS */
1027
    case 0x50:        /* IPGENERICOCPSPL_GPI */
1028
        OMAP_RO_REG(addr);
1029
        break;
1030

    
1031
    case 0x10:        /* IPGENERICOCPSPL_SYSCONFIG */
1032
        if (value & (1 << 1))                                        /* SOFTRESET */
1033
            omap_gpif_reset(s);
1034
        s->autoidle = value & 1;
1035
        break;
1036

    
1037
    case 0x40:        /* IPGENERICOCPSPL_GPO */
1038
        s->gpo = value & 1;
1039
        break;
1040

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

    
1047
static CPUReadMemoryFunc *omap_gpif_top_readfn[] = {
1048
    omap_gpif_top_read,
1049
    omap_gpif_top_read,
1050
    omap_gpif_top_read,
1051
};
1052

    
1053
static CPUWriteMemoryFunc *omap_gpif_top_writefn[] = {
1054
    omap_gpif_top_write,
1055
    omap_gpif_top_write,
1056
    omap_gpif_top_write,
1057
};
1058

    
1059
struct omap_gpif_s *omap2_gpio_init(struct omap_target_agent_s *ta,
1060
                qemu_irq *irq, omap_clk *fclk, omap_clk iclk, int modules)
1061
{
1062
    int iomemtype, i;
1063
    struct omap_gpif_s *s = (struct omap_gpif_s *)
1064
            qemu_mallocz(sizeof(struct omap_gpif_s));
1065
    int region[4] = { 0, 2, 4, 5 };
1066

    
1067
    s->modules = modules;
1068
    for (i = 0; i < modules; i ++)
1069
        omap_gpio_module_init(s->module + i, ta, region[i],
1070
                        irq[i], 0, 0, fclk[i], iclk);
1071

    
1072
    omap_gpif_reset(s);
1073

    
1074
    iomemtype = cpu_register_io_memory(0, omap_gpif_top_readfn,
1075
                    omap_gpif_top_writefn, s);
1076
    s->topbase = omap_l4_attach(ta, 1, iomemtype);
1077

    
1078
    return s;
1079
}
1080

    
1081
qemu_irq *omap2_gpio_in_get(struct omap_gpif_s *s, int start)
1082
{
1083
    if (start >= s->modules * 32 || start < 0)
1084
        cpu_abort(cpu_single_env, "%s: No GPIO line %i\n",
1085
                        __FUNCTION__, start);
1086
    return s->module[start >> 5].in + (start & 31);
1087
}
1088

    
1089
void omap2_gpio_out_set(struct omap_gpif_s *s, int line, qemu_irq handler)
1090
{
1091
    if (line >= s->modules * 32 || line < 0)
1092
        cpu_abort(cpu_single_env, "%s: No GPIO line %i\n", __FUNCTION__, line);
1093
    s->module[line >> 5].handler[line & 31] = handler;
1094
}
1095

    
1096
/* Multichannel SPI */
1097
struct omap_mcspi_s {
1098
    target_phys_addr_t base;
1099
    qemu_irq irq;
1100
    int chnum;
1101

    
1102
    uint32_t sysconfig;
1103
    uint32_t systest;
1104
    uint32_t irqst;
1105
    uint32_t irqen;
1106
    uint32_t wken;
1107
    uint32_t control;
1108

    
1109
    struct omap_mcspi_ch_s {
1110
        qemu_irq txdrq;
1111
        qemu_irq rxdrq;
1112
        uint32_t (*txrx)(void *opaque, uint32_t);
1113
        void *opaque;
1114

    
1115
        uint32_t tx;
1116
        uint32_t rx;
1117

    
1118
        uint32_t config;
1119
        uint32_t status;
1120
        uint32_t control;
1121
    } ch[4];
1122
};
1123

    
1124
static inline void omap_mcspi_interrupt_update(struct omap_mcspi_s *s)
1125
{
1126
    qemu_set_irq(s->irq, s->irqst & s->irqen);
1127
}
1128

    
1129
static inline void omap_mcspi_dmarequest_update(struct omap_mcspi_ch_s *ch)
1130
{
1131
    qemu_set_irq(ch->txdrq,
1132
                    (ch->control & 1) &&                /* EN */
1133
                    (ch->config & (1 << 14)) &&                /* DMAW */
1134
                    (ch->status & (1 << 1)) &&                /* TXS */
1135
                    ((ch->config >> 12) & 3) != 1);        /* TRM */
1136
    qemu_set_irq(ch->rxdrq,
1137
                    (ch->control & 1) &&                /* EN */
1138
                    (ch->config & (1 << 15)) &&                /* DMAW */
1139
                    (ch->status & (1 << 0)) &&                /* RXS */
1140
                    ((ch->config >> 12) & 3) != 2);        /* TRM */
1141
}
1142

    
1143
static void omap_mcspi_transfer_run(struct omap_mcspi_s *s, int chnum)
1144
{
1145
    struct omap_mcspi_ch_s *ch = s->ch + chnum;
1146

    
1147
    if (!(ch->control & 1))                                /* EN */
1148
        return;
1149
    if ((ch->status & (1 << 0)) &&                        /* RXS */
1150
                    ((ch->config >> 12) & 3) != 2 &&        /* TRM */
1151
                    !(ch->config & (1 << 19)))                /* TURBO */
1152
        goto intr_update;
1153
    if ((ch->status & (1 << 1)) &&                        /* TXS */
1154
                    ((ch->config >> 12) & 3) != 1)        /* TRM */
1155
        goto intr_update;
1156

    
1157
    if (!(s->control & 1) ||                                /* SINGLE */
1158
                    (ch->config & (1 << 20))) {                /* FORCE */
1159
        if (ch->txrx)
1160
            ch->rx = ch->txrx(ch->opaque, ch->tx);
1161
    }
1162

    
1163
    ch->tx = 0;
1164
    ch->status |= 1 << 2;                                /* EOT */
1165
    ch->status |= 1 << 1;                                /* TXS */
1166
    if (((ch->config >> 12) & 3) != 2)                        /* TRM */
1167
        ch->status |= 1 << 0;                                /* RXS */
1168

    
1169
intr_update:
1170
    if ((ch->status & (1 << 0)) &&                        /* RXS */
1171
                    ((ch->config >> 12) & 3) != 2 &&        /* TRM */
1172
                    !(ch->config & (1 << 19)))                /* TURBO */
1173
        s->irqst |= 1 << (2 + 4 * chnum);                /* RX_FULL */
1174
    if ((ch->status & (1 << 1)) &&                        /* TXS */
1175
                    ((ch->config >> 12) & 3) != 1)        /* TRM */
1176
        s->irqst |= 1 << (0 + 4 * chnum);                /* TX_EMPTY */
1177
    omap_mcspi_interrupt_update(s);
1178
    omap_mcspi_dmarequest_update(ch);
1179
}
1180

    
1181
static void omap_mcspi_reset(struct omap_mcspi_s *s)
1182
{
1183
    int ch;
1184

    
1185
    s->sysconfig = 0;
1186
    s->systest = 0;
1187
    s->irqst = 0;
1188
    s->irqen = 0;
1189
    s->wken = 0;
1190
    s->control = 4;
1191

    
1192
    for (ch = 0; ch < 4; ch ++) {
1193
        s->ch[ch].config = 0x060000;
1194
        s->ch[ch].status = 2;                                /* TXS */
1195
        s->ch[ch].control = 0;
1196

    
1197
        omap_mcspi_dmarequest_update(s->ch + ch);
1198
    }
1199

    
1200
    omap_mcspi_interrupt_update(s);
1201
}
1202

    
1203
static uint32_t omap_mcspi_read(void *opaque, target_phys_addr_t addr)
1204
{
1205
    struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
1206
    int offset = addr - s->base;
1207
    int ch = 0;
1208
    uint32_t ret;
1209

    
1210
    switch (offset) {
1211
    case 0x00:        /* MCSPI_REVISION */
1212
        return 0x91;
1213

    
1214
    case 0x10:        /* MCSPI_SYSCONFIG */
1215
        return s->sysconfig;
1216

    
1217
    case 0x14:        /* MCSPI_SYSSTATUS */
1218
        return 1;                                        /* RESETDONE */
1219

    
1220
    case 0x18:        /* MCSPI_IRQSTATUS */
1221
        return s->irqst;
1222

    
1223
    case 0x1c:        /* MCSPI_IRQENABLE */
1224
        return s->irqen;
1225

    
1226
    case 0x20:        /* MCSPI_WAKEUPENABLE */
1227
        return s->wken;
1228

    
1229
    case 0x24:        /* MCSPI_SYST */
1230
        return s->systest;
1231

    
1232
    case 0x28:        /* MCSPI_MODULCTRL */
1233
        return s->control;
1234

    
1235
    case 0x68: ch ++;
1236
    case 0x54: ch ++;
1237
    case 0x40: ch ++;
1238
    case 0x2c:        /* MCSPI_CHCONF */
1239
        return s->ch[ch].config;
1240

    
1241
    case 0x6c: ch ++;
1242
    case 0x58: ch ++;
1243
    case 0x44: ch ++;
1244
    case 0x30:        /* MCSPI_CHSTAT */
1245
        return s->ch[ch].status;
1246

    
1247
    case 0x70: ch ++;
1248
    case 0x5c: ch ++;
1249
    case 0x48: ch ++;
1250
    case 0x34:        /* MCSPI_CHCTRL */
1251
        return s->ch[ch].control;
1252

    
1253
    case 0x74: ch ++;
1254
    case 0x60: ch ++;
1255
    case 0x4c: ch ++;
1256
    case 0x38:        /* MCSPI_TX */
1257
        return s->ch[ch].tx;
1258

    
1259
    case 0x78: ch ++;
1260
    case 0x64: ch ++;
1261
    case 0x50: ch ++;
1262
    case 0x3c:        /* MCSPI_RX */
1263
        s->ch[ch].status &= ~(1 << 0);                        /* RXS */
1264
        ret = s->ch[ch].rx;
1265
        omap_mcspi_transfer_run(s, ch);
1266
        return ret;
1267
    }
1268

    
1269
    OMAP_BAD_REG(addr);
1270
    return 0;
1271
}
1272

    
1273
static void omap_mcspi_write(void *opaque, target_phys_addr_t addr,
1274
                uint32_t value)
1275
{
1276
    struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
1277
    int offset = addr - s->base;
1278
    int ch = 0;
1279

    
1280
    switch (offset) {
1281
    case 0x00:        /* MCSPI_REVISION */
1282
    case 0x14:        /* MCSPI_SYSSTATUS */
1283
    case 0x30:        /* MCSPI_CHSTAT0 */
1284
    case 0x3c:        /* MCSPI_RX0 */
1285
    case 0x44:        /* MCSPI_CHSTAT1 */
1286
    case 0x50:        /* MCSPI_RX1 */
1287
    case 0x58:        /* MCSPI_CHSTAT2 */
1288
    case 0x64:        /* MCSPI_RX2 */
1289
    case 0x6c:        /* MCSPI_CHSTAT3 */
1290
    case 0x78:        /* MCSPI_RX3 */
1291
        OMAP_RO_REG(addr);
1292
        return;
1293

    
1294
    case 0x10:        /* MCSPI_SYSCONFIG */
1295
        if (value & (1 << 1))                                /* SOFTRESET */
1296
            omap_mcspi_reset(s);
1297
        s->sysconfig = value & 0x31d;
1298
        break;
1299

    
1300
    case 0x18:        /* MCSPI_IRQSTATUS */
1301
        if (!((s->control & (1 << 3)) && (s->systest & (1 << 11)))) {
1302
            s->irqst &= ~value;
1303
            omap_mcspi_interrupt_update(s);
1304
        }
1305
        break;
1306

    
1307
    case 0x1c:        /* MCSPI_IRQENABLE */
1308
        s->irqen = value & 0x1777f;
1309
        omap_mcspi_interrupt_update(s);
1310
        break;
1311

    
1312
    case 0x20:        /* MCSPI_WAKEUPENABLE */
1313
        s->wken = value & 1;
1314
        break;
1315

    
1316
    case 0x24:        /* MCSPI_SYST */
1317
        if (s->control & (1 << 3))                        /* SYSTEM_TEST */
1318
            if (value & (1 << 11)) {                        /* SSB */
1319
                s->irqst |= 0x1777f;
1320
                omap_mcspi_interrupt_update(s);
1321
            }
1322
        s->systest = value & 0xfff;
1323
        break;
1324

    
1325
    case 0x28:        /* MCSPI_MODULCTRL */
1326
        if (value & (1 << 3))                                /* SYSTEM_TEST */
1327
            if (s->systest & (1 << 11)) {                /* SSB */
1328
                s->irqst |= 0x1777f;
1329
                omap_mcspi_interrupt_update(s);
1330
            }
1331
        s->control = value & 0xf;
1332
        break;
1333

    
1334
    case 0x68: ch ++;
1335
    case 0x54: ch ++;
1336
    case 0x40: ch ++;
1337
    case 0x2c:        /* MCSPI_CHCONF */
1338
        if ((value ^ s->ch[ch].config) & (3 << 14))        /* DMAR | DMAW */
1339
            omap_mcspi_dmarequest_update(s->ch + ch);
1340
        if (((value >> 12) & 3) == 3)                        /* TRM */
1341
            fprintf(stderr, "%s: invalid TRM value (3)\n", __FUNCTION__);
1342
        if (((value >> 7) & 0x1f) < 3)                        /* WL */
1343
            fprintf(stderr, "%s: invalid WL value (%i)\n",
1344
                            __FUNCTION__, (value >> 7) & 0x1f);
1345
        s->ch[ch].config = value & 0x7fffff;
1346
        break;
1347

    
1348
    case 0x70: ch ++;
1349
    case 0x5c: ch ++;
1350
    case 0x48: ch ++;
1351
    case 0x34:        /* MCSPI_CHCTRL */
1352
        if (value & ~s->ch[ch].control & 1) {                /* EN */
1353
            s->ch[ch].control |= 1;
1354
            omap_mcspi_transfer_run(s, ch);
1355
        } else
1356
            s->ch[ch].control = value & 1;
1357
        break;
1358

    
1359
    case 0x74: ch ++;
1360
    case 0x60: ch ++;
1361
    case 0x4c: ch ++;
1362
    case 0x38:        /* MCSPI_TX */
1363
        s->ch[ch].tx = value;
1364
        s->ch[ch].status &= ~(1 << 1);                        /* TXS */
1365
        omap_mcspi_transfer_run(s, ch);
1366
        break;
1367

    
1368
    default:
1369
        OMAP_BAD_REG(addr);
1370
        return;
1371
    }
1372
}
1373

    
1374
static CPUReadMemoryFunc *omap_mcspi_readfn[] = {
1375
    omap_badwidth_read32,
1376
    omap_badwidth_read32,
1377
    omap_mcspi_read,
1378
};
1379

    
1380
static CPUWriteMemoryFunc *omap_mcspi_writefn[] = {
1381
    omap_badwidth_write32,
1382
    omap_badwidth_write32,
1383
    omap_mcspi_write,
1384
};
1385

    
1386
struct omap_mcspi_s *omap_mcspi_init(struct omap_target_agent_s *ta, int chnum,
1387
                qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
1388
{
1389
    int iomemtype;
1390
    struct omap_mcspi_s *s = (struct omap_mcspi_s *)
1391
            qemu_mallocz(sizeof(struct omap_mcspi_s));
1392
    struct omap_mcspi_ch_s *ch = s->ch;
1393

    
1394
    s->irq = irq;
1395
    s->chnum = chnum;
1396
    while (chnum --) {
1397
        ch->txdrq = *drq ++;
1398
        ch->rxdrq = *drq ++;
1399
        ch ++;
1400
    }
1401
    omap_mcspi_reset(s);
1402

    
1403
    iomemtype = cpu_register_io_memory(0, omap_mcspi_readfn,
1404
                    omap_mcspi_writefn, s);
1405
    s->base = omap_l4_attach(ta, 0, iomemtype);
1406

    
1407
    return s;
1408
}
1409

    
1410
void omap_mcspi_attach(struct omap_mcspi_s *s,
1411
                uint32_t (*txrx)(void *opaque, uint32_t), void *opaque,
1412
                int chipselect)
1413
{
1414
    if (chipselect < 0 || chipselect >= s->chnum)
1415
        cpu_abort(cpu_single_env, "%s: Bad chipselect %i\n",
1416
                        __FUNCTION__, chipselect);
1417

    
1418
    s->ch[chipselect].txrx = txrx;
1419
    s->ch[chipselect].opaque = opaque;
1420
}
1421

    
1422
/* L4 Interconnect */
1423
struct omap_target_agent_s {
1424
    struct omap_l4_s *bus;
1425
    int regions;
1426
    struct omap_l4_region_s *start;
1427
    target_phys_addr_t base;
1428
    uint32_t component;
1429
    uint32_t control;
1430
    uint32_t status;
1431
};
1432

    
1433
struct omap_l4_s {
1434
    target_phys_addr_t base;
1435
    int ta_num;
1436
    struct omap_target_agent_s ta[0];
1437
};
1438

    
1439
struct omap_l4_s *omap_l4_init(target_phys_addr_t base, int ta_num)
1440
{
1441
    struct omap_l4_s *bus = qemu_mallocz(
1442
                    sizeof(*bus) + ta_num * sizeof(*bus->ta));
1443

    
1444
    bus->ta_num = ta_num;
1445
    bus->base = base;
1446

    
1447
    return bus;
1448
}
1449

    
1450
static uint32_t omap_l4ta_read(void *opaque, target_phys_addr_t addr)
1451
{
1452
    struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque;
1453
    target_phys_addr_t reg = addr - s->base;
1454

    
1455
    switch (reg) {
1456
    case 0x00:        /* COMPONENT */
1457
        return s->component;
1458

    
1459
    case 0x20:        /* AGENT_CONTROL */
1460
        return s->control;
1461

    
1462
    case 0x28:        /* AGENT_STATUS */
1463
        return s->status;
1464
    }
1465

    
1466
    OMAP_BAD_REG(addr);
1467
    return 0;
1468
}
1469

    
1470
static void omap_l4ta_write(void *opaque, target_phys_addr_t addr,
1471
                uint32_t value)
1472
{
1473
    struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque;
1474
    target_phys_addr_t reg = addr - s->base;
1475

    
1476
    switch (reg) {
1477
    case 0x00:        /* COMPONENT */
1478
    case 0x28:        /* AGENT_STATUS */
1479
        OMAP_RO_REG(addr);
1480
        break;
1481

    
1482
    case 0x20:        /* AGENT_CONTROL */
1483
        s->control = value & 0x01000700;
1484
        if (value & 1)                                        /* OCP_RESET */
1485
            s->status &= ~1;                                /* REQ_TIMEOUT */
1486
        break;
1487

    
1488
    default:
1489
        OMAP_BAD_REG(addr);
1490
    }
1491
}
1492

    
1493
static CPUReadMemoryFunc *omap_l4ta_readfn[] = {
1494
    omap_badwidth_read16,
1495
    omap_l4ta_read,
1496
    omap_badwidth_read16,
1497
};
1498

    
1499
static CPUWriteMemoryFunc *omap_l4ta_writefn[] = {
1500
    omap_badwidth_write32,
1501
    omap_badwidth_write32,
1502
    omap_l4ta_write,
1503
};
1504

    
1505
#define L4TA(n)                (n)
1506
#define L4TAO(n)        ((n) + 39)
1507

    
1508
static struct omap_l4_region_s {
1509
    target_phys_addr_t offset;
1510
    size_t size;
1511
    int access;
1512
} omap_l4_region[125] = {
1513
    [  1] = { 0x40800,  0x800, 32          }, /* Initiator agent */
1514
    [  2] = { 0x41000, 0x1000, 32          }, /* Link agent */
1515
    [  0] = { 0x40000,  0x800, 32          }, /* Address and protection */
1516
    [  3] = { 0x00000, 0x1000, 32 | 16 | 8 }, /* System Control and Pinout */
1517
    [  4] = { 0x01000, 0x1000, 32 | 16 | 8 }, /* L4TAO1 */
1518
    [  5] = { 0x04000, 0x1000, 32 | 16     }, /* 32K Timer */
1519
    [  6] = { 0x05000, 0x1000, 32 | 16 | 8 }, /* L4TAO2 */
1520
    [  7] = { 0x08000,  0x800, 32          }, /* PRCM Region A */
1521
    [  8] = { 0x08800,  0x800, 32          }, /* PRCM Region B */
1522
    [  9] = { 0x09000, 0x1000, 32 | 16 | 8 }, /* L4TAO */
1523
    [ 10] = { 0x12000, 0x1000, 32 | 16 | 8 }, /* Test (BCM) */
1524
    [ 11] = { 0x13000, 0x1000, 32 | 16 | 8 }, /* L4TA1 */
1525
    [ 12] = { 0x14000, 0x1000, 32          }, /* Test/emulation (TAP) */
1526
    [ 13] = { 0x15000, 0x1000, 32 | 16 | 8 }, /* L4TA2 */
1527
    [ 14] = { 0x18000, 0x1000, 32 | 16 | 8 }, /* GPIO1 */
1528
    [ 16] = { 0x1a000, 0x1000, 32 | 16 | 8 }, /* GPIO2 */
1529
    [ 18] = { 0x1c000, 0x1000, 32 | 16 | 8 }, /* GPIO3 */
1530
    [ 19] = { 0x1e000, 0x1000, 32 | 16 | 8 }, /* GPIO4 */
1531
    [ 15] = { 0x19000, 0x1000, 32 | 16 | 8 }, /* Quad GPIO TOP */
1532
    [ 17] = { 0x1b000, 0x1000, 32 | 16 | 8 }, /* L4TA3 */
1533
    [ 20] = { 0x20000, 0x1000, 32 | 16 | 8 }, /* WD Timer 1 (Secure) */
1534
    [ 22] = { 0x22000, 0x1000, 32 | 16 | 8 }, /* WD Timer 2 (OMAP) */
1535
    [ 21] = { 0x21000, 0x1000, 32 | 16 | 8 }, /* Dual WD timer TOP */
1536
    [ 23] = { 0x23000, 0x1000, 32 | 16 | 8 }, /* L4TA4 */
1537
    [ 24] = { 0x28000, 0x1000, 32 | 16 | 8 }, /* GP Timer 1 */
1538
    [ 25] = { 0x29000, 0x1000, 32 | 16 | 8 }, /* L4TA7 */
1539
    [ 26] = { 0x48000, 0x2000, 32 | 16 | 8 }, /* Emulation (ARM11ETB) */
1540
    [ 27] = { 0x4a000, 0x1000, 32 | 16 | 8 }, /* L4TA9 */
1541
    [ 28] = { 0x50000,  0x400, 32 | 16 | 8 }, /* Display top */
1542
    [ 29] = { 0x50400,  0x400, 32 | 16 | 8 }, /* Display control */
1543
    [ 30] = { 0x50800,  0x400, 32 | 16 | 8 }, /* Display RFBI */
1544
    [ 31] = { 0x50c00,  0x400, 32 | 16 | 8 }, /* Display encoder */
1545
    [ 32] = { 0x51000, 0x1000, 32 | 16 | 8 }, /* L4TA10 */
1546
    [ 33] = { 0x52000,  0x400, 32 | 16 | 8 }, /* Camera top */
1547
    [ 34] = { 0x52400,  0x400, 32 | 16 | 8 }, /* Camera core */
1548
    [ 35] = { 0x52800,  0x400, 32 | 16 | 8 }, /* Camera DMA */
1549
    [ 36] = { 0x52c00,  0x400, 32 | 16 | 8 }, /* Camera MMU */
1550
    [ 37] = { 0x53000, 0x1000, 32 | 16 | 8 }, /* L4TA11 */
1551
    [ 38] = { 0x56000, 0x1000, 32 | 16 | 8 }, /* sDMA */
1552
    [ 39] = { 0x57000, 0x1000, 32 | 16 | 8 }, /* L4TA12 */
1553
    [ 40] = { 0x58000, 0x1000, 32 | 16 | 8 }, /* SSI top */
1554
    [ 41] = { 0x59000, 0x1000, 32 | 16 | 8 }, /* SSI GDD */
1555
    [ 42] = { 0x5a000, 0x1000, 32 | 16 | 8 }, /* SSI Port1 */
1556
    [ 43] = { 0x5b000, 0x1000, 32 | 16 | 8 }, /* SSI Port2 */
1557
    [ 44] = { 0x5c000, 0x1000, 32 | 16 | 8 }, /* L4TA13 */
1558
    [ 45] = { 0x5e000, 0x1000, 32 | 16 | 8 }, /* USB OTG */
1559
    [ 46] = { 0x5f000, 0x1000, 32 | 16 | 8 }, /* L4TAO4 */
1560
    [ 47] = { 0x60000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER1SDRC) */
1561
    [ 48] = { 0x61000, 0x1000, 32 | 16 | 8 }, /* L4TA14 */
1562
    [ 49] = { 0x62000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER2GPMC) */
1563
    [ 50] = { 0x63000, 0x1000, 32 | 16 | 8 }, /* L4TA15 */
1564
    [ 51] = { 0x64000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER3OCM) */
1565
    [ 52] = { 0x65000, 0x1000, 32 | 16 | 8 }, /* L4TA16 */
1566
    [ 53] = { 0x66000,  0x300, 32 | 16 | 8 }, /* Emulation (WIN_TRACER4L4) */
1567
    [ 54] = { 0x67000, 0x1000, 32 | 16 | 8 }, /* L4TA17 */
1568
    [ 55] = { 0x68000, 0x1000, 32 | 16 | 8 }, /* Emulation (XTI) */
1569
    [ 56] = { 0x69000, 0x1000, 32 | 16 | 8 }, /* L4TA18 */
1570
    [ 57] = { 0x6a000, 0x1000,      16 | 8 }, /* UART1 */
1571
    [ 58] = { 0x6b000, 0x1000, 32 | 16 | 8 }, /* L4TA19 */
1572
    [ 59] = { 0x6c000, 0x1000,      16 | 8 }, /* UART2 */
1573
    [ 60] = { 0x6d000, 0x1000, 32 | 16 | 8 }, /* L4TA20 */
1574
    [ 61] = { 0x6e000, 0x1000,      16 | 8 }, /* UART3 */
1575
    [ 62] = { 0x6f000, 0x1000, 32 | 16 | 8 }, /* L4TA21 */
1576
    [ 63] = { 0x70000, 0x1000,      16     }, /* I2C1 */
1577
    [ 64] = { 0x71000, 0x1000, 32 | 16 | 8 }, /* L4TAO5 */
1578
    [ 65] = { 0x72000, 0x1000,      16     }, /* I2C2 */
1579
    [ 66] = { 0x73000, 0x1000, 32 | 16 | 8 }, /* L4TAO6 */
1580
    [ 67] = { 0x74000, 0x1000,      16     }, /* McBSP1 */
1581
    [ 68] = { 0x75000, 0x1000, 32 | 16 | 8 }, /* L4TAO7 */
1582
    [ 69] = { 0x76000, 0x1000,      16     }, /* McBSP2 */
1583
    [ 70] = { 0x77000, 0x1000, 32 | 16 | 8 }, /* L4TAO8 */
1584
    [ 71] = { 0x24000, 0x1000, 32 | 16 | 8 }, /* WD Timer 3 (DSP) */
1585
    [ 72] = { 0x25000, 0x1000, 32 | 16 | 8 }, /* L4TA5 */
1586
    [ 73] = { 0x26000, 0x1000, 32 | 16 | 8 }, /* WD Timer 4 (IVA) */
1587
    [ 74] = { 0x27000, 0x1000, 32 | 16 | 8 }, /* L4TA6 */
1588
    [ 75] = { 0x2a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 2 */
1589
    [ 76] = { 0x2b000, 0x1000, 32 | 16 | 8 }, /* L4TA8 */
1590
    [ 77] = { 0x78000, 0x1000, 32 | 16 | 8 }, /* GP Timer 3 */
1591
    [ 78] = { 0x79000, 0x1000, 32 | 16 | 8 }, /* L4TA22 */
1592
    [ 79] = { 0x7a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 4 */
1593
    [ 80] = { 0x7b000, 0x1000, 32 | 16 | 8 }, /* L4TA23 */
1594
    [ 81] = { 0x7c000, 0x1000, 32 | 16 | 8 }, /* GP Timer 5 */
1595
    [ 82] = { 0x7d000, 0x1000, 32 | 16 | 8 }, /* L4TA24 */
1596
    [ 83] = { 0x7e000, 0x1000, 32 | 16 | 8 }, /* GP Timer 6 */
1597
    [ 84] = { 0x7f000, 0x1000, 32 | 16 | 8 }, /* L4TA25 */
1598
    [ 85] = { 0x80000, 0x1000, 32 | 16 | 8 }, /* GP Timer 7 */
1599
    [ 86] = { 0x81000, 0x1000, 32 | 16 | 8 }, /* L4TA26 */
1600
    [ 87] = { 0x82000, 0x1000, 32 | 16 | 8 }, /* GP Timer 8 */
1601
    [ 88] = { 0x83000, 0x1000, 32 | 16 | 8 }, /* L4TA27 */
1602
    [ 89] = { 0x84000, 0x1000, 32 | 16 | 8 }, /* GP Timer 9 */
1603
    [ 90] = { 0x85000, 0x1000, 32 | 16 | 8 }, /* L4TA28 */
1604
    [ 91] = { 0x86000, 0x1000, 32 | 16 | 8 }, /* GP Timer 10 */
1605
    [ 92] = { 0x87000, 0x1000, 32 | 16 | 8 }, /* L4TA29 */
1606
    [ 93] = { 0x88000, 0x1000, 32 | 16 | 8 }, /* GP Timer 11 */
1607
    [ 94] = { 0x89000, 0x1000, 32 | 16 | 8 }, /* L4TA30 */
1608
    [ 95] = { 0x8a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 12 */
1609
    [ 96] = { 0x8b000, 0x1000, 32 | 16 | 8 }, /* L4TA31 */
1610
    [ 97] = { 0x90000, 0x1000,      16     }, /* EAC */
1611
    [ 98] = { 0x91000, 0x1000, 32 | 16 | 8 }, /* L4TA32 */
1612
    [ 99] = { 0x92000, 0x1000,      16     }, /* FAC */
1613
    [100] = { 0x93000, 0x1000, 32 | 16 | 8 }, /* L4TA33 */
1614
    [101] = { 0x94000, 0x1000, 32 | 16 | 8 }, /* IPC (MAILBOX) */
1615
    [102] = { 0x95000, 0x1000, 32 | 16 | 8 }, /* L4TA34 */
1616
    [103] = { 0x98000, 0x1000, 32 | 16 | 8 }, /* SPI1 */
1617
    [104] = { 0x99000, 0x1000, 32 | 16 | 8 }, /* L4TA35 */
1618
    [105] = { 0x9a000, 0x1000, 32 | 16 | 8 }, /* SPI2 */
1619
    [106] = { 0x9b000, 0x1000, 32 | 16 | 8 }, /* L4TA36 */
1620
    [107] = { 0x9c000, 0x1000,      16 | 8 }, /* MMC SDIO */
1621
    [108] = { 0x9d000, 0x1000, 32 | 16 | 8 }, /* L4TAO9 */
1622
    [109] = { 0x9e000, 0x1000, 32 | 16 | 8 }, /* MS_PRO */
1623
    [110] = { 0x9f000, 0x1000, 32 | 16 | 8 }, /* L4TAO10 */
1624
    [111] = { 0xa0000, 0x1000, 32          }, /* RNG */
1625
    [112] = { 0xa1000, 0x1000, 32 | 16 | 8 }, /* L4TAO11 */
1626
    [113] = { 0xa2000, 0x1000, 32          }, /* DES3DES */
1627
    [114] = { 0xa3000, 0x1000, 32 | 16 | 8 }, /* L4TAO12 */
1628
    [115] = { 0xa4000, 0x1000, 32          }, /* SHA1MD5 */
1629
    [116] = { 0xa5000, 0x1000, 32 | 16 | 8 }, /* L4TAO13 */
1630
    [117] = { 0xa6000, 0x1000, 32          }, /* AES */
1631
    [118] = { 0xa7000, 0x1000, 32 | 16 | 8 }, /* L4TA37 */
1632
    [119] = { 0xa8000, 0x2000, 32          }, /* PKA */
1633
    [120] = { 0xaa000, 0x1000, 32 | 16 | 8 }, /* L4TA38 */
1634
    [121] = { 0xb0000, 0x1000, 32          }, /* MG */
1635
    [122] = { 0xb1000, 0x1000, 32 | 16 | 8 },
1636
    [123] = { 0xb2000, 0x1000, 32          }, /* HDQ/1-Wire */
1637
    [124] = { 0xb3000, 0x1000, 32 | 16 | 8 }, /* L4TA39 */
1638
};
1639

    
1640
static struct omap_l4_agent_info_s {
1641
    int ta;
1642
    int region;
1643
    int regions;
1644
    int ta_region;
1645
} omap_l4_agent_info[54] = {
1646
    { 0,           0, 3, 2 }, /* L4IA initiatior agent */
1647
    { L4TAO(1),    3, 2, 1 }, /* Control and pinout module */
1648
    { L4TAO(2),    5, 2, 1 }, /* 32K timer */
1649
    { L4TAO(3),    7, 3, 2 }, /* PRCM */
1650
    { L4TA(1),    10, 2, 1 }, /* BCM */
1651
    { L4TA(2),    12, 2, 1 }, /* Test JTAG */
1652
    { L4TA(3),    14, 6, 3 }, /* Quad GPIO */
1653
    { L4TA(4),    20, 4, 3 }, /* WD timer 1/2 */
1654
    { L4TA(7),    24, 2, 1 }, /* GP timer 1 */
1655
    { L4TA(9),    26, 2, 1 }, /* ATM11 ETB */
1656
    { L4TA(10),   28, 5, 4 }, /* Display subsystem */
1657
    { L4TA(11),   33, 5, 4 }, /* Camera subsystem */
1658
    { L4TA(12),   38, 2, 1 }, /* sDMA */
1659
    { L4TA(13),   40, 5, 4 }, /* SSI */
1660
    { L4TAO(4),   45, 2, 1 }, /* USB */
1661
    { L4TA(14),   47, 2, 1 }, /* Win Tracer1 */
1662
    { L4TA(15),   49, 2, 1 }, /* Win Tracer2 */
1663
    { L4TA(16),   51, 2, 1 }, /* Win Tracer3 */
1664
    { L4TA(17),   53, 2, 1 }, /* Win Tracer4 */
1665
    { L4TA(18),   55, 2, 1 }, /* XTI */
1666
    { L4TA(19),   57, 2, 1 }, /* UART1 */
1667
    { L4TA(20),   59, 2, 1 }, /* UART2 */
1668
    { L4TA(21),   61, 2, 1 }, /* UART3 */
1669
    { L4TAO(5),   63, 2, 1 }, /* I2C1 */
1670
    { L4TAO(6),   65, 2, 1 }, /* I2C2 */
1671
    { L4TAO(7),   67, 2, 1 }, /* McBSP1 */
1672
    { L4TAO(8),   69, 2, 1 }, /* McBSP2 */
1673
    { L4TA(5),    71, 2, 1 }, /* WD Timer 3 (DSP) */
1674
    { L4TA(6),    73, 2, 1 }, /* WD Timer 4 (IVA) */
1675
    { L4TA(8),    75, 2, 1 }, /* GP Timer 2 */
1676
    { L4TA(22),   77, 2, 1 }, /* GP Timer 3 */
1677
    { L4TA(23),   79, 2, 1 }, /* GP Timer 4 */
1678
    { L4TA(24),   81, 2, 1 }, /* GP Timer 5 */
1679
    { L4TA(25),   83, 2, 1 }, /* GP Timer 6 */
1680
    { L4TA(26),   85, 2, 1 }, /* GP Timer 7 */
1681
    { L4TA(27),   87, 2, 1 }, /* GP Timer 8 */
1682
    { L4TA(28),   89, 2, 1 }, /* GP Timer 9 */
1683
    { L4TA(29),   91, 2, 1 }, /* GP Timer 10 */
1684
    { L4TA(30),   93, 2, 1 }, /* GP Timer 11 */
1685
    { L4TA(31),   95, 2, 1 }, /* GP Timer 12 */
1686
    { L4TA(32),   97, 2, 1 }, /* EAC */
1687
    { L4TA(33),   99, 2, 1 }, /* FAC */
1688
    { L4TA(34),  101, 2, 1 }, /* IPC */
1689
    { L4TA(35),  103, 2, 1 }, /* SPI1 */
1690
    { L4TA(36),  105, 2, 1 }, /* SPI2 */
1691
    { L4TAO(9),  107, 2, 1 }, /* MMC SDIO */
1692
    { L4TAO(10), 109, 2, 1 },
1693
    { L4TAO(11), 111, 2, 1 }, /* RNG */
1694
    { L4TAO(12), 113, 2, 1 }, /* DES3DES */
1695
    { L4TAO(13), 115, 2, 1 }, /* SHA1MD5 */
1696
    { L4TA(37),  117, 2, 1 }, /* AES */
1697
    { L4TA(38),  119, 2, 1 }, /* PKA */
1698
    { -1,        121, 2, 1 },
1699
    { L4TA(39),  123, 2, 1 }, /* HDQ/1-Wire */
1700
};
1701

    
1702
#define omap_l4ta(bus, cs)        omap_l4ta_get(bus, L4TA(cs))
1703
#define omap_l4tao(bus, cs)        omap_l4ta_get(bus, L4TAO(cs))
1704

    
1705
struct omap_target_agent_s *omap_l4ta_get(struct omap_l4_s *bus, int cs)
1706
{
1707
    int i, iomemtype;
1708
    struct omap_target_agent_s *ta = 0;
1709
    struct omap_l4_agent_info_s *info = 0;
1710

    
1711
    for (i = 0; i < bus->ta_num; i ++)
1712
        if (omap_l4_agent_info[i].ta == cs) {
1713
            ta = &bus->ta[i];
1714
            info = &omap_l4_agent_info[i];
1715
            break;
1716
        }
1717
    if (!ta) {
1718
        fprintf(stderr, "%s: bad target agent (%i)\n", __FUNCTION__, cs);
1719
        exit(-1);
1720
    }
1721

    
1722
    ta->bus = bus;
1723
    ta->start = &omap_l4_region[info->region];
1724
    ta->regions = info->regions;
1725
    ta->base = bus->base + ta->start[info->ta_region].offset;
1726

    
1727
    ta->component = ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1728
    ta->status = 0x00000000;
1729
    ta->control = 0x00000200;        /* XXX 01000200 for L4TAO */
1730

    
1731
    iomemtype = cpu_register_io_memory(0, omap_l4ta_readfn,
1732
                    omap_l4ta_writefn, ta);
1733
    cpu_register_physical_memory(ta->base, 0x200, iomemtype);
1734

    
1735
    return ta;
1736
}
1737

    
1738
target_phys_addr_t omap_l4_attach(struct omap_target_agent_s *ta, int region,
1739
                int iotype)
1740
{
1741
    target_phys_addr_t base;
1742
    size_t size;
1743

    
1744
    if (region < 0 || region >= ta->regions) {
1745
        fprintf(stderr, "%s: bad io region (%i)\n", __FUNCTION__, region);
1746
        exit(-1);
1747
    }
1748

    
1749
    base = ta->bus->base + ta->start[region].offset;
1750
    size = ta->start[region].size;
1751
    if (iotype)
1752
        cpu_register_physical_memory(base, size, iotype);
1753

    
1754
    return base;
1755
}
1756

    
1757
/* TEST-Chip-level TAP */
1758
static uint32_t omap_tap_read(void *opaque, target_phys_addr_t addr)
1759
{
1760
    struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque;
1761
    target_phys_addr_t reg = addr - s->tap_base;
1762

    
1763
    switch (reg) {
1764
    case 0x204:        /* IDCODE_reg */
1765
        switch (s->mpu_model) {
1766
        case omap2420:
1767
        case omap2422:
1768
        case omap2423:
1769
            return 0x5b5d902f;        /* ES 2.2 */
1770
        case omap2430:
1771
            return 0x5b68a02f;        /* ES 2.2 */
1772
        case omap3430:
1773
            return 0x1b7ae02f;        /* ES 2 */
1774
        default:
1775
            cpu_abort(cpu_single_env, "%s: Bad mpu model\n", __FUNCTION__);
1776
        }
1777

    
1778
    case 0x208:        /* PRODUCTION_ID_reg for OMAP2 */
1779
    case 0x210:        /* PRODUCTION_ID_reg for OMAP3 */
1780
        switch (s->mpu_model) {
1781
        case omap2420:
1782
            return 0x000254f0;        /* POP ESHS2.1.1 in N91/93/95, ES2 in N800 */
1783
        case omap2422:
1784
            return 0x000400f0;
1785
        case omap2423:
1786
            return 0x000800f0;
1787
        case omap2430:
1788
            return 0x000000f0;
1789
        case omap3430:
1790
            return 0x000000f0;
1791
        default:
1792
            cpu_abort(cpu_single_env, "%s: Bad mpu model\n", __FUNCTION__);
1793
        }
1794

    
1795
    case 0x20c:
1796
        switch (s->mpu_model) {
1797
        case omap2420:
1798
        case omap2422:
1799
        case omap2423:
1800
            return 0xcafeb5d9;        /* ES 2.2 */
1801
        case omap2430:
1802
            return 0xcafeb68a;        /* ES 2.2 */
1803
        case omap3430:
1804
            return 0xcafeb7ae;        /* ES 2 */
1805
        default:
1806
            cpu_abort(cpu_single_env, "%s: Bad mpu model\n", __FUNCTION__);
1807
        }
1808

    
1809
    case 0x218:        /* DIE_ID_reg */
1810
        return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1811
    case 0x21c:        /* DIE_ID_reg */
1812
        return 0x54 << 24;
1813
    case 0x220:        /* DIE_ID_reg */
1814
        return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1815
    case 0x224:        /* DIE_ID_reg */
1816
        return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
1817
    }
1818

    
1819
    OMAP_BAD_REG(addr);
1820
    return 0;
1821
}
1822

    
1823
static void omap_tap_write(void *opaque, target_phys_addr_t addr,
1824
                uint32_t value)
1825
{
1826
    OMAP_BAD_REG(addr);
1827
}
1828

    
1829
static CPUReadMemoryFunc *omap_tap_readfn[] = {
1830
    omap_badwidth_read32,
1831
    omap_badwidth_read32,
1832
    omap_tap_read,
1833
};
1834

    
1835
static CPUWriteMemoryFunc *omap_tap_writefn[] = {
1836
    omap_badwidth_write32,
1837
    omap_badwidth_write32,
1838
    omap_tap_write,
1839
};
1840

    
1841
void omap_tap_init(struct omap_target_agent_s *ta,
1842
                struct omap_mpu_state_s *mpu)
1843
{
1844
    mpu->tap_base = omap_l4_attach(ta, 0, cpu_register_io_memory(0,
1845
                            omap_tap_readfn, omap_tap_writefn, mpu));
1846
}
1847

    
1848
/* Power, Reset, and Clock Management */
1849
struct omap_prcm_s {
1850
    target_phys_addr_t base;
1851
    qemu_irq irq[3];
1852
    struct omap_mpu_state_s *mpu;
1853

    
1854
    uint32_t irqst[3];
1855
    uint32_t irqen[3];
1856

    
1857
    uint32_t sysconfig;
1858
    uint32_t voltctrl;
1859
    uint32_t scratch[20];
1860

    
1861
    uint32_t clksrc[1];
1862
    uint32_t clkout[1];
1863
    uint32_t clkemul[1];
1864
    uint32_t clkpol[1];
1865
    uint32_t clksel[8];
1866
    uint32_t clken[12];
1867
    uint32_t clkctrl[4];
1868
    uint32_t clkidle[7];
1869
    uint32_t setuptime[2];
1870

    
1871
    uint32_t wkup[3];
1872
    uint32_t wken[3];
1873
    uint32_t wkst[3];
1874
    uint32_t rst[4];
1875
    uint32_t rstctrl[1];
1876
    uint32_t power[4];
1877
    uint32_t rsttime_wkup;
1878

    
1879
    uint32_t ev;
1880
    uint32_t evtime[2];
1881
};
1882

    
1883
static void omap_prcm_int_update(struct omap_prcm_s *s, int dom)
1884
{
1885
    qemu_set_irq(s->irq[dom], s->irqst[dom] & s->irqen[dom]);
1886
    /* XXX or is the mask applied before PRCM_IRQSTATUS_* ? */
1887
}
1888

    
1889
static uint32_t omap_prcm_read(void *opaque, target_phys_addr_t addr)
1890
{
1891
    struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
1892
    int offset = addr - s->base;
1893

    
1894
    switch (offset) {
1895
    case 0x000:        /* PRCM_REVISION */
1896
        return 0x10;
1897

    
1898
    case 0x010:        /* PRCM_SYSCONFIG */
1899
        return s->sysconfig;
1900

    
1901
    case 0x018:        /* PRCM_IRQSTATUS_MPU */
1902
        return s->irqst[0];
1903

    
1904
    case 0x01c:        /* PRCM_IRQENABLE_MPU */
1905
        return s->irqen[0];
1906

    
1907
    case 0x050:        /* PRCM_VOLTCTRL */
1908
        return s->voltctrl;
1909
    case 0x054:        /* PRCM_VOLTST */
1910
        return s->voltctrl & 3;
1911

    
1912
    case 0x060:        /* PRCM_CLKSRC_CTRL */
1913
        return s->clksrc[0];
1914
    case 0x070:        /* PRCM_CLKOUT_CTRL */
1915
        return s->clkout[0];
1916
    case 0x078:        /* PRCM_CLKEMUL_CTRL */
1917
        return s->clkemul[0];
1918
    case 0x080:        /* PRCM_CLKCFG_CTRL */
1919
    case 0x084:        /* PRCM_CLKCFG_STATUS */
1920
        return 0;
1921

    
1922
    case 0x090:        /* PRCM_VOLTSETUP */
1923
        return s->setuptime[0];
1924

    
1925
    case 0x094:        /* PRCM_CLKSSETUP */
1926
        return s->setuptime[1];
1927

    
1928
    case 0x098:        /* PRCM_POLCTRL */
1929
        return s->clkpol[0];
1930

    
1931
    case 0x0b0:        /* GENERAL_PURPOSE1 */
1932
    case 0x0b4:        /* GENERAL_PURPOSE2 */
1933
    case 0x0b8:        /* GENERAL_PURPOSE3 */
1934
    case 0x0bc:        /* GENERAL_PURPOSE4 */
1935
    case 0x0c0:        /* GENERAL_PURPOSE5 */
1936
    case 0x0c4:        /* GENERAL_PURPOSE6 */
1937
    case 0x0c8:        /* GENERAL_PURPOSE7 */
1938
    case 0x0cc:        /* GENERAL_PURPOSE8 */
1939
    case 0x0d0:        /* GENERAL_PURPOSE9 */
1940
    case 0x0d4:        /* GENERAL_PURPOSE10 */
1941
    case 0x0d8:        /* GENERAL_PURPOSE11 */
1942
    case 0x0dc:        /* GENERAL_PURPOSE12 */
1943
    case 0x0e0:        /* GENERAL_PURPOSE13 */
1944
    case 0x0e4:        /* GENERAL_PURPOSE14 */
1945
    case 0x0e8:        /* GENERAL_PURPOSE15 */
1946
    case 0x0ec:        /* GENERAL_PURPOSE16 */
1947
    case 0x0f0:        /* GENERAL_PURPOSE17 */
1948
    case 0x0f4:        /* GENERAL_PURPOSE18 */
1949
    case 0x0f8:        /* GENERAL_PURPOSE19 */
1950
    case 0x0fc:        /* GENERAL_PURPOSE20 */
1951
        return s->scratch[(offset - 0xb0) >> 2];
1952

    
1953
    case 0x140:        /* CM_CLKSEL_MPU */
1954
        return s->clksel[0];
1955
    case 0x148:        /* CM_CLKSTCTRL_MPU */
1956
        return s->clkctrl[0];
1957

    
1958
    case 0x158:        /* RM_RSTST_MPU */
1959
        return s->rst[0];
1960
    case 0x1c8:        /* PM_WKDEP_MPU */
1961
        return s->wkup[0];
1962
    case 0x1d4:        /* PM_EVGENCTRL_MPU */
1963
        return s->ev;
1964
    case 0x1d8:        /* PM_EVEGENONTIM_MPU */
1965
        return s->evtime[0];
1966
    case 0x1dc:        /* PM_EVEGENOFFTIM_MPU */
1967
        return s->evtime[1];
1968
    case 0x1e0:        /* PM_PWSTCTRL_MPU */
1969
        return s->power[0];
1970
    case 0x1e4:        /* PM_PWSTST_MPU */
1971
        return 0;
1972

    
1973
    case 0x200:        /* CM_FCLKEN1_CORE */
1974
        return s->clken[0];
1975
    case 0x204:        /* CM_FCLKEN2_CORE */
1976
        return s->clken[1];
1977
    case 0x210:        /* CM_ICLKEN1_CORE */
1978
        return s->clken[2];
1979
    case 0x214:        /* CM_ICLKEN2_CORE */
1980
        return s->clken[3];
1981
    case 0x21c:        /* CM_ICLKEN4_CORE */
1982
        return s->clken[4];
1983

    
1984
    case 0x220:        /* CM_IDLEST1_CORE */
1985
        /* TODO: check the actual iclk status */
1986
        return 0x7ffffff9;
1987
    case 0x224:        /* CM_IDLEST2_CORE */
1988
        /* TODO: check the actual iclk status */
1989
        return 0x00000007;
1990
    case 0x22c:        /* CM_IDLEST4_CORE */
1991
        /* TODO: check the actual iclk status */
1992
        return 0x0000001f;
1993

    
1994
    case 0x230:        /* CM_AUTOIDLE1_CORE */
1995
        return s->clkidle[0];
1996
    case 0x234:        /* CM_AUTOIDLE2_CORE */
1997
        return s->clkidle[1];
1998
    case 0x238:        /* CM_AUTOIDLE3_CORE */
1999
        return s->clkidle[2];
2000
    case 0x23c:        /* CM_AUTOIDLE4_CORE */
2001
        return s->clkidle[3];
2002

    
2003
    case 0x240:        /* CM_CLKSEL1_CORE */
2004
        return s->clksel[1];
2005
    case 0x244:        /* CM_CLKSEL2_CORE */
2006
        return s->clksel[2];
2007

    
2008
    case 0x248:        /* CM_CLKSTCTRL_CORE */
2009
        return s->clkctrl[1];
2010

    
2011
    case 0x2a0:        /* PM_WKEN1_CORE */
2012
        return s->wken[0];
2013
    case 0x2a4:        /* PM_WKEN2_CORE */
2014
        return s->wken[1];
2015

    
2016
    case 0x2b0:        /* PM_WKST1_CORE */
2017
        return s->wkst[0];
2018
    case 0x2b4:        /* PM_WKST2_CORE */
2019
        return s->wkst[1];
2020
    case 0x2c8:        /* PM_WKDEP_CORE */
2021
        return 0x1e;
2022

    
2023
    case 0x2e0:        /* PM_PWSTCTRL_CORE */
2024
        return s->power[1];
2025
    case 0x2e4:        /* PM_PWSTST_CORE */
2026
        return 0x000030 | (s->power[1] & 0xfc00);
2027

    
2028
    case 0x300:        /* CM_FCLKEN_GFX */
2029
        return s->clken[5];
2030
    case 0x310:        /* CM_ICLKEN_GFX */
2031
        return s->clken[6];
2032
    case 0x320:        /* CM_IDLEST_GFX */
2033
        /* TODO: check the actual iclk status */
2034
        return 0x00000001;
2035
    case 0x340:        /* CM_CLKSEL_GFX */
2036
        return s->clksel[3];
2037
    case 0x348:        /* CM_CLKSTCTRL_GFX */
2038
        return s->clkctrl[2];
2039
    case 0x350:        /* RM_RSTCTRL_GFX */
2040
        return s->rstctrl[0];
2041
    case 0x358:        /* RM_RSTST_GFX */
2042
        return s->rst[1];
2043
    case 0x3c8:        /* PM_WKDEP_GFX */
2044
        return s->wkup[1];
2045

    
2046
    case 0x3e0:        /* PM_PWSTCTRL_GFX */
2047
        return s->power[2];
2048
    case 0x3e4:        /* PM_PWSTST_GFX */
2049
        return s->power[2] & 3;
2050

    
2051
    case 0x400:        /* CM_FCLKEN_WKUP */
2052
        return s->clken[7];
2053
    case 0x410:        /* CM_ICLKEN_WKUP */
2054
        return s->clken[8];
2055
    case 0x420:        /* CM_IDLEST_WKUP */
2056
        /* TODO: check the actual iclk status */
2057
        return 0x0000003f;
2058
    case 0x430:        /* CM_AUTOIDLE_WKUP */
2059
        return s->clkidle[4];
2060
    case 0x440:        /* CM_CLKSEL_WKUP */
2061
        return s->clksel[4];
2062
    case 0x450:        /* RM_RSTCTRL_WKUP */
2063
        return 0;
2064
    case 0x454:        /* RM_RSTTIME_WKUP */
2065
        return s->rsttime_wkup;
2066
    case 0x458:        /* RM_RSTST_WKUP */
2067
        return s->rst[2];
2068
    case 0x4a0:        /* PM_WKEN_WKUP */
2069
        return s->wken[2];
2070
    case 0x4b0:        /* PM_WKST_WKUP */
2071
        return s->wkst[2];
2072

    
2073
    case 0x500:        /* CM_CLKEN_PLL */
2074
        return s->clken[9];
2075
    case 0x520:        /* CM_IDLEST_CKGEN */
2076
        /* Core uses 32-kHz clock */
2077
        if (!(s->clksel[6] & 3))
2078
            return 0x00000377;
2079
        /* DPLL not in lock mode, core uses ref_clk */
2080
        if ((s->clken[9] & 3) != 3)
2081
            return 0x00000375;
2082
        /* Core uses DPLL */
2083
        return 0x00000376;
2084
    case 0x530:        /* CM_AUTOIDLE_PLL */
2085
        return s->clkidle[5];
2086
    case 0x540:        /* CM_CLKSEL1_PLL */
2087
        return s->clksel[5];
2088
    case 0x544:        /* CM_CLKSEL2_PLL */
2089
        return s->clksel[6];
2090

    
2091
    case 0x800:        /* CM_FCLKEN_DSP */
2092
        return s->clken[10];
2093
    case 0x810:        /* CM_ICLKEN_DSP */
2094
        return s->clken[11];
2095
    case 0x820:        /* CM_IDLEST_DSP */
2096
        /* TODO: check the actual iclk status */
2097
        return 0x00000103;
2098
    case 0x830:        /* CM_AUTOIDLE_DSP */
2099
        return s->clkidle[6];
2100
    case 0x840:        /* CM_CLKSEL_DSP */
2101
        return s->clksel[7];
2102
    case 0x848:        /* CM_CLKSTCTRL_DSP */
2103
        return s->clkctrl[3];
2104
    case 0x850:        /* RM_RSTCTRL_DSP */
2105
        return 0;
2106
    case 0x858:        /* RM_RSTST_DSP */
2107
        return s->rst[3];
2108
    case 0x8c8:        /* PM_WKDEP_DSP */
2109
        return s->wkup[2];
2110
    case 0x8e0:        /* PM_PWSTCTRL_DSP */
2111
        return s->power[3];
2112
    case 0x8e4:        /* PM_PWSTST_DSP */
2113
        return 0x008030 | (s->power[3] & 0x3003);
2114

    
2115
    case 0x8f0:        /* PRCM_IRQSTATUS_DSP */
2116
        return s->irqst[1];
2117
    case 0x8f4:        /* PRCM_IRQENABLE_DSP */
2118
        return s->irqen[1];
2119

    
2120
    case 0x8f8:        /* PRCM_IRQSTATUS_IVA */
2121
        return s->irqst[2];
2122
    case 0x8fc:        /* PRCM_IRQENABLE_IVA */
2123
        return s->irqen[2];
2124
    }
2125

    
2126
    OMAP_BAD_REG(addr);
2127
    return 0;
2128
}
2129

    
2130
static void omap_prcm_write(void *opaque, target_phys_addr_t addr,
2131
                uint32_t value)
2132
{
2133
    struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
2134
    int offset = addr - s->base;
2135

    
2136
    switch (offset) {
2137
    case 0x000:        /* PRCM_REVISION */
2138
    case 0x054:        /* PRCM_VOLTST */
2139
    case 0x084:        /* PRCM_CLKCFG_STATUS */
2140
    case 0x1e4:        /* PM_PWSTST_MPU */
2141
    case 0x220:        /* CM_IDLEST1_CORE */
2142
    case 0x224:        /* CM_IDLEST2_CORE */
2143
    case 0x22c:        /* CM_IDLEST4_CORE */
2144
    case 0x2c8:        /* PM_WKDEP_CORE */
2145
    case 0x2e4:        /* PM_PWSTST_CORE */
2146
    case 0x320:        /* CM_IDLEST_GFX */
2147
    case 0x3e4:        /* PM_PWSTST_GFX */
2148
    case 0x420:        /* CM_IDLEST_WKUP */
2149
    case 0x520:        /* CM_IDLEST_CKGEN */
2150
    case 0x820:        /* CM_IDLEST_DSP */
2151
    case 0x8e4:        /* PM_PWSTST_DSP */
2152
        OMAP_RO_REG(addr);
2153
        return;
2154

    
2155
    case 0x010:        /* PRCM_SYSCONFIG */
2156
        s->sysconfig = value & 1;
2157
        break;
2158

    
2159
    case 0x018:        /* PRCM_IRQSTATUS_MPU */
2160
        s->irqst[0] &= ~value;
2161
        omap_prcm_int_update(s, 0);
2162
        break;
2163
    case 0x01c:        /* PRCM_IRQENABLE_MPU */
2164
        s->irqen[0] = value & 0x3f;
2165
        omap_prcm_int_update(s, 0);
2166
        break;
2167

    
2168
    case 0x050:        /* PRCM_VOLTCTRL */
2169
        s->voltctrl = value & 0xf1c3;
2170
        break;
2171

    
2172
    case 0x060:        /* PRCM_CLKSRC_CTRL */
2173
        s->clksrc[0] = value & 0xdb;
2174
        /* TODO update clocks */
2175
        break;
2176

    
2177
    case 0x070:        /* PRCM_CLKOUT_CTRL */
2178
        s->clkout[0] = value & 0xbbbb;
2179
        /* TODO update clocks */
2180
        break;
2181

    
2182
    case 0x078:        /* PRCM_CLKEMUL_CTRL */
2183
        s->clkemul[0] = value & 1;
2184
        /* TODO update clocks */
2185
        break;
2186

    
2187
    case 0x080:        /* PRCM_CLKCFG_CTRL */
2188
        break;
2189

    
2190
    case 0x090:        /* PRCM_VOLTSETUP */
2191
        s->setuptime[0] = value & 0xffff;
2192
        break;
2193
    case 0x094:        /* PRCM_CLKSSETUP */
2194
        s->setuptime[1] = value & 0xffff;
2195
        break;
2196

    
2197
    case 0x098:        /* PRCM_POLCTRL */
2198
        s->clkpol[0] = value & 0x701;
2199
        break;
2200

    
2201
    case 0x0b0:        /* GENERAL_PURPOSE1 */
2202
    case 0x0b4:        /* GENERAL_PURPOSE2 */
2203
    case 0x0b8:        /* GENERAL_PURPOSE3 */
2204
    case 0x0bc:        /* GENERAL_PURPOSE4 */
2205
    case 0x0c0:        /* GENERAL_PURPOSE5 */
2206
    case 0x0c4:        /* GENERAL_PURPOSE6 */
2207
    case 0x0c8:        /* GENERAL_PURPOSE7 */
2208
    case 0x0cc:        /* GENERAL_PURPOSE8 */
2209
    case 0x0d0:        /* GENERAL_PURPOSE9 */
2210
    case 0x0d4:        /* GENERAL_PURPOSE10 */
2211
    case 0x0d8:        /* GENERAL_PURPOSE11 */
2212
    case 0x0dc:        /* GENERAL_PURPOSE12 */
2213
    case 0x0e0:        /* GENERAL_PURPOSE13 */
2214
    case 0x0e4:        /* GENERAL_PURPOSE14 */
2215
    case 0x0e8:        /* GENERAL_PURPOSE15 */
2216
    case 0x0ec:        /* GENERAL_PURPOSE16 */
2217
    case 0x0f0:        /* GENERAL_PURPOSE17 */
2218
    case 0x0f4:        /* GENERAL_PURPOSE18 */
2219
    case 0x0f8:        /* GENERAL_PURPOSE19 */
2220
    case 0x0fc:        /* GENERAL_PURPOSE20 */
2221
        s->scratch[(offset - 0xb0) >> 2] = value;
2222
        break;
2223

    
2224
    case 0x140:        /* CM_CLKSEL_MPU */
2225
        s->clksel[0] = value & 0x1f;
2226
        /* TODO update clocks */
2227
        break;
2228
    case 0x148:        /* CM_CLKSTCTRL_MPU */
2229
        s->clkctrl[0] = value & 0x1f;
2230
        break;
2231

    
2232
    case 0x158:        /* RM_RSTST_MPU */
2233
        s->rst[0] &= ~value;
2234
        break;
2235
    case 0x1c8:        /* PM_WKDEP_MPU */
2236
        s->wkup[0] = value & 0x15;
2237
        break;
2238

    
2239
    case 0x1d4:        /* PM_EVGENCTRL_MPU */
2240
        s->ev = value & 0x1f;
2241
        break;
2242
    case 0x1d8:        /* PM_EVEGENONTIM_MPU */
2243
        s->evtime[0] = value;
2244
        break;
2245
    case 0x1dc:        /* PM_EVEGENOFFTIM_MPU */
2246
        s->evtime[1] = value;
2247
        break;
2248

    
2249
    case 0x1e0:        /* PM_PWSTCTRL_MPU */
2250
        s->power[0] = value & 0xc0f;
2251
        break;
2252

    
2253
    case 0x200:        /* CM_FCLKEN1_CORE */
2254
        s->clken[0] = value & 0xbfffffff;
2255
        /* TODO update clocks */
2256
        break;
2257
    case 0x204:        /* CM_FCLKEN2_CORE */
2258
        s->clken[1] = value & 0x00000007;
2259
        /* TODO update clocks */
2260
        break;
2261
    case 0x210:        /* CM_ICLKEN1_CORE */
2262
        s->clken[2] = value & 0xfffffff9;
2263
        /* TODO update clocks */
2264
        break;
2265
    case 0x214:        /* CM_ICLKEN2_CORE */
2266
        s->clken[3] = value & 0x00000007;
2267
        /* TODO update clocks */
2268
        break;
2269
    case 0x21c:        /* CM_ICLKEN4_CORE */
2270
        s->clken[4] = value & 0x0000001f;
2271
        /* TODO update clocks */
2272
        break;
2273

    
2274
    case 0x230:        /* CM_AUTOIDLE1_CORE */
2275
        s->clkidle[0] = value & 0xfffffff9;
2276
        /* TODO update clocks */
2277
        break;
2278
    case 0x234:        /* CM_AUTOIDLE2_CORE */
2279
        s->clkidle[1] = value & 0x00000007;
2280
        /* TODO update clocks */
2281
        break;
2282
    case 0x238:        /* CM_AUTOIDLE3_CORE */
2283
        s->clkidle[2] = value & 0x00000007;
2284
        /* TODO update clocks */
2285
        break;
2286
    case 0x23c:        /* CM_AUTOIDLE4_CORE */
2287
        s->clkidle[3] = value & 0x0000001f;
2288
        /* TODO update clocks */
2289
        break;
2290

    
2291
    case 0x240:        /* CM_CLKSEL1_CORE */
2292
        s->clksel[1] = value & 0x0fffbf7f;
2293
        /* TODO update clocks */
2294
        break;
2295

    
2296
    case 0x244:        /* CM_CLKSEL2_CORE */
2297
        s->clksel[2] = value & 0x00fffffc;
2298
        /* TODO update clocks */
2299
        break;
2300

    
2301
    case 0x248:        /* CM_CLKSTCTRL_CORE */
2302
        s->clkctrl[1] = value & 0x7;
2303
        break;
2304

    
2305
    case 0x2a0:        /* PM_WKEN1_CORE */
2306
        s->wken[0] = value & 0x04667ff8;
2307
        break;
2308
    case 0x2a4:        /* PM_WKEN2_CORE */
2309
        s->wken[1] = value & 0x00000005;
2310
        break;
2311

    
2312
    case 0x2b0:        /* PM_WKST1_CORE */
2313
        s->wkst[0] &= ~value;
2314
        break;
2315
    case 0x2b4:        /* PM_WKST2_CORE */
2316
        s->wkst[1] &= ~value;
2317
        break;
2318

    
2319
    case 0x2e0:        /* PM_PWSTCTRL_CORE */
2320
        s->power[1] = (value & 0x00fc3f) | (1 << 2);
2321
        break;
2322

    
2323
    case 0x300:        /* CM_FCLKEN_GFX */
2324
        s->clken[5] = value & 6;
2325
        /* TODO update clocks */
2326
        break;
2327
    case 0x310:        /* CM_ICLKEN_GFX */
2328
        s->clken[6] = value & 1;
2329
        /* TODO update clocks */
2330
        break;
2331
    case 0x340:        /* CM_CLKSEL_GFX */
2332
        s->clksel[3] = value & 7;
2333
        /* TODO update clocks */
2334
        break;
2335
    case 0x348:        /* CM_CLKSTCTRL_GFX */
2336
        s->clkctrl[2] = value & 1;
2337
        break;
2338
    case 0x350:        /* RM_RSTCTRL_GFX */
2339
        s->rstctrl[0] = value & 1;
2340
        /* TODO: reset */
2341
        break;
2342
    case 0x358:        /* RM_RSTST_GFX */
2343
        s->rst[1] &= ~value;
2344
        break;
2345
    case 0x3c8:        /* PM_WKDEP_GFX */
2346
        s->wkup[1] = value & 0x13;
2347
        break;
2348
    case 0x3e0:        /* PM_PWSTCTRL_GFX */
2349
        s->power[2] = (value & 0x00c0f) | (3 << 2);
2350
        break;
2351

    
2352
    case 0x400:        /* CM_FCLKEN_WKUP */
2353
        s->clken[7] = value & 0xd;
2354
        /* TODO update clocks */
2355
        break;
2356
    case 0x410:        /* CM_ICLKEN_WKUP */
2357
        s->clken[8] = value & 0x3f;
2358
        /* TODO update clocks */
2359
        break;
2360
    case 0x430:        /* CM_AUTOIDLE_WKUP */
2361
        s->clkidle[4] = value & 0x0000003f;
2362
        /* TODO update clocks */
2363
        break;
2364
    case 0x440:        /* CM_CLKSEL_WKUP */
2365
        s->clksel[4] = value & 3;
2366
        /* TODO update clocks */
2367
        break;
2368
    case 0x450:        /* RM_RSTCTRL_WKUP */
2369
        /* TODO: reset */
2370
        if (value & 2)
2371
            qemu_system_reset_request();
2372
        break;
2373
    case 0x454:        /* RM_RSTTIME_WKUP */
2374
        s->rsttime_wkup = value & 0x1fff;
2375
        break;
2376
    case 0x458:        /* RM_RSTST_WKUP */
2377
        s->rst[2] &= ~value;
2378
        break;
2379
    case 0x4a0:        /* PM_WKEN_WKUP */
2380
        s->wken[2] = value & 0x00000005;
2381
        break;
2382
    case 0x4b0:        /* PM_WKST_WKUP */
2383
        s->wkst[2] &= ~value;
2384
        break;
2385

    
2386
    case 0x500:        /* CM_CLKEN_PLL */
2387
        s->clken[9] = value & 0xcf;
2388
        /* TODO update clocks */
2389
        break;
2390
    case 0x530:        /* CM_AUTOIDLE_PLL */
2391
        s->clkidle[5] = value & 0x000000cf;
2392
        /* TODO update clocks */
2393
        break;
2394
    case 0x540:        /* CM_CLKSEL1_PLL */
2395
        s->clksel[5] = value & 0x03bfff28;
2396
        /* TODO update clocks */
2397
        break;
2398
    case 0x544:        /* CM_CLKSEL2_PLL */
2399
        s->clksel[6] = value & 3;
2400
        /* TODO update clocks */
2401
        break;
2402

    
2403
    case 0x800:        /* CM_FCLKEN_DSP */
2404
        s->clken[10] = value & 0x501;
2405
        /* TODO update clocks */
2406
        break;
2407
    case 0x810:        /* CM_ICLKEN_DSP */
2408
        s->clken[11] = value & 0x2;
2409
        /* TODO update clocks */
2410
        break;
2411
    case 0x830:        /* CM_AUTOIDLE_DSP */
2412
        s->clkidle[6] = value & 0x2;
2413
        /* TODO update clocks */
2414
        break;
2415
    case 0x840:        /* CM_CLKSEL_DSP */
2416
        s->clksel[7] = value & 0x3fff;
2417
        /* TODO update clocks */
2418
        break;
2419
    case 0x848:        /* CM_CLKSTCTRL_DSP */
2420
        s->clkctrl[3] = value & 0x101;
2421
        break;
2422
    case 0x850:        /* RM_RSTCTRL_DSP */
2423
        /* TODO: reset */
2424
        break;
2425
    case 0x858:        /* RM_RSTST_DSP */
2426
        s->rst[3] &= ~value;
2427
        break;
2428
    case 0x8c8:        /* PM_WKDEP_DSP */
2429
        s->wkup[2] = value & 0x13;
2430
        break;
2431
    case 0x8e0:        /* PM_PWSTCTRL_DSP */
2432
        s->power[3] = (value & 0x03017) | (3 << 2);
2433
        break;
2434

    
2435
    case 0x8f0:        /* PRCM_IRQSTATUS_DSP */
2436
        s->irqst[1] &= ~value;
2437
        omap_prcm_int_update(s, 1);
2438
        break;
2439
    case 0x8f4:        /* PRCM_IRQENABLE_DSP */
2440
        s->irqen[1] = value & 0x7;
2441
        omap_prcm_int_update(s, 1);
2442
        break;
2443

    
2444
    case 0x8f8:        /* PRCM_IRQSTATUS_IVA */
2445
        s->irqst[2] &= ~value;
2446
        omap_prcm_int_update(s, 2);
2447
        break;
2448
    case 0x8fc:        /* PRCM_IRQENABLE_IVA */
2449
        s->irqen[2] = value & 0x7;
2450
        omap_prcm_int_update(s, 2);
2451
        break;
2452

    
2453
    default:
2454
        OMAP_BAD_REG(addr);
2455
        return;
2456
    }
2457
}
2458

    
2459
static CPUReadMemoryFunc *omap_prcm_readfn[] = {
2460
    omap_badwidth_read32,
2461
    omap_badwidth_read32,
2462
    omap_prcm_read,
2463
};
2464

    
2465
static CPUWriteMemoryFunc *omap_prcm_writefn[] = {
2466
    omap_badwidth_write32,
2467
    omap_badwidth_write32,
2468
    omap_prcm_write,
2469
};
2470

    
2471
static void omap_prcm_reset(struct omap_prcm_s *s)
2472
{
2473
    s->sysconfig = 0;
2474
    s->irqst[0] = 0;
2475
    s->irqst[1] = 0;
2476
    s->irqst[2] = 0;
2477
    s->irqen[0] = 0;
2478
    s->irqen[1] = 0;
2479
    s->irqen[2] = 0;
2480
    s->voltctrl = 0x1040;
2481
    s->ev = 0x14;
2482
    s->evtime[0] = 0;
2483
    s->evtime[1] = 0;
2484
    s->clkctrl[0] = 0;
2485
    s->clkctrl[1] = 0;
2486
    s->clkctrl[2] = 0;
2487
    s->clkctrl[3] = 0;
2488
    s->clken[1] = 7;
2489
    s->clken[3] = 7;
2490
    s->clken[4] = 0;
2491
    s->clken[5] = 0;
2492
    s->clken[6] = 0;
2493
    s->clken[7] = 0xc;
2494
    s->clken[8] = 0x3e;
2495
    s->clken[9] = 0x0d;
2496
    s->clken[10] = 0;
2497
    s->clken[11] = 0;
2498
    s->clkidle[0] = 0;
2499
    s->clkidle[2] = 7;
2500
    s->clkidle[3] = 0;
2501
    s->clkidle[4] = 0;
2502
    s->clkidle[5] = 0x0c;
2503
    s->clkidle[6] = 0;
2504
    s->clksel[0] = 0x01;
2505
    s->clksel[1] = 0x02100121;
2506
    s->clksel[2] = 0x00000000;
2507
    s->clksel[3] = 0x01;
2508
    s->clksel[4] = 0;
2509
    s->clksel[7] = 0x0121;
2510
    s->wkup[0] = 0x15;
2511
    s->wkup[1] = 0x13;
2512
    s->wkup[2] = 0x13;
2513
    s->wken[0] = 0x04667ff8;
2514
    s->wken[1] = 0x00000005;
2515
    s->wken[2] = 5;
2516
    s->wkst[0] = 0;
2517
    s->wkst[1] = 0;
2518
    s->wkst[2] = 0;
2519
    s->power[0] = 0x00c;
2520
    s->power[1] = 4;
2521
    s->power[2] = 0x0000c;
2522
    s->power[3] = 0x14;
2523
    s->rstctrl[0] = 1;
2524
    s->rst[3] = 1;
2525
}
2526

    
2527
static void omap_prcm_coldreset(struct omap_prcm_s *s)
2528
{
2529
    s->setuptime[0] = 0;
2530
    s->setuptime[1] = 0;
2531
    memset(&s->scratch, 0, sizeof(s->scratch));
2532
    s->rst[0] = 0x01;
2533
    s->rst[1] = 0x00;
2534
    s->rst[2] = 0x01;
2535
    s->clken[0] = 0;
2536
    s->clken[2] = 0;
2537
    s->clkidle[1] = 0;
2538
    s->clksel[5] = 0;
2539
    s->clksel[6] = 2;
2540
    s->clksrc[0] = 0x43;
2541
    s->clkout[0] = 0x0303;
2542
    s->clkemul[0] = 0;
2543
    s->clkpol[0] = 0x100;
2544
    s->rsttime_wkup = 0x1002;
2545

    
2546
    omap_prcm_reset(s);
2547
}
2548

    
2549
struct omap_prcm_s *omap_prcm_init(struct omap_target_agent_s *ta,
2550
                qemu_irq mpu_int, qemu_irq dsp_int, qemu_irq iva_int,
2551
                struct omap_mpu_state_s *mpu)
2552
{
2553
    int iomemtype;
2554
    struct omap_prcm_s *s = (struct omap_prcm_s *)
2555
            qemu_mallocz(sizeof(struct omap_prcm_s));
2556

    
2557
    s->irq[0] = mpu_int;
2558
    s->irq[1] = dsp_int;
2559
    s->irq[2] = iva_int;
2560
    s->mpu = mpu;
2561
    omap_prcm_coldreset(s);
2562

    
2563
    iomemtype = cpu_register_io_memory(0, omap_prcm_readfn,
2564
                    omap_prcm_writefn, s);
2565
    s->base = omap_l4_attach(ta, 0, iomemtype);
2566
    omap_l4_attach(ta, 1, iomemtype);
2567

    
2568
    return s;
2569
}
2570

    
2571
/* System and Pinout control */
2572
struct omap_sysctl_s {
2573
    target_phys_addr_t base;
2574
    struct omap_mpu_state_s *mpu;
2575

    
2576
    uint32_t sysconfig;
2577
    uint32_t devconfig;
2578
    uint32_t psaconfig;
2579
    uint32_t padconf[0x45];
2580
    uint8_t obs;
2581
    uint32_t msuspendmux[5];
2582
};
2583

    
2584
static uint32_t omap_sysctl_read(void *opaque, target_phys_addr_t addr)
2585
{
2586
    struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
2587
    int offset = addr - s->base;
2588

    
2589
    switch (offset) {
2590
    case 0x000:        /* CONTROL_REVISION */
2591
        return 0x20;
2592

    
2593
    case 0x010:        /* CONTROL_SYSCONFIG */
2594
        return s->sysconfig;
2595

    
2596
    case 0x030 ... 0x140:        /* CONTROL_PADCONF - only used in the POP */
2597
        return s->padconf[(offset - 0x30) >> 2];
2598

    
2599
    case 0x270:        /* CONTROL_DEBOBS */
2600
        return s->obs;
2601

    
2602
    case 0x274:        /* CONTROL_DEVCONF */
2603
        return s->devconfig;
2604

    
2605
    case 0x28c:        /* CONTROL_EMU_SUPPORT */
2606
        return 0;
2607

    
2608
    case 0x290:        /* CONTROL_MSUSPENDMUX_0 */
2609
        return s->msuspendmux[0];
2610
    case 0x294:        /* CONTROL_MSUSPENDMUX_1 */
2611
        return s->msuspendmux[1];
2612
    case 0x298:        /* CONTROL_MSUSPENDMUX_2 */
2613
        return s->msuspendmux[2];
2614
    case 0x29c:        /* CONTROL_MSUSPENDMUX_3 */
2615
        return s->msuspendmux[3];
2616
    case 0x2a0:        /* CONTROL_MSUSPENDMUX_4 */
2617
        return s->msuspendmux[4];
2618
    case 0x2a4:        /* CONTROL_MSUSPENDMUX_5 */
2619
        return 0;
2620

    
2621
    case 0x2b8:        /* CONTROL_PSA_CTRL */
2622
        return s->psaconfig;
2623
    case 0x2bc:        /* CONTROL_PSA_CMD */
2624
    case 0x2c0:        /* CONTROL_PSA_VALUE */
2625
        return 0;
2626

    
2627
    case 0x2b0:        /* CONTROL_SEC_CTRL */
2628
        return 0x800000f1;
2629
    case 0x2d0:        /* CONTROL_SEC_EMU */
2630
        return 0x80000015;
2631
    case 0x2d4:        /* CONTROL_SEC_TAP */
2632
        return 0x8000007f;
2633
    case 0x2b4:        /* CONTROL_SEC_TEST */
2634
    case 0x2f0:        /* CONTROL_SEC_STATUS */
2635
    case 0x2f4:        /* CONTROL_SEC_ERR_STATUS */
2636
        /* Secure mode is not present on general-pusrpose device.  Outside
2637
         * secure mode these values cannot be read or written.  */
2638
        return 0;
2639

    
2640
    case 0x2d8:        /* CONTROL_OCM_RAM_PERM */
2641
        return 0xff;
2642
    case 0x2dc:        /* CONTROL_OCM_PUB_RAM_ADD */
2643
    case 0x2e0:        /* CONTROL_EXT_SEC_RAM_START_ADD */
2644
    case 0x2e4:        /* CONTROL_EXT_SEC_RAM_STOP_ADD */
2645
        /* No secure mode so no Extended Secure RAM present.  */
2646
        return 0;
2647

    
2648
    case 0x2f8:        /* CONTROL_STATUS */
2649
        /* Device Type => General-purpose */
2650
        return 0x0300;
2651
    case 0x2fc:        /* CONTROL_GENERAL_PURPOSE_STATUS */
2652

    
2653
    case 0x300:        /* CONTROL_RPUB_KEY_H_0 */
2654
    case 0x304:        /* CONTROL_RPUB_KEY_H_1 */
2655
    case 0x308:        /* CONTROL_RPUB_KEY_H_2 */
2656
    case 0x30c:        /* CONTROL_RPUB_KEY_H_3 */
2657
        return 0xdecafbad;
2658

    
2659
    case 0x310:        /* CONTROL_RAND_KEY_0 */
2660
    case 0x314:        /* CONTROL_RAND_KEY_1 */
2661
    case 0x318:        /* CONTROL_RAND_KEY_2 */
2662
    case 0x31c:        /* CONTROL_RAND_KEY_3 */
2663
    case 0x320:        /* CONTROL_CUST_KEY_0 */
2664
    case 0x324:        /* CONTROL_CUST_KEY_1 */
2665
    case 0x330:        /* CONTROL_TEST_KEY_0 */
2666
    case 0x334:        /* CONTROL_TEST_KEY_1 */
2667
    case 0x338:        /* CONTROL_TEST_KEY_2 */
2668
    case 0x33c:        /* CONTROL_TEST_KEY_3 */
2669
    case 0x340:        /* CONTROL_TEST_KEY_4 */
2670
    case 0x344:        /* CONTROL_TEST_KEY_5 */
2671
    case 0x348:        /* CONTROL_TEST_KEY_6 */
2672
    case 0x34c:        /* CONTROL_TEST_KEY_7 */
2673
    case 0x350:        /* CONTROL_TEST_KEY_8 */
2674
    case 0x354:        /* CONTROL_TEST_KEY_9 */
2675
        /* Can only be accessed in secure mode and when C_FieldAccEnable
2676
         * bit is set in CONTROL_SEC_CTRL.
2677
         * TODO: otherwise an interconnect access error is generated.  */
2678
        return 0;
2679
    }
2680

    
2681
    OMAP_BAD_REG(addr);
2682
    return 0;
2683
}
2684

    
2685
static void omap_sysctl_write(void *opaque, target_phys_addr_t addr,
2686
                uint32_t value)
2687
{
2688
    struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
2689
    int offset = addr - s->base;
2690

    
2691
    switch (offset) {
2692
    case 0x000:        /* CONTROL_REVISION */
2693
    case 0x2a4:        /* CONTROL_MSUSPENDMUX_5 */
2694
    case 0x2c0:        /* CONTROL_PSA_VALUE */
2695
    case 0x2f8:        /* CONTROL_STATUS */
2696
    case 0x2fc:        /* CONTROL_GENERAL_PURPOSE_STATUS */
2697
    case 0x300:        /* CONTROL_RPUB_KEY_H_0 */
2698
    case 0x304:        /* CONTROL_RPUB_KEY_H_1 */
2699
    case 0x308:        /* CONTROL_RPUB_KEY_H_2 */
2700
    case 0x30c:        /* CONTROL_RPUB_KEY_H_3 */
2701
    case 0x310:        /* CONTROL_RAND_KEY_0 */
2702
    case 0x314:        /* CONTROL_RAND_KEY_1 */
2703
    case 0x318:        /* CONTROL_RAND_KEY_2 */
2704
    case 0x31c:        /* CONTROL_RAND_KEY_3 */
2705
    case 0x320:        /* CONTROL_CUST_KEY_0 */
2706
    case 0x324:        /* CONTROL_CUST_KEY_1 */
2707
    case 0x330:        /* CONTROL_TEST_KEY_0 */
2708
    case 0x334:        /* CONTROL_TEST_KEY_1 */
2709
    case 0x338:        /* CONTROL_TEST_KEY_2 */
2710
    case 0x33c:        /* CONTROL_TEST_KEY_3 */
2711
    case 0x340:        /* CONTROL_TEST_KEY_4 */
2712
    case 0x344:        /* CONTROL_TEST_KEY_5 */
2713
    case 0x348:        /* CONTROL_TEST_KEY_6 */
2714
    case 0x34c:        /* CONTROL_TEST_KEY_7 */
2715
    case 0x350:        /* CONTROL_TEST_KEY_8 */
2716
    case 0x354:        /* CONTROL_TEST_KEY_9 */
2717
        OMAP_RO_REG(addr);
2718
        return;
2719

    
2720
    case 0x010:        /* CONTROL_SYSCONFIG */
2721
        s->sysconfig = value & 0x1e;
2722
        break;
2723

    
2724
    case 0x030 ... 0x140:        /* CONTROL_PADCONF - only used in the POP */
2725
        /* XXX: should check constant bits */
2726
        s->padconf[(offset - 0x30) >> 2] = value & 0x1f1f1f1f;
2727
        break;
2728

    
2729
    case 0x270:        /* CONTROL_DEBOBS */
2730
        s->obs = value & 0xff;
2731
        break;
2732

    
2733
    case 0x274:        /* CONTROL_DEVCONF */
2734
        s->devconfig = value & 0xffffc7ff;
2735
        break;
2736

    
2737
    case 0x28c:        /* CONTROL_EMU_SUPPORT */
2738
        break;
2739

    
2740
    case 0x290:        /* CONTROL_MSUSPENDMUX_0 */
2741
        s->msuspendmux[0] = value & 0x3fffffff;
2742
        break;
2743
    case 0x294:        /* CONTROL_MSUSPENDMUX_1 */
2744
        s->msuspendmux[1] = value & 0x3fffffff;
2745
        break;
2746
    case 0x298:        /* CONTROL_MSUSPENDMUX_2 */
2747
        s->msuspendmux[2] = value & 0x3fffffff;
2748
        break;
2749
    case 0x29c:        /* CONTROL_MSUSPENDMUX_3 */
2750
        s->msuspendmux[3] = value & 0x3fffffff;
2751
        break;
2752
    case 0x2a0:        /* CONTROL_MSUSPENDMUX_4 */
2753
        s->msuspendmux[4] = value & 0x3fffffff;
2754
        break;
2755

    
2756
    case 0x2b8:        /* CONTROL_PSA_CTRL */
2757
        s->psaconfig = value & 0x1c;
2758
        s->psaconfig |= (value & 0x20) ? 2 : 1;
2759
        break;
2760
    case 0x2bc:        /* CONTROL_PSA_CMD */
2761
        break;
2762

    
2763
    case 0x2b0:        /* CONTROL_SEC_CTRL */
2764
    case 0x2b4:        /* CONTROL_SEC_TEST */
2765
    case 0x2d0:        /* CONTROL_SEC_EMU */
2766
    case 0x2d4:        /* CONTROL_SEC_TAP */
2767
    case 0x2d8:        /* CONTROL_OCM_RAM_PERM */
2768
    case 0x2dc:        /* CONTROL_OCM_PUB_RAM_ADD */
2769
    case 0x2e0:        /* CONTROL_EXT_SEC_RAM_START_ADD */
2770
    case 0x2e4:        /* CONTROL_EXT_SEC_RAM_STOP_ADD */
2771
    case 0x2f0:        /* CONTROL_SEC_STATUS */
2772
    case 0x2f4:        /* CONTROL_SEC_ERR_STATUS */
2773
        break;
2774

    
2775
    default:
2776
        OMAP_BAD_REG(addr);
2777
        return;
2778
    }
2779
}
2780

    
2781
static CPUReadMemoryFunc *omap_sysctl_readfn[] = {
2782
    omap_badwidth_read32,        /* TODO */
2783
    omap_badwidth_read32,        /* TODO */
2784
    omap_sysctl_read,
2785
};
2786

    
2787
static CPUWriteMemoryFunc *omap_sysctl_writefn[] = {
2788
    omap_badwidth_write32,        /* TODO */
2789
    omap_badwidth_write32,        /* TODO */
2790
    omap_sysctl_write,
2791
};
2792

    
2793
static void omap_sysctl_reset(struct omap_sysctl_s *s)
2794
{
2795
    /* (power-on reset) */
2796
    s->sysconfig = 0;
2797
    s->obs = 0;
2798
    s->devconfig = 0x0c000000;
2799
    s->msuspendmux[0] = 0x00000000;
2800
    s->msuspendmux[1] = 0x00000000;
2801
    s->msuspendmux[2] = 0x00000000;
2802
    s->msuspendmux[3] = 0x00000000;
2803
    s->msuspendmux[4] = 0x00000000;
2804
    s->psaconfig = 1;
2805

    
2806
    s->padconf[0x00] = 0x000f0f0f;
2807
    s->padconf[0x01] = 0x00000000;
2808
    s->padconf[0x02] = 0x00000000;
2809
    s->padconf[0x03] = 0x00000000;
2810
    s->padconf[0x04] = 0x00000000;
2811
    s->padconf[0x05] = 0x00000000;
2812
    s->padconf[0x06] = 0x00000000;
2813
    s->padconf[0x07] = 0x00000000;
2814
    s->padconf[0x08] = 0x08080800;
2815
    s->padconf[0x09] = 0x08080808;
2816
    s->padconf[0x0a] = 0x08080808;
2817
    s->padconf[0x0b] = 0x08080808;
2818
    s->padconf[0x0c] = 0x08080808;
2819
    s->padconf[0x0d] = 0x08080800;
2820
    s->padconf[0x0e] = 0x08080808;
2821
    s->padconf[0x0f] = 0x08080808;
2822
    s->padconf[0x10] = 0x18181808;        /* | 0x07070700 if SBoot3 */
2823
    s->padconf[0x11] = 0x18181818;        /* | 0x07070707 if SBoot3 */
2824
    s->padconf[0x12] = 0x18181818;        /* | 0x07070707 if SBoot3 */
2825
    s->padconf[0x13] = 0x18181818;        /* | 0x07070707 if SBoot3 */
2826
    s->padconf[0x14] = 0x18181818;        /* | 0x00070707 if SBoot3 */
2827
    s->padconf[0x15] = 0x18181818;
2828
    s->padconf[0x16] = 0x18181818;        /* | 0x07000000 if SBoot3 */
2829
    s->padconf[0x17] = 0x1f001f00;
2830
    s->padconf[0x18] = 0x1f1f1f1f;
2831
    s->padconf[0x19] = 0x00000000;
2832
    s->padconf[0x1a] = 0x1f180000;
2833
    s->padconf[0x1b] = 0x00001f1f;
2834
    s->padconf[0x1c] = 0x1f001f00;
2835
    s->padconf[0x1d] = 0x00000000;
2836
    s->padconf[0x1e] = 0x00000000;
2837
    s->padconf[0x1f] = 0x08000000;
2838
    s->padconf[0x20] = 0x08080808;
2839
    s->padconf[0x21] = 0x08080808;
2840
    s->padconf[0x22] = 0x0f080808;
2841
    s->padconf[0x23] = 0x0f0f0f0f;
2842
    s->padconf[0x24] = 0x000f0f0f;
2843
    s->padconf[0x25] = 0x1f1f1f0f;
2844
    s->padconf[0x26] = 0x080f0f1f;
2845
    s->padconf[0x27] = 0x070f1808;
2846
    s->padconf[0x28] = 0x0f070707;
2847
    s->padconf[0x29] = 0x000f0f1f;
2848
    s->padconf[0x2a] = 0x0f0f0f1f;
2849
    s->padconf[0x2b] = 0x08000000;
2850
    s->padconf[0x2c] = 0x0000001f;
2851
    s->padconf[0x2d] = 0x0f0f1f00;
2852
    s->padconf[0x2e] = 0x1f1f0f0f;
2853
    s->padconf[0x2f] = 0x0f1f1f1f;
2854
    s->padconf[0x30] = 0x0f0f0f0f;
2855
    s->padconf[0x31] = 0x0f1f0f1f;
2856
    s->padconf[0x32] = 0x0f0f0f0f;
2857
    s->padconf[0x33] = 0x0f1f0f1f;
2858
    s->padconf[0x34] = 0x1f1f0f0f;
2859
    s->padconf[0x35] = 0x0f0f1f1f;
2860
    s->padconf[0x36] = 0x0f0f1f0f;
2861
    s->padconf[0x37] = 0x0f0f0f0f;
2862
    s->padconf[0x38] = 0x1f18180f;
2863
    s->padconf[0x39] = 0x1f1f1f1f;
2864
    s->padconf[0x3a] = 0x00001f1f;
2865
    s->padconf[0x3b] = 0x00000000;
2866
    s->padconf[0x3c] = 0x00000000;
2867
    s->padconf[0x3d] = 0x0f0f0f0f;
2868
    s->padconf[0x3e] = 0x18000f0f;
2869
    s->padconf[0x3f] = 0x00070000;
2870
    s->padconf[0x40] = 0x00000707;
2871
    s->padconf[0x41] = 0x0f1f0700;
2872
    s->padconf[0x42] = 0x1f1f070f;
2873
    s->padconf[0x43] = 0x0008081f;
2874
    s->padconf[0x44] = 0x00000800;
2875
}
2876

    
2877
struct omap_sysctl_s *omap_sysctl_init(struct omap_target_agent_s *ta,
2878
                omap_clk iclk, struct omap_mpu_state_s *mpu)
2879
{
2880
    int iomemtype;
2881
    struct omap_sysctl_s *s = (struct omap_sysctl_s *)
2882
            qemu_mallocz(sizeof(struct omap_sysctl_s));
2883

    
2884
    s->mpu = mpu;
2885
    omap_sysctl_reset(s);
2886

    
2887
    iomemtype = cpu_register_io_memory(0, omap_sysctl_readfn,
2888
                    omap_sysctl_writefn, s);
2889
    s->base = omap_l4_attach(ta, 0, iomemtype);
2890
    omap_l4_attach(ta, 0, iomemtype);
2891

    
2892
    return s;
2893
}
2894

    
2895
/* SDRAM Controller Subsystem */
2896
struct omap_sdrc_s {
2897
    target_phys_addr_t base;
2898

    
2899
    uint8_t config;
2900
};
2901

    
2902
static void omap_sdrc_reset(struct omap_sdrc_s *s)
2903
{
2904
    s->config = 0x10;
2905
}
2906

    
2907
static uint32_t omap_sdrc_read(void *opaque, target_phys_addr_t addr)
2908
{
2909
    struct omap_sdrc_s *s = (struct omap_sdrc_s *) opaque;
2910
    int offset = addr - s->base;
2911

    
2912
    switch (offset) {
2913
    case 0x00:        /* SDRC_REVISION */
2914
        return 0x20;
2915

    
2916
    case 0x10:        /* SDRC_SYSCONFIG */
2917
        return s->config;
2918

    
2919
    case 0x14:        /* SDRC_SYSSTATUS */
2920
        return 1;                                                /* RESETDONE */
2921

    
2922
    case 0x40:        /* SDRC_CS_CFG */
2923
    case 0x44:        /* SDRC_SHARING */
2924
    case 0x48:        /* SDRC_ERR_ADDR */
2925
    case 0x4c:        /* SDRC_ERR_TYPE */
2926
    case 0x60:        /* SDRC_DLLA_SCTRL */
2927
    case 0x64:        /* SDRC_DLLA_STATUS */
2928
    case 0x68:        /* SDRC_DLLB_CTRL */
2929
    case 0x6c:        /* SDRC_DLLB_STATUS */
2930
    case 0x70:        /* SDRC_POWER */
2931
    case 0x80:        /* SDRC_MCFG_0 */
2932
    case 0x84:        /* SDRC_MR_0 */
2933
    case 0x88:        /* SDRC_EMR1_0 */
2934
    case 0x8c:        /* SDRC_EMR2_0 */
2935
    case 0x90:        /* SDRC_EMR3_0 */
2936
    case 0x94:        /* SDRC_DCDL1_CTRL */
2937
    case 0x98:        /* SDRC_DCDL2_CTRL */
2938
    case 0x9c:        /* SDRC_ACTIM_CTRLA_0 */
2939
    case 0xa0:        /* SDRC_ACTIM_CTRLB_0 */
2940
    case 0xa4:        /* SDRC_RFR_CTRL_0 */
2941
    case 0xa8:        /* SDRC_MANUAL_0 */
2942
    case 0xb0:        /* SDRC_MCFG_1 */
2943
    case 0xb4:        /* SDRC_MR_1 */
2944
    case 0xb8:        /* SDRC_EMR1_1 */
2945
    case 0xbc:        /* SDRC_EMR2_1 */
2946
    case 0xc0:        /* SDRC_EMR3_1 */
2947
    case 0xc4:        /* SDRC_ACTIM_CTRLA_1 */
2948
    case 0xc8:        /* SDRC_ACTIM_CTRLB_1 */
2949
    case 0xd4:        /* SDRC_RFR_CTRL_1 */
2950
    case 0xd8:        /* SDRC_MANUAL_1 */
2951
        return 0x00;
2952
    }
2953

    
2954
    OMAP_BAD_REG(addr);
2955
    return 0;
2956
}
2957

    
2958
static void omap_sdrc_write(void *opaque, target_phys_addr_t addr,
2959
                uint32_t value)
2960
{
2961
    struct omap_sdrc_s *s = (struct omap_sdrc_s *) opaque;
2962
    int offset = addr - s->base;
2963

    
2964
    switch (offset) {
2965
    case 0x00:        /* SDRC_REVISION */
2966
    case 0x14:        /* SDRC_SYSSTATUS */
2967
    case 0x48:        /* SDRC_ERR_ADDR */
2968
    case 0x64:        /* SDRC_DLLA_STATUS */
2969
    case 0x6c:        /* SDRC_DLLB_STATUS */
2970
        OMAP_RO_REG(addr);
2971
        return;
2972

    
2973
    case 0x10:        /* SDRC_SYSCONFIG */
2974
        if ((value >> 3) != 0x2)
2975
            fprintf(stderr, "%s: bad SDRAM idle mode %i\n",
2976
                            __FUNCTION__, value >> 3);
2977
        if (value & 2)
2978
            omap_sdrc_reset(s);
2979
        s->config = value & 0x18;
2980
        break;
2981

    
2982
    case 0x40:        /* SDRC_CS_CFG */
2983
    case 0x44:        /* SDRC_SHARING */
2984
    case 0x4c:        /* SDRC_ERR_TYPE */
2985
    case 0x60:        /* SDRC_DLLA_SCTRL */
2986
    case 0x68:        /* SDRC_DLLB_CTRL */
2987
    case 0x70:        /* SDRC_POWER */
2988
    case 0x80:        /* SDRC_MCFG_0 */
2989
    case 0x84:        /* SDRC_MR_0 */
2990
    case 0x88:        /* SDRC_EMR1_0 */
2991
    case 0x8c:        /* SDRC_EMR2_0 */
2992
    case 0x90:        /* SDRC_EMR3_0 */
2993
    case 0x94:        /* SDRC_DCDL1_CTRL */
2994
    case 0x98:        /* SDRC_DCDL2_CTRL */
2995
    case 0x9c:        /* SDRC_ACTIM_CTRLA_0 */
2996
    case 0xa0:        /* SDRC_ACTIM_CTRLB_0 */
2997
    case 0xa4:        /* SDRC_RFR_CTRL_0 */
2998
    case 0xa8:        /* SDRC_MANUAL_0 */
2999
    case 0xb0:        /* SDRC_MCFG_1 */
3000
    case 0xb4:        /* SDRC_MR_1 */
3001
    case 0xb8:        /* SDRC_EMR1_1 */
3002
    case 0xbc:        /* SDRC_EMR2_1 */
3003
    case 0xc0:        /* SDRC_EMR3_1 */
3004
    case 0xc4:        /* SDRC_ACTIM_CTRLA_1 */
3005
    case 0xc8:        /* SDRC_ACTIM_CTRLB_1 */
3006
    case 0xd4:        /* SDRC_RFR_CTRL_1 */
3007
    case 0xd8:        /* SDRC_MANUAL_1 */
3008
        break;
3009

    
3010
    default:
3011
        OMAP_BAD_REG(addr);
3012
        return;
3013
    }
3014
}
3015

    
3016
static CPUReadMemoryFunc *omap_sdrc_readfn[] = {
3017
    omap_badwidth_read32,
3018
    omap_badwidth_read32,
3019
    omap_sdrc_read,
3020
};
3021

    
3022
static CPUWriteMemoryFunc *omap_sdrc_writefn[] = {
3023
    omap_badwidth_write32,
3024
    omap_badwidth_write32,
3025
    omap_sdrc_write,
3026
};
3027

    
3028
struct omap_sdrc_s *omap_sdrc_init(target_phys_addr_t base)
3029
{
3030
    int iomemtype;
3031
    struct omap_sdrc_s *s = (struct omap_sdrc_s *)
3032
            qemu_mallocz(sizeof(struct omap_sdrc_s));
3033

    
3034
    s->base = base;
3035
    omap_sdrc_reset(s);
3036

    
3037
    iomemtype = cpu_register_io_memory(0, omap_sdrc_readfn,
3038
                    omap_sdrc_writefn, s);
3039
    cpu_register_physical_memory(s->base, 0x1000, iomemtype);
3040

    
3041
    return s;
3042
}
3043

    
3044
/* General-Purpose Memory Controller */
3045
struct omap_gpmc_s {
3046
    target_phys_addr_t base;
3047
    qemu_irq irq;
3048

    
3049
    uint8_t sysconfig;
3050
    uint16_t irqst;
3051
    uint16_t irqen;
3052
    uint16_t timeout;
3053
    uint16_t config;
3054
    uint32_t prefconfig[2];
3055
    int prefcontrol;
3056
    int preffifo;
3057
    int prefcount;
3058
    struct omap_gpmc_cs_file_s {
3059
        uint32_t config[7];
3060
        target_phys_addr_t base;
3061
        size_t size;
3062
        int iomemtype;
3063
        void (*base_update)(void *opaque, target_phys_addr_t new);
3064
        void (*unmap)(void *opaque);
3065
        void *opaque;
3066
    } cs_file[8];
3067
    int ecc_cs;
3068
    int ecc_ptr;
3069
    uint32_t ecc_cfg;
3070
    struct ecc_state_s ecc[9];
3071
};
3072

    
3073
static void omap_gpmc_int_update(struct omap_gpmc_s *s)
3074
{
3075
    qemu_set_irq(s->irq, s->irqen & s->irqst);
3076
}
3077

    
3078
static void omap_gpmc_cs_map(struct omap_gpmc_cs_file_s *f, int base, int mask)
3079
{
3080
    /* TODO: check for overlapping regions and report access errors */
3081
    if ((mask != 0x8 && mask != 0xc && mask != 0xe && mask != 0xf) ||
3082
                    (base < 0 || base >= 0x40) ||
3083
                    (base & 0x0f & ~mask)) {
3084
        fprintf(stderr, "%s: wrong cs address mapping/decoding!\n",
3085
                        __FUNCTION__);
3086
        return;
3087
    }
3088

    
3089
    if (!f->opaque)
3090
        return;
3091

    
3092
    f->base = base << 24;
3093
    f->size = (0x0fffffff & ~(mask << 24)) + 1;
3094
    /* TODO: rather than setting the size of the mapping (which should be
3095
     * constant), the mask should cause wrapping of the address space, so
3096
     * that the same memory becomes accessible at every <i>size</i> bytes
3097
     * starting from <i>base</i>.  */
3098
    if (f->iomemtype)
3099
        cpu_register_physical_memory(f->base, f->size, f->iomemtype);
3100

    
3101
    if (f->base_update)
3102
        f->base_update(f->opaque, f->base);
3103
}
3104

    
3105
static void omap_gpmc_cs_unmap(struct omap_gpmc_cs_file_s *f)
3106
{
3107
    if (f->size) {
3108
        if (f->unmap)
3109
            f->unmap(f->opaque);
3110
        if (f->iomemtype)
3111
            cpu_register_physical_memory(f->base, f->size, IO_MEM_UNASSIGNED);
3112
        f->base = 0;
3113
        f->size = 0;
3114
    }
3115
}
3116

    
3117
static void omap_gpmc_reset(struct omap_gpmc_s *s)
3118
{
3119
    int i;
3120

    
3121
    s->sysconfig = 0;
3122
    s->irqst = 0;
3123
    s->irqen = 0;
3124
    omap_gpmc_int_update(s);
3125
    s->timeout = 0;
3126
    s->config = 0xa00;
3127
    s->prefconfig[0] = 0x00004000;
3128
    s->prefconfig[1] = 0x00000000;
3129
    s->prefcontrol = 0;
3130
    s->preffifo = 0;
3131
    s->prefcount = 0;
3132
    for (i = 0; i < 8; i ++) {
3133
        if (s->cs_file[i].config[6] & (1 << 6))                        /* CSVALID */
3134
            omap_gpmc_cs_unmap(s->cs_file + i);
3135
        s->cs_file[i].config[0] = i ? 1 << 12 : 0;
3136
        s->cs_file[i].config[1] = 0x101001;
3137
        s->cs_file[i].config[2] = 0x020201;
3138
        s->cs_file[i].config[3] = 0x10031003;
3139
        s->cs_file[i].config[4] = 0x10f1111;
3140
        s->cs_file[i].config[5] = 0;
3141
        s->cs_file[i].config[6] = 0xf00 | (i ? 0 : 1 << 6);
3142
        if (s->cs_file[i].config[6] & (1 << 6))                        /* CSVALID */
3143
            omap_gpmc_cs_map(&s->cs_file[i],
3144
                            s->cs_file[i].config[6] & 0x1f,        /* MASKADDR */
3145
                        (s->cs_file[i].config[6] >> 8 & 0xf));        /* BASEADDR */
3146
    }
3147
    omap_gpmc_cs_map(s->cs_file, 0, 0xf);
3148
    s->ecc_cs = 0;
3149
    s->ecc_ptr = 0;
3150
    s->ecc_cfg = 0x3fcff000;
3151
    for (i = 0; i < 9; i ++)
3152
        ecc_reset(&s->ecc[i]);
3153
}
3154

    
3155
static uint32_t omap_gpmc_read(void *opaque, target_phys_addr_t addr)
3156
{
3157
    struct omap_gpmc_s *s = (struct omap_gpmc_s *) opaque;
3158
    int offset = addr - s->base;
3159
    int cs;
3160
    struct omap_gpmc_cs_file_s *f;
3161

    
3162
    switch (offset) {
3163
    case 0x000:        /* GPMC_REVISION */
3164
        return 0x20;
3165

    
3166
    case 0x010:        /* GPMC_SYSCONFIG */
3167
        return s->sysconfig;
3168

    
3169
    case 0x014:        /* GPMC_SYSSTATUS */
3170
        return 1;                                                /* RESETDONE */
3171

    
3172
    case 0x018:        /* GPMC_IRQSTATUS */
3173
        return s->irqst;
3174

    
3175
    case 0x01c:        /* GPMC_IRQENABLE */
3176
        return s->irqen;
3177

    
3178
    case 0x040:        /* GPMC_TIMEOUT_CONTROL */
3179
        return s->timeout;
3180

    
3181
    case 0x044:        /* GPMC_ERR_ADDRESS */
3182
    case 0x048:        /* GPMC_ERR_TYPE */
3183
        return 0;
3184

    
3185
    case 0x050:        /* GPMC_CONFIG */
3186
        return s->config;
3187

    
3188
    case 0x054:        /* GPMC_STATUS */
3189
        return 0x001;
3190

    
3191
    case 0x060 ... 0x1d4:
3192
        cs = (offset - 0x060) / 0x30;
3193
        offset -= cs * 0x30;
3194
        f = s->cs_file + cs;
3195
        switch (offset - cs * 0x30) {
3196
            case 0x60:        /* GPMC_CONFIG1 */
3197
                return f->config[0];
3198
            case 0x64:        /* GPMC_CONFIG2 */
3199
                return f->config[1];
3200
            case 0x68:        /* GPMC_CONFIG3 */
3201
                return f->config[2];
3202
            case 0x6c:        /* GPMC_CONFIG4 */
3203
                return f->config[3];
3204
            case 0x70:        /* GPMC_CONFIG5 */
3205
                return f->config[4];
3206
            case 0x74:        /* GPMC_CONFIG6 */
3207
                return f->config[5];
3208
            case 0x78:        /* GPMC_CONFIG7 */
3209
                return f->config[6];
3210
            case 0x84:        /* GPMC_NAND_DATA */
3211
                return 0;
3212
        }
3213
        break;
3214

    
3215
    case 0x1e0:        /* GPMC_PREFETCH_CONFIG1 */
3216
        return s->prefconfig[0];
3217
    case 0x1e4:        /* GPMC_PREFETCH_CONFIG2 */
3218
        return s->prefconfig[1];
3219
    case 0x1ec:        /* GPMC_PREFETCH_CONTROL */
3220
        return s->prefcontrol;
3221
    case 0x1f0:        /* GPMC_PREFETCH_STATUS */
3222
        return (s->preffifo << 24) |
3223
                ((s->preffifo >
3224
                  ((s->prefconfig[0] >> 8) & 0x7f) ? 1 : 0) << 16) |
3225
                s->prefcount;
3226

    
3227
    case 0x1f4:        /* GPMC_ECC_CONFIG */
3228
        return s->ecc_cs;
3229
    case 0x1f8:        /* GPMC_ECC_CONTROL */
3230
        return s->ecc_ptr;
3231
    case 0x1fc:        /* GPMC_ECC_SIZE_CONFIG */
3232
        return s->ecc_cfg;
3233
    case 0x200 ... 0x220:        /* GPMC_ECC_RESULT */
3234
        cs = (offset & 0x1f) >> 2;
3235
        /* TODO: check correctness */
3236
        return
3237
                ((s->ecc[cs].cp    &  0x07) <<  0) |
3238
                ((s->ecc[cs].cp    &  0x38) << 13) |
3239
                ((s->ecc[cs].lp[0] & 0x1ff) <<  3) |
3240
                ((s->ecc[cs].lp[1] & 0x1ff) << 19);
3241

    
3242
    case 0x230:        /* GPMC_TESTMODE_CTRL */
3243
        return 0;
3244
    case 0x234:        /* GPMC_PSA_LSB */
3245
    case 0x238:        /* GPMC_PSA_MSB */
3246
        return 0x00000000;
3247
    }
3248

    
3249
    OMAP_BAD_REG(addr);
3250
    return 0;
3251
}
3252

    
3253
static void omap_gpmc_write(void *opaque, target_phys_addr_t addr,
3254
                uint32_t value)
3255
{
3256
    struct omap_gpmc_s *s = (struct omap_gpmc_s *) opaque;
3257
    int offset = addr - s->base;
3258
    int cs;
3259
    struct omap_gpmc_cs_file_s *f;
3260

    
3261
    switch (offset) {
3262
    case 0x000:        /* GPMC_REVISION */
3263
    case 0x014:        /* GPMC_SYSSTATUS */
3264
    case 0x054:        /* GPMC_STATUS */
3265
    case 0x1f0:        /* GPMC_PREFETCH_STATUS */
3266
    case 0x200 ... 0x220:        /* GPMC_ECC_RESULT */
3267
    case 0x234:        /* GPMC_PSA_LSB */
3268
    case 0x238:        /* GPMC_PSA_MSB */
3269
        OMAP_RO_REG(addr);
3270
        break;
3271

    
3272
    case 0x010:        /* GPMC_SYSCONFIG */
3273
        if ((value >> 3) == 0x3)
3274
            fprintf(stderr, "%s: bad SDRAM idle mode %i\n",
3275
                            __FUNCTION__, value >> 3);
3276
        if (value & 2)
3277
            omap_gpmc_reset(s);
3278
        s->sysconfig = value & 0x19;
3279
        break;
3280

    
3281
    case 0x018:        /* GPMC_IRQSTATUS */
3282
        s->irqen = ~value;
3283
        omap_gpmc_int_update(s);
3284
        break;
3285

    
3286
    case 0x01c:        /* GPMC_IRQENABLE */
3287
        s->irqen = value & 0xf03;
3288
        omap_gpmc_int_update(s);
3289
        break;
3290

    
3291
    case 0x040:        /* GPMC_TIMEOUT_CONTROL */
3292
        s->timeout = value & 0x1ff1;
3293
        break;
3294

    
3295
    case 0x044:        /* GPMC_ERR_ADDRESS */
3296
    case 0x048:        /* GPMC_ERR_TYPE */
3297
        break;
3298

    
3299
    case 0x050:        /* GPMC_CONFIG */
3300
        s->config = value & 0xf13;
3301
        break;
3302

    
3303
    case 0x060 ... 0x1d4:
3304
        cs = (offset - 0x060) / 0x30;
3305
        offset -= cs * 0x30;
3306
        f = s->cs_file + cs;
3307
        switch (offset) {
3308
            case 0x60:        /* GPMC_CONFIG1 */
3309
                f->config[0] = value & 0xffef3e13;
3310
                break;
3311
            case 0x64:        /* GPMC_CONFIG2 */
3312
                f->config[1] = value & 0x001f1f8f;
3313
                break;
3314
            case 0x68:        /* GPMC_CONFIG3 */
3315
                f->config[2] = value & 0x001f1f8f;
3316
                break;
3317
            case 0x6c:        /* GPMC_CONFIG4 */
3318
                f->config[3] = value & 0x1f8f1f8f;
3319
                break;
3320
            case 0x70:        /* GPMC_CONFIG5 */
3321
                f->config[4] = value & 0x0f1f1f1f;
3322
                break;
3323
            case 0x74:        /* GPMC_CONFIG6 */
3324
                f->config[5] = value & 0x00000fcf;
3325
                break;
3326
            case 0x78:        /* GPMC_CONFIG7 */
3327
                if ((f->config[6] ^ value) & 0xf7f) {
3328
                    if (f->config[6] & (1 << 6))                /* CSVALID */
3329
                        omap_gpmc_cs_unmap(f);
3330
                    if (value & (1 << 6))                        /* CSVALID */
3331
                        omap_gpmc_cs_map(f, value & 0x1f,        /* MASKADDR */
3332
                                        (value >> 8 & 0xf));        /* BASEADDR */
3333
                }
3334
                f->config[6] = value & 0x00000f7f;
3335
                break;
3336
            case 0x7c:        /* GPMC_NAND_COMMAND */
3337
            case 0x80:        /* GPMC_NAND_ADDRESS */
3338
            case 0x84:        /* GPMC_NAND_DATA */
3339
                break;
3340

    
3341
            default:
3342
                goto bad_reg;
3343
        }
3344
        break;
3345

    
3346
    case 0x1e0:        /* GPMC_PREFETCH_CONFIG1 */
3347
        s->prefconfig[0] = value & 0x7f8f7fbf;
3348
        /* TODO: update interrupts, fifos, dmas */
3349
        break;
3350

    
3351
    case 0x1e4:        /* GPMC_PREFETCH_CONFIG2 */
3352
        s->prefconfig[1] = value & 0x3fff;
3353
        break;
3354

    
3355
    case 0x1ec:        /* GPMC_PREFETCH_CONTROL */
3356
        s->prefcontrol = value & 1;
3357
        if (s->prefcontrol) {
3358
            if (s->prefconfig[0] & 1)
3359
                s->preffifo = 0x40;
3360
            else
3361
                s->preffifo = 0x00;
3362
        }
3363
        /* TODO: start */
3364
        break;
3365

    
3366
    case 0x1f4:        /* GPMC_ECC_CONFIG */
3367
        s->ecc_cs = 0x8f;
3368
        break;
3369
    case 0x1f8:        /* GPMC_ECC_CONTROL */
3370
        if (value & (1 << 8))
3371
            for (cs = 0; cs < 9; cs ++)
3372
                ecc_reset(&s->ecc[cs]);
3373
        s->ecc_ptr = value & 0xf;
3374
        if (s->ecc_ptr == 0 || s->ecc_ptr > 9) {
3375
            s->ecc_ptr = 0;
3376
            s->ecc_cs &= ~1;
3377
        }
3378
        break;
3379
    case 0x1fc:        /* GPMC_ECC_SIZE_CONFIG */
3380
        s->ecc_cfg = value & 0x3fcff1ff;
3381
        break;
3382
    case 0x230:        /* GPMC_TESTMODE_CTRL */
3383
        if (value & 7)
3384
            fprintf(stderr, "%s: test mode enable attempt\n", __FUNCTION__);
3385
        break;
3386

    
3387
    default:
3388
    bad_reg:
3389
        OMAP_BAD_REG(addr);
3390
        return;
3391
    }
3392
}
3393

    
3394
static CPUReadMemoryFunc *omap_gpmc_readfn[] = {
3395
    omap_badwidth_read32,        /* TODO */
3396
    omap_badwidth_read32,        /* TODO */
3397
    omap_gpmc_read,
3398
};
3399

    
3400
static CPUWriteMemoryFunc *omap_gpmc_writefn[] = {
3401
    omap_badwidth_write32,        /* TODO */
3402
    omap_badwidth_write32,        /* TODO */
3403
    omap_gpmc_write,
3404
};
3405

    
3406
struct omap_gpmc_s *omap_gpmc_init(target_phys_addr_t base, qemu_irq irq)
3407
{
3408
    int iomemtype;
3409
    struct omap_gpmc_s *s = (struct omap_gpmc_s *)
3410
            qemu_mallocz(sizeof(struct omap_gpmc_s));
3411

    
3412
    s->base = base;
3413
    omap_gpmc_reset(s);
3414

    
3415
    iomemtype = cpu_register_io_memory(0, omap_gpmc_readfn,
3416
                    omap_gpmc_writefn, s);
3417
    cpu_register_physical_memory(s->base, 0x1000, iomemtype);
3418

    
3419
    return s;
3420
}
3421

    
3422
void omap_gpmc_attach(struct omap_gpmc_s *s, int cs, int iomemtype,
3423
                void (*base_upd)(void *opaque, target_phys_addr_t new),
3424
                void (*unmap)(void *opaque), void *opaque)
3425
{
3426
    struct omap_gpmc_cs_file_s *f;
3427

    
3428
    if (cs < 0 || cs >= 8) {
3429
        fprintf(stderr, "%s: bad chip-select %i\n", __FUNCTION__, cs);
3430
        exit(-1);
3431
    }
3432
    f = &s->cs_file[cs];
3433

    
3434
    f->iomemtype = iomemtype;
3435
    f->base_update = base_upd;
3436
    f->unmap = unmap;
3437
    f->opaque = opaque;
3438

    
3439
    if (f->config[6] & (1 << 6))                                /* CSVALID */
3440
        omap_gpmc_cs_map(f, f->config[6] & 0x1f,                /* MASKADDR */
3441
                        (f->config[6] >> 8 & 0xf));                /* BASEADDR */
3442
}
3443

    
3444
/* General chip reset */
3445
static void omap2_mpu_reset(void *opaque)
3446
{
3447
    struct omap_mpu_state_s *mpu = (struct omap_mpu_state_s *) opaque;
3448

    
3449
    omap_inth_reset(mpu->ih[0]);
3450
    omap_dma_reset(mpu->dma);
3451
    omap_prcm_reset(mpu->prcm);
3452
    omap_sysctl_reset(mpu->sysc);
3453
    omap_gp_timer_reset(mpu->gptimer[0]);
3454
    omap_gp_timer_reset(mpu->gptimer[1]);
3455
    omap_gp_timer_reset(mpu->gptimer[2]);
3456
    omap_gp_timer_reset(mpu->gptimer[3]);
3457
    omap_gp_timer_reset(mpu->gptimer[4]);
3458
    omap_gp_timer_reset(mpu->gptimer[5]);
3459
    omap_gp_timer_reset(mpu->gptimer[6]);
3460
    omap_gp_timer_reset(mpu->gptimer[7]);
3461
    omap_gp_timer_reset(mpu->gptimer[8]);
3462
    omap_gp_timer_reset(mpu->gptimer[9]);
3463
    omap_gp_timer_reset(mpu->gptimer[10]);
3464
    omap_gp_timer_reset(mpu->gptimer[11]);
3465
    omap_synctimer_reset(&mpu->synctimer);
3466
    omap_sdrc_reset(mpu->sdrc);
3467
    omap_gpmc_reset(mpu->gpmc);
3468
    omap_dss_reset(mpu->dss);
3469
    omap_uart_reset(mpu->uart[0]);
3470
    omap_uart_reset(mpu->uart[1]);
3471
    omap_uart_reset(mpu->uart[2]);
3472
    omap_mmc_reset(mpu->mmc);
3473
    omap_gpif_reset(mpu->gpif);
3474
    omap_mcspi_reset(mpu->mcspi[0]);
3475
    omap_mcspi_reset(mpu->mcspi[1]);
3476
    omap_i2c_reset(mpu->i2c[0]);
3477
    omap_i2c_reset(mpu->i2c[1]);
3478
    cpu_reset(mpu->env);
3479
}
3480

    
3481
static int omap2_validate_addr(struct omap_mpu_state_s *s,
3482
                target_phys_addr_t addr)
3483
{
3484
    return 1;
3485
}
3486

    
3487
static const struct dma_irq_map omap2_dma_irq_map[] = {
3488
    { 0, OMAP_INT_24XX_SDMA_IRQ0 },
3489
    { 0, OMAP_INT_24XX_SDMA_IRQ1 },
3490
    { 0, OMAP_INT_24XX_SDMA_IRQ2 },
3491
    { 0, OMAP_INT_24XX_SDMA_IRQ3 },
3492
};
3493

    
3494
struct omap_mpu_state_s *omap2420_mpu_init(unsigned long sdram_size,
3495
                DisplayState *ds, const char *core)
3496
{
3497
    struct omap_mpu_state_s *s = (struct omap_mpu_state_s *)
3498
            qemu_mallocz(sizeof(struct omap_mpu_state_s));
3499
    ram_addr_t sram_base, q2_base;
3500
    qemu_irq *cpu_irq;
3501
    qemu_irq dma_irqs[4];
3502
    omap_clk gpio_clks[4];
3503
    int sdindex;
3504
    int i;
3505

    
3506
    /* Core */
3507
    s->mpu_model = omap2420;
3508
    s->env = cpu_init(core ?: "arm1136-r2");
3509
    if (!s->env) {
3510
        fprintf(stderr, "Unable to find CPU definition\n");
3511
        exit(1);
3512
    }
3513
    s->sdram_size = sdram_size;
3514
    s->sram_size = OMAP242X_SRAM_SIZE;
3515

    
3516
    s->wakeup = qemu_allocate_irqs(omap_mpu_wakeup, s, 1)[0];
3517

    
3518
    /* Clocks */
3519
    omap_clk_init(s);
3520

    
3521
    /* Memory-mapped stuff */
3522
    cpu_register_physical_memory(OMAP2_Q2_BASE, s->sdram_size,
3523
                    (q2_base = qemu_ram_alloc(s->sdram_size)) | IO_MEM_RAM);
3524
    cpu_register_physical_memory(OMAP2_SRAM_BASE, s->sram_size,
3525
                    (sram_base = qemu_ram_alloc(s->sram_size)) | IO_MEM_RAM);
3526

    
3527
    s->l4 = omap_l4_init(OMAP2_L4_BASE, 54);
3528

    
3529
    /* Actually mapped at any 2K boundary in the ARM11 private-peripheral if */
3530
    cpu_irq = arm_pic_init_cpu(s->env);
3531
    s->ih[0] = omap2_inth_init(0x480fe000, 0x1000, 3, &s->irq[0],
3532
                    cpu_irq[ARM_PIC_CPU_IRQ], cpu_irq[ARM_PIC_CPU_FIQ],
3533
                    omap_findclk(s, "mpu_intc_fclk"),
3534
                    omap_findclk(s, "mpu_intc_iclk"));
3535

    
3536
    s->prcm = omap_prcm_init(omap_l4tao(s->l4, 3),
3537
                    s->irq[0][OMAP_INT_24XX_PRCM_MPU_IRQ], NULL, NULL, s);
3538

    
3539
    s->sysc = omap_sysctl_init(omap_l4tao(s->l4, 1),
3540
                    omap_findclk(s, "omapctrl_iclk"), s);
3541

    
3542
    for (i = 0; i < 4; i ++)
3543
        dma_irqs[i] =
3544
                s->irq[omap2_dma_irq_map[i].ih][omap2_dma_irq_map[i].intr];
3545
    s->dma = omap_dma4_init(0x48056000, dma_irqs, s, 256, 32,
3546
                    omap_findclk(s, "sdma_iclk"),
3547
                    omap_findclk(s, "sdma_fclk"));
3548
    s->port->addr_valid = omap2_validate_addr;
3549

    
3550
    s->uart[0] = omap2_uart_init(omap_l4ta(s->l4, 19),
3551
                    s->irq[0][OMAP_INT_24XX_UART1_IRQ],
3552
                    omap_findclk(s, "uart1_fclk"),
3553
                    omap_findclk(s, "uart1_iclk"),
3554
                    s->drq[OMAP24XX_DMA_UART1_TX],
3555
                    s->drq[OMAP24XX_DMA_UART1_RX], serial_hds[0]);
3556
    s->uart[1] = omap2_uart_init(omap_l4ta(s->l4, 20),
3557
                    s->irq[0][OMAP_INT_24XX_UART2_IRQ],
3558
                    omap_findclk(s, "uart2_fclk"),
3559
                    omap_findclk(s, "uart2_iclk"),
3560
                    s->drq[OMAP24XX_DMA_UART2_TX],
3561
                    s->drq[OMAP24XX_DMA_UART2_RX],
3562
                    serial_hds[0] ? serial_hds[1] : 0);
3563
    s->uart[2] = omap2_uart_init(omap_l4ta(s->l4, 21),
3564
                    s->irq[0][OMAP_INT_24XX_UART3_IRQ],
3565
                    omap_findclk(s, "uart3_fclk"),
3566
                    omap_findclk(s, "uart3_iclk"),
3567
                    s->drq[OMAP24XX_DMA_UART3_TX],
3568
                    s->drq[OMAP24XX_DMA_UART3_RX],
3569
                    serial_hds[0] && serial_hds[1] ? serial_hds[2] : 0);
3570

    
3571
    s->gptimer[0] = omap_gp_timer_init(omap_l4ta(s->l4, 7),
3572
                    s->irq[0][OMAP_INT_24XX_GPTIMER1],
3573
                    omap_findclk(s, "wu_gpt1_clk"),
3574
                    omap_findclk(s, "wu_l4_iclk"));
3575
    s->gptimer[1] = omap_gp_timer_init(omap_l4ta(s->l4, 8),
3576
                    s->irq[0][OMAP_INT_24XX_GPTIMER2],
3577
                    omap_findclk(s, "core_gpt2_clk"),
3578
                    omap_findclk(s, "core_l4_iclk"));
3579
    s->gptimer[2] = omap_gp_timer_init(omap_l4ta(s->l4, 22),
3580
                    s->irq[0][OMAP_INT_24XX_GPTIMER3],
3581
                    omap_findclk(s, "core_gpt3_clk"),
3582
                    omap_findclk(s, "core_l4_iclk"));
3583
    s->gptimer[3] = omap_gp_timer_init(omap_l4ta(s->l4, 23),
3584
                    s->irq[0][OMAP_INT_24XX_GPTIMER4],
3585
                    omap_findclk(s, "core_gpt4_clk"),
3586
                    omap_findclk(s, "core_l4_iclk"));
3587
    s->gptimer[4] = omap_gp_timer_init(omap_l4ta(s->l4, 24),
3588
                    s->irq[0][OMAP_INT_24XX_GPTIMER5],
3589
                    omap_findclk(s, "core_gpt5_clk"),
3590
                    omap_findclk(s, "core_l4_iclk"));
3591
    s->gptimer[5] = omap_gp_timer_init(omap_l4ta(s->l4, 25),
3592
                    s->irq[0][OMAP_INT_24XX_GPTIMER6],
3593
                    omap_findclk(s, "core_gpt6_clk"),
3594
                    omap_findclk(s, "core_l4_iclk"));
3595
    s->gptimer[6] = omap_gp_timer_init(omap_l4ta(s->l4, 26),
3596
                    s->irq[0][OMAP_INT_24XX_GPTIMER7],
3597
                    omap_findclk(s, "core_gpt7_clk"),
3598
                    omap_findclk(s, "core_l4_iclk"));
3599
    s->gptimer[7] = omap_gp_timer_init(omap_l4ta(s->l4, 27),
3600
                    s->irq[0][OMAP_INT_24XX_GPTIMER8],
3601
                    omap_findclk(s, "core_gpt8_clk"),
3602
                    omap_findclk(s, "core_l4_iclk"));
3603
    s->gptimer[8] = omap_gp_timer_init(omap_l4ta(s->l4, 28),
3604
                    s->irq[0][OMAP_INT_24XX_GPTIMER9],
3605
                    omap_findclk(s, "core_gpt9_clk"),
3606
                    omap_findclk(s, "core_l4_iclk"));
3607
    s->gptimer[9] = omap_gp_timer_init(omap_l4ta(s->l4, 29),
3608
                    s->irq[0][OMAP_INT_24XX_GPTIMER10],
3609
                    omap_findclk(s, "core_gpt10_clk"),
3610
                    omap_findclk(s, "core_l4_iclk"));
3611
    s->gptimer[10] = omap_gp_timer_init(omap_l4ta(s->l4, 30),
3612
                    s->irq[0][OMAP_INT_24XX_GPTIMER11],
3613
                    omap_findclk(s, "core_gpt11_clk"),
3614
                    omap_findclk(s, "core_l4_iclk"));
3615
    s->gptimer[11] = omap_gp_timer_init(omap_l4ta(s->l4, 31),
3616
                    s->irq[0][OMAP_INT_24XX_GPTIMER12],
3617
                    omap_findclk(s, "core_gpt12_clk"),
3618
                    omap_findclk(s, "core_l4_iclk"));
3619

    
3620
    omap_tap_init(omap_l4ta(s->l4, 2), s);
3621

    
3622
    omap_synctimer_init(omap_l4tao(s->l4, 2), s,
3623
                    omap_findclk(s, "clk32-kHz"),
3624
                    omap_findclk(s, "core_l4_iclk"));
3625

    
3626
    s->i2c[0] = omap2_i2c_init(omap_l4tao(s->l4, 5),
3627
                    s->irq[0][OMAP_INT_24XX_I2C1_IRQ],
3628
                    &s->drq[OMAP24XX_DMA_I2C1_TX],
3629
                    omap_findclk(s, "i2c1.fclk"),
3630
                    omap_findclk(s, "i2c1.iclk"));
3631
    s->i2c[1] = omap2_i2c_init(omap_l4tao(s->l4, 6),
3632
                    s->irq[0][OMAP_INT_24XX_I2C2_IRQ],
3633
                    &s->drq[OMAP24XX_DMA_I2C2_TX],
3634
                    omap_findclk(s, "i2c2.fclk"),
3635
                    omap_findclk(s, "i2c2.iclk"));
3636

    
3637
    gpio_clks[0] = omap_findclk(s, "gpio1_dbclk");
3638
    gpio_clks[1] = omap_findclk(s, "gpio2_dbclk");
3639
    gpio_clks[2] = omap_findclk(s, "gpio3_dbclk");
3640
    gpio_clks[3] = omap_findclk(s, "gpio4_dbclk");
3641
    s->gpif = omap2_gpio_init(omap_l4ta(s->l4, 3),
3642
                    &s->irq[0][OMAP_INT_24XX_GPIO_BANK1],
3643
                    gpio_clks, omap_findclk(s, "gpio_iclk"), 4);
3644

    
3645
    s->sdrc = omap_sdrc_init(0x68009000);
3646
    s->gpmc = omap_gpmc_init(0x6800a000, s->irq[0][OMAP_INT_24XX_GPMC_IRQ]);
3647

    
3648
    sdindex = drive_get_index(IF_SD, 0, 0);
3649
    if (sdindex == -1) {
3650
        fprintf(stderr, "qemu: missing SecureDigital device\n");
3651
        exit(1);
3652
    }
3653
    s->mmc = omap2_mmc_init(omap_l4tao(s->l4, 9), drives_table[sdindex].bdrv,
3654
                    s->irq[0][OMAP_INT_24XX_MMC_IRQ],
3655
                    &s->drq[OMAP24XX_DMA_MMC1_TX],
3656
                    omap_findclk(s, "mmc_fclk"), omap_findclk(s, "mmc_iclk"));
3657

    
3658
    s->mcspi[0] = omap_mcspi_init(omap_l4ta(s->l4, 35), 4,
3659
                    s->irq[0][OMAP_INT_24XX_MCSPI1_IRQ], 
3660
                    &s->drq[OMAP24XX_DMA_SPI1_TX0],
3661
                    omap_findclk(s, "spi1_fclk"),
3662
                    omap_findclk(s, "spi1_iclk"));
3663
    s->mcspi[1] = omap_mcspi_init(omap_l4ta(s->l4, 36), 2,
3664
                    s->irq[0][OMAP_INT_24XX_MCSPI2_IRQ], 
3665
                    &s->drq[OMAP24XX_DMA_SPI2_TX0],
3666
                    omap_findclk(s, "spi2_fclk"),
3667
                    omap_findclk(s, "spi2_iclk"));
3668

    
3669
    s->dss = omap_dss_init(omap_l4ta(s->l4, 10), 0x68000800, ds,
3670
                    /* XXX wire M_IRQ_25, D_L2_IRQ_30 and I_IRQ_13 together */
3671
                    s->irq[0][OMAP_INT_24XX_DSS_IRQ], s->drq[OMAP24XX_DMA_DSS],
3672
                    omap_findclk(s, "dss_clk1"), omap_findclk(s, "dss_clk2"),
3673
                    omap_findclk(s, "dss_54m_clk"),
3674
                    omap_findclk(s, "dss_l3_iclk"),
3675
                    omap_findclk(s, "dss_l4_iclk"));
3676

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

    
3857
    qemu_register_reset(omap2_mpu_reset, s);
3858

    
3859
    return s;
3860
}