Annotation of qemu/hw/iommu.c, revision 1.1.1.5

1.1       root        1: /*
                      2:  * QEMU SPARC iommu emulation
                      3:  *
                      4:  * Copyright (c) 2003-2005 Fabrice Bellard
1.1.1.4   root        5:  *
1.1       root        6:  * Permission is hereby granted, free of charge, to any person obtaining a copy
                      7:  * of this software and associated documentation files (the "Software"), to deal
                      8:  * in the Software without restriction, including without limitation the rights
                      9:  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
                     10:  * copies of the Software, and to permit persons to whom the Software is
                     11:  * furnished to do so, subject to the following conditions:
                     12:  *
                     13:  * The above copyright notice and this permission notice shall be included in
                     14:  * all copies or substantial portions of the Software.
                     15:  *
                     16:  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
                     17:  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
                     18:  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
                     19:  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
                     20:  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
                     21:  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
                     22:  * THE SOFTWARE.
                     23:  */
1.1.1.4   root       24: #include "hw.h"
                     25: #include "sun4m.h"
1.1       root       26: 
                     27: /* debug iommu */
                     28: //#define DEBUG_IOMMU
                     29: 
                     30: #ifdef DEBUG_IOMMU
                     31: #define DPRINTF(fmt, args...) \
                     32: do { printf("IOMMU: " fmt , ##args); } while (0)
                     33: #else
                     34: #define DPRINTF(fmt, args...)
                     35: #endif
                     36: 
1.1.1.5 ! root       37: #define IOMMU_NREGS         (4*4096/4)
1.1.1.2   root       38: #define IOMMU_CTRL          (0x0000 >> 2)
1.1       root       39: #define IOMMU_CTRL_IMPL     0xf0000000 /* Implementation */
                     40: #define IOMMU_CTRL_VERS     0x0f000000 /* Version */
                     41: #define IOMMU_CTRL_RNGE     0x0000001c /* Mapping RANGE */
                     42: #define IOMMU_RNGE_16MB     0x00000000 /* 0xff000000 -> 0xffffffff */
                     43: #define IOMMU_RNGE_32MB     0x00000004 /* 0xfe000000 -> 0xffffffff */
                     44: #define IOMMU_RNGE_64MB     0x00000008 /* 0xfc000000 -> 0xffffffff */
                     45: #define IOMMU_RNGE_128MB    0x0000000c /* 0xf8000000 -> 0xffffffff */
                     46: #define IOMMU_RNGE_256MB    0x00000010 /* 0xf0000000 -> 0xffffffff */
                     47: #define IOMMU_RNGE_512MB    0x00000014 /* 0xe0000000 -> 0xffffffff */
                     48: #define IOMMU_RNGE_1GB      0x00000018 /* 0xc0000000 -> 0xffffffff */
                     49: #define IOMMU_RNGE_2GB      0x0000001c /* 0x80000000 -> 0xffffffff */
                     50: #define IOMMU_CTRL_ENAB     0x00000001 /* IOMMU Enable */
1.1.1.2   root       51: #define IOMMU_CTRL_MASK     0x0000001d
                     52: 
                     53: #define IOMMU_BASE          (0x0004 >> 2)
                     54: #define IOMMU_BASE_MASK     0x07fffc00
                     55: 
                     56: #define IOMMU_TLBFLUSH      (0x0014 >> 2)
                     57: #define IOMMU_TLBFLUSH_MASK 0xffffffff
                     58: 
                     59: #define IOMMU_PGFLUSH       (0x0018 >> 2)
                     60: #define IOMMU_PGFLUSH_MASK  0xffffffff
                     61: 
1.1.1.4   root       62: #define IOMMU_AFSR          (0x1000 >> 2)
                     63: #define IOMMU_AFSR_ERR      0x80000000 /* LE, TO, or BE asserted */
                     64: #define IOMMU_AFSR_LE       0x40000000 /* SBUS reports error after
                     65:                                           transaction */
                     66: #define IOMMU_AFSR_TO       0x20000000 /* Write access took more than
                     67:                                           12.8 us. */
                     68: #define IOMMU_AFSR_BE       0x10000000 /* Write access received error
                     69:                                           acknowledge */
                     70: #define IOMMU_AFSR_SIZE     0x0e000000 /* Size of transaction causing error */
                     71: #define IOMMU_AFSR_S        0x01000000 /* Sparc was in supervisor mode */
                     72: #define IOMMU_AFSR_RESV     0x00800000 /* Reserved, forced to 0x8 by
                     73:                                           hardware */
                     74: #define IOMMU_AFSR_ME       0x00080000 /* Multiple errors occurred */
                     75: #define IOMMU_AFSR_RD       0x00040000 /* A read operation was in progress */
                     76: #define IOMMU_AFSR_FAV      0x00020000 /* IOMMU afar has valid contents */
                     77: #define IOMMU_AFSR_MASK     0xff0fffff
                     78: 
                     79: #define IOMMU_AFAR          (0x1004 >> 2)
                     80: 
1.1.1.5 ! root       81: #define IOMMU_AER           (0x1008 >> 2) /* Arbiter Enable Register */
        !            82: #define IOMMU_AER_EN_P0_ARB 0x00000001    /* MBus master 0x8 (Always 1) */
        !            83: #define IOMMU_AER_EN_P1_ARB 0x00000002    /* MBus master 0x9 */
        !            84: #define IOMMU_AER_EN_P2_ARB 0x00000004    /* MBus master 0xa */
        !            85: #define IOMMU_AER_EN_P3_ARB 0x00000008    /* MBus master 0xb */
        !            86: #define IOMMU_AER_EN_0      0x00010000    /* SBus slot 0 */
        !            87: #define IOMMU_AER_EN_1      0x00020000    /* SBus slot 1 */
        !            88: #define IOMMU_AER_EN_2      0x00040000    /* SBus slot 2 */
        !            89: #define IOMMU_AER_EN_3      0x00080000    /* SBus slot 3 */
        !            90: #define IOMMU_AER_EN_F      0x00100000    /* SBus on-board */
        !            91: #define IOMMU_AER_SBW       0x80000000    /* S-to-M asynchronous writes */
        !            92: #define IOMMU_AER_MASK      0x801f000f
        !            93: 
1.1.1.2   root       94: #define IOMMU_SBCFG0        (0x1010 >> 2) /* SBUS configration per-slot */
                     95: #define IOMMU_SBCFG1        (0x1014 >> 2) /* SBUS configration per-slot */
                     96: #define IOMMU_SBCFG2        (0x1018 >> 2) /* SBUS configration per-slot */
                     97: #define IOMMU_SBCFG3        (0x101c >> 2) /* SBUS configration per-slot */
1.1.1.4   root       98: #define IOMMU_SBCFG_SAB30   0x00010000 /* Phys-address bit 30 when
                     99:                                           bypass enabled */
1.1.1.2   root      100: #define IOMMU_SBCFG_BA16    0x00000004 /* Slave supports 16 byte bursts */
                    101: #define IOMMU_SBCFG_BA8     0x00000002 /* Slave supports 8 byte bursts */
                    102: #define IOMMU_SBCFG_BYPASS  0x00000001 /* Bypass IOMMU, treat all addresses
1.1.1.4   root      103:                                           produced by this device as pure
1.1.1.2   root      104:                                           physical. */
                    105: #define IOMMU_SBCFG_MASK    0x00010003
                    106: 
                    107: #define IOMMU_ARBEN         (0x2000 >> 2) /* SBUS arbitration enable */
                    108: #define IOMMU_ARBEN_MASK    0x001f0000
                    109: #define IOMMU_MID           0x00000008
1.1       root      110: 
1.1.1.5 ! root      111: #define IOMMU_MASK_ID       (0x3018 >> 2) /* Mask ID */
        !           112: #define IOMMU_MASK_ID_MASK  0x00ffffff
        !           113: 
        !           114: #define IOMMU_MSII_MASK     0x26000000 /* microSPARC II mask number */
        !           115: #define IOMMU_TS_MASK       0x23000000 /* turboSPARC mask number */
        !           116: 
1.1       root      117: /* The format of an iopte in the page tables */
1.1.1.4   root      118: #define IOPTE_PAGE          0xffffff00 /* Physical page number (PA[35:12]) */
                    119: #define IOPTE_CACHE         0x00000080 /* Cached (in vme IOCACHE or
                    120:                                           Viking/MXCC) */
1.1       root      121: #define IOPTE_WRITE         0x00000004 /* Writeable */
                    122: #define IOPTE_VALID         0x00000002 /* IOPTE is valid */
                    123: #define IOPTE_WAZ           0x00000001 /* Write as zeros */
                    124: 
1.1.1.5 ! root      125: #define IOMMU_PAGE_SHIFT    12
        !           126: #define IOMMU_PAGE_SIZE     (1 << IOMMU_PAGE_SHIFT)
        !           127: #define IOMMU_PAGE_MASK     ~(IOMMU_PAGE_SIZE - 1)
1.1       root      128: 
                    129: typedef struct IOMMUState {
                    130:     uint32_t regs[IOMMU_NREGS];
1.1.1.4   root      131:     target_phys_addr_t iostart;
                    132:     uint32_t version;
                    133:     qemu_irq irq;
1.1       root      134: } IOMMUState;
                    135: 
1.1.1.4   root      136: static uint32_t iommu_mem_readl(void *opaque, target_phys_addr_t addr)
1.1       root      137: {
                    138:     IOMMUState *s = opaque;
1.1.1.4   root      139:     target_phys_addr_t saddr;
                    140:     uint32_t ret;
1.1       root      141: 
1.1.1.5 ! root      142:     saddr = addr >> 2;
1.1       root      143:     switch (saddr) {
                    144:     default:
1.1.1.4   root      145:         ret = s->regs[saddr];
                    146:         break;
                    147:     case IOMMU_AFAR:
                    148:     case IOMMU_AFSR:
                    149:         ret = s->regs[saddr];
                    150:         qemu_irq_lower(s->irq);
                    151:         break;
1.1       root      152:     }
1.1.1.4   root      153:     DPRINTF("read reg[%d] = %x\n", (int)saddr, ret);
                    154:     return ret;
1.1       root      155: }
                    156: 
1.1.1.4   root      157: static void iommu_mem_writel(void *opaque, target_phys_addr_t addr,
                    158:                              uint32_t val)
1.1       root      159: {
                    160:     IOMMUState *s = opaque;
1.1.1.4   root      161:     target_phys_addr_t saddr;
1.1       root      162: 
1.1.1.5 ! root      163:     saddr = addr >> 2;
1.1.1.4   root      164:     DPRINTF("write reg[%d] = %x\n", (int)saddr, val);
1.1       root      165:     switch (saddr) {
1.1.1.2   root      166:     case IOMMU_CTRL:
1.1.1.4   root      167:         switch (val & IOMMU_CTRL_RNGE) {
                    168:         case IOMMU_RNGE_16MB:
                    169:             s->iostart = 0xffffffffff000000ULL;
                    170:             break;
                    171:         case IOMMU_RNGE_32MB:
                    172:             s->iostart = 0xfffffffffe000000ULL;
                    173:             break;
                    174:         case IOMMU_RNGE_64MB:
                    175:             s->iostart = 0xfffffffffc000000ULL;
                    176:             break;
                    177:         case IOMMU_RNGE_128MB:
                    178:             s->iostart = 0xfffffffff8000000ULL;
                    179:             break;
                    180:         case IOMMU_RNGE_256MB:
                    181:             s->iostart = 0xfffffffff0000000ULL;
                    182:             break;
                    183:         case IOMMU_RNGE_512MB:
                    184:             s->iostart = 0xffffffffe0000000ULL;
                    185:             break;
                    186:         case IOMMU_RNGE_1GB:
                    187:             s->iostart = 0xffffffffc0000000ULL;
                    188:             break;
                    189:         default:
                    190:         case IOMMU_RNGE_2GB:
                    191:             s->iostart = 0xffffffff80000000ULL;
                    192:             break;
                    193:         }
                    194:         DPRINTF("iostart = " TARGET_FMT_plx "\n", s->iostart);
                    195:         s->regs[saddr] = ((val & IOMMU_CTRL_MASK) | s->version);
                    196:         break;
1.1.1.2   root      197:     case IOMMU_BASE:
1.1.1.4   root      198:         s->regs[saddr] = val & IOMMU_BASE_MASK;
                    199:         break;
1.1.1.2   root      200:     case IOMMU_TLBFLUSH:
1.1.1.4   root      201:         DPRINTF("tlb flush %x\n", val);
                    202:         s->regs[saddr] = val & IOMMU_TLBFLUSH_MASK;
                    203:         break;
1.1.1.2   root      204:     case IOMMU_PGFLUSH:
1.1.1.4   root      205:         DPRINTF("page flush %x\n", val);
                    206:         s->regs[saddr] = val & IOMMU_PGFLUSH_MASK;
                    207:         break;
                    208:     case IOMMU_AFAR:
                    209:         s->regs[saddr] = val;
                    210:         qemu_irq_lower(s->irq);
                    211:         break;
1.1.1.5 ! root      212:     case IOMMU_AER:
        !           213:         s->regs[saddr] = (val & IOMMU_AER_MASK) | IOMMU_AER_EN_P0_ARB;
        !           214:         break;
1.1.1.4   root      215:     case IOMMU_AFSR:
                    216:         s->regs[saddr] = (val & IOMMU_AFSR_MASK) | IOMMU_AFSR_RESV;
                    217:         qemu_irq_lower(s->irq);
                    218:         break;
1.1.1.2   root      219:     case IOMMU_SBCFG0:
                    220:     case IOMMU_SBCFG1:
                    221:     case IOMMU_SBCFG2:
                    222:     case IOMMU_SBCFG3:
1.1.1.4   root      223:         s->regs[saddr] = val & IOMMU_SBCFG_MASK;
                    224:         break;
1.1.1.2   root      225:     case IOMMU_ARBEN:
                    226:         // XXX implement SBus probing: fault when reading unmapped
                    227:         // addresses, fault cause and address stored to MMU/IOMMU
1.1.1.4   root      228:         s->regs[saddr] = (val & IOMMU_ARBEN_MASK) | IOMMU_MID;
                    229:         break;
1.1.1.5 ! root      230:     case IOMMU_MASK_ID:
        !           231:         s->regs[saddr] |= val & IOMMU_MASK_ID_MASK;
        !           232:         break;
1.1       root      233:     default:
1.1.1.4   root      234:         s->regs[saddr] = val;
                    235:         break;
1.1       root      236:     }
                    237: }
                    238: 
                    239: static CPUReadMemoryFunc *iommu_mem_read[3] = {
1.1.1.4   root      240:     NULL,
                    241:     NULL,
                    242:     iommu_mem_readl,
1.1       root      243: };
                    244: 
                    245: static CPUWriteMemoryFunc *iommu_mem_write[3] = {
1.1.1.4   root      246:     NULL,
                    247:     NULL,
                    248:     iommu_mem_writel,
1.1       root      249: };
                    250: 
1.1.1.4   root      251: static uint32_t iommu_page_get_flags(IOMMUState *s, target_phys_addr_t addr)
1.1       root      252: {
1.1.1.4   root      253:     uint32_t ret;
                    254:     target_phys_addr_t iopte;
                    255: #ifdef DEBUG_IOMMU
                    256:     target_phys_addr_t pa = addr;
                    257: #endif
1.1       root      258: 
1.1.1.4   root      259:     iopte = s->regs[IOMMU_BASE] << 4;
1.1       root      260:     addr &= ~s->iostart;
1.1.1.5 ! root      261:     iopte += (addr >> (IOMMU_PAGE_SHIFT - 2)) & ~3;
1.1.1.4   root      262:     cpu_physical_memory_read(iopte, (uint8_t *)&ret, 4);
                    263:     tswap32s(&ret);
                    264:     DPRINTF("get flags addr " TARGET_FMT_plx " => pte " TARGET_FMT_plx
                    265:             ", *pte = %x\n", pa, iopte, ret);
                    266: 
                    267:     return ret;
1.1.1.3   root      268: }
                    269: 
1.1.1.5 ! root      270: static target_phys_addr_t iommu_translate_pa(target_phys_addr_t addr,
1.1.1.4   root      271:                                              uint32_t pte)
1.1.1.3   root      272: {
                    273:     uint32_t tmppte;
1.1.1.4   root      274:     target_phys_addr_t pa;
                    275: 
                    276:     tmppte = pte;
1.1.1.5 ! root      277:     pa = ((pte & IOPTE_PAGE) << 4) + (addr & ~IOMMU_PAGE_MASK);
1.1.1.4   root      278:     DPRINTF("xlate dva " TARGET_FMT_plx " => pa " TARGET_FMT_plx
                    279:             " (iopte = %x)\n", addr, pa, tmppte);
1.1.1.3   root      280: 
1.1       root      281:     return pa;
                    282: }
                    283: 
1.1.1.4   root      284: static void iommu_bad_addr(IOMMUState *s, target_phys_addr_t addr,
                    285:                            int is_write)
                    286: {
                    287:     DPRINTF("bad addr " TARGET_FMT_plx "\n", addr);
                    288:     s->regs[IOMMU_AFSR] = IOMMU_AFSR_ERR | IOMMU_AFSR_LE | IOMMU_AFSR_RESV |
                    289:         IOMMU_AFSR_FAV;
                    290:     if (!is_write)
                    291:         s->regs[IOMMU_AFSR] |= IOMMU_AFSR_RD;
                    292:     s->regs[IOMMU_AFAR] = addr;
                    293:     qemu_irq_raise(s->irq);
                    294: }
                    295: 
1.1.1.3   root      296: void sparc_iommu_memory_rw(void *opaque, target_phys_addr_t addr,
                    297:                            uint8_t *buf, int len, int is_write)
                    298: {
1.1.1.4   root      299:     int l;
                    300:     uint32_t flags;
                    301:     target_phys_addr_t page, phys_addr;
1.1.1.3   root      302: 
                    303:     while (len > 0) {
1.1.1.5 ! root      304:         page = addr & IOMMU_PAGE_MASK;
        !           305:         l = (page + IOMMU_PAGE_SIZE) - addr;
1.1.1.3   root      306:         if (l > len)
                    307:             l = len;
                    308:         flags = iommu_page_get_flags(opaque, page);
1.1.1.4   root      309:         if (!(flags & IOPTE_VALID)) {
                    310:             iommu_bad_addr(opaque, page, is_write);
1.1.1.3   root      311:             return;
1.1.1.4   root      312:         }
1.1.1.5 ! root      313:         phys_addr = iommu_translate_pa(addr, flags);
1.1.1.3   root      314:         if (is_write) {
1.1.1.4   root      315:             if (!(flags & IOPTE_WRITE)) {
                    316:                 iommu_bad_addr(opaque, page, is_write);
1.1.1.3   root      317:                 return;
1.1.1.4   root      318:             }
1.1.1.5 ! root      319:             cpu_physical_memory_write(phys_addr, buf, l);
1.1.1.3   root      320:         } else {
1.1.1.5 ! root      321:             cpu_physical_memory_read(phys_addr, buf, l);
1.1.1.3   root      322:         }
                    323:         len -= l;
                    324:         buf += l;
                    325:         addr += l;
                    326:     }
                    327: }
                    328: 
1.1       root      329: static void iommu_save(QEMUFile *f, void *opaque)
                    330: {
                    331:     IOMMUState *s = opaque;
                    332:     int i;
1.1.1.4   root      333: 
1.1       root      334:     for (i = 0; i < IOMMU_NREGS; i++)
1.1.1.4   root      335:         qemu_put_be32s(f, &s->regs[i]);
                    336:     qemu_put_be64s(f, &s->iostart);
1.1       root      337: }
                    338: 
                    339: static int iommu_load(QEMUFile *f, void *opaque, int version_id)
                    340: {
                    341:     IOMMUState *s = opaque;
                    342:     int i;
1.1.1.4   root      343: 
                    344:     if (version_id != 2)
1.1       root      345:         return -EINVAL;
                    346: 
                    347:     for (i = 0; i < IOMMU_NREGS; i++)
1.1.1.4   root      348:         qemu_get_be32s(f, &s->regs[i]);
                    349:     qemu_get_be64s(f, &s->iostart);
1.1       root      350: 
                    351:     return 0;
                    352: }
                    353: 
                    354: static void iommu_reset(void *opaque)
                    355: {
                    356:     IOMMUState *s = opaque;
                    357: 
                    358:     memset(s->regs, 0, IOMMU_NREGS * 4);
                    359:     s->iostart = 0;
1.1.1.4   root      360:     s->regs[IOMMU_CTRL] = s->version;
                    361:     s->regs[IOMMU_ARBEN] = IOMMU_MID;
                    362:     s->regs[IOMMU_AFSR] = IOMMU_AFSR_RESV;
1.1.1.5 ! root      363:     s->regs[IOMMU_AER] = IOMMU_AER_EN_P0_ARB | IOMMU_AER_EN_P1_ARB;
        !           364:     s->regs[IOMMU_MASK_ID] = IOMMU_TS_MASK;
1.1.1.4   root      365:     qemu_irq_lower(s->irq);
1.1       root      366: }
                    367: 
1.1.1.4   root      368: void *iommu_init(target_phys_addr_t addr, uint32_t version, qemu_irq irq)
1.1       root      369: {
                    370:     IOMMUState *s;
                    371:     int iommu_io_memory;
                    372: 
                    373:     s = qemu_mallocz(sizeof(IOMMUState));
                    374: 
1.1.1.4   root      375:     s->version = version;
                    376:     s->irq = irq;
1.1       root      377: 
1.1.1.4   root      378:     iommu_io_memory = cpu_register_io_memory(0, iommu_mem_read,
                    379:                                              iommu_mem_write, s);
1.1       root      380:     cpu_register_physical_memory(addr, IOMMU_NREGS * 4, iommu_io_memory);
1.1.1.4   root      381: 
                    382:     register_savevm("iommu", addr, 2, iommu_save, iommu_load, s);
1.1       root      383:     qemu_register_reset(iommu_reset, s);
1.1.1.4   root      384:     iommu_reset(s);
1.1       root      385:     return s;
                    386: }

unix.superglobalmegacorp.com

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.