hw/spapr_iommu.c

   1 /*
   2  * QEMU sPAPR IOMMU (TCE) code
   3  *
   4  * Copyright (c) 2010 David Gibson, IBM Corporation <dwg@au1.ibm.com>
   5  *
   6  * This library is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2 of the License, or (at your option) any later version.
  10  *
  11  * This library is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  18  */
  19 #include "hw.h"
  20 #include "kvm.h"
  21 #include "qdev.h"
  22 #include "kvm_ppc.h"
  23 #include "dma.h"
  24
  25 #include "hw/spapr.h"
  26
  27 #include <libfdt.h>
  28
  29 /* #define DEBUG_TCE */
  30
  31 enum sPAPRTCEAccess {
  32     SPAPR_TCE_FAULT = 0,
  33     SPAPR_TCE_RO = 1,
  34     SPAPR_TCE_WO = 2,
  35     SPAPR_TCE_RW = 3,
  36 };
  37
  38 typedef struct sPAPRTCETable sPAPRTCETable;
  39
  40 struct sPAPRTCETable {
  41     DMAContext dma;
  42     uint32_t liobn;
  43     uint32_t window_size;
  44     sPAPRTCE *table;
  45     int fd;
  46     QLIST_ENTRY(sPAPRTCETable) list;
  47 };
  48
  49
  50 QLIST_HEAD(spapr_tce_tables, sPAPRTCETable) spapr_tce_tables;
  51
  52 static sPAPRTCETable *spapr_tce_find_by_liobn(uint32_t liobn)
  53 {
  54     sPAPRTCETable *tcet;
  55
  56     QLIST_FOREACH(tcet, &spapr_tce_tables, list) {
  57         if (tcet->liobn == liobn) {
  58             return tcet;
  59         }
  60     }
  61
  62     return NULL;
  63 }
  64
  65 static int spapr_tce_translate(DMAContext *dma,
  66                                dma_addr_t addr,
  67                                target_phys_addr_t *paddr,
  68                                target_phys_addr_t *len,
  69                                DMADirection dir)
  70 {
  71     sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, dma);
  72     enum sPAPRTCEAccess access = (dir == DMA_DIRECTION_FROM_DEVICE)
  73         ? SPAPR_TCE_WO : SPAPR_TCE_RO;
  74     uint64_t tce;
  75
  76 #ifdef DEBUG_TCE
  77     fprintf(stderr, "spapr_tce_translate liobn=0x%" PRIx32 " addr=0x"
  78             DMA_ADDR_FMT "\n", tcet->liobn, addr);
  79 #endif
  80
  81     /* Check if we are in bound */
  82     if (addr >= tcet->window_size) {
  83 #ifdef DEBUG_TCE
  84         fprintf(stderr, "spapr_tce_translate out of bounds\n");
  85 #endif
  86         return -EFAULT;
  87     }
  88
  89     tce = tcet->table[addr >> SPAPR_TCE_PAGE_SHIFT].tce;
  90
  91     /* Check TCE */
  92     if (!(tce & access)) {
  93         return -EPERM;
  94     }
  95
  96     /* How much til end of page ? */
  97     *len = ((~addr) & SPAPR_TCE_PAGE_MASK) + 1;
  98
  99     /* Translate */
 100     *paddr = (tce & ~SPAPR_TCE_PAGE_MASK) |
 101         (addr & SPAPR_TCE_PAGE_MASK);
 102
 103 #ifdef DEBUG_TCE
 104     fprintf(stderr, " ->  *paddr=0x" TARGET_FMT_plx ", *len=0x"
 105             TARGET_FMT_plx "\n", *paddr, *len);
 106 #endif
 107
 108     return 0;
 109 }
 110
 111 DMAContext *spapr_tce_new_dma_context(uint32_t liobn, size_t window_size)
 112 {
 113     sPAPRTCETable *tcet;
 114
 115     if (!window_size) {
 116         return NULL;
 117     }
 118
 119     tcet = g_malloc0(sizeof(*tcet));
 120     dma_context_init(&tcet->dma, spapr_tce_translate, NULL, NULL);
 121
 122     tcet->liobn = liobn;
 123     tcet->window_size = window_size;
 124
 125     if (kvm_enabled()) {
 126         tcet->table = kvmppc_create_spapr_tce(liobn,
 127                                               window_size,
 128                                               &tcet->fd);
 129     }
 130
 131     if (!tcet->table) {
 132         size_t table_size = (window_size >> SPAPR_TCE_PAGE_SHIFT)
 133             * sizeof(sPAPRTCE);
 134         tcet->table = g_malloc0(table_size);
 135     }
 136
 137 #ifdef DEBUG_TCE
 138     fprintf(stderr, "spapr_iommu: New TCE table, liobn=0x%x, context @ %p, "
 139             "table @ %p, fd=%d\n", liobn, &tcet->dma, tcet->table, tcet->fd);
 140 #endif
 141
 142     QLIST_INSERT_HEAD(&spapr_tce_tables, tcet, list);
 143
 144     return &tcet->dma;
 145 }
 146
 147 void spapr_tce_free(DMAContext *dma)
 148 {
 149
 150     if (dma) {
 151         sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, dma);
 152
 153         QLIST_REMOVE(tcet, list);
 154
 155         if (!kvm_enabled() ||
 156             (kvmppc_remove_spapr_tce(tcet->table, tcet->fd,
 157                                      tcet->window_size) != 0)) {
 158             g_free(tcet->table);
 159         }
 160
 161         g_free(tcet);
 162     }
 163 }
 164
 165 static target_ulong put_tce_emu(sPAPRTCETable *tcet, target_ulong ioba,
 166                                 target_ulong tce)
 167 {
 168     sPAPRTCE *tcep;
 169
 170     if (ioba >= tcet->window_size) {
 171         hcall_dprintf("spapr_vio_put_tce on out-of-boards IOBA 0x"
 172                       TARGET_FMT_lx "\n", ioba);
 173         return H_PARAMETER;
 174     }
 175
 176     tcep = tcet->table + (ioba >> SPAPR_TCE_PAGE_SHIFT);
 177     tcep->tce = tce;
 178
 179     return H_SUCCESS;
 180 }
 181
 182 static target_ulong h_put_tce(CPUPPCState *env, sPAPREnvironment *spapr,
 183                               target_ulong opcode, target_ulong *args)
 184 {
 185     target_ulong liobn = args[0];
 186     target_ulong ioba = args[1];
 187     target_ulong tce = args[2];
 188     sPAPRTCETable *tcet = spapr_tce_find_by_liobn(liobn);
 189
 190     if (liobn & 0xFFFFFFFF00000000ULL) {
 191         hcall_dprintf("spapr_vio_put_tce on out-of-boundsw LIOBN "
 192                       TARGET_FMT_lx "\n", liobn);
 193         return H_PARAMETER;
 194     }
 195
 196     ioba &= ~(SPAPR_TCE_PAGE_SIZE - 1);
 197
 198     if (tcet) {
 199         return put_tce_emu(tcet, ioba, tce);
 200     }
 201 #ifdef DEBUG_TCE
 202     fprintf(stderr, "%s on liobn=" TARGET_FMT_lx /*%s*/
 203             "  ioba 0x" TARGET_FMT_lx "  TCE 0x" TARGET_FMT_lx "\n",
 204             __func__, liobn, /*dev->qdev.id, */ioba, tce);
 205 #endif
 206
 207     return H_PARAMETER;
 208 }
 209
 210 void spapr_iommu_init(void)
 211 {
 212     QLIST_INIT(&spapr_tce_tables);
 213
 214     /* hcall-tce */
 215     spapr_register_hypercall(H_PUT_TCE, h_put_tce);
 216 }
 217
 218 int spapr_dma_dt(void *fdt, int node_off, const char *propname,
 219                  DMAContext *dma)
 220 {
 221     if (dma) {
 222         sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, dma);
 223         uint32_t dma_prop[] = {cpu_to_be32(tcet->liobn),
 224                                0, 0,
 225                                0, cpu_to_be32(tcet->window_size)};
 226         int ret;
 227
 228         ret = fdt_setprop_cell(fdt, node_off, "ibm,#dma-address-cells", 2);
 229         if (ret < 0) {
 230             return ret;
 231         }
 232
 233         ret = fdt_setprop_cell(fdt, node_off, "ibm,#dma-size-cells", 2);
 234         if (ret < 0) {
 235             return ret;
 236         }
 237
 238         ret = fdt_setprop(fdt, node_off, propname, dma_prop,
 239                           sizeof(dma_prop));
 240         if (ret < 0) {
 241             return ret;
 242         }
 243     }
 244
 245     return 0;
 246 }