qemu

FORK: QEMU emulator
git clone https://git.neptards.moe/neptards/qemu.git
Log | Files | Refs | Submodules | LICENSE

omap2.c (88996B)


      1 /*
      2  * TI OMAP processors emulation.
      3  *
      4  * Copyright (C) 2007-2008 Nokia Corporation
      5  * Written by Andrzej Zaborowski <andrew@openedhand.com>
      6  *
      7  * This program is free software; you can redistribute it and/or
      8  * modify it under the terms of the GNU General Public License as
      9  * published by the Free Software Foundation; either version 2 or
     10  * (at your option) version 3 of the License.
     11  *
     12  * This program is distributed in the hope that it will be useful,
     13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
     14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     15  * GNU General Public License for more details.
     16  *
     17  * You should have received a copy of the GNU General Public License along
     18  * with this program; if not, see <http://www.gnu.org/licenses/>.
     19  */
     20 
     21 #include "qemu/osdep.h"
     22 #include "qemu/error-report.h"
     23 #include "qapi/error.h"
     24 #include "cpu.h"
     25 #include "exec/address-spaces.h"
     26 #include "sysemu/blockdev.h"
     27 #include "sysemu/qtest.h"
     28 #include "sysemu/reset.h"
     29 #include "sysemu/runstate.h"
     30 #include "hw/irq.h"
     31 #include "hw/qdev-properties.h"
     32 #include "hw/arm/boot.h"
     33 #include "hw/arm/omap.h"
     34 #include "sysemu/sysemu.h"
     35 #include "qemu/timer.h"
     36 #include "chardev/char-fe.h"
     37 #include "hw/block/flash.h"
     38 #include "hw/arm/soc_dma.h"
     39 #include "hw/sysbus.h"
     40 #include "audio/audio.h"
     41 
     42 /* Enhanced Audio Controller (CODEC only) */
     43 struct omap_eac_s {
     44     qemu_irq irq;
     45     MemoryRegion iomem;
     46 
     47     uint16_t sysconfig;
     48     uint8_t config[4];
     49     uint8_t control;
     50     uint8_t address;
     51     uint16_t data;
     52     uint8_t vtol;
     53     uint8_t vtsl;
     54     uint16_t mixer;
     55     uint16_t gain[4];
     56     uint8_t att;
     57     uint16_t max[7];
     58 
     59     struct {
     60         qemu_irq txdrq;
     61         qemu_irq rxdrq;
     62         uint32_t (*txrx)(void *opaque, uint32_t, int);
     63         void *opaque;
     64 
     65 #define EAC_BUF_LEN 1024
     66         uint32_t rxbuf[EAC_BUF_LEN];
     67         int rxoff;
     68         int rxlen;
     69         int rxavail;
     70         uint32_t txbuf[EAC_BUF_LEN];
     71         int txlen;
     72         int txavail;
     73 
     74         int enable;
     75         int rate;
     76 
     77         uint16_t config[4];
     78 
     79         /* These need to be moved to the actual codec */
     80         QEMUSoundCard card;
     81         SWVoiceIn *in_voice;
     82         SWVoiceOut *out_voice;
     83         int hw_enable;
     84     } codec;
     85 
     86     struct {
     87         uint8_t control;
     88         uint16_t config;
     89     } modem, bt;
     90 };
     91 
     92 static inline void omap_eac_interrupt_update(struct omap_eac_s *s)
     93 {
     94     qemu_set_irq(s->irq, (s->codec.config[1] >> 14) & 1);	/* AURDI */
     95 }
     96 
     97 static inline void omap_eac_in_dmarequest_update(struct omap_eac_s *s)
     98 {
     99     qemu_set_irq(s->codec.rxdrq, (s->codec.rxavail || s->codec.rxlen) &&
    100                     ((s->codec.config[1] >> 12) & 1));		/* DMAREN */
    101 }
    102 
    103 static inline void omap_eac_out_dmarequest_update(struct omap_eac_s *s)
    104 {
    105     qemu_set_irq(s->codec.txdrq, s->codec.txlen < s->codec.txavail &&
    106                     ((s->codec.config[1] >> 11) & 1));		/* DMAWEN */
    107 }
    108 
    109 static inline void omap_eac_in_refill(struct omap_eac_s *s)
    110 {
    111     int left = MIN(EAC_BUF_LEN - s->codec.rxlen, s->codec.rxavail) << 2;
    112     int start = ((s->codec.rxoff + s->codec.rxlen) & (EAC_BUF_LEN - 1)) << 2;
    113     int leftwrap = MIN(left, (EAC_BUF_LEN << 2) - start);
    114     int recv = 1;
    115     uint8_t *buf = (uint8_t *) s->codec.rxbuf + start;
    116 
    117     left -= leftwrap;
    118     start = 0;
    119     while (leftwrap && (recv = AUD_read(s->codec.in_voice, buf + start,
    120                                     leftwrap)) > 0) {	/* Be defensive */
    121         start += recv;
    122         leftwrap -= recv;
    123     }
    124     if (recv <= 0)
    125         s->codec.rxavail = 0;
    126     else
    127         s->codec.rxavail -= start >> 2;
    128     s->codec.rxlen += start >> 2;
    129 
    130     if (recv > 0 && left > 0) {
    131         start = 0;
    132         while (left && (recv = AUD_read(s->codec.in_voice,
    133                                         (uint8_t *) s->codec.rxbuf + start,
    134                                         left)) > 0) {	/* Be defensive */
    135             start += recv;
    136             left -= recv;
    137         }
    138         if (recv <= 0)
    139             s->codec.rxavail = 0;
    140         else
    141             s->codec.rxavail -= start >> 2;
    142         s->codec.rxlen += start >> 2;
    143     }
    144 }
    145 
    146 static inline void omap_eac_out_empty(struct omap_eac_s *s)
    147 {
    148     int left = s->codec.txlen << 2;
    149     int start = 0;
    150     int sent = 1;
    151 
    152     while (left && (sent = AUD_write(s->codec.out_voice,
    153                                     (uint8_t *) s->codec.txbuf + start,
    154                                     left)) > 0) {	/* Be defensive */
    155         start += sent;
    156         left -= sent;
    157     }
    158 
    159     if (!sent) {
    160         s->codec.txavail = 0;
    161         omap_eac_out_dmarequest_update(s);
    162     }
    163 
    164     if (start)
    165         s->codec.txlen = 0;
    166 }
    167 
    168 static void omap_eac_in_cb(void *opaque, int avail_b)
    169 {
    170     struct omap_eac_s *s = (struct omap_eac_s *) opaque;
    171 
    172     s->codec.rxavail = avail_b >> 2;
    173     omap_eac_in_refill(s);
    174     /* TODO: possibly discard current buffer if overrun */
    175     omap_eac_in_dmarequest_update(s);
    176 }
    177 
    178 static void omap_eac_out_cb(void *opaque, int free_b)
    179 {
    180     struct omap_eac_s *s = (struct omap_eac_s *) opaque;
    181 
    182     s->codec.txavail = free_b >> 2;
    183     if (s->codec.txlen)
    184         omap_eac_out_empty(s);
    185     else
    186         omap_eac_out_dmarequest_update(s);
    187 }
    188 
    189 static void omap_eac_enable_update(struct omap_eac_s *s)
    190 {
    191     s->codec.enable = !(s->codec.config[1] & 1) &&		/* EACPWD */
    192             (s->codec.config[1] & 2) &&				/* AUDEN */
    193             s->codec.hw_enable;
    194 }
    195 
    196 static const int omap_eac_fsint[4] = {
    197     8000,
    198     11025,
    199     22050,
    200     44100,
    201 };
    202 
    203 static const int omap_eac_fsint2[8] = {
    204     8000,
    205     11025,
    206     22050,
    207     44100,
    208     48000,
    209     0, 0, 0,
    210 };
    211 
    212 static const int omap_eac_fsint3[16] = {
    213     8000,
    214     11025,
    215     16000,
    216     22050,
    217     24000,
    218     32000,
    219     44100,
    220     48000,
    221     0, 0, 0, 0, 0, 0, 0, 0,
    222 };
    223 
    224 static void omap_eac_rate_update(struct omap_eac_s *s)
    225 {
    226     int fsint[3];
    227 
    228     fsint[2] = (s->codec.config[3] >> 9) & 0xf;
    229     fsint[1] = (s->codec.config[2] >> 0) & 0x7;
    230     fsint[0] = (s->codec.config[0] >> 6) & 0x3;
    231     if (fsint[2] < 0xf)
    232         s->codec.rate = omap_eac_fsint3[fsint[2]];
    233     else if (fsint[1] < 0x7)
    234         s->codec.rate = omap_eac_fsint2[fsint[1]];
    235     else
    236         s->codec.rate = omap_eac_fsint[fsint[0]];
    237 }
    238 
    239 static void omap_eac_volume_update(struct omap_eac_s *s)
    240 {
    241     /* TODO */
    242 }
    243 
    244 static void omap_eac_format_update(struct omap_eac_s *s)
    245 {
    246     struct audsettings fmt;
    247 
    248     /* The hardware buffers at most one sample */
    249     if (s->codec.rxlen)
    250         s->codec.rxlen = 1;
    251 
    252     if (s->codec.in_voice) {
    253         AUD_set_active_in(s->codec.in_voice, 0);
    254         AUD_close_in(&s->codec.card, s->codec.in_voice);
    255         s->codec.in_voice = NULL;
    256     }
    257     if (s->codec.out_voice) {
    258         omap_eac_out_empty(s);
    259         AUD_set_active_out(s->codec.out_voice, 0);
    260         AUD_close_out(&s->codec.card, s->codec.out_voice);
    261         s->codec.out_voice = NULL;
    262         s->codec.txavail = 0;
    263     }
    264     /* Discard what couldn't be written */
    265     s->codec.txlen = 0;
    266 
    267     omap_eac_enable_update(s);
    268     if (!s->codec.enable)
    269         return;
    270 
    271     omap_eac_rate_update(s);
    272     fmt.endianness = ((s->codec.config[0] >> 8) & 1);		/* LI_BI */
    273     fmt.nchannels = ((s->codec.config[0] >> 10) & 1) ? 2 : 1;	/* MN_ST */
    274     fmt.freq = s->codec.rate;
    275     /* TODO: signedness possibly depends on the CODEC hardware - or
    276      * does I2S specify it?  */
    277     /* All register writes are 16 bits so we store 16-bit samples
    278      * in the buffers regardless of AGCFR[B8_16] value.  */
    279     fmt.fmt = AUDIO_FORMAT_U16;
    280 
    281     s->codec.in_voice = AUD_open_in(&s->codec.card, s->codec.in_voice,
    282                     "eac.codec.in", s, omap_eac_in_cb, &fmt);
    283     s->codec.out_voice = AUD_open_out(&s->codec.card, s->codec.out_voice,
    284                     "eac.codec.out", s, omap_eac_out_cb, &fmt);
    285 
    286     omap_eac_volume_update(s);
    287 
    288     AUD_set_active_in(s->codec.in_voice, 1);
    289     AUD_set_active_out(s->codec.out_voice, 1);
    290 }
    291 
    292 static void omap_eac_reset(struct omap_eac_s *s)
    293 {
    294     s->sysconfig = 0;
    295     s->config[0] = 0x0c;
    296     s->config[1] = 0x09;
    297     s->config[2] = 0xab;
    298     s->config[3] = 0x03;
    299     s->control = 0x00;
    300     s->address = 0x00;
    301     s->data = 0x0000;
    302     s->vtol = 0x00;
    303     s->vtsl = 0x00;
    304     s->mixer = 0x0000;
    305     s->gain[0] = 0xe7e7;
    306     s->gain[1] = 0x6767;
    307     s->gain[2] = 0x6767;
    308     s->gain[3] = 0x6767;
    309     s->att = 0xce;
    310     s->max[0] = 0;
    311     s->max[1] = 0;
    312     s->max[2] = 0;
    313     s->max[3] = 0;
    314     s->max[4] = 0;
    315     s->max[5] = 0;
    316     s->max[6] = 0;
    317 
    318     s->modem.control = 0x00;
    319     s->modem.config = 0x0000;
    320     s->bt.control = 0x00;
    321     s->bt.config = 0x0000;
    322     s->codec.config[0] = 0x0649;
    323     s->codec.config[1] = 0x0000;
    324     s->codec.config[2] = 0x0007;
    325     s->codec.config[3] = 0x1ffc;
    326     s->codec.rxoff = 0;
    327     s->codec.rxlen = 0;
    328     s->codec.txlen = 0;
    329     s->codec.rxavail = 0;
    330     s->codec.txavail = 0;
    331 
    332     omap_eac_format_update(s);
    333     omap_eac_interrupt_update(s);
    334 }
    335 
    336 static uint64_t omap_eac_read(void *opaque, hwaddr addr,
    337                               unsigned size)
    338 {
    339     struct omap_eac_s *s = (struct omap_eac_s *) opaque;
    340     uint32_t ret;
    341 
    342     if (size != 2) {
    343         return omap_badwidth_read16(opaque, addr);
    344     }
    345 
    346     switch (addr) {
    347     case 0x000:	/* CPCFR1 */
    348         return s->config[0];
    349     case 0x004:	/* CPCFR2 */
    350         return s->config[1];
    351     case 0x008:	/* CPCFR3 */
    352         return s->config[2];
    353     case 0x00c:	/* CPCFR4 */
    354         return s->config[3];
    355 
    356     case 0x010:	/* CPTCTL */
    357         return s->control | ((s->codec.rxavail + s->codec.rxlen > 0) << 7) |
    358                 ((s->codec.txlen < s->codec.txavail) << 5);
    359 
    360     case 0x014:	/* CPTTADR */
    361         return s->address;
    362     case 0x018:	/* CPTDATL */
    363         return s->data & 0xff;
    364     case 0x01c:	/* CPTDATH */
    365         return s->data >> 8;
    366     case 0x020:	/* CPTVSLL */
    367         return s->vtol;
    368     case 0x024:	/* CPTVSLH */
    369         return s->vtsl | (3 << 5);	/* CRDY1 | CRDY2 */
    370     case 0x040:	/* MPCTR */
    371         return s->modem.control;
    372     case 0x044:	/* MPMCCFR */
    373         return s->modem.config;
    374     case 0x060:	/* BPCTR */
    375         return s->bt.control;
    376     case 0x064:	/* BPMCCFR */
    377         return s->bt.config;
    378     case 0x080:	/* AMSCFR */
    379         return s->mixer;
    380     case 0x084:	/* AMVCTR */
    381         return s->gain[0];
    382     case 0x088:	/* AM1VCTR */
    383         return s->gain[1];
    384     case 0x08c:	/* AM2VCTR */
    385         return s->gain[2];
    386     case 0x090:	/* AM3VCTR */
    387         return s->gain[3];
    388     case 0x094:	/* ASTCTR */
    389         return s->att;
    390     case 0x098:	/* APD1LCR */
    391         return s->max[0];
    392     case 0x09c:	/* APD1RCR */
    393         return s->max[1];
    394     case 0x0a0:	/* APD2LCR */
    395         return s->max[2];
    396     case 0x0a4:	/* APD2RCR */
    397         return s->max[3];
    398     case 0x0a8:	/* APD3LCR */
    399         return s->max[4];
    400     case 0x0ac:	/* APD3RCR */
    401         return s->max[5];
    402     case 0x0b0:	/* APD4R */
    403         return s->max[6];
    404     case 0x0b4:	/* ADWR */
    405         /* This should be write-only?  Docs list it as read-only.  */
    406         return 0x0000;
    407     case 0x0b8:	/* ADRDR */
    408         if (likely(s->codec.rxlen > 1)) {
    409             ret = s->codec.rxbuf[s->codec.rxoff ++];
    410             s->codec.rxlen --;
    411             s->codec.rxoff &= EAC_BUF_LEN - 1;
    412             return ret;
    413         } else if (s->codec.rxlen) {
    414             ret = s->codec.rxbuf[s->codec.rxoff ++];
    415             s->codec.rxlen --;
    416             s->codec.rxoff &= EAC_BUF_LEN - 1;
    417             if (s->codec.rxavail)
    418                 omap_eac_in_refill(s);
    419             omap_eac_in_dmarequest_update(s);
    420             return ret;
    421         }
    422         return 0x0000;
    423     case 0x0bc:	/* AGCFR */
    424         return s->codec.config[0];
    425     case 0x0c0:	/* AGCTR */
    426         return s->codec.config[1] | ((s->codec.config[1] & 2) << 14);
    427     case 0x0c4:	/* AGCFR2 */
    428         return s->codec.config[2];
    429     case 0x0c8:	/* AGCFR3 */
    430         return s->codec.config[3];
    431     case 0x0cc:	/* MBPDMACTR */
    432     case 0x0d0:	/* MPDDMARR */
    433     case 0x0d8:	/* MPUDMARR */
    434     case 0x0e4:	/* BPDDMARR */
    435     case 0x0ec:	/* BPUDMARR */
    436         return 0x0000;
    437 
    438     case 0x100:	/* VERSION_NUMBER */
    439         return 0x0010;
    440 
    441     case 0x104:	/* SYSCONFIG */
    442         return s->sysconfig;
    443 
    444     case 0x108:	/* SYSSTATUS */
    445         return 1 | 0xe;					/* RESETDONE | stuff */
    446     }
    447 
    448     OMAP_BAD_REG(addr);
    449     return 0;
    450 }
    451 
    452 static void omap_eac_write(void *opaque, hwaddr addr,
    453                            uint64_t value, unsigned size)
    454 {
    455     struct omap_eac_s *s = (struct omap_eac_s *) opaque;
    456 
    457     if (size != 2) {
    458         omap_badwidth_write16(opaque, addr, value);
    459         return;
    460     }
    461 
    462     switch (addr) {
    463     case 0x098:	/* APD1LCR */
    464     case 0x09c:	/* APD1RCR */
    465     case 0x0a0:	/* APD2LCR */
    466     case 0x0a4:	/* APD2RCR */
    467     case 0x0a8:	/* APD3LCR */
    468     case 0x0ac:	/* APD3RCR */
    469     case 0x0b0:	/* APD4R */
    470     case 0x0b8:	/* ADRDR */
    471     case 0x0d0:	/* MPDDMARR */
    472     case 0x0d8:	/* MPUDMARR */
    473     case 0x0e4:	/* BPDDMARR */
    474     case 0x0ec:	/* BPUDMARR */
    475     case 0x100:	/* VERSION_NUMBER */
    476     case 0x108:	/* SYSSTATUS */
    477         OMAP_RO_REG(addr);
    478         return;
    479 
    480     case 0x000:	/* CPCFR1 */
    481         s->config[0] = value & 0xff;
    482         omap_eac_format_update(s);
    483         break;
    484     case 0x004:	/* CPCFR2 */
    485         s->config[1] = value & 0xff;
    486         omap_eac_format_update(s);
    487         break;
    488     case 0x008:	/* CPCFR3 */
    489         s->config[2] = value & 0xff;
    490         omap_eac_format_update(s);
    491         break;
    492     case 0x00c:	/* CPCFR4 */
    493         s->config[3] = value & 0xff;
    494         omap_eac_format_update(s);
    495         break;
    496 
    497     case 0x010:	/* CPTCTL */
    498         /* Assuming TXF and TXE bits are read-only... */
    499         s->control = value & 0x5f;
    500         omap_eac_interrupt_update(s);
    501         break;
    502 
    503     case 0x014:	/* CPTTADR */
    504         s->address = value & 0xff;
    505         break;
    506     case 0x018:	/* CPTDATL */
    507         s->data &= 0xff00;
    508         s->data |= value & 0xff;
    509         break;
    510     case 0x01c:	/* CPTDATH */
    511         s->data &= 0x00ff;
    512         s->data |= value << 8;
    513         break;
    514     case 0x020:	/* CPTVSLL */
    515         s->vtol = value & 0xf8;
    516         break;
    517     case 0x024:	/* CPTVSLH */
    518         s->vtsl = value & 0x9f;
    519         break;
    520     case 0x040:	/* MPCTR */
    521         s->modem.control = value & 0x8f;
    522         break;
    523     case 0x044:	/* MPMCCFR */
    524         s->modem.config = value & 0x7fff;
    525         break;
    526     case 0x060:	/* BPCTR */
    527         s->bt.control = value & 0x8f;
    528         break;
    529     case 0x064:	/* BPMCCFR */
    530         s->bt.config = value & 0x7fff;
    531         break;
    532     case 0x080:	/* AMSCFR */
    533         s->mixer = value & 0x0fff;
    534         break;
    535     case 0x084:	/* AMVCTR */
    536         s->gain[0] = value & 0xffff;
    537         break;
    538     case 0x088:	/* AM1VCTR */
    539         s->gain[1] = value & 0xff7f;
    540         break;
    541     case 0x08c:	/* AM2VCTR */
    542         s->gain[2] = value & 0xff7f;
    543         break;
    544     case 0x090:	/* AM3VCTR */
    545         s->gain[3] = value & 0xff7f;
    546         break;
    547     case 0x094:	/* ASTCTR */
    548         s->att = value & 0xff;
    549         break;
    550 
    551     case 0x0b4:	/* ADWR */
    552         s->codec.txbuf[s->codec.txlen ++] = value;
    553         if (unlikely(s->codec.txlen == EAC_BUF_LEN ||
    554                                 s->codec.txlen == s->codec.txavail)) {
    555             if (s->codec.txavail)
    556                 omap_eac_out_empty(s);
    557             /* Discard what couldn't be written */
    558             s->codec.txlen = 0;
    559         }
    560         break;
    561 
    562     case 0x0bc:	/* AGCFR */
    563         s->codec.config[0] = value & 0x07ff;
    564         omap_eac_format_update(s);
    565         break;
    566     case 0x0c0:	/* AGCTR */
    567         s->codec.config[1] = value & 0x780f;
    568         omap_eac_format_update(s);
    569         break;
    570     case 0x0c4:	/* AGCFR2 */
    571         s->codec.config[2] = value & 0x003f;
    572         omap_eac_format_update(s);
    573         break;
    574     case 0x0c8:	/* AGCFR3 */
    575         s->codec.config[3] = value & 0xffff;
    576         omap_eac_format_update(s);
    577         break;
    578     case 0x0cc:	/* MBPDMACTR */
    579     case 0x0d4:	/* MPDDMAWR */
    580     case 0x0e0:	/* MPUDMAWR */
    581     case 0x0e8:	/* BPDDMAWR */
    582     case 0x0f0:	/* BPUDMAWR */
    583         break;
    584 
    585     case 0x104:	/* SYSCONFIG */
    586         if (value & (1 << 1))				/* SOFTRESET */
    587             omap_eac_reset(s);
    588         s->sysconfig = value & 0x31d;
    589         break;
    590 
    591     default:
    592         OMAP_BAD_REG(addr);
    593         return;
    594     }
    595 }
    596 
    597 static const MemoryRegionOps omap_eac_ops = {
    598     .read = omap_eac_read,
    599     .write = omap_eac_write,
    600     .endianness = DEVICE_NATIVE_ENDIAN,
    601 };
    602 
    603 static struct omap_eac_s *omap_eac_init(struct omap_target_agent_s *ta,
    604                 qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
    605 {
    606     struct omap_eac_s *s = g_new0(struct omap_eac_s, 1);
    607 
    608     s->irq = irq;
    609     s->codec.rxdrq = *drq ++;
    610     s->codec.txdrq = *drq;
    611     omap_eac_reset(s);
    612 
    613     AUD_register_card("OMAP EAC", &s->codec.card);
    614 
    615     memory_region_init_io(&s->iomem, NULL, &omap_eac_ops, s, "omap.eac",
    616                           omap_l4_region_size(ta, 0));
    617     omap_l4_attach(ta, 0, &s->iomem);
    618 
    619     return s;
    620 }
    621 
    622 /* STI/XTI (emulation interface) console - reverse engineered only */
    623 struct omap_sti_s {
    624     qemu_irq irq;
    625     MemoryRegion iomem;
    626     MemoryRegion iomem_fifo;
    627     CharBackend chr;
    628 
    629     uint32_t sysconfig;
    630     uint32_t systest;
    631     uint32_t irqst;
    632     uint32_t irqen;
    633     uint32_t clkcontrol;
    634     uint32_t serial_config;
    635 };
    636 
    637 #define STI_TRACE_CONSOLE_CHANNEL	239
    638 #define STI_TRACE_CONTROL_CHANNEL	253
    639 
    640 static inline void omap_sti_interrupt_update(struct omap_sti_s *s)
    641 {
    642     qemu_set_irq(s->irq, s->irqst & s->irqen);
    643 }
    644 
    645 static void omap_sti_reset(struct omap_sti_s *s)
    646 {
    647     s->sysconfig = 0;
    648     s->irqst = 0;
    649     s->irqen = 0;
    650     s->clkcontrol = 0;
    651     s->serial_config = 0;
    652 
    653     omap_sti_interrupt_update(s);
    654 }
    655 
    656 static uint64_t omap_sti_read(void *opaque, hwaddr addr,
    657                               unsigned size)
    658 {
    659     struct omap_sti_s *s = (struct omap_sti_s *) opaque;
    660 
    661     if (size != 4) {
    662         return omap_badwidth_read32(opaque, addr);
    663     }
    664 
    665     switch (addr) {
    666     case 0x00:	/* STI_REVISION */
    667         return 0x10;
    668 
    669     case 0x10:	/* STI_SYSCONFIG */
    670         return s->sysconfig;
    671 
    672     case 0x14:	/* STI_SYSSTATUS / STI_RX_STATUS / XTI_SYSSTATUS */
    673         return 0x00;
    674 
    675     case 0x18:	/* STI_IRQSTATUS */
    676         return s->irqst;
    677 
    678     case 0x1c:	/* STI_IRQSETEN / STI_IRQCLREN */
    679         return s->irqen;
    680 
    681     case 0x24:	/* STI_ER / STI_DR / XTI_TRACESELECT */
    682     case 0x28:	/* STI_RX_DR / XTI_RXDATA */
    683         /* TODO */
    684         return 0;
    685 
    686     case 0x2c:	/* STI_CLK_CTRL / XTI_SCLKCRTL */
    687         return s->clkcontrol;
    688 
    689     case 0x30:	/* STI_SERIAL_CFG / XTI_SCONFIG */
    690         return s->serial_config;
    691     }
    692 
    693     OMAP_BAD_REG(addr);
    694     return 0;
    695 }
    696 
    697 static void omap_sti_write(void *opaque, hwaddr addr,
    698                            uint64_t value, unsigned size)
    699 {
    700     struct omap_sti_s *s = (struct omap_sti_s *) opaque;
    701 
    702     if (size != 4) {
    703         omap_badwidth_write32(opaque, addr, value);
    704         return;
    705     }
    706 
    707     switch (addr) {
    708     case 0x00:	/* STI_REVISION */
    709     case 0x14:	/* STI_SYSSTATUS / STI_RX_STATUS / XTI_SYSSTATUS */
    710         OMAP_RO_REG(addr);
    711         return;
    712 
    713     case 0x10:	/* STI_SYSCONFIG */
    714         if (value & (1 << 1))				/* SOFTRESET */
    715             omap_sti_reset(s);
    716         s->sysconfig = value & 0xfe;
    717         break;
    718 
    719     case 0x18:	/* STI_IRQSTATUS */
    720         s->irqst &= ~value;
    721         omap_sti_interrupt_update(s);
    722         break;
    723 
    724     case 0x1c:	/* STI_IRQSETEN / STI_IRQCLREN */
    725         s->irqen = value & 0xffff;
    726         omap_sti_interrupt_update(s);
    727         break;
    728 
    729     case 0x2c:	/* STI_CLK_CTRL / XTI_SCLKCRTL */
    730         s->clkcontrol = value & 0xff;
    731         break;
    732 
    733     case 0x30:	/* STI_SERIAL_CFG / XTI_SCONFIG */
    734         s->serial_config = value & 0xff;
    735         break;
    736 
    737     case 0x24:	/* STI_ER / STI_DR / XTI_TRACESELECT */
    738     case 0x28:	/* STI_RX_DR / XTI_RXDATA */
    739         /* TODO */
    740         return;
    741 
    742     default:
    743         OMAP_BAD_REG(addr);
    744         return;
    745     }
    746 }
    747 
    748 static const MemoryRegionOps omap_sti_ops = {
    749     .read = omap_sti_read,
    750     .write = omap_sti_write,
    751     .endianness = DEVICE_NATIVE_ENDIAN,
    752 };
    753 
    754 static uint64_t omap_sti_fifo_read(void *opaque, hwaddr addr,
    755                                    unsigned size)
    756 {
    757     OMAP_BAD_REG(addr);
    758     return 0;
    759 }
    760 
    761 static void omap_sti_fifo_write(void *opaque, hwaddr addr,
    762                                 uint64_t value, unsigned size)
    763 {
    764     struct omap_sti_s *s = (struct omap_sti_s *) opaque;
    765     int ch = addr >> 6;
    766     uint8_t byte = value;
    767 
    768     if (size != 1) {
    769         omap_badwidth_write8(opaque, addr, size);
    770         return;
    771     }
    772 
    773     if (ch == STI_TRACE_CONTROL_CHANNEL) {
    774         /* Flush channel <i>value</i>.  */
    775         /* XXX this blocks entire thread. Rewrite to use
    776          * qemu_chr_fe_write and background I/O callbacks */
    777         qemu_chr_fe_write_all(&s->chr, (const uint8_t *) "\r", 1);
    778     } else if (ch == STI_TRACE_CONSOLE_CHANNEL || 1) {
    779         if (value == 0xc0 || value == 0xc3) {
    780             /* Open channel <i>ch</i>.  */
    781         } else if (value == 0x00) {
    782             qemu_chr_fe_write_all(&s->chr, (const uint8_t *) "\n", 1);
    783         } else {
    784             qemu_chr_fe_write_all(&s->chr, &byte, 1);
    785         }
    786     }
    787 }
    788 
    789 static const MemoryRegionOps omap_sti_fifo_ops = {
    790     .read = omap_sti_fifo_read,
    791     .write = omap_sti_fifo_write,
    792     .endianness = DEVICE_NATIVE_ENDIAN,
    793 };
    794 
    795 static struct omap_sti_s *omap_sti_init(struct omap_target_agent_s *ta,
    796                 MemoryRegion *sysmem,
    797                 hwaddr channel_base, qemu_irq irq, omap_clk clk,
    798                 Chardev *chr)
    799 {
    800     struct omap_sti_s *s = g_new0(struct omap_sti_s, 1);
    801 
    802     s->irq = irq;
    803     omap_sti_reset(s);
    804 
    805     qemu_chr_fe_init(&s->chr, chr ?: qemu_chr_new("null", "null", NULL),
    806                      &error_abort);
    807 
    808     memory_region_init_io(&s->iomem, NULL, &omap_sti_ops, s, "omap.sti",
    809                           omap_l4_region_size(ta, 0));
    810     omap_l4_attach(ta, 0, &s->iomem);
    811 
    812     memory_region_init_io(&s->iomem_fifo, NULL, &omap_sti_fifo_ops, s,
    813                           "omap.sti.fifo", 0x10000);
    814     memory_region_add_subregion(sysmem, channel_base, &s->iomem_fifo);
    815 
    816     return s;
    817 }
    818 
    819 /* L4 Interconnect */
    820 #define L4TA(n)		(n)
    821 #define L4TAO(n)	((n) + 39)
    822 
    823 static const struct omap_l4_region_s omap_l4_region[125] = {
    824     [  1] = { 0x40800,  0x800, 32          }, /* Initiator agent */
    825     [  2] = { 0x41000, 0x1000, 32          }, /* Link agent */
    826     [  0] = { 0x40000,  0x800, 32          }, /* Address and protection */
    827     [  3] = { 0x00000, 0x1000, 32 | 16 | 8 }, /* System Control and Pinout */
    828     [  4] = { 0x01000, 0x1000, 32 | 16 | 8 }, /* L4TAO1 */
    829     [  5] = { 0x04000, 0x1000, 32 | 16     }, /* 32K Timer */
    830     [  6] = { 0x05000, 0x1000, 32 | 16 | 8 }, /* L4TAO2 */
    831     [  7] = { 0x08000,  0x800, 32          }, /* PRCM Region A */
    832     [  8] = { 0x08800,  0x800, 32          }, /* PRCM Region B */
    833     [  9] = { 0x09000, 0x1000, 32 | 16 | 8 }, /* L4TAO */
    834     [ 10] = { 0x12000, 0x1000, 32 | 16 | 8 }, /* Test (BCM) */
    835     [ 11] = { 0x13000, 0x1000, 32 | 16 | 8 }, /* L4TA1 */
    836     [ 12] = { 0x14000, 0x1000, 32          }, /* Test/emulation (TAP) */
    837     [ 13] = { 0x15000, 0x1000, 32 | 16 | 8 }, /* L4TA2 */
    838     [ 14] = { 0x18000, 0x1000, 32 | 16 | 8 }, /* GPIO1 */
    839     [ 16] = { 0x1a000, 0x1000, 32 | 16 | 8 }, /* GPIO2 */
    840     [ 18] = { 0x1c000, 0x1000, 32 | 16 | 8 }, /* GPIO3 */
    841     [ 19] = { 0x1e000, 0x1000, 32 | 16 | 8 }, /* GPIO4 */
    842     [ 15] = { 0x19000, 0x1000, 32 | 16 | 8 }, /* Quad GPIO TOP */
    843     [ 17] = { 0x1b000, 0x1000, 32 | 16 | 8 }, /* L4TA3 */
    844     [ 20] = { 0x20000, 0x1000, 32 | 16 | 8 }, /* WD Timer 1 (Secure) */
    845     [ 22] = { 0x22000, 0x1000, 32 | 16 | 8 }, /* WD Timer 2 (OMAP) */
    846     [ 21] = { 0x21000, 0x1000, 32 | 16 | 8 }, /* Dual WD timer TOP */
    847     [ 23] = { 0x23000, 0x1000, 32 | 16 | 8 }, /* L4TA4 */
    848     [ 24] = { 0x28000, 0x1000, 32 | 16 | 8 }, /* GP Timer 1 */
    849     [ 25] = { 0x29000, 0x1000, 32 | 16 | 8 }, /* L4TA7 */
    850     [ 26] = { 0x48000, 0x2000, 32 | 16 | 8 }, /* Emulation (ARM11ETB) */
    851     [ 27] = { 0x4a000, 0x1000, 32 | 16 | 8 }, /* L4TA9 */
    852     [ 28] = { 0x50000,  0x400, 32 | 16 | 8 }, /* Display top */
    853     [ 29] = { 0x50400,  0x400, 32 | 16 | 8 }, /* Display control */
    854     [ 30] = { 0x50800,  0x400, 32 | 16 | 8 }, /* Display RFBI */
    855     [ 31] = { 0x50c00,  0x400, 32 | 16 | 8 }, /* Display encoder */
    856     [ 32] = { 0x51000, 0x1000, 32 | 16 | 8 }, /* L4TA10 */
    857     [ 33] = { 0x52000,  0x400, 32 | 16 | 8 }, /* Camera top */
    858     [ 34] = { 0x52400,  0x400, 32 | 16 | 8 }, /* Camera core */
    859     [ 35] = { 0x52800,  0x400, 32 | 16 | 8 }, /* Camera DMA */
    860     [ 36] = { 0x52c00,  0x400, 32 | 16 | 8 }, /* Camera MMU */
    861     [ 37] = { 0x53000, 0x1000, 32 | 16 | 8 }, /* L4TA11 */
    862     [ 38] = { 0x56000, 0x1000, 32 | 16 | 8 }, /* sDMA */
    863     [ 39] = { 0x57000, 0x1000, 32 | 16 | 8 }, /* L4TA12 */
    864     [ 40] = { 0x58000, 0x1000, 32 | 16 | 8 }, /* SSI top */
    865     [ 41] = { 0x59000, 0x1000, 32 | 16 | 8 }, /* SSI GDD */
    866     [ 42] = { 0x5a000, 0x1000, 32 | 16 | 8 }, /* SSI Port1 */
    867     [ 43] = { 0x5b000, 0x1000, 32 | 16 | 8 }, /* SSI Port2 */
    868     [ 44] = { 0x5c000, 0x1000, 32 | 16 | 8 }, /* L4TA13 */
    869     [ 45] = { 0x5e000, 0x1000, 32 | 16 | 8 }, /* USB OTG */
    870     [ 46] = { 0x5f000, 0x1000, 32 | 16 | 8 }, /* L4TAO4 */
    871     [ 47] = { 0x60000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER1SDRC) */
    872     [ 48] = { 0x61000, 0x1000, 32 | 16 | 8 }, /* L4TA14 */
    873     [ 49] = { 0x62000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER2GPMC) */
    874     [ 50] = { 0x63000, 0x1000, 32 | 16 | 8 }, /* L4TA15 */
    875     [ 51] = { 0x64000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER3OCM) */
    876     [ 52] = { 0x65000, 0x1000, 32 | 16 | 8 }, /* L4TA16 */
    877     [ 53] = { 0x66000,  0x300, 32 | 16 | 8 }, /* Emulation (WIN_TRACER4L4) */
    878     [ 54] = { 0x67000, 0x1000, 32 | 16 | 8 }, /* L4TA17 */
    879     [ 55] = { 0x68000, 0x1000, 32 | 16 | 8 }, /* Emulation (XTI) */
    880     [ 56] = { 0x69000, 0x1000, 32 | 16 | 8 }, /* L4TA18 */
    881     [ 57] = { 0x6a000, 0x1000,      16 | 8 }, /* UART1 */
    882     [ 58] = { 0x6b000, 0x1000, 32 | 16 | 8 }, /* L4TA19 */
    883     [ 59] = { 0x6c000, 0x1000,      16 | 8 }, /* UART2 */
    884     [ 60] = { 0x6d000, 0x1000, 32 | 16 | 8 }, /* L4TA20 */
    885     [ 61] = { 0x6e000, 0x1000,      16 | 8 }, /* UART3 */
    886     [ 62] = { 0x6f000, 0x1000, 32 | 16 | 8 }, /* L4TA21 */
    887     [ 63] = { 0x70000, 0x1000,      16     }, /* I2C1 */
    888     [ 64] = { 0x71000, 0x1000, 32 | 16 | 8 }, /* L4TAO5 */
    889     [ 65] = { 0x72000, 0x1000,      16     }, /* I2C2 */
    890     [ 66] = { 0x73000, 0x1000, 32 | 16 | 8 }, /* L4TAO6 */
    891     [ 67] = { 0x74000, 0x1000,      16     }, /* McBSP1 */
    892     [ 68] = { 0x75000, 0x1000, 32 | 16 | 8 }, /* L4TAO7 */
    893     [ 69] = { 0x76000, 0x1000,      16     }, /* McBSP2 */
    894     [ 70] = { 0x77000, 0x1000, 32 | 16 | 8 }, /* L4TAO8 */
    895     [ 71] = { 0x24000, 0x1000, 32 | 16 | 8 }, /* WD Timer 3 (DSP) */
    896     [ 72] = { 0x25000, 0x1000, 32 | 16 | 8 }, /* L4TA5 */
    897     [ 73] = { 0x26000, 0x1000, 32 | 16 | 8 }, /* WD Timer 4 (IVA) */
    898     [ 74] = { 0x27000, 0x1000, 32 | 16 | 8 }, /* L4TA6 */
    899     [ 75] = { 0x2a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 2 */
    900     [ 76] = { 0x2b000, 0x1000, 32 | 16 | 8 }, /* L4TA8 */
    901     [ 77] = { 0x78000, 0x1000, 32 | 16 | 8 }, /* GP Timer 3 */
    902     [ 78] = { 0x79000, 0x1000, 32 | 16 | 8 }, /* L4TA22 */
    903     [ 79] = { 0x7a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 4 */
    904     [ 80] = { 0x7b000, 0x1000, 32 | 16 | 8 }, /* L4TA23 */
    905     [ 81] = { 0x7c000, 0x1000, 32 | 16 | 8 }, /* GP Timer 5 */
    906     [ 82] = { 0x7d000, 0x1000, 32 | 16 | 8 }, /* L4TA24 */
    907     [ 83] = { 0x7e000, 0x1000, 32 | 16 | 8 }, /* GP Timer 6 */
    908     [ 84] = { 0x7f000, 0x1000, 32 | 16 | 8 }, /* L4TA25 */
    909     [ 85] = { 0x80000, 0x1000, 32 | 16 | 8 }, /* GP Timer 7 */
    910     [ 86] = { 0x81000, 0x1000, 32 | 16 | 8 }, /* L4TA26 */
    911     [ 87] = { 0x82000, 0x1000, 32 | 16 | 8 }, /* GP Timer 8 */
    912     [ 88] = { 0x83000, 0x1000, 32 | 16 | 8 }, /* L4TA27 */
    913     [ 89] = { 0x84000, 0x1000, 32 | 16 | 8 }, /* GP Timer 9 */
    914     [ 90] = { 0x85000, 0x1000, 32 | 16 | 8 }, /* L4TA28 */
    915     [ 91] = { 0x86000, 0x1000, 32 | 16 | 8 }, /* GP Timer 10 */
    916     [ 92] = { 0x87000, 0x1000, 32 | 16 | 8 }, /* L4TA29 */
    917     [ 93] = { 0x88000, 0x1000, 32 | 16 | 8 }, /* GP Timer 11 */
    918     [ 94] = { 0x89000, 0x1000, 32 | 16 | 8 }, /* L4TA30 */
    919     [ 95] = { 0x8a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 12 */
    920     [ 96] = { 0x8b000, 0x1000, 32 | 16 | 8 }, /* L4TA31 */
    921     [ 97] = { 0x90000, 0x1000,      16     }, /* EAC */
    922     [ 98] = { 0x91000, 0x1000, 32 | 16 | 8 }, /* L4TA32 */
    923     [ 99] = { 0x92000, 0x1000,      16     }, /* FAC */
    924     [100] = { 0x93000, 0x1000, 32 | 16 | 8 }, /* L4TA33 */
    925     [101] = { 0x94000, 0x1000, 32 | 16 | 8 }, /* IPC (MAILBOX) */
    926     [102] = { 0x95000, 0x1000, 32 | 16 | 8 }, /* L4TA34 */
    927     [103] = { 0x98000, 0x1000, 32 | 16 | 8 }, /* SPI1 */
    928     [104] = { 0x99000, 0x1000, 32 | 16 | 8 }, /* L4TA35 */
    929     [105] = { 0x9a000, 0x1000, 32 | 16 | 8 }, /* SPI2 */
    930     [106] = { 0x9b000, 0x1000, 32 | 16 | 8 }, /* L4TA36 */
    931     [107] = { 0x9c000, 0x1000,      16 | 8 }, /* MMC SDIO */
    932     [108] = { 0x9d000, 0x1000, 32 | 16 | 8 }, /* L4TAO9 */
    933     [109] = { 0x9e000, 0x1000, 32 | 16 | 8 }, /* MS_PRO */
    934     [110] = { 0x9f000, 0x1000, 32 | 16 | 8 }, /* L4TAO10 */
    935     [111] = { 0xa0000, 0x1000, 32          }, /* RNG */
    936     [112] = { 0xa1000, 0x1000, 32 | 16 | 8 }, /* L4TAO11 */
    937     [113] = { 0xa2000, 0x1000, 32          }, /* DES3DES */
    938     [114] = { 0xa3000, 0x1000, 32 | 16 | 8 }, /* L4TAO12 */
    939     [115] = { 0xa4000, 0x1000, 32          }, /* SHA1MD5 */
    940     [116] = { 0xa5000, 0x1000, 32 | 16 | 8 }, /* L4TAO13 */
    941     [117] = { 0xa6000, 0x1000, 32          }, /* AES */
    942     [118] = { 0xa7000, 0x1000, 32 | 16 | 8 }, /* L4TA37 */
    943     [119] = { 0xa8000, 0x2000, 32          }, /* PKA */
    944     [120] = { 0xaa000, 0x1000, 32 | 16 | 8 }, /* L4TA38 */
    945     [121] = { 0xb0000, 0x1000, 32          }, /* MG */
    946     [122] = { 0xb1000, 0x1000, 32 | 16 | 8 },
    947     [123] = { 0xb2000, 0x1000, 32          }, /* HDQ/1-Wire */
    948     [124] = { 0xb3000, 0x1000, 32 | 16 | 8 }, /* L4TA39 */
    949 };
    950 
    951 static const struct omap_l4_agent_info_s omap_l4_agent_info[54] = {
    952     { 0,           0, 3, 2 }, /* L4IA initiatior agent */
    953     { L4TAO(1),    3, 2, 1 }, /* Control and pinout module */
    954     { L4TAO(2),    5, 2, 1 }, /* 32K timer */
    955     { L4TAO(3),    7, 3, 2 }, /* PRCM */
    956     { L4TA(1),    10, 2, 1 }, /* BCM */
    957     { L4TA(2),    12, 2, 1 }, /* Test JTAG */
    958     { L4TA(3),    14, 6, 3 }, /* Quad GPIO */
    959     { L4TA(4),    20, 4, 3 }, /* WD timer 1/2 */
    960     { L4TA(7),    24, 2, 1 }, /* GP timer 1 */
    961     { L4TA(9),    26, 2, 1 }, /* ATM11 ETB */
    962     { L4TA(10),   28, 5, 4 }, /* Display subsystem */
    963     { L4TA(11),   33, 5, 4 }, /* Camera subsystem */
    964     { L4TA(12),   38, 2, 1 }, /* sDMA */
    965     { L4TA(13),   40, 5, 4 }, /* SSI */
    966     { L4TAO(4),   45, 2, 1 }, /* USB */
    967     { L4TA(14),   47, 2, 1 }, /* Win Tracer1 */
    968     { L4TA(15),   49, 2, 1 }, /* Win Tracer2 */
    969     { L4TA(16),   51, 2, 1 }, /* Win Tracer3 */
    970     { L4TA(17),   53, 2, 1 }, /* Win Tracer4 */
    971     { L4TA(18),   55, 2, 1 }, /* XTI */
    972     { L4TA(19),   57, 2, 1 }, /* UART1 */
    973     { L4TA(20),   59, 2, 1 }, /* UART2 */
    974     { L4TA(21),   61, 2, 1 }, /* UART3 */
    975     { L4TAO(5),   63, 2, 1 }, /* I2C1 */
    976     { L4TAO(6),   65, 2, 1 }, /* I2C2 */
    977     { L4TAO(7),   67, 2, 1 }, /* McBSP1 */
    978     { L4TAO(8),   69, 2, 1 }, /* McBSP2 */
    979     { L4TA(5),    71, 2, 1 }, /* WD Timer 3 (DSP) */
    980     { L4TA(6),    73, 2, 1 }, /* WD Timer 4 (IVA) */
    981     { L4TA(8),    75, 2, 1 }, /* GP Timer 2 */
    982     { L4TA(22),   77, 2, 1 }, /* GP Timer 3 */
    983     { L4TA(23),   79, 2, 1 }, /* GP Timer 4 */
    984     { L4TA(24),   81, 2, 1 }, /* GP Timer 5 */
    985     { L4TA(25),   83, 2, 1 }, /* GP Timer 6 */
    986     { L4TA(26),   85, 2, 1 }, /* GP Timer 7 */
    987     { L4TA(27),   87, 2, 1 }, /* GP Timer 8 */
    988     { L4TA(28),   89, 2, 1 }, /* GP Timer 9 */
    989     { L4TA(29),   91, 2, 1 }, /* GP Timer 10 */
    990     { L4TA(30),   93, 2, 1 }, /* GP Timer 11 */
    991     { L4TA(31),   95, 2, 1 }, /* GP Timer 12 */
    992     { L4TA(32),   97, 2, 1 }, /* EAC */
    993     { L4TA(33),   99, 2, 1 }, /* FAC */
    994     { L4TA(34),  101, 2, 1 }, /* IPC */
    995     { L4TA(35),  103, 2, 1 }, /* SPI1 */
    996     { L4TA(36),  105, 2, 1 }, /* SPI2 */
    997     { L4TAO(9),  107, 2, 1 }, /* MMC SDIO */
    998     { L4TAO(10), 109, 2, 1 },
    999     { L4TAO(11), 111, 2, 1 }, /* RNG */
   1000     { L4TAO(12), 113, 2, 1 }, /* DES3DES */
   1001     { L4TAO(13), 115, 2, 1 }, /* SHA1MD5 */
   1002     { L4TA(37),  117, 2, 1 }, /* AES */
   1003     { L4TA(38),  119, 2, 1 }, /* PKA */
   1004     { -1,        121, 2, 1 },
   1005     { L4TA(39),  123, 2, 1 }, /* HDQ/1-Wire */
   1006 };
   1007 
   1008 #define omap_l4ta(bus, cs)	\
   1009     omap_l4ta_get(bus, omap_l4_region, omap_l4_agent_info, L4TA(cs))
   1010 #define omap_l4tao(bus, cs)	\
   1011     omap_l4ta_get(bus, omap_l4_region, omap_l4_agent_info, L4TAO(cs))
   1012 
   1013 /* Power, Reset, and Clock Management */
   1014 struct omap_prcm_s {
   1015     qemu_irq irq[3];
   1016     struct omap_mpu_state_s *mpu;
   1017     MemoryRegion iomem0;
   1018     MemoryRegion iomem1;
   1019 
   1020     uint32_t irqst[3];
   1021     uint32_t irqen[3];
   1022 
   1023     uint32_t sysconfig;
   1024     uint32_t voltctrl;
   1025     uint32_t scratch[20];
   1026 
   1027     uint32_t clksrc[1];
   1028     uint32_t clkout[1];
   1029     uint32_t clkemul[1];
   1030     uint32_t clkpol[1];
   1031     uint32_t clksel[8];
   1032     uint32_t clken[12];
   1033     uint32_t clkctrl[4];
   1034     uint32_t clkidle[7];
   1035     uint32_t setuptime[2];
   1036 
   1037     uint32_t wkup[3];
   1038     uint32_t wken[3];
   1039     uint32_t wkst[3];
   1040     uint32_t rst[4];
   1041     uint32_t rstctrl[1];
   1042     uint32_t power[4];
   1043     uint32_t rsttime_wkup;
   1044 
   1045     uint32_t ev;
   1046     uint32_t evtime[2];
   1047 
   1048     int dpll_lock, apll_lock[2];
   1049 };
   1050 
   1051 static void omap_prcm_int_update(struct omap_prcm_s *s, int dom)
   1052 {
   1053     qemu_set_irq(s->irq[dom], s->irqst[dom] & s->irqen[dom]);
   1054     /* XXX or is the mask applied before PRCM_IRQSTATUS_* ? */
   1055 }
   1056 
   1057 static uint64_t omap_prcm_read(void *opaque, hwaddr addr,
   1058                                unsigned size)
   1059 {
   1060     struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
   1061     uint32_t ret;
   1062 
   1063     if (size != 4) {
   1064         return omap_badwidth_read32(opaque, addr);
   1065     }
   1066 
   1067     switch (addr) {
   1068     case 0x000:	/* PRCM_REVISION */
   1069         return 0x10;
   1070 
   1071     case 0x010:	/* PRCM_SYSCONFIG */
   1072         return s->sysconfig;
   1073 
   1074     case 0x018:	/* PRCM_IRQSTATUS_MPU */
   1075         return s->irqst[0];
   1076 
   1077     case 0x01c:	/* PRCM_IRQENABLE_MPU */
   1078         return s->irqen[0];
   1079 
   1080     case 0x050:	/* PRCM_VOLTCTRL */
   1081         return s->voltctrl;
   1082     case 0x054:	/* PRCM_VOLTST */
   1083         return s->voltctrl & 3;
   1084 
   1085     case 0x060:	/* PRCM_CLKSRC_CTRL */
   1086         return s->clksrc[0];
   1087     case 0x070:	/* PRCM_CLKOUT_CTRL */
   1088         return s->clkout[0];
   1089     case 0x078:	/* PRCM_CLKEMUL_CTRL */
   1090         return s->clkemul[0];
   1091     case 0x080:	/* PRCM_CLKCFG_CTRL */
   1092     case 0x084:	/* PRCM_CLKCFG_STATUS */
   1093         return 0;
   1094 
   1095     case 0x090:	/* PRCM_VOLTSETUP */
   1096         return s->setuptime[0];
   1097 
   1098     case 0x094:	/* PRCM_CLKSSETUP */
   1099         return s->setuptime[1];
   1100 
   1101     case 0x098:	/* PRCM_POLCTRL */
   1102         return s->clkpol[0];
   1103 
   1104     case 0x0b0:	/* GENERAL_PURPOSE1 */
   1105     case 0x0b4:	/* GENERAL_PURPOSE2 */
   1106     case 0x0b8:	/* GENERAL_PURPOSE3 */
   1107     case 0x0bc:	/* GENERAL_PURPOSE4 */
   1108     case 0x0c0:	/* GENERAL_PURPOSE5 */
   1109     case 0x0c4:	/* GENERAL_PURPOSE6 */
   1110     case 0x0c8:	/* GENERAL_PURPOSE7 */
   1111     case 0x0cc:	/* GENERAL_PURPOSE8 */
   1112     case 0x0d0:	/* GENERAL_PURPOSE9 */
   1113     case 0x0d4:	/* GENERAL_PURPOSE10 */
   1114     case 0x0d8:	/* GENERAL_PURPOSE11 */
   1115     case 0x0dc:	/* GENERAL_PURPOSE12 */
   1116     case 0x0e0:	/* GENERAL_PURPOSE13 */
   1117     case 0x0e4:	/* GENERAL_PURPOSE14 */
   1118     case 0x0e8:	/* GENERAL_PURPOSE15 */
   1119     case 0x0ec:	/* GENERAL_PURPOSE16 */
   1120     case 0x0f0:	/* GENERAL_PURPOSE17 */
   1121     case 0x0f4:	/* GENERAL_PURPOSE18 */
   1122     case 0x0f8:	/* GENERAL_PURPOSE19 */
   1123     case 0x0fc:	/* GENERAL_PURPOSE20 */
   1124         return s->scratch[(addr - 0xb0) >> 2];
   1125 
   1126     case 0x140:	/* CM_CLKSEL_MPU */
   1127         return s->clksel[0];
   1128     case 0x148:	/* CM_CLKSTCTRL_MPU */
   1129         return s->clkctrl[0];
   1130 
   1131     case 0x158:	/* RM_RSTST_MPU */
   1132         return s->rst[0];
   1133     case 0x1c8:	/* PM_WKDEP_MPU */
   1134         return s->wkup[0];
   1135     case 0x1d4:	/* PM_EVGENCTRL_MPU */
   1136         return s->ev;
   1137     case 0x1d8:	/* PM_EVEGENONTIM_MPU */
   1138         return s->evtime[0];
   1139     case 0x1dc:	/* PM_EVEGENOFFTIM_MPU */
   1140         return s->evtime[1];
   1141     case 0x1e0:	/* PM_PWSTCTRL_MPU */
   1142         return s->power[0];
   1143     case 0x1e4:	/* PM_PWSTST_MPU */
   1144         return 0;
   1145 
   1146     case 0x200:	/* CM_FCLKEN1_CORE */
   1147         return s->clken[0];
   1148     case 0x204:	/* CM_FCLKEN2_CORE */
   1149         return s->clken[1];
   1150     case 0x210:	/* CM_ICLKEN1_CORE */
   1151         return s->clken[2];
   1152     case 0x214:	/* CM_ICLKEN2_CORE */
   1153         return s->clken[3];
   1154     case 0x21c:	/* CM_ICLKEN4_CORE */
   1155         return s->clken[4];
   1156 
   1157     case 0x220:	/* CM_IDLEST1_CORE */
   1158         /* TODO: check the actual iclk status */
   1159         return 0x7ffffff9;
   1160     case 0x224:	/* CM_IDLEST2_CORE */
   1161         /* TODO: check the actual iclk status */
   1162         return 0x00000007;
   1163     case 0x22c:	/* CM_IDLEST4_CORE */
   1164         /* TODO: check the actual iclk status */
   1165         return 0x0000001f;
   1166 
   1167     case 0x230:	/* CM_AUTOIDLE1_CORE */
   1168         return s->clkidle[0];
   1169     case 0x234:	/* CM_AUTOIDLE2_CORE */
   1170         return s->clkidle[1];
   1171     case 0x238:	/* CM_AUTOIDLE3_CORE */
   1172         return s->clkidle[2];
   1173     case 0x23c:	/* CM_AUTOIDLE4_CORE */
   1174         return s->clkidle[3];
   1175 
   1176     case 0x240:	/* CM_CLKSEL1_CORE */
   1177         return s->clksel[1];
   1178     case 0x244:	/* CM_CLKSEL2_CORE */
   1179         return s->clksel[2];
   1180 
   1181     case 0x248:	/* CM_CLKSTCTRL_CORE */
   1182         return s->clkctrl[1];
   1183 
   1184     case 0x2a0:	/* PM_WKEN1_CORE */
   1185         return s->wken[0];
   1186     case 0x2a4:	/* PM_WKEN2_CORE */
   1187         return s->wken[1];
   1188 
   1189     case 0x2b0:	/* PM_WKST1_CORE */
   1190         return s->wkst[0];
   1191     case 0x2b4:	/* PM_WKST2_CORE */
   1192         return s->wkst[1];
   1193     case 0x2c8:	/* PM_WKDEP_CORE */
   1194         return 0x1e;
   1195 
   1196     case 0x2e0:	/* PM_PWSTCTRL_CORE */
   1197         return s->power[1];
   1198     case 0x2e4:	/* PM_PWSTST_CORE */
   1199         return 0x000030 | (s->power[1] & 0xfc00);
   1200 
   1201     case 0x300:	/* CM_FCLKEN_GFX */
   1202         return s->clken[5];
   1203     case 0x310:	/* CM_ICLKEN_GFX */
   1204         return s->clken[6];
   1205     case 0x320:	/* CM_IDLEST_GFX */
   1206         /* TODO: check the actual iclk status */
   1207         return 0x00000001;
   1208     case 0x340:	/* CM_CLKSEL_GFX */
   1209         return s->clksel[3];
   1210     case 0x348:	/* CM_CLKSTCTRL_GFX */
   1211         return s->clkctrl[2];
   1212     case 0x350:	/* RM_RSTCTRL_GFX */
   1213         return s->rstctrl[0];
   1214     case 0x358:	/* RM_RSTST_GFX */
   1215         return s->rst[1];
   1216     case 0x3c8:	/* PM_WKDEP_GFX */
   1217         return s->wkup[1];
   1218 
   1219     case 0x3e0:	/* PM_PWSTCTRL_GFX */
   1220         return s->power[2];
   1221     case 0x3e4:	/* PM_PWSTST_GFX */
   1222         return s->power[2] & 3;
   1223 
   1224     case 0x400:	/* CM_FCLKEN_WKUP */
   1225         return s->clken[7];
   1226     case 0x410:	/* CM_ICLKEN_WKUP */
   1227         return s->clken[8];
   1228     case 0x420:	/* CM_IDLEST_WKUP */
   1229         /* TODO: check the actual iclk status */
   1230         return 0x0000003f;
   1231     case 0x430:	/* CM_AUTOIDLE_WKUP */
   1232         return s->clkidle[4];
   1233     case 0x440:	/* CM_CLKSEL_WKUP */
   1234         return s->clksel[4];
   1235     case 0x450:	/* RM_RSTCTRL_WKUP */
   1236         return 0;
   1237     case 0x454:	/* RM_RSTTIME_WKUP */
   1238         return s->rsttime_wkup;
   1239     case 0x458:	/* RM_RSTST_WKUP */
   1240         return s->rst[2];
   1241     case 0x4a0:	/* PM_WKEN_WKUP */
   1242         return s->wken[2];
   1243     case 0x4b0:	/* PM_WKST_WKUP */
   1244         return s->wkst[2];
   1245 
   1246     case 0x500:	/* CM_CLKEN_PLL */
   1247         return s->clken[9];
   1248     case 0x520:	/* CM_IDLEST_CKGEN */
   1249         ret = 0x0000070 | (s->apll_lock[0] << 9) | (s->apll_lock[1] << 8);
   1250         if (!(s->clksel[6] & 3))
   1251             /* Core uses 32-kHz clock */
   1252             ret |= 3 << 0;
   1253         else if (!s->dpll_lock)
   1254             /* DPLL not locked, core uses ref_clk */
   1255             ret |= 1 << 0;
   1256         else
   1257             /* Core uses DPLL */
   1258             ret |= 2 << 0;
   1259         return ret;
   1260     case 0x530:	/* CM_AUTOIDLE_PLL */
   1261         return s->clkidle[5];
   1262     case 0x540:	/* CM_CLKSEL1_PLL */
   1263         return s->clksel[5];
   1264     case 0x544:	/* CM_CLKSEL2_PLL */
   1265         return s->clksel[6];
   1266 
   1267     case 0x800:	/* CM_FCLKEN_DSP */
   1268         return s->clken[10];
   1269     case 0x810:	/* CM_ICLKEN_DSP */
   1270         return s->clken[11];
   1271     case 0x820:	/* CM_IDLEST_DSP */
   1272         /* TODO: check the actual iclk status */
   1273         return 0x00000103;
   1274     case 0x830:	/* CM_AUTOIDLE_DSP */
   1275         return s->clkidle[6];
   1276     case 0x840:	/* CM_CLKSEL_DSP */
   1277         return s->clksel[7];
   1278     case 0x848:	/* CM_CLKSTCTRL_DSP */
   1279         return s->clkctrl[3];
   1280     case 0x850:	/* RM_RSTCTRL_DSP */
   1281         return 0;
   1282     case 0x858:	/* RM_RSTST_DSP */
   1283         return s->rst[3];
   1284     case 0x8c8:	/* PM_WKDEP_DSP */
   1285         return s->wkup[2];
   1286     case 0x8e0:	/* PM_PWSTCTRL_DSP */
   1287         return s->power[3];
   1288     case 0x8e4:	/* PM_PWSTST_DSP */
   1289         return 0x008030 | (s->power[3] & 0x3003);
   1290 
   1291     case 0x8f0:	/* PRCM_IRQSTATUS_DSP */
   1292         return s->irqst[1];
   1293     case 0x8f4:	/* PRCM_IRQENABLE_DSP */
   1294         return s->irqen[1];
   1295 
   1296     case 0x8f8:	/* PRCM_IRQSTATUS_IVA */
   1297         return s->irqst[2];
   1298     case 0x8fc:	/* PRCM_IRQENABLE_IVA */
   1299         return s->irqen[2];
   1300     }
   1301 
   1302     OMAP_BAD_REG(addr);
   1303     return 0;
   1304 }
   1305 
   1306 static void omap_prcm_apll_update(struct omap_prcm_s *s)
   1307 {
   1308     int mode[2];
   1309 
   1310     mode[0] = (s->clken[9] >> 6) & 3;
   1311     s->apll_lock[0] = (mode[0] == 3);
   1312     mode[1] = (s->clken[9] >> 2) & 3;
   1313     s->apll_lock[1] = (mode[1] == 3);
   1314     /* TODO: update clocks */
   1315 
   1316     if (mode[0] == 1 || mode[0] == 2 || mode[1] == 1 || mode[1] == 2)
   1317         fprintf(stderr, "%s: bad EN_54M_PLL or bad EN_96M_PLL\n",
   1318                         __func__);
   1319 }
   1320 
   1321 static void omap_prcm_dpll_update(struct omap_prcm_s *s)
   1322 {
   1323     omap_clk dpll = omap_findclk(s->mpu, "dpll");
   1324     omap_clk dpll_x2 = omap_findclk(s->mpu, "dpll");
   1325     omap_clk core = omap_findclk(s->mpu, "core_clk");
   1326     int mode = (s->clken[9] >> 0) & 3;
   1327     int mult, div;
   1328 
   1329     mult = (s->clksel[5] >> 12) & 0x3ff;
   1330     div = (s->clksel[5] >> 8) & 0xf;
   1331     if (mult == 0 || mult == 1)
   1332         mode = 1;	/* Bypass */
   1333 
   1334     s->dpll_lock = 0;
   1335     switch (mode) {
   1336     case 0:
   1337         fprintf(stderr, "%s: bad EN_DPLL\n", __func__);
   1338         break;
   1339     case 1:	/* Low-power bypass mode (Default) */
   1340     case 2:	/* Fast-relock bypass mode */
   1341         omap_clk_setrate(dpll, 1, 1);
   1342         omap_clk_setrate(dpll_x2, 1, 1);
   1343         break;
   1344     case 3:	/* Lock mode */
   1345         s->dpll_lock = 1; /* After 20 FINT cycles (ref_clk / (div + 1)).  */
   1346 
   1347         omap_clk_setrate(dpll, div + 1, mult);
   1348         omap_clk_setrate(dpll_x2, div + 1, mult * 2);
   1349         break;
   1350     }
   1351 
   1352     switch ((s->clksel[6] >> 0) & 3) {
   1353     case 0:
   1354         omap_clk_reparent(core, omap_findclk(s->mpu, "clk32-kHz"));
   1355         break;
   1356     case 1:
   1357         omap_clk_reparent(core, dpll);
   1358         break;
   1359     case 2:
   1360         /* Default */
   1361         omap_clk_reparent(core, dpll_x2);
   1362         break;
   1363     case 3:
   1364         fprintf(stderr, "%s: bad CORE_CLK_SRC\n", __func__);
   1365         break;
   1366     }
   1367 }
   1368 
   1369 static void omap_prcm_write(void *opaque, hwaddr addr,
   1370                             uint64_t value, unsigned size)
   1371 {
   1372     struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
   1373 
   1374     if (size != 4) {
   1375         omap_badwidth_write32(opaque, addr, value);
   1376         return;
   1377     }
   1378 
   1379     switch (addr) {
   1380     case 0x000:	/* PRCM_REVISION */
   1381     case 0x054:	/* PRCM_VOLTST */
   1382     case 0x084:	/* PRCM_CLKCFG_STATUS */
   1383     case 0x1e4:	/* PM_PWSTST_MPU */
   1384     case 0x220:	/* CM_IDLEST1_CORE */
   1385     case 0x224:	/* CM_IDLEST2_CORE */
   1386     case 0x22c:	/* CM_IDLEST4_CORE */
   1387     case 0x2c8:	/* PM_WKDEP_CORE */
   1388     case 0x2e4:	/* PM_PWSTST_CORE */
   1389     case 0x320:	/* CM_IDLEST_GFX */
   1390     case 0x3e4:	/* PM_PWSTST_GFX */
   1391     case 0x420:	/* CM_IDLEST_WKUP */
   1392     case 0x520:	/* CM_IDLEST_CKGEN */
   1393     case 0x820:	/* CM_IDLEST_DSP */
   1394     case 0x8e4:	/* PM_PWSTST_DSP */
   1395         OMAP_RO_REG(addr);
   1396         return;
   1397 
   1398     case 0x010:	/* PRCM_SYSCONFIG */
   1399         s->sysconfig = value & 1;
   1400         break;
   1401 
   1402     case 0x018:	/* PRCM_IRQSTATUS_MPU */
   1403         s->irqst[0] &= ~value;
   1404         omap_prcm_int_update(s, 0);
   1405         break;
   1406     case 0x01c:	/* PRCM_IRQENABLE_MPU */
   1407         s->irqen[0] = value & 0x3f;
   1408         omap_prcm_int_update(s, 0);
   1409         break;
   1410 
   1411     case 0x050:	/* PRCM_VOLTCTRL */
   1412         s->voltctrl = value & 0xf1c3;
   1413         break;
   1414 
   1415     case 0x060:	/* PRCM_CLKSRC_CTRL */
   1416         s->clksrc[0] = value & 0xdb;
   1417         /* TODO update clocks */
   1418         break;
   1419 
   1420     case 0x070:	/* PRCM_CLKOUT_CTRL */
   1421         s->clkout[0] = value & 0xbbbb;
   1422         /* TODO update clocks */
   1423         break;
   1424 
   1425     case 0x078:	/* PRCM_CLKEMUL_CTRL */
   1426         s->clkemul[0] = value & 1;
   1427         /* TODO update clocks */
   1428         break;
   1429 
   1430     case 0x080:	/* PRCM_CLKCFG_CTRL */
   1431         break;
   1432 
   1433     case 0x090:	/* PRCM_VOLTSETUP */
   1434         s->setuptime[0] = value & 0xffff;
   1435         break;
   1436     case 0x094:	/* PRCM_CLKSSETUP */
   1437         s->setuptime[1] = value & 0xffff;
   1438         break;
   1439 
   1440     case 0x098:	/* PRCM_POLCTRL */
   1441         s->clkpol[0] = value & 0x701;
   1442         break;
   1443 
   1444     case 0x0b0:	/* GENERAL_PURPOSE1 */
   1445     case 0x0b4:	/* GENERAL_PURPOSE2 */
   1446     case 0x0b8:	/* GENERAL_PURPOSE3 */
   1447     case 0x0bc:	/* GENERAL_PURPOSE4 */
   1448     case 0x0c0:	/* GENERAL_PURPOSE5 */
   1449     case 0x0c4:	/* GENERAL_PURPOSE6 */
   1450     case 0x0c8:	/* GENERAL_PURPOSE7 */
   1451     case 0x0cc:	/* GENERAL_PURPOSE8 */
   1452     case 0x0d0:	/* GENERAL_PURPOSE9 */
   1453     case 0x0d4:	/* GENERAL_PURPOSE10 */
   1454     case 0x0d8:	/* GENERAL_PURPOSE11 */
   1455     case 0x0dc:	/* GENERAL_PURPOSE12 */
   1456     case 0x0e0:	/* GENERAL_PURPOSE13 */
   1457     case 0x0e4:	/* GENERAL_PURPOSE14 */
   1458     case 0x0e8:	/* GENERAL_PURPOSE15 */
   1459     case 0x0ec:	/* GENERAL_PURPOSE16 */
   1460     case 0x0f0:	/* GENERAL_PURPOSE17 */
   1461     case 0x0f4:	/* GENERAL_PURPOSE18 */
   1462     case 0x0f8:	/* GENERAL_PURPOSE19 */
   1463     case 0x0fc:	/* GENERAL_PURPOSE20 */
   1464         s->scratch[(addr - 0xb0) >> 2] = value;
   1465         break;
   1466 
   1467     case 0x140:	/* CM_CLKSEL_MPU */
   1468         s->clksel[0] = value & 0x1f;
   1469         /* TODO update clocks */
   1470         break;
   1471     case 0x148:	/* CM_CLKSTCTRL_MPU */
   1472         s->clkctrl[0] = value & 0x1f;
   1473         break;
   1474 
   1475     case 0x158:	/* RM_RSTST_MPU */
   1476         s->rst[0] &= ~value;
   1477         break;
   1478     case 0x1c8:	/* PM_WKDEP_MPU */
   1479         s->wkup[0] = value & 0x15;
   1480         break;
   1481 
   1482     case 0x1d4:	/* PM_EVGENCTRL_MPU */
   1483         s->ev = value & 0x1f;
   1484         break;
   1485     case 0x1d8:	/* PM_EVEGENONTIM_MPU */
   1486         s->evtime[0] = value;
   1487         break;
   1488     case 0x1dc:	/* PM_EVEGENOFFTIM_MPU */
   1489         s->evtime[1] = value;
   1490         break;
   1491 
   1492     case 0x1e0:	/* PM_PWSTCTRL_MPU */
   1493         s->power[0] = value & 0xc0f;
   1494         break;
   1495 
   1496     case 0x200:	/* CM_FCLKEN1_CORE */
   1497         s->clken[0] = value & 0xbfffffff;
   1498         /* TODO update clocks */
   1499         /* The EN_EAC bit only gets/puts func_96m_clk.  */
   1500         break;
   1501     case 0x204:	/* CM_FCLKEN2_CORE */
   1502         s->clken[1] = value & 0x00000007;
   1503         /* TODO update clocks */
   1504         break;
   1505     case 0x210:	/* CM_ICLKEN1_CORE */
   1506         s->clken[2] = value & 0xfffffff9;
   1507         /* TODO update clocks */
   1508         /* The EN_EAC bit only gets/puts core_l4_iclk.  */
   1509         break;
   1510     case 0x214:	/* CM_ICLKEN2_CORE */
   1511         s->clken[3] = value & 0x00000007;
   1512         /* TODO update clocks */
   1513         break;
   1514     case 0x21c:	/* CM_ICLKEN4_CORE */
   1515         s->clken[4] = value & 0x0000001f;
   1516         /* TODO update clocks */
   1517         break;
   1518 
   1519     case 0x230:	/* CM_AUTOIDLE1_CORE */
   1520         s->clkidle[0] = value & 0xfffffff9;
   1521         /* TODO update clocks */
   1522         break;
   1523     case 0x234:	/* CM_AUTOIDLE2_CORE */
   1524         s->clkidle[1] = value & 0x00000007;
   1525         /* TODO update clocks */
   1526         break;
   1527     case 0x238:	/* CM_AUTOIDLE3_CORE */
   1528         s->clkidle[2] = value & 0x00000007;
   1529         /* TODO update clocks */
   1530         break;
   1531     case 0x23c:	/* CM_AUTOIDLE4_CORE */
   1532         s->clkidle[3] = value & 0x0000001f;
   1533         /* TODO update clocks */
   1534         break;
   1535 
   1536     case 0x240:	/* CM_CLKSEL1_CORE */
   1537         s->clksel[1] = value & 0x0fffbf7f;
   1538         /* TODO update clocks */
   1539         break;
   1540 
   1541     case 0x244:	/* CM_CLKSEL2_CORE */
   1542         s->clksel[2] = value & 0x00fffffc;
   1543         /* TODO update clocks */
   1544         break;
   1545 
   1546     case 0x248:	/* CM_CLKSTCTRL_CORE */
   1547         s->clkctrl[1] = value & 0x7;
   1548         break;
   1549 
   1550     case 0x2a0:	/* PM_WKEN1_CORE */
   1551         s->wken[0] = value & 0x04667ff8;
   1552         break;
   1553     case 0x2a4:	/* PM_WKEN2_CORE */
   1554         s->wken[1] = value & 0x00000005;
   1555         break;
   1556 
   1557     case 0x2b0:	/* PM_WKST1_CORE */
   1558         s->wkst[0] &= ~value;
   1559         break;
   1560     case 0x2b4:	/* PM_WKST2_CORE */
   1561         s->wkst[1] &= ~value;
   1562         break;
   1563 
   1564     case 0x2e0:	/* PM_PWSTCTRL_CORE */
   1565         s->power[1] = (value & 0x00fc3f) | (1 << 2);
   1566         break;
   1567 
   1568     case 0x300:	/* CM_FCLKEN_GFX */
   1569         s->clken[5] = value & 6;
   1570         /* TODO update clocks */
   1571         break;
   1572     case 0x310:	/* CM_ICLKEN_GFX */
   1573         s->clken[6] = value & 1;
   1574         /* TODO update clocks */
   1575         break;
   1576     case 0x340:	/* CM_CLKSEL_GFX */
   1577         s->clksel[3] = value & 7;
   1578         /* TODO update clocks */
   1579         break;
   1580     case 0x348:	/* CM_CLKSTCTRL_GFX */
   1581         s->clkctrl[2] = value & 1;
   1582         break;
   1583     case 0x350:	/* RM_RSTCTRL_GFX */
   1584         s->rstctrl[0] = value & 1;
   1585         /* TODO: reset */
   1586         break;
   1587     case 0x358:	/* RM_RSTST_GFX */
   1588         s->rst[1] &= ~value;
   1589         break;
   1590     case 0x3c8:	/* PM_WKDEP_GFX */
   1591         s->wkup[1] = value & 0x13;
   1592         break;
   1593     case 0x3e0:	/* PM_PWSTCTRL_GFX */
   1594         s->power[2] = (value & 0x00c0f) | (3 << 2);
   1595         break;
   1596 
   1597     case 0x400:	/* CM_FCLKEN_WKUP */
   1598         s->clken[7] = value & 0xd;
   1599         /* TODO update clocks */
   1600         break;
   1601     case 0x410:	/* CM_ICLKEN_WKUP */
   1602         s->clken[8] = value & 0x3f;
   1603         /* TODO update clocks */
   1604         break;
   1605     case 0x430:	/* CM_AUTOIDLE_WKUP */
   1606         s->clkidle[4] = value & 0x0000003f;
   1607         /* TODO update clocks */
   1608         break;
   1609     case 0x440:	/* CM_CLKSEL_WKUP */
   1610         s->clksel[4] = value & 3;
   1611         /* TODO update clocks */
   1612         break;
   1613     case 0x450:	/* RM_RSTCTRL_WKUP */
   1614         /* TODO: reset */
   1615         if (value & 2)
   1616             qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
   1617         break;
   1618     case 0x454:	/* RM_RSTTIME_WKUP */
   1619         s->rsttime_wkup = value & 0x1fff;
   1620         break;
   1621     case 0x458:	/* RM_RSTST_WKUP */
   1622         s->rst[2] &= ~value;
   1623         break;
   1624     case 0x4a0:	/* PM_WKEN_WKUP */
   1625         s->wken[2] = value & 0x00000005;
   1626         break;
   1627     case 0x4b0:	/* PM_WKST_WKUP */
   1628         s->wkst[2] &= ~value;
   1629         break;
   1630 
   1631     case 0x500:	/* CM_CLKEN_PLL */
   1632         if (value & 0xffffff30)
   1633             fprintf(stderr, "%s: write 0s in CM_CLKEN_PLL for "
   1634                             "future compatibility\n", __func__);
   1635         if ((s->clken[9] ^ value) & 0xcc) {
   1636             s->clken[9] &= ~0xcc;
   1637             s->clken[9] |= value & 0xcc;
   1638             omap_prcm_apll_update(s);
   1639         }
   1640         if ((s->clken[9] ^ value) & 3) {
   1641             s->clken[9] &= ~3;
   1642             s->clken[9] |= value & 3;
   1643             omap_prcm_dpll_update(s);
   1644         }
   1645         break;
   1646     case 0x530:	/* CM_AUTOIDLE_PLL */
   1647         s->clkidle[5] = value & 0x000000cf;
   1648         /* TODO update clocks */
   1649         break;
   1650     case 0x540:	/* CM_CLKSEL1_PLL */
   1651         if (value & 0xfc4000d7)
   1652             fprintf(stderr, "%s: write 0s in CM_CLKSEL1_PLL for "
   1653                             "future compatibility\n", __func__);
   1654         if ((s->clksel[5] ^ value) & 0x003fff00) {
   1655             s->clksel[5] = value & 0x03bfff28;
   1656             omap_prcm_dpll_update(s);
   1657         }
   1658         /* TODO update the other clocks */
   1659 
   1660         s->clksel[5] = value & 0x03bfff28;
   1661         break;
   1662     case 0x544:	/* CM_CLKSEL2_PLL */
   1663         if (value & ~3)
   1664             fprintf(stderr, "%s: write 0s in CM_CLKSEL2_PLL[31:2] for "
   1665                             "future compatibility\n", __func__);
   1666         if (s->clksel[6] != (value & 3)) {
   1667             s->clksel[6] = value & 3;
   1668             omap_prcm_dpll_update(s);
   1669         }
   1670         break;
   1671 
   1672     case 0x800:	/* CM_FCLKEN_DSP */
   1673         s->clken[10] = value & 0x501;
   1674         /* TODO update clocks */
   1675         break;
   1676     case 0x810:	/* CM_ICLKEN_DSP */
   1677         s->clken[11] = value & 0x2;
   1678         /* TODO update clocks */
   1679         break;
   1680     case 0x830:	/* CM_AUTOIDLE_DSP */
   1681         s->clkidle[6] = value & 0x2;
   1682         /* TODO update clocks */
   1683         break;
   1684     case 0x840:	/* CM_CLKSEL_DSP */
   1685         s->clksel[7] = value & 0x3fff;
   1686         /* TODO update clocks */
   1687         break;
   1688     case 0x848:	/* CM_CLKSTCTRL_DSP */
   1689         s->clkctrl[3] = value & 0x101;
   1690         break;
   1691     case 0x850:	/* RM_RSTCTRL_DSP */
   1692         /* TODO: reset */
   1693         break;
   1694     case 0x858:	/* RM_RSTST_DSP */
   1695         s->rst[3] &= ~value;
   1696         break;
   1697     case 0x8c8:	/* PM_WKDEP_DSP */
   1698         s->wkup[2] = value & 0x13;
   1699         break;
   1700     case 0x8e0:	/* PM_PWSTCTRL_DSP */
   1701         s->power[3] = (value & 0x03017) | (3 << 2);
   1702         break;
   1703 
   1704     case 0x8f0:	/* PRCM_IRQSTATUS_DSP */
   1705         s->irqst[1] &= ~value;
   1706         omap_prcm_int_update(s, 1);
   1707         break;
   1708     case 0x8f4:	/* PRCM_IRQENABLE_DSP */
   1709         s->irqen[1] = value & 0x7;
   1710         omap_prcm_int_update(s, 1);
   1711         break;
   1712 
   1713     case 0x8f8:	/* PRCM_IRQSTATUS_IVA */
   1714         s->irqst[2] &= ~value;
   1715         omap_prcm_int_update(s, 2);
   1716         break;
   1717     case 0x8fc:	/* PRCM_IRQENABLE_IVA */
   1718         s->irqen[2] = value & 0x7;
   1719         omap_prcm_int_update(s, 2);
   1720         break;
   1721 
   1722     default:
   1723         OMAP_BAD_REG(addr);
   1724         return;
   1725     }
   1726 }
   1727 
   1728 static const MemoryRegionOps omap_prcm_ops = {
   1729     .read = omap_prcm_read,
   1730     .write = omap_prcm_write,
   1731     .endianness = DEVICE_NATIVE_ENDIAN,
   1732 };
   1733 
   1734 static void omap_prcm_reset(struct omap_prcm_s *s)
   1735 {
   1736     s->sysconfig = 0;
   1737     s->irqst[0] = 0;
   1738     s->irqst[1] = 0;
   1739     s->irqst[2] = 0;
   1740     s->irqen[0] = 0;
   1741     s->irqen[1] = 0;
   1742     s->irqen[2] = 0;
   1743     s->voltctrl = 0x1040;
   1744     s->ev = 0x14;
   1745     s->evtime[0] = 0;
   1746     s->evtime[1] = 0;
   1747     s->clkctrl[0] = 0;
   1748     s->clkctrl[1] = 0;
   1749     s->clkctrl[2] = 0;
   1750     s->clkctrl[3] = 0;
   1751     s->clken[1] = 7;
   1752     s->clken[3] = 7;
   1753     s->clken[4] = 0;
   1754     s->clken[5] = 0;
   1755     s->clken[6] = 0;
   1756     s->clken[7] = 0xc;
   1757     s->clken[8] = 0x3e;
   1758     s->clken[9] = 0x0d;
   1759     s->clken[10] = 0;
   1760     s->clken[11] = 0;
   1761     s->clkidle[0] = 0;
   1762     s->clkidle[2] = 7;
   1763     s->clkidle[3] = 0;
   1764     s->clkidle[4] = 0;
   1765     s->clkidle[5] = 0x0c;
   1766     s->clkidle[6] = 0;
   1767     s->clksel[0] = 0x01;
   1768     s->clksel[1] = 0x02100121;
   1769     s->clksel[2] = 0x00000000;
   1770     s->clksel[3] = 0x01;
   1771     s->clksel[4] = 0;
   1772     s->clksel[7] = 0x0121;
   1773     s->wkup[0] = 0x15;
   1774     s->wkup[1] = 0x13;
   1775     s->wkup[2] = 0x13;
   1776     s->wken[0] = 0x04667ff8;
   1777     s->wken[1] = 0x00000005;
   1778     s->wken[2] = 5;
   1779     s->wkst[0] = 0;
   1780     s->wkst[1] = 0;
   1781     s->wkst[2] = 0;
   1782     s->power[0] = 0x00c;
   1783     s->power[1] = 4;
   1784     s->power[2] = 0x0000c;
   1785     s->power[3] = 0x14;
   1786     s->rstctrl[0] = 1;
   1787     s->rst[3] = 1;
   1788     omap_prcm_apll_update(s);
   1789     omap_prcm_dpll_update(s);
   1790 }
   1791 
   1792 static void omap_prcm_coldreset(struct omap_prcm_s *s)
   1793 {
   1794     s->setuptime[0] = 0;
   1795     s->setuptime[1] = 0;
   1796     memset(&s->scratch, 0, sizeof(s->scratch));
   1797     s->rst[0] = 0x01;
   1798     s->rst[1] = 0x00;
   1799     s->rst[2] = 0x01;
   1800     s->clken[0] = 0;
   1801     s->clken[2] = 0;
   1802     s->clkidle[1] = 0;
   1803     s->clksel[5] = 0;
   1804     s->clksel[6] = 2;
   1805     s->clksrc[0] = 0x43;
   1806     s->clkout[0] = 0x0303;
   1807     s->clkemul[0] = 0;
   1808     s->clkpol[0] = 0x100;
   1809     s->rsttime_wkup = 0x1002;
   1810 
   1811     omap_prcm_reset(s);
   1812 }
   1813 
   1814 static struct omap_prcm_s *omap_prcm_init(struct omap_target_agent_s *ta,
   1815                 qemu_irq mpu_int, qemu_irq dsp_int, qemu_irq iva_int,
   1816                 struct omap_mpu_state_s *mpu)
   1817 {
   1818     struct omap_prcm_s *s = g_new0(struct omap_prcm_s, 1);
   1819 
   1820     s->irq[0] = mpu_int;
   1821     s->irq[1] = dsp_int;
   1822     s->irq[2] = iva_int;
   1823     s->mpu = mpu;
   1824     omap_prcm_coldreset(s);
   1825 
   1826     memory_region_init_io(&s->iomem0, NULL, &omap_prcm_ops, s, "omap.pcrm0",
   1827                           omap_l4_region_size(ta, 0));
   1828     memory_region_init_io(&s->iomem1, NULL, &omap_prcm_ops, s, "omap.pcrm1",
   1829                           omap_l4_region_size(ta, 1));
   1830     omap_l4_attach(ta, 0, &s->iomem0);
   1831     omap_l4_attach(ta, 1, &s->iomem1);
   1832 
   1833     return s;
   1834 }
   1835 
   1836 /* System and Pinout control */
   1837 struct omap_sysctl_s {
   1838     struct omap_mpu_state_s *mpu;
   1839     MemoryRegion iomem;
   1840 
   1841     uint32_t sysconfig;
   1842     uint32_t devconfig;
   1843     uint32_t psaconfig;
   1844     uint32_t padconf[0x45];
   1845     uint8_t obs;
   1846     uint32_t msuspendmux[5];
   1847 };
   1848 
   1849 static uint32_t omap_sysctl_read8(void *opaque, hwaddr addr)
   1850 {
   1851 
   1852     struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
   1853     int pad_offset, byte_offset;
   1854     int value;
   1855 
   1856     switch (addr) {
   1857     case 0x030 ... 0x140:	/* CONTROL_PADCONF - only used in the POP */
   1858         pad_offset = (addr - 0x30) >> 2;
   1859         byte_offset = (addr - 0x30) & (4 - 1);
   1860 
   1861         value = s->padconf[pad_offset];
   1862         value = (value >> (byte_offset * 8)) & 0xff;
   1863 
   1864         return value;
   1865 
   1866     default:
   1867         break;
   1868     }
   1869 
   1870     OMAP_BAD_REG(addr);
   1871     return 0;
   1872 }
   1873 
   1874 static uint32_t omap_sysctl_read(void *opaque, hwaddr addr)
   1875 {
   1876     struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
   1877 
   1878     switch (addr) {
   1879     case 0x000:	/* CONTROL_REVISION */
   1880         return 0x20;
   1881 
   1882     case 0x010:	/* CONTROL_SYSCONFIG */
   1883         return s->sysconfig;
   1884 
   1885     case 0x030 ... 0x140:	/* CONTROL_PADCONF - only used in the POP */
   1886         return s->padconf[(addr - 0x30) >> 2];
   1887 
   1888     case 0x270:	/* CONTROL_DEBOBS */
   1889         return s->obs;
   1890 
   1891     case 0x274:	/* CONTROL_DEVCONF */
   1892         return s->devconfig;
   1893 
   1894     case 0x28c:	/* CONTROL_EMU_SUPPORT */
   1895         return 0;
   1896 
   1897     case 0x290:	/* CONTROL_MSUSPENDMUX_0 */
   1898         return s->msuspendmux[0];
   1899     case 0x294:	/* CONTROL_MSUSPENDMUX_1 */
   1900         return s->msuspendmux[1];
   1901     case 0x298:	/* CONTROL_MSUSPENDMUX_2 */
   1902         return s->msuspendmux[2];
   1903     case 0x29c:	/* CONTROL_MSUSPENDMUX_3 */
   1904         return s->msuspendmux[3];
   1905     case 0x2a0:	/* CONTROL_MSUSPENDMUX_4 */
   1906         return s->msuspendmux[4];
   1907     case 0x2a4:	/* CONTROL_MSUSPENDMUX_5 */
   1908         return 0;
   1909 
   1910     case 0x2b8:	/* CONTROL_PSA_CTRL */
   1911         return s->psaconfig;
   1912     case 0x2bc:	/* CONTROL_PSA_CMD */
   1913     case 0x2c0:	/* CONTROL_PSA_VALUE */
   1914         return 0;
   1915 
   1916     case 0x2b0:	/* CONTROL_SEC_CTRL */
   1917         return 0x800000f1;
   1918     case 0x2d0:	/* CONTROL_SEC_EMU */
   1919         return 0x80000015;
   1920     case 0x2d4:	/* CONTROL_SEC_TAP */
   1921         return 0x8000007f;
   1922     case 0x2b4:	/* CONTROL_SEC_TEST */
   1923     case 0x2f0:	/* CONTROL_SEC_STATUS */
   1924     case 0x2f4:	/* CONTROL_SEC_ERR_STATUS */
   1925         /* Secure mode is not present on general-pusrpose device.  Outside
   1926          * secure mode these values cannot be read or written.  */
   1927         return 0;
   1928 
   1929     case 0x2d8:	/* CONTROL_OCM_RAM_PERM */
   1930         return 0xff;
   1931     case 0x2dc:	/* CONTROL_OCM_PUB_RAM_ADD */
   1932     case 0x2e0:	/* CONTROL_EXT_SEC_RAM_START_ADD */
   1933     case 0x2e4:	/* CONTROL_EXT_SEC_RAM_STOP_ADD */
   1934         /* No secure mode so no Extended Secure RAM present.  */
   1935         return 0;
   1936 
   1937     case 0x2f8:	/* CONTROL_STATUS */
   1938         /* Device Type => General-purpose */
   1939         return 0x0300;
   1940     case 0x2fc:	/* CONTROL_GENERAL_PURPOSE_STATUS */
   1941 
   1942     case 0x300:	/* CONTROL_RPUB_KEY_H_0 */
   1943     case 0x304:	/* CONTROL_RPUB_KEY_H_1 */
   1944     case 0x308:	/* CONTROL_RPUB_KEY_H_2 */
   1945     case 0x30c:	/* CONTROL_RPUB_KEY_H_3 */
   1946         return 0xdecafbad;
   1947 
   1948     case 0x310:	/* CONTROL_RAND_KEY_0 */
   1949     case 0x314:	/* CONTROL_RAND_KEY_1 */
   1950     case 0x318:	/* CONTROL_RAND_KEY_2 */
   1951     case 0x31c:	/* CONTROL_RAND_KEY_3 */
   1952     case 0x320:	/* CONTROL_CUST_KEY_0 */
   1953     case 0x324:	/* CONTROL_CUST_KEY_1 */
   1954     case 0x330:	/* CONTROL_TEST_KEY_0 */
   1955     case 0x334:	/* CONTROL_TEST_KEY_1 */
   1956     case 0x338:	/* CONTROL_TEST_KEY_2 */
   1957     case 0x33c:	/* CONTROL_TEST_KEY_3 */
   1958     case 0x340:	/* CONTROL_TEST_KEY_4 */
   1959     case 0x344:	/* CONTROL_TEST_KEY_5 */
   1960     case 0x348:	/* CONTROL_TEST_KEY_6 */
   1961     case 0x34c:	/* CONTROL_TEST_KEY_7 */
   1962     case 0x350:	/* CONTROL_TEST_KEY_8 */
   1963     case 0x354:	/* CONTROL_TEST_KEY_9 */
   1964         /* Can only be accessed in secure mode and when C_FieldAccEnable
   1965          * bit is set in CONTROL_SEC_CTRL.
   1966          * TODO: otherwise an interconnect access error is generated.  */
   1967         return 0;
   1968     }
   1969 
   1970     OMAP_BAD_REG(addr);
   1971     return 0;
   1972 }
   1973 
   1974 static void omap_sysctl_write8(void *opaque, hwaddr addr,
   1975                 uint32_t value)
   1976 {
   1977     struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
   1978     int pad_offset, byte_offset;
   1979     int prev_value;
   1980 
   1981     switch (addr) {
   1982     case 0x030 ... 0x140:	/* CONTROL_PADCONF - only used in the POP */
   1983         pad_offset = (addr - 0x30) >> 2;
   1984         byte_offset = (addr - 0x30) & (4 - 1);
   1985 
   1986         prev_value = s->padconf[pad_offset];
   1987         prev_value &= ~(0xff << (byte_offset * 8));
   1988         prev_value |= ((value & 0x1f1f1f1f) << (byte_offset * 8)) & 0x1f1f1f1f;
   1989         s->padconf[pad_offset] = prev_value;
   1990         break;
   1991 
   1992     default:
   1993         OMAP_BAD_REG(addr);
   1994         break;
   1995     }
   1996 }
   1997 
   1998 static void omap_sysctl_write(void *opaque, hwaddr addr,
   1999                 uint32_t value)
   2000 {
   2001     struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
   2002 
   2003     switch (addr) {
   2004     case 0x000:	/* CONTROL_REVISION */
   2005     case 0x2a4:	/* CONTROL_MSUSPENDMUX_5 */
   2006     case 0x2c0:	/* CONTROL_PSA_VALUE */
   2007     case 0x2f8:	/* CONTROL_STATUS */
   2008     case 0x2fc:	/* CONTROL_GENERAL_PURPOSE_STATUS */
   2009     case 0x300:	/* CONTROL_RPUB_KEY_H_0 */
   2010     case 0x304:	/* CONTROL_RPUB_KEY_H_1 */
   2011     case 0x308:	/* CONTROL_RPUB_KEY_H_2 */
   2012     case 0x30c:	/* CONTROL_RPUB_KEY_H_3 */
   2013     case 0x310:	/* CONTROL_RAND_KEY_0 */
   2014     case 0x314:	/* CONTROL_RAND_KEY_1 */
   2015     case 0x318:	/* CONTROL_RAND_KEY_2 */
   2016     case 0x31c:	/* CONTROL_RAND_KEY_3 */
   2017     case 0x320:	/* CONTROL_CUST_KEY_0 */
   2018     case 0x324:	/* CONTROL_CUST_KEY_1 */
   2019     case 0x330:	/* CONTROL_TEST_KEY_0 */
   2020     case 0x334:	/* CONTROL_TEST_KEY_1 */
   2021     case 0x338:	/* CONTROL_TEST_KEY_2 */
   2022     case 0x33c:	/* CONTROL_TEST_KEY_3 */
   2023     case 0x340:	/* CONTROL_TEST_KEY_4 */
   2024     case 0x344:	/* CONTROL_TEST_KEY_5 */
   2025     case 0x348:	/* CONTROL_TEST_KEY_6 */
   2026     case 0x34c:	/* CONTROL_TEST_KEY_7 */
   2027     case 0x350:	/* CONTROL_TEST_KEY_8 */
   2028     case 0x354:	/* CONTROL_TEST_KEY_9 */
   2029         OMAP_RO_REG(addr);
   2030         return;
   2031 
   2032     case 0x010:	/* CONTROL_SYSCONFIG */
   2033         s->sysconfig = value & 0x1e;
   2034         break;
   2035 
   2036     case 0x030 ... 0x140:	/* CONTROL_PADCONF - only used in the POP */
   2037         /* XXX: should check constant bits */
   2038         s->padconf[(addr - 0x30) >> 2] = value & 0x1f1f1f1f;
   2039         break;
   2040 
   2041     case 0x270:	/* CONTROL_DEBOBS */
   2042         s->obs = value & 0xff;
   2043         break;
   2044 
   2045     case 0x274:	/* CONTROL_DEVCONF */
   2046         s->devconfig = value & 0xffffc7ff;
   2047         break;
   2048 
   2049     case 0x28c:	/* CONTROL_EMU_SUPPORT */
   2050         break;
   2051 
   2052     case 0x290:	/* CONTROL_MSUSPENDMUX_0 */
   2053         s->msuspendmux[0] = value & 0x3fffffff;
   2054         break;
   2055     case 0x294:	/* CONTROL_MSUSPENDMUX_1 */
   2056         s->msuspendmux[1] = value & 0x3fffffff;
   2057         break;
   2058     case 0x298:	/* CONTROL_MSUSPENDMUX_2 */
   2059         s->msuspendmux[2] = value & 0x3fffffff;
   2060         break;
   2061     case 0x29c:	/* CONTROL_MSUSPENDMUX_3 */
   2062         s->msuspendmux[3] = value & 0x3fffffff;
   2063         break;
   2064     case 0x2a0:	/* CONTROL_MSUSPENDMUX_4 */
   2065         s->msuspendmux[4] = value & 0x3fffffff;
   2066         break;
   2067 
   2068     case 0x2b8:	/* CONTROL_PSA_CTRL */
   2069         s->psaconfig = value & 0x1c;
   2070         s->psaconfig |= (value & 0x20) ? 2 : 1;
   2071         break;
   2072     case 0x2bc:	/* CONTROL_PSA_CMD */
   2073         break;
   2074 
   2075     case 0x2b0:	/* CONTROL_SEC_CTRL */
   2076     case 0x2b4:	/* CONTROL_SEC_TEST */
   2077     case 0x2d0:	/* CONTROL_SEC_EMU */
   2078     case 0x2d4:	/* CONTROL_SEC_TAP */
   2079     case 0x2d8:	/* CONTROL_OCM_RAM_PERM */
   2080     case 0x2dc:	/* CONTROL_OCM_PUB_RAM_ADD */
   2081     case 0x2e0:	/* CONTROL_EXT_SEC_RAM_START_ADD */
   2082     case 0x2e4:	/* CONTROL_EXT_SEC_RAM_STOP_ADD */
   2083     case 0x2f0:	/* CONTROL_SEC_STATUS */
   2084     case 0x2f4:	/* CONTROL_SEC_ERR_STATUS */
   2085         break;
   2086 
   2087     default:
   2088         OMAP_BAD_REG(addr);
   2089         return;
   2090     }
   2091 }
   2092 
   2093 static uint64_t omap_sysctl_readfn(void *opaque, hwaddr addr,
   2094                                    unsigned size)
   2095 {
   2096     switch (size) {
   2097     case 1:
   2098         return omap_sysctl_read8(opaque, addr);
   2099     case 2:
   2100         return omap_badwidth_read32(opaque, addr); /* TODO */
   2101     case 4:
   2102         return omap_sysctl_read(opaque, addr);
   2103     default:
   2104         g_assert_not_reached();
   2105     }
   2106 }
   2107 
   2108 static void omap_sysctl_writefn(void *opaque, hwaddr addr,
   2109                                 uint64_t value, unsigned size)
   2110 {
   2111     switch (size) {
   2112     case 1:
   2113         omap_sysctl_write8(opaque, addr, value);
   2114         break;
   2115     case 2:
   2116         omap_badwidth_write32(opaque, addr, value); /* TODO */
   2117         break;
   2118     case 4:
   2119         omap_sysctl_write(opaque, addr, value);
   2120         break;
   2121     default:
   2122         g_assert_not_reached();
   2123     }
   2124 }
   2125 
   2126 static const MemoryRegionOps omap_sysctl_ops = {
   2127     .read = omap_sysctl_readfn,
   2128     .write = omap_sysctl_writefn,
   2129     .valid.min_access_size = 1,
   2130     .valid.max_access_size = 4,
   2131     .endianness = DEVICE_NATIVE_ENDIAN,
   2132 };
   2133 
   2134 static void omap_sysctl_reset(struct omap_sysctl_s *s)
   2135 {
   2136     /* (power-on reset) */
   2137     s->sysconfig = 0;
   2138     s->obs = 0;
   2139     s->devconfig = 0x0c000000;
   2140     s->msuspendmux[0] = 0x00000000;
   2141     s->msuspendmux[1] = 0x00000000;
   2142     s->msuspendmux[2] = 0x00000000;
   2143     s->msuspendmux[3] = 0x00000000;
   2144     s->msuspendmux[4] = 0x00000000;
   2145     s->psaconfig = 1;
   2146 
   2147     s->padconf[0x00] = 0x000f0f0f;
   2148     s->padconf[0x01] = 0x00000000;
   2149     s->padconf[0x02] = 0x00000000;
   2150     s->padconf[0x03] = 0x00000000;
   2151     s->padconf[0x04] = 0x00000000;
   2152     s->padconf[0x05] = 0x00000000;
   2153     s->padconf[0x06] = 0x00000000;
   2154     s->padconf[0x07] = 0x00000000;
   2155     s->padconf[0x08] = 0x08080800;
   2156     s->padconf[0x09] = 0x08080808;
   2157     s->padconf[0x0a] = 0x08080808;
   2158     s->padconf[0x0b] = 0x08080808;
   2159     s->padconf[0x0c] = 0x08080808;
   2160     s->padconf[0x0d] = 0x08080800;
   2161     s->padconf[0x0e] = 0x08080808;
   2162     s->padconf[0x0f] = 0x08080808;
   2163     s->padconf[0x10] = 0x18181808;	/* | 0x07070700 if SBoot3 */
   2164     s->padconf[0x11] = 0x18181818;	/* | 0x07070707 if SBoot3 */
   2165     s->padconf[0x12] = 0x18181818;	/* | 0x07070707 if SBoot3 */
   2166     s->padconf[0x13] = 0x18181818;	/* | 0x07070707 if SBoot3 */
   2167     s->padconf[0x14] = 0x18181818;	/* | 0x00070707 if SBoot3 */
   2168     s->padconf[0x15] = 0x18181818;
   2169     s->padconf[0x16] = 0x18181818;	/* | 0x07000000 if SBoot3 */
   2170     s->padconf[0x17] = 0x1f001f00;
   2171     s->padconf[0x18] = 0x1f1f1f1f;
   2172     s->padconf[0x19] = 0x00000000;
   2173     s->padconf[0x1a] = 0x1f180000;
   2174     s->padconf[0x1b] = 0x00001f1f;
   2175     s->padconf[0x1c] = 0x1f001f00;
   2176     s->padconf[0x1d] = 0x00000000;
   2177     s->padconf[0x1e] = 0x00000000;
   2178     s->padconf[0x1f] = 0x08000000;
   2179     s->padconf[0x20] = 0x08080808;
   2180     s->padconf[0x21] = 0x08080808;
   2181     s->padconf[0x22] = 0x0f080808;
   2182     s->padconf[0x23] = 0x0f0f0f0f;
   2183     s->padconf[0x24] = 0x000f0f0f;
   2184     s->padconf[0x25] = 0x1f1f1f0f;
   2185     s->padconf[0x26] = 0x080f0f1f;
   2186     s->padconf[0x27] = 0x070f1808;
   2187     s->padconf[0x28] = 0x0f070707;
   2188     s->padconf[0x29] = 0x000f0f1f;
   2189     s->padconf[0x2a] = 0x0f0f0f1f;
   2190     s->padconf[0x2b] = 0x08000000;
   2191     s->padconf[0x2c] = 0x0000001f;
   2192     s->padconf[0x2d] = 0x0f0f1f00;
   2193     s->padconf[0x2e] = 0x1f1f0f0f;
   2194     s->padconf[0x2f] = 0x0f1f1f1f;
   2195     s->padconf[0x30] = 0x0f0f0f0f;
   2196     s->padconf[0x31] = 0x0f1f0f1f;
   2197     s->padconf[0x32] = 0x0f0f0f0f;
   2198     s->padconf[0x33] = 0x0f1f0f1f;
   2199     s->padconf[0x34] = 0x1f1f0f0f;
   2200     s->padconf[0x35] = 0x0f0f1f1f;
   2201     s->padconf[0x36] = 0x0f0f1f0f;
   2202     s->padconf[0x37] = 0x0f0f0f0f;
   2203     s->padconf[0x38] = 0x1f18180f;
   2204     s->padconf[0x39] = 0x1f1f1f1f;
   2205     s->padconf[0x3a] = 0x00001f1f;
   2206     s->padconf[0x3b] = 0x00000000;
   2207     s->padconf[0x3c] = 0x00000000;
   2208     s->padconf[0x3d] = 0x0f0f0f0f;
   2209     s->padconf[0x3e] = 0x18000f0f;
   2210     s->padconf[0x3f] = 0x00070000;
   2211     s->padconf[0x40] = 0x00000707;
   2212     s->padconf[0x41] = 0x0f1f0700;
   2213     s->padconf[0x42] = 0x1f1f070f;
   2214     s->padconf[0x43] = 0x0008081f;
   2215     s->padconf[0x44] = 0x00000800;
   2216 }
   2217 
   2218 static struct omap_sysctl_s *omap_sysctl_init(struct omap_target_agent_s *ta,
   2219                 omap_clk iclk, struct omap_mpu_state_s *mpu)
   2220 {
   2221     struct omap_sysctl_s *s = g_new0(struct omap_sysctl_s, 1);
   2222 
   2223     s->mpu = mpu;
   2224     omap_sysctl_reset(s);
   2225 
   2226     memory_region_init_io(&s->iomem, NULL, &omap_sysctl_ops, s, "omap.sysctl",
   2227                           omap_l4_region_size(ta, 0));
   2228     omap_l4_attach(ta, 0, &s->iomem);
   2229 
   2230     return s;
   2231 }
   2232 
   2233 /* General chip reset */
   2234 static void omap2_mpu_reset(void *opaque)
   2235 {
   2236     struct omap_mpu_state_s *mpu = (struct omap_mpu_state_s *) opaque;
   2237 
   2238     omap_dma_reset(mpu->dma);
   2239     omap_prcm_reset(mpu->prcm);
   2240     omap_sysctl_reset(mpu->sysc);
   2241     omap_gp_timer_reset(mpu->gptimer[0]);
   2242     omap_gp_timer_reset(mpu->gptimer[1]);
   2243     omap_gp_timer_reset(mpu->gptimer[2]);
   2244     omap_gp_timer_reset(mpu->gptimer[3]);
   2245     omap_gp_timer_reset(mpu->gptimer[4]);
   2246     omap_gp_timer_reset(mpu->gptimer[5]);
   2247     omap_gp_timer_reset(mpu->gptimer[6]);
   2248     omap_gp_timer_reset(mpu->gptimer[7]);
   2249     omap_gp_timer_reset(mpu->gptimer[8]);
   2250     omap_gp_timer_reset(mpu->gptimer[9]);
   2251     omap_gp_timer_reset(mpu->gptimer[10]);
   2252     omap_gp_timer_reset(mpu->gptimer[11]);
   2253     omap_synctimer_reset(mpu->synctimer);
   2254     omap_sdrc_reset(mpu->sdrc);
   2255     omap_gpmc_reset(mpu->gpmc);
   2256     omap_dss_reset(mpu->dss);
   2257     omap_uart_reset(mpu->uart[0]);
   2258     omap_uart_reset(mpu->uart[1]);
   2259     omap_uart_reset(mpu->uart[2]);
   2260     omap_mmc_reset(mpu->mmc);
   2261     omap_mcspi_reset(mpu->mcspi[0]);
   2262     omap_mcspi_reset(mpu->mcspi[1]);
   2263     cpu_reset(CPU(mpu->cpu));
   2264 }
   2265 
   2266 static int omap2_validate_addr(struct omap_mpu_state_s *s,
   2267                 hwaddr addr)
   2268 {
   2269     return 1;
   2270 }
   2271 
   2272 static const struct dma_irq_map omap2_dma_irq_map[] = {
   2273     { 0, OMAP_INT_24XX_SDMA_IRQ0 },
   2274     { 0, OMAP_INT_24XX_SDMA_IRQ1 },
   2275     { 0, OMAP_INT_24XX_SDMA_IRQ2 },
   2276     { 0, OMAP_INT_24XX_SDMA_IRQ3 },
   2277 };
   2278 
   2279 struct omap_mpu_state_s *omap2420_mpu_init(MemoryRegion *sdram,
   2280                 const char *cpu_type)
   2281 {
   2282     struct omap_mpu_state_s *s = g_new0(struct omap_mpu_state_s, 1);
   2283     qemu_irq dma_irqs[4];
   2284     DriveInfo *dinfo;
   2285     int i;
   2286     SysBusDevice *busdev;
   2287     struct omap_target_agent_s *ta;
   2288     MemoryRegion *sysmem = get_system_memory();
   2289 
   2290     /* Core */
   2291     s->mpu_model = omap2420;
   2292     s->cpu = ARM_CPU(cpu_create(cpu_type));
   2293     s->sram_size = OMAP242X_SRAM_SIZE;
   2294 
   2295     s->wakeup = qemu_allocate_irq(omap_mpu_wakeup, s, 0);
   2296 
   2297     /* Clocks */
   2298     omap_clk_init(s);
   2299 
   2300     /* Memory-mapped stuff */
   2301     memory_region_init_ram(&s->sram, NULL, "omap2.sram", s->sram_size,
   2302                            &error_fatal);
   2303     memory_region_add_subregion(sysmem, OMAP2_SRAM_BASE, &s->sram);
   2304 
   2305     s->l4 = omap_l4_init(sysmem, OMAP2_L4_BASE, 54);
   2306 
   2307     /* Actually mapped at any 2K boundary in the ARM11 private-peripheral if */
   2308     s->ih[0] = qdev_new("omap2-intc");
   2309     qdev_prop_set_uint8(s->ih[0], "revision", 0x21);
   2310     omap_intc_set_fclk(OMAP_INTC(s->ih[0]), omap_findclk(s, "mpu_intc_fclk"));
   2311     omap_intc_set_iclk(OMAP_INTC(s->ih[0]), omap_findclk(s, "mpu_intc_iclk"));
   2312     busdev = SYS_BUS_DEVICE(s->ih[0]);
   2313     sysbus_realize_and_unref(busdev, &error_fatal);
   2314     sysbus_connect_irq(busdev, 0,
   2315                        qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ));
   2316     sysbus_connect_irq(busdev, 1,
   2317                        qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_FIQ));
   2318     sysbus_mmio_map(busdev, 0, 0x480fe000);
   2319     s->prcm = omap_prcm_init(omap_l4tao(s->l4, 3),
   2320                              qdev_get_gpio_in(s->ih[0],
   2321                                               OMAP_INT_24XX_PRCM_MPU_IRQ),
   2322                              NULL, NULL, s);
   2323 
   2324     s->sysc = omap_sysctl_init(omap_l4tao(s->l4, 1),
   2325                     omap_findclk(s, "omapctrl_iclk"), s);
   2326 
   2327     for (i = 0; i < 4; i++) {
   2328         dma_irqs[i] = qdev_get_gpio_in(s->ih[omap2_dma_irq_map[i].ih],
   2329                                        omap2_dma_irq_map[i].intr);
   2330     }
   2331     s->dma = omap_dma4_init(0x48056000, dma_irqs, sysmem, s, 256, 32,
   2332                     omap_findclk(s, "sdma_iclk"),
   2333                     omap_findclk(s, "sdma_fclk"));
   2334     s->port->addr_valid = omap2_validate_addr;
   2335 
   2336     /* Register SDRAM and SRAM ports for fast DMA transfers.  */
   2337     soc_dma_port_add_mem(s->dma, memory_region_get_ram_ptr(sdram),
   2338                          OMAP2_Q2_BASE, memory_region_size(sdram));
   2339     soc_dma_port_add_mem(s->dma, memory_region_get_ram_ptr(&s->sram),
   2340                          OMAP2_SRAM_BASE, s->sram_size);
   2341 
   2342     s->uart[0] = omap2_uart_init(sysmem, omap_l4ta(s->l4, 19),
   2343                                  qdev_get_gpio_in(s->ih[0],
   2344                                                   OMAP_INT_24XX_UART1_IRQ),
   2345                     omap_findclk(s, "uart1_fclk"),
   2346                     omap_findclk(s, "uart1_iclk"),
   2347                     s->drq[OMAP24XX_DMA_UART1_TX],
   2348                     s->drq[OMAP24XX_DMA_UART1_RX],
   2349                     "uart1",
   2350                     serial_hd(0));
   2351     s->uart[1] = omap2_uart_init(sysmem, omap_l4ta(s->l4, 20),
   2352                                  qdev_get_gpio_in(s->ih[0],
   2353                                                   OMAP_INT_24XX_UART2_IRQ),
   2354                     omap_findclk(s, "uart2_fclk"),
   2355                     omap_findclk(s, "uart2_iclk"),
   2356                     s->drq[OMAP24XX_DMA_UART2_TX],
   2357                     s->drq[OMAP24XX_DMA_UART2_RX],
   2358                     "uart2",
   2359                     serial_hd(0) ? serial_hd(1) : NULL);
   2360     s->uart[2] = omap2_uart_init(sysmem, omap_l4ta(s->l4, 21),
   2361                                  qdev_get_gpio_in(s->ih[0],
   2362                                                   OMAP_INT_24XX_UART3_IRQ),
   2363                     omap_findclk(s, "uart3_fclk"),
   2364                     omap_findclk(s, "uart3_iclk"),
   2365                     s->drq[OMAP24XX_DMA_UART3_TX],
   2366                     s->drq[OMAP24XX_DMA_UART3_RX],
   2367                     "uart3",
   2368                     serial_hd(0) && serial_hd(1) ? serial_hd(2) : NULL);
   2369 
   2370     s->gptimer[0] = omap_gp_timer_init(omap_l4ta(s->l4, 7),
   2371                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER1),
   2372                     omap_findclk(s, "wu_gpt1_clk"),
   2373                     omap_findclk(s, "wu_l4_iclk"));
   2374     s->gptimer[1] = omap_gp_timer_init(omap_l4ta(s->l4, 8),
   2375                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER2),
   2376                     omap_findclk(s, "core_gpt2_clk"),
   2377                     omap_findclk(s, "core_l4_iclk"));
   2378     s->gptimer[2] = omap_gp_timer_init(omap_l4ta(s->l4, 22),
   2379                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER3),
   2380                     omap_findclk(s, "core_gpt3_clk"),
   2381                     omap_findclk(s, "core_l4_iclk"));
   2382     s->gptimer[3] = omap_gp_timer_init(omap_l4ta(s->l4, 23),
   2383                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER4),
   2384                     omap_findclk(s, "core_gpt4_clk"),
   2385                     omap_findclk(s, "core_l4_iclk"));
   2386     s->gptimer[4] = omap_gp_timer_init(omap_l4ta(s->l4, 24),
   2387                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER5),
   2388                     omap_findclk(s, "core_gpt5_clk"),
   2389                     omap_findclk(s, "core_l4_iclk"));
   2390     s->gptimer[5] = omap_gp_timer_init(omap_l4ta(s->l4, 25),
   2391                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER6),
   2392                     omap_findclk(s, "core_gpt6_clk"),
   2393                     omap_findclk(s, "core_l4_iclk"));
   2394     s->gptimer[6] = omap_gp_timer_init(omap_l4ta(s->l4, 26),
   2395                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER7),
   2396                     omap_findclk(s, "core_gpt7_clk"),
   2397                     omap_findclk(s, "core_l4_iclk"));
   2398     s->gptimer[7] = omap_gp_timer_init(omap_l4ta(s->l4, 27),
   2399                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER8),
   2400                     omap_findclk(s, "core_gpt8_clk"),
   2401                     omap_findclk(s, "core_l4_iclk"));
   2402     s->gptimer[8] = omap_gp_timer_init(omap_l4ta(s->l4, 28),
   2403                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER9),
   2404                     omap_findclk(s, "core_gpt9_clk"),
   2405                     omap_findclk(s, "core_l4_iclk"));
   2406     s->gptimer[9] = omap_gp_timer_init(omap_l4ta(s->l4, 29),
   2407                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER10),
   2408                     omap_findclk(s, "core_gpt10_clk"),
   2409                     omap_findclk(s, "core_l4_iclk"));
   2410     s->gptimer[10] = omap_gp_timer_init(omap_l4ta(s->l4, 30),
   2411                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER11),
   2412                     omap_findclk(s, "core_gpt11_clk"),
   2413                     omap_findclk(s, "core_l4_iclk"));
   2414     s->gptimer[11] = omap_gp_timer_init(omap_l4ta(s->l4, 31),
   2415                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPTIMER12),
   2416                     omap_findclk(s, "core_gpt12_clk"),
   2417                     omap_findclk(s, "core_l4_iclk"));
   2418 
   2419     omap_tap_init(omap_l4ta(s->l4, 2), s);
   2420 
   2421     s->synctimer = omap_synctimer_init(omap_l4tao(s->l4, 2), s,
   2422                     omap_findclk(s, "clk32-kHz"),
   2423                     omap_findclk(s, "core_l4_iclk"));
   2424 
   2425     s->i2c[0] = qdev_new("omap_i2c");
   2426     qdev_prop_set_uint8(s->i2c[0], "revision", 0x34);
   2427     omap_i2c_set_iclk(OMAP_I2C(s->i2c[0]), omap_findclk(s, "i2c1.iclk"));
   2428     omap_i2c_set_fclk(OMAP_I2C(s->i2c[0]), omap_findclk(s, "i2c1.fclk"));
   2429     busdev = SYS_BUS_DEVICE(s->i2c[0]);
   2430     sysbus_realize_and_unref(busdev, &error_fatal);
   2431     sysbus_connect_irq(busdev, 0,
   2432                        qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_I2C1_IRQ));
   2433     sysbus_connect_irq(busdev, 1, s->drq[OMAP24XX_DMA_I2C1_TX]);
   2434     sysbus_connect_irq(busdev, 2, s->drq[OMAP24XX_DMA_I2C1_RX]);
   2435     sysbus_mmio_map(busdev, 0, omap_l4_region_base(omap_l4tao(s->l4, 5), 0));
   2436 
   2437     s->i2c[1] = qdev_new("omap_i2c");
   2438     qdev_prop_set_uint8(s->i2c[1], "revision", 0x34);
   2439     omap_i2c_set_iclk(OMAP_I2C(s->i2c[1]), omap_findclk(s, "i2c2.iclk"));
   2440     omap_i2c_set_fclk(OMAP_I2C(s->i2c[1]), omap_findclk(s, "i2c2.fclk"));
   2441     busdev = SYS_BUS_DEVICE(s->i2c[1]);
   2442     sysbus_realize_and_unref(busdev, &error_fatal);
   2443     sysbus_connect_irq(busdev, 0,
   2444                        qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_I2C2_IRQ));
   2445     sysbus_connect_irq(busdev, 1, s->drq[OMAP24XX_DMA_I2C2_TX]);
   2446     sysbus_connect_irq(busdev, 2, s->drq[OMAP24XX_DMA_I2C2_RX]);
   2447     sysbus_mmio_map(busdev, 0, omap_l4_region_base(omap_l4tao(s->l4, 6), 0));
   2448 
   2449     s->gpio = qdev_new("omap2-gpio");
   2450     qdev_prop_set_int32(s->gpio, "mpu_model", s->mpu_model);
   2451     omap2_gpio_set_iclk(OMAP2_GPIO(s->gpio), omap_findclk(s, "gpio_iclk"));
   2452     omap2_gpio_set_fclk(OMAP2_GPIO(s->gpio), 0, omap_findclk(s, "gpio1_dbclk"));
   2453     omap2_gpio_set_fclk(OMAP2_GPIO(s->gpio), 1, omap_findclk(s, "gpio2_dbclk"));
   2454     omap2_gpio_set_fclk(OMAP2_GPIO(s->gpio), 2, omap_findclk(s, "gpio3_dbclk"));
   2455     omap2_gpio_set_fclk(OMAP2_GPIO(s->gpio), 3, omap_findclk(s, "gpio4_dbclk"));
   2456     if (s->mpu_model == omap2430) {
   2457         omap2_gpio_set_fclk(OMAP2_GPIO(s->gpio), 4,
   2458                             omap_findclk(s, "gpio5_dbclk"));
   2459     }
   2460     busdev = SYS_BUS_DEVICE(s->gpio);
   2461     sysbus_realize_and_unref(busdev, &error_fatal);
   2462     sysbus_connect_irq(busdev, 0,
   2463                        qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPIO_BANK1));
   2464     sysbus_connect_irq(busdev, 3,
   2465                        qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPIO_BANK2));
   2466     sysbus_connect_irq(busdev, 6,
   2467                        qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPIO_BANK3));
   2468     sysbus_connect_irq(busdev, 9,
   2469                        qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPIO_BANK4));
   2470     if (s->mpu_model == omap2430) {
   2471         sysbus_connect_irq(busdev, 12,
   2472                            qdev_get_gpio_in(s->ih[0],
   2473                                             OMAP_INT_243X_GPIO_BANK5));
   2474     }
   2475     ta = omap_l4ta(s->l4, 3);
   2476     sysbus_mmio_map(busdev, 0, omap_l4_region_base(ta, 1));
   2477     sysbus_mmio_map(busdev, 1, omap_l4_region_base(ta, 0));
   2478     sysbus_mmio_map(busdev, 2, omap_l4_region_base(ta, 2));
   2479     sysbus_mmio_map(busdev, 3, omap_l4_region_base(ta, 4));
   2480     sysbus_mmio_map(busdev, 4, omap_l4_region_base(ta, 5));
   2481 
   2482     s->sdrc = omap_sdrc_init(sysmem, 0x68009000);
   2483     s->gpmc = omap_gpmc_init(s, 0x6800a000,
   2484                              qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_GPMC_IRQ),
   2485                              s->drq[OMAP24XX_DMA_GPMC]);
   2486 
   2487     dinfo = drive_get(IF_SD, 0, 0);
   2488     if (!dinfo && !qtest_enabled()) {
   2489         warn_report("missing SecureDigital device");
   2490     }
   2491     s->mmc = omap2_mmc_init(omap_l4tao(s->l4, 9),
   2492                     dinfo ? blk_by_legacy_dinfo(dinfo) : NULL,
   2493                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_MMC_IRQ),
   2494                     &s->drq[OMAP24XX_DMA_MMC1_TX],
   2495                     omap_findclk(s, "mmc_fclk"), omap_findclk(s, "mmc_iclk"));
   2496 
   2497     s->mcspi[0] = omap_mcspi_init(omap_l4ta(s->l4, 35), 4,
   2498                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_MCSPI1_IRQ),
   2499                     &s->drq[OMAP24XX_DMA_SPI1_TX0],
   2500                     omap_findclk(s, "spi1_fclk"),
   2501                     omap_findclk(s, "spi1_iclk"));
   2502     s->mcspi[1] = omap_mcspi_init(omap_l4ta(s->l4, 36), 2,
   2503                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_MCSPI2_IRQ),
   2504                     &s->drq[OMAP24XX_DMA_SPI2_TX0],
   2505                     omap_findclk(s, "spi2_fclk"),
   2506                     omap_findclk(s, "spi2_iclk"));
   2507 
   2508     s->dss = omap_dss_init(omap_l4ta(s->l4, 10), sysmem, 0x68000800,
   2509                     /* XXX wire M_IRQ_25, D_L2_IRQ_30 and I_IRQ_13 together */
   2510                     qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_DSS_IRQ),
   2511                            s->drq[OMAP24XX_DMA_DSS],
   2512                     omap_findclk(s, "dss_clk1"), omap_findclk(s, "dss_clk2"),
   2513                     omap_findclk(s, "dss_54m_clk"),
   2514                     omap_findclk(s, "dss_l3_iclk"),
   2515                     omap_findclk(s, "dss_l4_iclk"));
   2516 
   2517     omap_sti_init(omap_l4ta(s->l4, 18), sysmem, 0x54000000,
   2518                   qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_STI),
   2519                   omap_findclk(s, "emul_ck"),
   2520                     serial_hd(0) && serial_hd(1) && serial_hd(2) ?
   2521                     serial_hd(3) : NULL);
   2522 
   2523     s->eac = omap_eac_init(omap_l4ta(s->l4, 32),
   2524                            qdev_get_gpio_in(s->ih[0], OMAP_INT_24XX_EAC_IRQ),
   2525                     /* Ten consecutive lines */
   2526                     &s->drq[OMAP24XX_DMA_EAC_AC_RD],
   2527                     omap_findclk(s, "func_96m_clk"),
   2528                     omap_findclk(s, "core_l4_iclk"));
   2529 
   2530     /* All register mappings (includin those not currenlty implemented):
   2531      * SystemControlMod	48000000 - 48000fff
   2532      * SystemControlL4	48001000 - 48001fff
   2533      * 32kHz Timer Mod	48004000 - 48004fff
   2534      * 32kHz Timer L4	48005000 - 48005fff
   2535      * PRCM ModA	48008000 - 480087ff
   2536      * PRCM ModB	48008800 - 48008fff
   2537      * PRCM L4		48009000 - 48009fff
   2538      * TEST-BCM Mod	48012000 - 48012fff
   2539      * TEST-BCM L4	48013000 - 48013fff
   2540      * TEST-TAP Mod	48014000 - 48014fff
   2541      * TEST-TAP L4	48015000 - 48015fff
   2542      * GPIO1 Mod	48018000 - 48018fff
   2543      * GPIO Top		48019000 - 48019fff
   2544      * GPIO2 Mod	4801a000 - 4801afff
   2545      * GPIO L4		4801b000 - 4801bfff
   2546      * GPIO3 Mod	4801c000 - 4801cfff
   2547      * GPIO4 Mod	4801e000 - 4801efff
   2548      * WDTIMER1 Mod	48020000 - 48010fff
   2549      * WDTIMER Top	48021000 - 48011fff
   2550      * WDTIMER2 Mod	48022000 - 48012fff
   2551      * WDTIMER L4	48023000 - 48013fff
   2552      * WDTIMER3 Mod	48024000 - 48014fff
   2553      * WDTIMER3 L4	48025000 - 48015fff
   2554      * WDTIMER4 Mod	48026000 - 48016fff
   2555      * WDTIMER4 L4	48027000 - 48017fff
   2556      * GPTIMER1 Mod	48028000 - 48018fff
   2557      * GPTIMER1 L4	48029000 - 48019fff
   2558      * GPTIMER2 Mod	4802a000 - 4801afff
   2559      * GPTIMER2 L4	4802b000 - 4801bfff
   2560      * L4-Config AP	48040000 - 480407ff
   2561      * L4-Config IP	48040800 - 48040fff
   2562      * L4-Config LA	48041000 - 48041fff
   2563      * ARM11ETB Mod	48048000 - 48049fff
   2564      * ARM11ETB L4	4804a000 - 4804afff
   2565      * DISPLAY Top	48050000 - 480503ff
   2566      * DISPLAY DISPC	48050400 - 480507ff
   2567      * DISPLAY RFBI	48050800 - 48050bff
   2568      * DISPLAY VENC	48050c00 - 48050fff
   2569      * DISPLAY L4	48051000 - 48051fff
   2570      * CAMERA Top	48052000 - 480523ff
   2571      * CAMERA core	48052400 - 480527ff
   2572      * CAMERA DMA	48052800 - 48052bff
   2573      * CAMERA MMU	48052c00 - 48052fff
   2574      * CAMERA L4	48053000 - 48053fff
   2575      * SDMA Mod		48056000 - 48056fff
   2576      * SDMA L4		48057000 - 48057fff
   2577      * SSI Top		48058000 - 48058fff
   2578      * SSI GDD		48059000 - 48059fff
   2579      * SSI Port1	4805a000 - 4805afff
   2580      * SSI Port2	4805b000 - 4805bfff
   2581      * SSI L4		4805c000 - 4805cfff
   2582      * USB Mod		4805e000 - 480fefff
   2583      * USB L4		4805f000 - 480fffff
   2584      * WIN_TRACER1 Mod	48060000 - 48060fff
   2585      * WIN_TRACER1 L4	48061000 - 48061fff
   2586      * WIN_TRACER2 Mod	48062000 - 48062fff
   2587      * WIN_TRACER2 L4	48063000 - 48063fff
   2588      * WIN_TRACER3 Mod	48064000 - 48064fff
   2589      * WIN_TRACER3 L4	48065000 - 48065fff
   2590      * WIN_TRACER4 Top	48066000 - 480660ff
   2591      * WIN_TRACER4 ETT	48066100 - 480661ff
   2592      * WIN_TRACER4 WT	48066200 - 480662ff
   2593      * WIN_TRACER4 L4	48067000 - 48067fff
   2594      * XTI Mod		48068000 - 48068fff
   2595      * XTI L4		48069000 - 48069fff
   2596      * UART1 Mod	4806a000 - 4806afff
   2597      * UART1 L4		4806b000 - 4806bfff
   2598      * UART2 Mod	4806c000 - 4806cfff
   2599      * UART2 L4		4806d000 - 4806dfff
   2600      * UART3 Mod	4806e000 - 4806efff
   2601      * UART3 L4		4806f000 - 4806ffff
   2602      * I2C1 Mod		48070000 - 48070fff
   2603      * I2C1 L4		48071000 - 48071fff
   2604      * I2C2 Mod		48072000 - 48072fff
   2605      * I2C2 L4		48073000 - 48073fff
   2606      * McBSP1 Mod	48074000 - 48074fff
   2607      * McBSP1 L4	48075000 - 48075fff
   2608      * McBSP2 Mod	48076000 - 48076fff
   2609      * McBSP2 L4	48077000 - 48077fff
   2610      * GPTIMER3 Mod	48078000 - 48078fff
   2611      * GPTIMER3 L4	48079000 - 48079fff
   2612      * GPTIMER4 Mod	4807a000 - 4807afff
   2613      * GPTIMER4 L4	4807b000 - 4807bfff
   2614      * GPTIMER5 Mod	4807c000 - 4807cfff
   2615      * GPTIMER5 L4	4807d000 - 4807dfff
   2616      * GPTIMER6 Mod	4807e000 - 4807efff
   2617      * GPTIMER6 L4	4807f000 - 4807ffff
   2618      * GPTIMER7 Mod	48080000 - 48080fff
   2619      * GPTIMER7 L4	48081000 - 48081fff
   2620      * GPTIMER8 Mod	48082000 - 48082fff
   2621      * GPTIMER8 L4	48083000 - 48083fff
   2622      * GPTIMER9 Mod	48084000 - 48084fff
   2623      * GPTIMER9 L4	48085000 - 48085fff
   2624      * GPTIMER10 Mod	48086000 - 48086fff
   2625      * GPTIMER10 L4	48087000 - 48087fff
   2626      * GPTIMER11 Mod	48088000 - 48088fff
   2627      * GPTIMER11 L4	48089000 - 48089fff
   2628      * GPTIMER12 Mod	4808a000 - 4808afff
   2629      * GPTIMER12 L4	4808b000 - 4808bfff
   2630      * EAC Mod		48090000 - 48090fff
   2631      * EAC L4		48091000 - 48091fff
   2632      * FAC Mod		48092000 - 48092fff
   2633      * FAC L4		48093000 - 48093fff
   2634      * MAILBOX Mod	48094000 - 48094fff
   2635      * MAILBOX L4	48095000 - 48095fff
   2636      * SPI1 Mod		48098000 - 48098fff
   2637      * SPI1 L4		48099000 - 48099fff
   2638      * SPI2 Mod		4809a000 - 4809afff
   2639      * SPI2 L4		4809b000 - 4809bfff
   2640      * MMC/SDIO Mod	4809c000 - 4809cfff
   2641      * MMC/SDIO L4	4809d000 - 4809dfff
   2642      * MS_PRO Mod	4809e000 - 4809efff
   2643      * MS_PRO L4	4809f000 - 4809ffff
   2644      * RNG Mod		480a0000 - 480a0fff
   2645      * RNG L4		480a1000 - 480a1fff
   2646      * DES3DES Mod	480a2000 - 480a2fff
   2647      * DES3DES L4	480a3000 - 480a3fff
   2648      * SHA1MD5 Mod	480a4000 - 480a4fff
   2649      * SHA1MD5 L4	480a5000 - 480a5fff
   2650      * AES Mod		480a6000 - 480a6fff
   2651      * AES L4		480a7000 - 480a7fff
   2652      * PKA Mod		480a8000 - 480a9fff
   2653      * PKA L4		480aa000 - 480aafff
   2654      * MG Mod		480b0000 - 480b0fff
   2655      * MG L4		480b1000 - 480b1fff
   2656      * HDQ/1-wire Mod	480b2000 - 480b2fff
   2657      * HDQ/1-wire L4	480b3000 - 480b3fff
   2658      * MPU interrupt	480fe000 - 480fefff
   2659      * STI channel base	54000000 - 5400ffff
   2660      * IVA RAM		5c000000 - 5c01ffff
   2661      * IVA ROM		5c020000 - 5c027fff
   2662      * IMG_BUF_A	5c040000 - 5c040fff
   2663      * IMG_BUF_B	5c042000 - 5c042fff
   2664      * VLCDS		5c048000 - 5c0487ff
   2665      * IMX_COEF		5c049000 - 5c04afff
   2666      * IMX_CMD		5c051000 - 5c051fff
   2667      * VLCDQ		5c053000 - 5c0533ff
   2668      * VLCDH		5c054000 - 5c054fff
   2669      * SEQ_CMD		5c055000 - 5c055fff
   2670      * IMX_REG		5c056000 - 5c0560ff
   2671      * VLCD_REG		5c056100 - 5c0561ff
   2672      * SEQ_REG		5c056200 - 5c0562ff
   2673      * IMG_BUF_REG	5c056300 - 5c0563ff
   2674      * SEQIRQ_REG	5c056400 - 5c0564ff
   2675      * OCP_REG		5c060000 - 5c060fff
   2676      * SYSC_REG		5c070000 - 5c070fff
   2677      * MMU_REG		5d000000 - 5d000fff
   2678      * sDMA R		68000400 - 680005ff
   2679      * sDMA W		68000600 - 680007ff
   2680      * Display Control	68000800 - 680009ff
   2681      * DSP subsystem	68000a00 - 68000bff
   2682      * MPU subsystem	68000c00 - 68000dff
   2683      * IVA subsystem	68001000 - 680011ff
   2684      * USB		68001200 - 680013ff
   2685      * Camera		68001400 - 680015ff
   2686      * VLYNQ (firewall)	68001800 - 68001bff
   2687      * VLYNQ		68001e00 - 68001fff
   2688      * SSI		68002000 - 680021ff
   2689      * L4		68002400 - 680025ff
   2690      * DSP (firewall)	68002800 - 68002bff
   2691      * DSP subsystem	68002e00 - 68002fff
   2692      * IVA (firewall)	68003000 - 680033ff
   2693      * IVA		68003600 - 680037ff
   2694      * GFX		68003a00 - 68003bff
   2695      * CMDWR emulation	68003c00 - 68003dff
   2696      * SMS		68004000 - 680041ff
   2697      * OCM		68004200 - 680043ff
   2698      * GPMC		68004400 - 680045ff
   2699      * RAM (firewall)	68005000 - 680053ff
   2700      * RAM (err login)	68005400 - 680057ff
   2701      * ROM (firewall)	68005800 - 68005bff
   2702      * ROM (err login)	68005c00 - 68005fff
   2703      * GPMC (firewall)	68006000 - 680063ff
   2704      * GPMC (err login)	68006400 - 680067ff
   2705      * SMS (err login)	68006c00 - 68006fff
   2706      * SMS registers	68008000 - 68008fff
   2707      * SDRC registers	68009000 - 68009fff
   2708      * GPMC registers	6800a000   6800afff
   2709      */
   2710 
   2711     qemu_register_reset(omap2_mpu_reset, s);
   2712 
   2713     return s;
   2714 }