pseries: Fix debug message for out-of-bounds address in H_PUT_TCE
[qemu/agraf.git] / hw / ppc / spapr_iommu.c
blobe1fe94115f80bfa10c425f06dfc75f3fbde760b0
1 /*
2 * QEMU sPAPR IOMMU (TCE) code
4 * Copyright (c) 2010 David Gibson, IBM Corporation <dwg@au1.ibm.com>
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.
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.
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/>.
19 #include "hw/hw.h"
20 #include "sysemu/kvm.h"
21 #include "hw/qdev.h"
22 #include "kvm_ppc.h"
23 #include "sysemu/dma.h"
24 #include "exec/address-spaces.h"
26 #include "hw/ppc/spapr.h"
28 #include <libfdt.h>
30 /* #define DEBUG_TCE */
32 enum sPAPRTCEAccess {
33 SPAPR_TCE_FAULT = 0,
34 SPAPR_TCE_RO = 1,
35 SPAPR_TCE_WO = 2,
36 SPAPR_TCE_RW = 3,
39 typedef struct sPAPRTCETable sPAPRTCETable;
41 struct sPAPRTCETable {
42 DMAContext dma;
43 uint32_t liobn;
44 uint32_t window_size;
45 sPAPRTCE *table;
46 bool bypass;
47 int fd;
48 QLIST_ENTRY(sPAPRTCETable) list;
52 QLIST_HEAD(spapr_tce_tables, sPAPRTCETable) spapr_tce_tables;
54 static sPAPRTCETable *spapr_tce_find_by_liobn(uint32_t liobn)
56 sPAPRTCETable *tcet;
58 if (liobn & 0xFFFFFFFF00000000ULL) {
59 hcall_dprintf("Request for out-of-bounds LIOBN 0x" TARGET_FMT_lx "\n",
60 liobn);
61 return NULL;
64 QLIST_FOREACH(tcet, &spapr_tce_tables, list) {
65 if (tcet->liobn == liobn) {
66 return tcet;
70 return NULL;
73 static int spapr_tce_translate(DMAContext *dma,
74 dma_addr_t addr,
75 hwaddr *paddr,
76 hwaddr *len,
77 DMADirection dir)
79 sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, dma);
80 enum sPAPRTCEAccess access = (dir == DMA_DIRECTION_FROM_DEVICE)
81 ? SPAPR_TCE_WO : SPAPR_TCE_RO;
82 uint64_t tce;
84 #ifdef DEBUG_TCE
85 fprintf(stderr, "spapr_tce_translate liobn=0x%" PRIx32 " addr=0x"
86 DMA_ADDR_FMT "\n", tcet->liobn, addr);
87 #endif
89 if (tcet->bypass) {
90 *paddr = addr;
91 *len = (hwaddr)-1;
92 return 0;
95 /* Check if we are in bound */
96 if (addr >= tcet->window_size) {
97 #ifdef DEBUG_TCE
98 fprintf(stderr, "spapr_tce_translate out of bounds\n");
99 #endif
100 return -EFAULT;
103 tce = tcet->table[addr >> SPAPR_TCE_PAGE_SHIFT].tce;
105 /* Check TCE */
106 if (!(tce & access)) {
107 return -EPERM;
110 /* How much til end of page ? */
111 *len = ((~addr) & SPAPR_TCE_PAGE_MASK) + 1;
113 /* Translate */
114 *paddr = (tce & ~SPAPR_TCE_PAGE_MASK) |
115 (addr & SPAPR_TCE_PAGE_MASK);
117 #ifdef DEBUG_TCE
118 fprintf(stderr, " -> *paddr=0x" TARGET_FMT_plx ", *len=0x"
119 TARGET_FMT_plx "\n", *paddr, *len);
120 #endif
122 return 0;
125 DMAContext *spapr_tce_new_dma_context(uint32_t liobn, size_t window_size)
127 sPAPRTCETable *tcet;
129 if (spapr_tce_find_by_liobn(liobn)) {
130 fprintf(stderr, "Attempted to create TCE table with duplicate"
131 " LIOBN 0x%x\n", liobn);
132 return NULL;
135 if (!window_size) {
136 return NULL;
139 tcet = g_malloc0(sizeof(*tcet));
140 dma_context_init(&tcet->dma, &address_space_memory, spapr_tce_translate, NULL, NULL);
142 tcet->liobn = liobn;
143 tcet->window_size = window_size;
145 if (kvm_enabled()) {
146 tcet->table = kvmppc_create_spapr_tce(liobn,
147 window_size,
148 &tcet->fd);
151 if (!tcet->table) {
152 size_t table_size = (window_size >> SPAPR_TCE_PAGE_SHIFT)
153 * sizeof(sPAPRTCE);
154 tcet->table = g_malloc0(table_size);
157 #ifdef DEBUG_TCE
158 fprintf(stderr, "spapr_iommu: New TCE table, liobn=0x%x, context @ %p, "
159 "table @ %p, fd=%d\n", liobn, &tcet->dma, tcet->table, tcet->fd);
160 #endif
162 QLIST_INSERT_HEAD(&spapr_tce_tables, tcet, list);
164 return &tcet->dma;
167 void spapr_tce_free(DMAContext *dma)
170 if (dma) {
171 sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, dma);
173 QLIST_REMOVE(tcet, list);
175 if (!kvm_enabled() ||
176 (kvmppc_remove_spapr_tce(tcet->table, tcet->fd,
177 tcet->window_size) != 0)) {
178 g_free(tcet->table);
181 g_free(tcet);
185 void spapr_tce_set_bypass(DMAContext *dma, bool bypass)
187 sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, dma);
189 tcet->bypass = bypass;
192 void spapr_tce_reset(DMAContext *dma)
194 sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, dma);
195 size_t table_size = (tcet->window_size >> SPAPR_TCE_PAGE_SHIFT)
196 * sizeof(sPAPRTCE);
198 tcet->bypass = false;
199 memset(tcet->table, 0, table_size);
202 static target_ulong put_tce_emu(sPAPRTCETable *tcet, target_ulong ioba,
203 target_ulong tce)
205 sPAPRTCE *tcep;
207 if (ioba >= tcet->window_size) {
208 hcall_dprintf("spapr_vio_put_tce on out-of-bounds IOBA 0x"
209 TARGET_FMT_lx "\n", ioba);
210 return H_PARAMETER;
213 tcep = tcet->table + (ioba >> SPAPR_TCE_PAGE_SHIFT);
214 tcep->tce = tce;
216 return H_SUCCESS;
219 static target_ulong h_put_tce(PowerPCCPU *cpu, sPAPREnvironment *spapr,
220 target_ulong opcode, target_ulong *args)
222 target_ulong liobn = args[0];
223 target_ulong ioba = args[1];
224 target_ulong tce = args[2];
225 sPAPRTCETable *tcet = spapr_tce_find_by_liobn(liobn);
227 ioba &= ~(SPAPR_TCE_PAGE_SIZE - 1);
229 if (tcet) {
230 return put_tce_emu(tcet, ioba, tce);
232 #ifdef DEBUG_TCE
233 fprintf(stderr, "%s on liobn=" TARGET_FMT_lx /*%s*/
234 " ioba 0x" TARGET_FMT_lx " TCE 0x" TARGET_FMT_lx "\n",
235 __func__, liobn, /*dev->qdev.id, */ioba, tce);
236 #endif
238 return H_PARAMETER;
241 void spapr_iommu_init(void)
243 QLIST_INIT(&spapr_tce_tables);
245 /* hcall-tce */
246 spapr_register_hypercall(H_PUT_TCE, h_put_tce);
249 int spapr_dma_dt(void *fdt, int node_off, const char *propname,
250 uint32_t liobn, uint64_t window, uint32_t size)
252 uint32_t dma_prop[5];
253 int ret;
255 dma_prop[0] = cpu_to_be32(liobn);
256 dma_prop[1] = cpu_to_be32(window >> 32);
257 dma_prop[2] = cpu_to_be32(window & 0xFFFFFFFF);
258 dma_prop[3] = 0; /* window size is 32 bits */
259 dma_prop[4] = cpu_to_be32(size);
261 ret = fdt_setprop_cell(fdt, node_off, "ibm,#dma-address-cells", 2);
262 if (ret < 0) {
263 return ret;
266 ret = fdt_setprop_cell(fdt, node_off, "ibm,#dma-size-cells", 2);
267 if (ret < 0) {
268 return ret;
271 ret = fdt_setprop(fdt, node_off, propname, dma_prop, sizeof(dma_prop));
272 if (ret < 0) {
273 return ret;
276 return 0;
279 int spapr_tcet_dma_dt(void *fdt, int node_off, const char *propname,
280 DMAContext *iommu)
282 if (!iommu) {
283 return 0;
286 if (iommu->translate == spapr_tce_translate) {
287 sPAPRTCETable *tcet = DO_UPCAST(sPAPRTCETable, dma, iommu);
288 return spapr_dma_dt(fdt, node_off, propname,
289 tcet->liobn, 0, tcet->window_size);
292 return -1;