qemu/hw/ssi/omap_spi.c
<<
>>
Prefs
   1/*
   2 * TI OMAP processor's Multichannel SPI emulation.
   3 *
   4 * Copyright (C) 2007-2009 Nokia Corporation
   5 *
   6 * Original code for OMAP2 by Andrzej Zaborowski <andrew@openedhand.com>
   7 *
   8 * This program is free software; you can redistribute it and/or
   9 * modify it under the terms of the GNU General Public License as
  10 * published by the Free Software Foundation; either version 2 or
  11 * (at your option) any later version of the License.
  12 *
  13 * This program is distributed in the hope that it will be useful,
  14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 * GNU General Public License for more details.
  17 *
  18 * You should have received a copy of the GNU General Public License along
  19 * with this program; if not, write to the Free Software Foundation, Inc.,
  20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  21 */
  22#include "hw/hw.h"
  23#include "hw/arm/omap.h"
  24
  25/* Multichannel SPI */
  26struct omap_mcspi_s {
  27    MemoryRegion iomem;
  28    qemu_irq irq;
  29    int chnum;
  30
  31    uint32_t sysconfig;
  32    uint32_t systest;
  33    uint32_t irqst;
  34    uint32_t irqen;
  35    uint32_t wken;
  36    uint32_t control;
  37
  38    struct omap_mcspi_ch_s {
  39        qemu_irq txdrq;
  40        qemu_irq rxdrq;
  41        uint32_t (*txrx)(void *opaque, uint32_t, int);
  42        void *opaque;
  43
  44        uint32_t tx;
  45        uint32_t rx;
  46
  47        uint32_t config;
  48        uint32_t status;
  49        uint32_t control;
  50    } ch[4];
  51};
  52
  53static inline void omap_mcspi_interrupt_update(struct omap_mcspi_s *s)
  54{
  55    qemu_set_irq(s->irq, s->irqst & s->irqen);
  56}
  57
  58static inline void omap_mcspi_dmarequest_update(struct omap_mcspi_ch_s *ch)
  59{
  60    qemu_set_irq(ch->txdrq,
  61                    (ch->control & 1) &&                /* EN */
  62                    (ch->config & (1 << 14)) &&         /* DMAW */
  63                    (ch->status & (1 << 1)) &&          /* TXS */
  64                    ((ch->config >> 12) & 3) != 1);     /* TRM */
  65    qemu_set_irq(ch->rxdrq,
  66                    (ch->control & 1) &&                /* EN */
  67                    (ch->config & (1 << 15)) &&         /* DMAW */
  68                    (ch->status & (1 << 0)) &&          /* RXS */
  69                    ((ch->config >> 12) & 3) != 2);     /* TRM */
  70}
  71
  72static void omap_mcspi_transfer_run(struct omap_mcspi_s *s, int chnum)
  73{
  74    struct omap_mcspi_ch_s *ch = s->ch + chnum;
  75
  76    if (!(ch->control & 1))                             /* EN */
  77        return;
  78    if ((ch->status & (1 << 0)) &&                      /* RXS */
  79                    ((ch->config >> 12) & 3) != 2 &&    /* TRM */
  80                    !(ch->config & (1 << 19)))          /* TURBO */
  81        goto intr_update;
  82    if ((ch->status & (1 << 1)) &&                      /* TXS */
  83                    ((ch->config >> 12) & 3) != 1)      /* TRM */
  84        goto intr_update;
  85
  86    if (!(s->control & 1) ||                            /* SINGLE */
  87                    (ch->config & (1 << 20))) {         /* FORCE */
  88        if (ch->txrx)
  89            ch->rx = ch->txrx(ch->opaque, ch->tx,       /* WL */
  90                            1 + (0x1f & (ch->config >> 7)));
  91    }
  92
  93    ch->tx = 0;
  94    ch->status |= 1 << 2;                               /* EOT */
  95    ch->status |= 1 << 1;                               /* TXS */
  96    if (((ch->config >> 12) & 3) != 2)                  /* TRM */
  97        ch->status |= 1 << 0;                           /* RXS */
  98
  99intr_update:
 100    if ((ch->status & (1 << 0)) &&                      /* RXS */
 101                    ((ch->config >> 12) & 3) != 2 &&    /* TRM */
 102                    !(ch->config & (1 << 19)))          /* TURBO */
 103        s->irqst |= 1 << (2 + 4 * chnum);               /* RX_FULL */
 104    if ((ch->status & (1 << 1)) &&                      /* TXS */
 105                    ((ch->config >> 12) & 3) != 1)      /* TRM */
 106        s->irqst |= 1 << (0 + 4 * chnum);               /* TX_EMPTY */
 107    omap_mcspi_interrupt_update(s);
 108    omap_mcspi_dmarequest_update(ch);
 109}
 110
 111void omap_mcspi_reset(struct omap_mcspi_s *s)
 112{
 113    int ch;
 114
 115    s->sysconfig = 0;
 116    s->systest = 0;
 117    s->irqst = 0;
 118    s->irqen = 0;
 119    s->wken = 0;
 120    s->control = 4;
 121
 122    for (ch = 0; ch < 4; ch ++) {
 123        s->ch[ch].config = 0x060000;
 124        s->ch[ch].status = 2;                           /* TXS */
 125        s->ch[ch].control = 0;
 126
 127        omap_mcspi_dmarequest_update(s->ch + ch);
 128    }
 129
 130    omap_mcspi_interrupt_update(s);
 131}
 132
 133static uint64_t omap_mcspi_read(void *opaque, hwaddr addr,
 134                                unsigned size)
 135{
 136    struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
 137    int ch = 0;
 138    uint32_t ret;
 139
 140    if (size != 4) {
 141        return omap_badwidth_read32(opaque, addr);
 142    }
 143
 144    switch (addr) {
 145    case 0x00:  /* MCSPI_REVISION */
 146        return 0x91;
 147
 148    case 0x10:  /* MCSPI_SYSCONFIG */
 149        return s->sysconfig;
 150
 151    case 0x14:  /* MCSPI_SYSSTATUS */
 152        return 1;                                       /* RESETDONE */
 153
 154    case 0x18:  /* MCSPI_IRQSTATUS */
 155        return s->irqst;
 156
 157    case 0x1c:  /* MCSPI_IRQENABLE */
 158        return s->irqen;
 159
 160    case 0x20:  /* MCSPI_WAKEUPENABLE */
 161        return s->wken;
 162
 163    case 0x24:  /* MCSPI_SYST */
 164        return s->systest;
 165
 166    case 0x28:  /* MCSPI_MODULCTRL */
 167        return s->control;
 168
 169    case 0x68: ch ++;
 170        /* fall through */
 171    case 0x54: ch ++;
 172        /* fall through */
 173    case 0x40: ch ++;
 174        /* fall through */
 175    case 0x2c:  /* MCSPI_CHCONF */
 176        return s->ch[ch].config;
 177
 178    case 0x6c: ch ++;
 179        /* fall through */
 180    case 0x58: ch ++;
 181        /* fall through */
 182    case 0x44: ch ++;
 183        /* fall through */
 184    case 0x30:  /* MCSPI_CHSTAT */
 185        return s->ch[ch].status;
 186
 187    case 0x70: ch ++;
 188        /* fall through */
 189    case 0x5c: ch ++;
 190        /* fall through */
 191    case 0x48: ch ++;
 192        /* fall through */
 193    case 0x34:  /* MCSPI_CHCTRL */
 194        return s->ch[ch].control;
 195
 196    case 0x74: ch ++;
 197        /* fall through */
 198    case 0x60: ch ++;
 199        /* fall through */
 200    case 0x4c: ch ++;
 201        /* fall through */
 202    case 0x38:  /* MCSPI_TX */
 203        return s->ch[ch].tx;
 204
 205    case 0x78: ch ++;
 206        /* fall through */
 207    case 0x64: ch ++;
 208        /* fall through */
 209    case 0x50: ch ++;
 210        /* fall through */
 211    case 0x3c:  /* MCSPI_RX */
 212        s->ch[ch].status &= ~(1 << 0);                  /* RXS */
 213        ret = s->ch[ch].rx;
 214        omap_mcspi_transfer_run(s, ch);
 215        return ret;
 216    }
 217
 218    OMAP_BAD_REG(addr);
 219    return 0;
 220}
 221
 222static void omap_mcspi_write(void *opaque, hwaddr addr,
 223                             uint64_t value, unsigned size)
 224{
 225    struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
 226    int ch = 0;
 227
 228    if (size != 4) {
 229        omap_badwidth_write32(opaque, addr, value);
 230        return;
 231    }
 232
 233    switch (addr) {
 234    case 0x00:  /* MCSPI_REVISION */
 235    case 0x14:  /* MCSPI_SYSSTATUS */
 236    case 0x30:  /* MCSPI_CHSTAT0 */
 237    case 0x3c:  /* MCSPI_RX0 */
 238    case 0x44:  /* MCSPI_CHSTAT1 */
 239    case 0x50:  /* MCSPI_RX1 */
 240    case 0x58:  /* MCSPI_CHSTAT2 */
 241    case 0x64:  /* MCSPI_RX2 */
 242    case 0x6c:  /* MCSPI_CHSTAT3 */
 243    case 0x78:  /* MCSPI_RX3 */
 244        OMAP_RO_REG(addr);
 245        return;
 246
 247    case 0x10:  /* MCSPI_SYSCONFIG */
 248        if (value & (1 << 1))                           /* SOFTRESET */
 249            omap_mcspi_reset(s);
 250        s->sysconfig = value & 0x31d;
 251        break;
 252
 253    case 0x18:  /* MCSPI_IRQSTATUS */
 254        if (!((s->control & (1 << 3)) && (s->systest & (1 << 11)))) {
 255            s->irqst &= ~value;
 256            omap_mcspi_interrupt_update(s);
 257        }
 258        break;
 259
 260    case 0x1c:  /* MCSPI_IRQENABLE */
 261        s->irqen = value & 0x1777f;
 262        omap_mcspi_interrupt_update(s);
 263        break;
 264
 265    case 0x20:  /* MCSPI_WAKEUPENABLE */
 266        s->wken = value & 1;
 267        break;
 268
 269    case 0x24:  /* MCSPI_SYST */
 270        if (s->control & (1 << 3))                      /* SYSTEM_TEST */
 271            if (value & (1 << 11)) {                    /* SSB */
 272                s->irqst |= 0x1777f;
 273                omap_mcspi_interrupt_update(s);
 274            }
 275        s->systest = value & 0xfff;
 276        break;
 277
 278    case 0x28:  /* MCSPI_MODULCTRL */
 279        if (value & (1 << 3))                           /* SYSTEM_TEST */
 280            if (s->systest & (1 << 11)) {               /* SSB */
 281                s->irqst |= 0x1777f;
 282                omap_mcspi_interrupt_update(s);
 283            }
 284        s->control = value & 0xf;
 285        break;
 286
 287    case 0x68: ch ++;
 288        /* fall through */
 289    case 0x54: ch ++;
 290        /* fall through */
 291    case 0x40: ch ++;
 292        /* fall through */
 293    case 0x2c:  /* MCSPI_CHCONF */
 294        if ((value ^ s->ch[ch].config) & (3 << 14))     /* DMAR | DMAW */
 295            omap_mcspi_dmarequest_update(s->ch + ch);
 296        if (((value >> 12) & 3) == 3)                   /* TRM */
 297            fprintf(stderr, "%s: invalid TRM value (3)\n", __FUNCTION__);
 298        if (((value >> 7) & 0x1f) < 3)                  /* WL */
 299            fprintf(stderr, "%s: invalid WL value (%" PRIx64 ")\n",
 300                            __FUNCTION__, (value >> 7) & 0x1f);
 301        s->ch[ch].config = value & 0x7fffff;
 302        break;
 303
 304    case 0x70: ch ++;
 305        /* fall through */
 306    case 0x5c: ch ++;
 307        /* fall through */
 308    case 0x48: ch ++;
 309        /* fall through */
 310    case 0x34:  /* MCSPI_CHCTRL */
 311        if (value & ~s->ch[ch].control & 1) {           /* EN */
 312            s->ch[ch].control |= 1;
 313            omap_mcspi_transfer_run(s, ch);
 314        } else
 315            s->ch[ch].control = value & 1;
 316        break;
 317
 318    case 0x74: ch ++;
 319        /* fall through */
 320    case 0x60: ch ++;
 321        /* fall through */
 322    case 0x4c: ch ++;
 323        /* fall through */
 324    case 0x38:  /* MCSPI_TX */
 325        s->ch[ch].tx = value;
 326        s->ch[ch].status &= ~(1 << 1);                  /* TXS */
 327        omap_mcspi_transfer_run(s, ch);
 328        break;
 329
 330    default:
 331        OMAP_BAD_REG(addr);
 332        return;
 333    }
 334}
 335
 336static const MemoryRegionOps omap_mcspi_ops = {
 337    .read = omap_mcspi_read,
 338    .write = omap_mcspi_write,
 339    .endianness = DEVICE_NATIVE_ENDIAN,
 340};
 341
 342struct omap_mcspi_s *omap_mcspi_init(struct omap_target_agent_s *ta, int chnum,
 343                qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
 344{
 345    struct omap_mcspi_s *s = g_new0(struct omap_mcspi_s, 1);
 346    struct omap_mcspi_ch_s *ch = s->ch;
 347
 348    s->irq = irq;
 349    s->chnum = chnum;
 350    while (chnum --) {
 351        ch->txdrq = *drq ++;
 352        ch->rxdrq = *drq ++;
 353        ch ++;
 354    }
 355    omap_mcspi_reset(s);
 356
 357    memory_region_init_io(&s->iomem, NULL, &omap_mcspi_ops, s, "omap.mcspi",
 358                          omap_l4_region_size(ta, 0));
 359    omap_l4_attach(ta, 0, &s->iomem);
 360
 361    return s;
 362}
 363
 364void omap_mcspi_attach(struct omap_mcspi_s *s,
 365                uint32_t (*txrx)(void *opaque, uint32_t, int), void *opaque,
 366                int chipselect)
 367{
 368    if (chipselect < 0 || chipselect >= s->chnum)
 369        hw_error("%s: Bad chipselect %i\n", __FUNCTION__, chipselect);
 370
 371    s->ch[chipselect].txrx = txrx;
 372    s->ch[chipselect].opaque = opaque;
 373}
 374