Statistics
| Branch: | Revision:

root / hw / spapr_vio.c @ 5414dec6

History | View | Annotate | Download (22.7 kB)

1 4040ab72 David Gibson
/*
2 4040ab72 David Gibson
 * QEMU sPAPR VIO code
3 4040ab72 David Gibson
 *
4 4040ab72 David Gibson
 * Copyright (c) 2010 David Gibson, IBM Corporation <dwg@au1.ibm.com>
5 4040ab72 David Gibson
 * Based on the s390 virtio bus code:
6 4040ab72 David Gibson
 * Copyright (c) 2009 Alexander Graf <agraf@suse.de>
7 4040ab72 David Gibson
 *
8 4040ab72 David Gibson
 * This library is free software; you can redistribute it and/or
9 4040ab72 David Gibson
 * modify it under the terms of the GNU Lesser General Public
10 4040ab72 David Gibson
 * License as published by the Free Software Foundation; either
11 4040ab72 David Gibson
 * version 2 of the License, or (at your option) any later version.
12 4040ab72 David Gibson
 *
13 4040ab72 David Gibson
 * This library is distributed in the hope that it will be useful,
14 4040ab72 David Gibson
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 4040ab72 David Gibson
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16 4040ab72 David Gibson
 * Lesser General Public License for more details.
17 4040ab72 David Gibson
 *
18 4040ab72 David Gibson
 * You should have received a copy of the GNU Lesser General Public
19 4040ab72 David Gibson
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
20 4040ab72 David Gibson
 */
21 4040ab72 David Gibson
22 4040ab72 David Gibson
#include "hw.h"
23 4040ab72 David Gibson
#include "sysemu.h"
24 4040ab72 David Gibson
#include "boards.h"
25 4040ab72 David Gibson
#include "monitor.h"
26 4040ab72 David Gibson
#include "loader.h"
27 4040ab72 David Gibson
#include "elf.h"
28 4040ab72 David Gibson
#include "hw/sysbus.h"
29 4040ab72 David Gibson
#include "kvm.h"
30 4040ab72 David Gibson
#include "device_tree.h"
31 b45d63b6 Ben Herrenschmidt
#include "kvm_ppc.h"
32 4040ab72 David Gibson
33 4040ab72 David Gibson
#include "hw/spapr.h"
34 4040ab72 David Gibson
#include "hw/spapr_vio.h"
35 277f9acf Paolo Bonzini
#include "hw/xics.h"
36 4040ab72 David Gibson
37 4040ab72 David Gibson
#ifdef CONFIG_FDT
38 4040ab72 David Gibson
#include <libfdt.h>
39 4040ab72 David Gibson
#endif /* CONFIG_FDT */
40 4040ab72 David Gibson
41 4040ab72 David Gibson
/* #define DEBUG_SPAPR */
42 ee86dfee David Gibson
/* #define DEBUG_TCE */
43 4040ab72 David Gibson
44 4040ab72 David Gibson
#ifdef DEBUG_SPAPR
45 4040ab72 David Gibson
#define dprintf(fmt, ...) \
46 4040ab72 David Gibson
    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
47 4040ab72 David Gibson
#else
48 4040ab72 David Gibson
#define dprintf(fmt, ...) \
49 4040ab72 David Gibson
    do { } while (0)
50 4040ab72 David Gibson
#endif
51 4040ab72 David Gibson
52 4040ab72 David Gibson
static struct BusInfo spapr_vio_bus_info = {
53 4040ab72 David Gibson
    .name       = "spapr-vio",
54 4040ab72 David Gibson
    .size       = sizeof(VIOsPAPRBus),
55 416343b1 Paolo Bonzini
    .props = (Property[]) {
56 416343b1 Paolo Bonzini
        DEFINE_PROP_UINT32("irq", VIOsPAPRDevice, vio_irq_num, 0), \
57 416343b1 Paolo Bonzini
        DEFINE_PROP_END_OF_LIST(),
58 416343b1 Paolo Bonzini
    },
59 4040ab72 David Gibson
};
60 4040ab72 David Gibson
61 4040ab72 David Gibson
VIOsPAPRDevice *spapr_vio_find_by_reg(VIOsPAPRBus *bus, uint32_t reg)
62 4040ab72 David Gibson
{
63 4040ab72 David Gibson
    DeviceState *qdev;
64 4040ab72 David Gibson
    VIOsPAPRDevice *dev = NULL;
65 4040ab72 David Gibson
66 d8bb00d6 Paolo Bonzini
    QTAILQ_FOREACH(qdev, &bus->bus.children, sibling) {
67 4040ab72 David Gibson
        dev = (VIOsPAPRDevice *)qdev;
68 4040ab72 David Gibson
        if (dev->reg == reg) {
69 5435352c David Gibson
            return dev;
70 4040ab72 David Gibson
        }
71 4040ab72 David Gibson
    }
72 4040ab72 David Gibson
73 5435352c David Gibson
    return NULL;
74 4040ab72 David Gibson
}
75 4040ab72 David Gibson
76 1e34d859 Michael Ellerman
static char *vio_format_dev_name(VIOsPAPRDevice *dev)
77 1e34d859 Michael Ellerman
{
78 3954d33a Anthony Liguori
    VIOsPAPRDeviceClass *pc = VIO_SPAPR_DEVICE_GET_CLASS(dev);
79 1e34d859 Michael Ellerman
    char *name;
80 1e34d859 Michael Ellerman
81 1e34d859 Michael Ellerman
    /* Device tree style name device@reg */
82 3954d33a Anthony Liguori
    if (asprintf(&name, "%s@%x", pc->dt_name, dev->reg) < 0) {
83 1e34d859 Michael Ellerman
        return NULL;
84 1e34d859 Michael Ellerman
    }
85 1e34d859 Michael Ellerman
86 1e34d859 Michael Ellerman
    return name;
87 1e34d859 Michael Ellerman
}
88 1e34d859 Michael Ellerman
89 4040ab72 David Gibson
#ifdef CONFIG_FDT
90 4040ab72 David Gibson
static int vio_make_devnode(VIOsPAPRDevice *dev,
91 4040ab72 David Gibson
                            void *fdt)
92 4040ab72 David Gibson
{
93 3954d33a Anthony Liguori
    VIOsPAPRDeviceClass *pc = VIO_SPAPR_DEVICE_GET_CLASS(dev);
94 1e34d859 Michael Ellerman
    int vdevice_off, node_off, ret;
95 1e34d859 Michael Ellerman
    char *dt_name;
96 4040ab72 David Gibson
97 4040ab72 David Gibson
    vdevice_off = fdt_path_offset(fdt, "/vdevice");
98 4040ab72 David Gibson
    if (vdevice_off < 0) {
99 4040ab72 David Gibson
        return vdevice_off;
100 4040ab72 David Gibson
    }
101 4040ab72 David Gibson
102 1e34d859 Michael Ellerman
    dt_name = vio_format_dev_name(dev);
103 1e34d859 Michael Ellerman
    if (!dt_name) {
104 1e34d859 Michael Ellerman
        return -ENOMEM;
105 1e34d859 Michael Ellerman
    }
106 1e34d859 Michael Ellerman
107 1e34d859 Michael Ellerman
    node_off = fdt_add_subnode(fdt, vdevice_off, dt_name);
108 1e34d859 Michael Ellerman
    free(dt_name);
109 4040ab72 David Gibson
    if (node_off < 0) {
110 4040ab72 David Gibson
        return node_off;
111 4040ab72 David Gibson
    }
112 4040ab72 David Gibson
113 4040ab72 David Gibson
    ret = fdt_setprop_cell(fdt, node_off, "reg", dev->reg);
114 4040ab72 David Gibson
    if (ret < 0) {
115 4040ab72 David Gibson
        return ret;
116 4040ab72 David Gibson
    }
117 4040ab72 David Gibson
118 3954d33a Anthony Liguori
    if (pc->dt_type) {
119 4040ab72 David Gibson
        ret = fdt_setprop_string(fdt, node_off, "device_type",
120 3954d33a Anthony Liguori
                                 pc->dt_type);
121 4040ab72 David Gibson
        if (ret < 0) {
122 4040ab72 David Gibson
            return ret;
123 4040ab72 David Gibson
        }
124 4040ab72 David Gibson
    }
125 4040ab72 David Gibson
126 3954d33a Anthony Liguori
    if (pc->dt_compatible) {
127 4040ab72 David Gibson
        ret = fdt_setprop_string(fdt, node_off, "compatible",
128 3954d33a Anthony Liguori
                                 pc->dt_compatible);
129 4040ab72 David Gibson
        if (ret < 0) {
130 4040ab72 David Gibson
            return ret;
131 4040ab72 David Gibson
        }
132 4040ab72 David Gibson
    }
133 4040ab72 David Gibson
134 00dc738d David Gibson
    if (dev->qirq) {
135 00dc738d David Gibson
        uint32_t ints_prop[] = {cpu_to_be32(dev->vio_irq_num), 0};
136 00dc738d David Gibson
137 00dc738d David Gibson
        ret = fdt_setprop(fdt, node_off, "interrupts", ints_prop,
138 00dc738d David Gibson
                          sizeof(ints_prop));
139 00dc738d David Gibson
        if (ret < 0) {
140 00dc738d David Gibson
            return ret;
141 00dc738d David Gibson
        }
142 00dc738d David Gibson
    }
143 00dc738d David Gibson
144 ee86dfee David Gibson
    if (dev->rtce_window_size) {
145 ee86dfee David Gibson
        uint32_t dma_prop[] = {cpu_to_be32(dev->reg),
146 ee86dfee David Gibson
                               0, 0,
147 ee86dfee David Gibson
                               0, cpu_to_be32(dev->rtce_window_size)};
148 ee86dfee David Gibson
149 ee86dfee David Gibson
        ret = fdt_setprop_cell(fdt, node_off, "ibm,#dma-address-cells", 2);
150 ee86dfee David Gibson
        if (ret < 0) {
151 ee86dfee David Gibson
            return ret;
152 ee86dfee David Gibson
        }
153 ee86dfee David Gibson
154 ee86dfee David Gibson
        ret = fdt_setprop_cell(fdt, node_off, "ibm,#dma-size-cells", 2);
155 ee86dfee David Gibson
        if (ret < 0) {
156 ee86dfee David Gibson
            return ret;
157 ee86dfee David Gibson
        }
158 ee86dfee David Gibson
159 ee86dfee David Gibson
        ret = fdt_setprop(fdt, node_off, "ibm,my-dma-window", dma_prop,
160 ee86dfee David Gibson
                          sizeof(dma_prop));
161 ee86dfee David Gibson
        if (ret < 0) {
162 ee86dfee David Gibson
            return ret;
163 ee86dfee David Gibson
        }
164 ee86dfee David Gibson
    }
165 ee86dfee David Gibson
166 3954d33a Anthony Liguori
    if (pc->devnode) {
167 3954d33a Anthony Liguori
        ret = (pc->devnode)(dev, fdt, node_off);
168 4040ab72 David Gibson
        if (ret < 0) {
169 4040ab72 David Gibson
            return ret;
170 4040ab72 David Gibson
        }
171 4040ab72 David Gibson
    }
172 4040ab72 David Gibson
173 4040ab72 David Gibson
    return node_off;
174 4040ab72 David Gibson
}
175 4040ab72 David Gibson
#endif /* CONFIG_FDT */
176 4040ab72 David Gibson
177 ee86dfee David Gibson
/*
178 ee86dfee David Gibson
 * RTCE handling
179 ee86dfee David Gibson
 */
180 ee86dfee David Gibson
181 ee86dfee David Gibson
static void rtce_init(VIOsPAPRDevice *dev)
182 ee86dfee David Gibson
{
183 ee86dfee David Gibson
    size_t size = (dev->rtce_window_size >> SPAPR_VIO_TCE_PAGE_SHIFT)
184 ee86dfee David Gibson
        * sizeof(VIOsPAPR_RTCE);
185 ee86dfee David Gibson
186 ee86dfee David Gibson
    if (size) {
187 0f5cb298 David Gibson
        dev->rtce_table = kvmppc_create_spapr_tce(dev->reg,
188 0f5cb298 David Gibson
                                                  dev->rtce_window_size,
189 0f5cb298 David Gibson
                                                  &dev->kvmtce_fd);
190 0f5cb298 David Gibson
191 0f5cb298 David Gibson
        if (!dev->rtce_table) {
192 0f5cb298 David Gibson
            dev->rtce_table = g_malloc0(size);
193 0f5cb298 David Gibson
        }
194 ee86dfee David Gibson
    }
195 ee86dfee David Gibson
}
196 ee86dfee David Gibson
197 e2684c0b Andreas Färber
static target_ulong h_put_tce(CPUPPCState *env, sPAPREnvironment *spapr,
198 ee86dfee David Gibson
                              target_ulong opcode, target_ulong *args)
199 ee86dfee David Gibson
{
200 ee86dfee David Gibson
    target_ulong liobn = args[0];
201 ee86dfee David Gibson
    target_ulong ioba = args[1];
202 ee86dfee David Gibson
    target_ulong tce = args[2];
203 ee86dfee David Gibson
    VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, liobn);
204 ee86dfee David Gibson
    VIOsPAPR_RTCE *rtce;
205 ee86dfee David Gibson
206 ee86dfee David Gibson
    if (!dev) {
207 d9599c92 David Gibson
        hcall_dprintf("LIOBN 0x" TARGET_FMT_lx " does not exist\n", liobn);
208 ee86dfee David Gibson
        return H_PARAMETER;
209 ee86dfee David Gibson
    }
210 ee86dfee David Gibson
211 ee86dfee David Gibson
    ioba &= ~(SPAPR_VIO_TCE_PAGE_SIZE - 1);
212 ee86dfee David Gibson
213 ee86dfee David Gibson
#ifdef DEBUG_TCE
214 ee86dfee David Gibson
    fprintf(stderr, "spapr_vio_put_tce on %s  ioba 0x" TARGET_FMT_lx
215 ee86dfee David Gibson
            "  TCE 0x" TARGET_FMT_lx "\n", dev->qdev.id, ioba, tce);
216 ee86dfee David Gibson
#endif
217 ee86dfee David Gibson
218 ee86dfee David Gibson
    if (ioba >= dev->rtce_window_size) {
219 d9599c92 David Gibson
        hcall_dprintf("Out-of-bounds IOBA 0x" TARGET_FMT_lx "\n", ioba);
220 ee86dfee David Gibson
        return H_PARAMETER;
221 ee86dfee David Gibson
    }
222 ee86dfee David Gibson
223 ee86dfee David Gibson
    rtce = dev->rtce_table + (ioba >> SPAPR_VIO_TCE_PAGE_SHIFT);
224 ee86dfee David Gibson
    rtce->tce = tce;
225 ee86dfee David Gibson
226 ee86dfee David Gibson
    return H_SUCCESS;
227 ee86dfee David Gibson
}
228 ee86dfee David Gibson
229 ee86dfee David Gibson
int spapr_vio_check_tces(VIOsPAPRDevice *dev, target_ulong ioba,
230 ee86dfee David Gibson
                         target_ulong len, enum VIOsPAPR_TCEAccess access)
231 ee86dfee David Gibson
{
232 ee86dfee David Gibson
    int start, end, i;
233 ee86dfee David Gibson
234 ee86dfee David Gibson
    start = ioba >> SPAPR_VIO_TCE_PAGE_SHIFT;
235 ee86dfee David Gibson
    end = (ioba + len - 1) >> SPAPR_VIO_TCE_PAGE_SHIFT;
236 ee86dfee David Gibson
237 ee86dfee David Gibson
    for (i = start; i <= end; i++) {
238 ee86dfee David Gibson
        if ((dev->rtce_table[i].tce & access) != access) {
239 ee86dfee David Gibson
#ifdef DEBUG_TCE
240 ee86dfee David Gibson
            fprintf(stderr, "FAIL on %d\n", i);
241 ee86dfee David Gibson
#endif
242 ee86dfee David Gibson
            return -1;
243 ee86dfee David Gibson
        }
244 ee86dfee David Gibson
    }
245 ee86dfee David Gibson
246 ee86dfee David Gibson
    return 0;
247 ee86dfee David Gibson
}
248 ee86dfee David Gibson
249 ee86dfee David Gibson
int spapr_tce_dma_write(VIOsPAPRDevice *dev, uint64_t taddr, const void *buf,
250 ee86dfee David Gibson
                        uint32_t size)
251 ee86dfee David Gibson
{
252 ee86dfee David Gibson
#ifdef DEBUG_TCE
253 ee86dfee David Gibson
    fprintf(stderr, "spapr_tce_dma_write taddr=0x%llx size=0x%x\n",
254 ee86dfee David Gibson
            (unsigned long long)taddr, size);
255 ee86dfee David Gibson
#endif
256 ee86dfee David Gibson
257 08942ac1 Ben Herrenschmidt
    /* Check for bypass */
258 08942ac1 Ben Herrenschmidt
    if (dev->flags & VIO_PAPR_FLAG_DMA_BYPASS) {
259 08942ac1 Ben Herrenschmidt
        cpu_physical_memory_write(taddr, buf, size);
260 08942ac1 Ben Herrenschmidt
        return 0;
261 08942ac1 Ben Herrenschmidt
    }
262 08942ac1 Ben Herrenschmidt
263 ee86dfee David Gibson
    while (size) {
264 ee86dfee David Gibson
        uint64_t tce;
265 ee86dfee David Gibson
        uint32_t lsize;
266 ee86dfee David Gibson
        uint64_t txaddr;
267 ee86dfee David Gibson
268 ee86dfee David Gibson
        /* Check if we are in bound */
269 ee86dfee David Gibson
        if (taddr >= dev->rtce_window_size) {
270 ee86dfee David Gibson
#ifdef DEBUG_TCE
271 ee86dfee David Gibson
            fprintf(stderr, "spapr_tce_dma_write out of bounds\n");
272 ee86dfee David Gibson
#endif
273 ee86dfee David Gibson
            return H_DEST_PARM;
274 ee86dfee David Gibson
        }
275 ee86dfee David Gibson
        tce = dev->rtce_table[taddr >> SPAPR_VIO_TCE_PAGE_SHIFT].tce;
276 ee86dfee David Gibson
277 ee86dfee David Gibson
        /* How much til end of page ? */
278 ee86dfee David Gibson
        lsize = MIN(size, ((~taddr) & SPAPR_VIO_TCE_PAGE_MASK) + 1);
279 ee86dfee David Gibson
280 ee86dfee David Gibson
        /* Check TCE */
281 ee86dfee David Gibson
        if (!(tce & 2)) {
282 ee86dfee David Gibson
            return H_DEST_PARM;
283 ee86dfee David Gibson
        }
284 ee86dfee David Gibson
285 ee86dfee David Gibson
        /* Translate */
286 ee86dfee David Gibson
        txaddr = (tce & ~SPAPR_VIO_TCE_PAGE_MASK) |
287 ee86dfee David Gibson
            (taddr & SPAPR_VIO_TCE_PAGE_MASK);
288 ee86dfee David Gibson
289 ee86dfee David Gibson
#ifdef DEBUG_TCE
290 ee86dfee David Gibson
        fprintf(stderr, " -> write to txaddr=0x%llx, size=0x%x\n",
291 ee86dfee David Gibson
                (unsigned long long)txaddr, lsize);
292 ee86dfee David Gibson
#endif
293 ee86dfee David Gibson
294 ee86dfee David Gibson
        /* Do it */
295 ee86dfee David Gibson
        cpu_physical_memory_write(txaddr, buf, lsize);
296 ee86dfee David Gibson
        buf += lsize;
297 ee86dfee David Gibson
        taddr += lsize;
298 ee86dfee David Gibson
        size -= lsize;
299 ee86dfee David Gibson
    }
300 ee86dfee David Gibson
    return 0;
301 ee86dfee David Gibson
}
302 ee86dfee David Gibson
303 ee86dfee David Gibson
int spapr_tce_dma_zero(VIOsPAPRDevice *dev, uint64_t taddr, uint32_t size)
304 ee86dfee David Gibson
{
305 ee86dfee David Gibson
    /* FIXME: allocating a temp buffer is nasty, but just stepping
306 ee86dfee David Gibson
     * through writing zeroes is awkward.  This will do for now. */
307 ee86dfee David Gibson
    uint8_t zeroes[size];
308 ee86dfee David Gibson
309 ee86dfee David Gibson
#ifdef DEBUG_TCE
310 ee86dfee David Gibson
    fprintf(stderr, "spapr_tce_dma_zero taddr=0x%llx size=0x%x\n",
311 ee86dfee David Gibson
            (unsigned long long)taddr, size);
312 ee86dfee David Gibson
#endif
313 ee86dfee David Gibson
314 ee86dfee David Gibson
    memset(zeroes, 0, size);
315 ee86dfee David Gibson
    return spapr_tce_dma_write(dev, taddr, zeroes, size);
316 ee86dfee David Gibson
}
317 ee86dfee David Gibson
318 ee86dfee David Gibson
void stb_tce(VIOsPAPRDevice *dev, uint64_t taddr, uint8_t val)
319 ee86dfee David Gibson
{
320 ee86dfee David Gibson
    spapr_tce_dma_write(dev, taddr, &val, sizeof(val));
321 ee86dfee David Gibson
}
322 ee86dfee David Gibson
323 ee86dfee David Gibson
void sth_tce(VIOsPAPRDevice *dev, uint64_t taddr, uint16_t val)
324 ee86dfee David Gibson
{
325 ee86dfee David Gibson
    val = tswap16(val);
326 ee86dfee David Gibson
    spapr_tce_dma_write(dev, taddr, &val, sizeof(val));
327 ee86dfee David Gibson
}
328 ee86dfee David Gibson
329 ee86dfee David Gibson
330 ee86dfee David Gibson
void stw_tce(VIOsPAPRDevice *dev, uint64_t taddr, uint32_t val)
331 ee86dfee David Gibson
{
332 ee86dfee David Gibson
    val = tswap32(val);
333 ee86dfee David Gibson
    spapr_tce_dma_write(dev, taddr, &val, sizeof(val));
334 ee86dfee David Gibson
}
335 ee86dfee David Gibson
336 ee86dfee David Gibson
void stq_tce(VIOsPAPRDevice *dev, uint64_t taddr, uint64_t val)
337 ee86dfee David Gibson
{
338 ee86dfee David Gibson
    val = tswap64(val);
339 ee86dfee David Gibson
    spapr_tce_dma_write(dev, taddr, &val, sizeof(val));
340 ee86dfee David Gibson
}
341 ee86dfee David Gibson
342 ee86dfee David Gibson
int spapr_tce_dma_read(VIOsPAPRDevice *dev, uint64_t taddr, void *buf,
343 ee86dfee David Gibson
                       uint32_t size)
344 ee86dfee David Gibson
{
345 ee86dfee David Gibson
#ifdef DEBUG_TCE
346 ee86dfee David Gibson
    fprintf(stderr, "spapr_tce_dma_write taddr=0x%llx size=0x%x\n",
347 ee86dfee David Gibson
            (unsigned long long)taddr, size);
348 ee86dfee David Gibson
#endif
349 ee86dfee David Gibson
350 08942ac1 Ben Herrenschmidt
    /* Check for bypass */
351 08942ac1 Ben Herrenschmidt
    if (dev->flags & VIO_PAPR_FLAG_DMA_BYPASS) {
352 08942ac1 Ben Herrenschmidt
        cpu_physical_memory_read(taddr, buf, size);
353 08942ac1 Ben Herrenschmidt
        return 0;
354 08942ac1 Ben Herrenschmidt
    }
355 08942ac1 Ben Herrenschmidt
356 ee86dfee David Gibson
    while (size) {
357 ee86dfee David Gibson
        uint64_t tce;
358 ee86dfee David Gibson
        uint32_t lsize;
359 ee86dfee David Gibson
        uint64_t txaddr;
360 ee86dfee David Gibson
361 ee86dfee David Gibson
        /* Check if we are in bound */
362 ee86dfee David Gibson
        if (taddr >= dev->rtce_window_size) {
363 ee86dfee David Gibson
#ifdef DEBUG_TCE
364 ee86dfee David Gibson
            fprintf(stderr, "spapr_tce_dma_read out of bounds\n");
365 ee86dfee David Gibson
#endif
366 ee86dfee David Gibson
            return H_DEST_PARM;
367 ee86dfee David Gibson
        }
368 ee86dfee David Gibson
        tce = dev->rtce_table[taddr >> SPAPR_VIO_TCE_PAGE_SHIFT].tce;
369 ee86dfee David Gibson
370 ee86dfee David Gibson
        /* How much til end of page ? */
371 ee86dfee David Gibson
        lsize = MIN(size, ((~taddr) & SPAPR_VIO_TCE_PAGE_MASK) + 1);
372 ee86dfee David Gibson
373 ee86dfee David Gibson
        /* Check TCE */
374 ee86dfee David Gibson
        if (!(tce & 1)) {
375 ee86dfee David Gibson
            return H_DEST_PARM;
376 ee86dfee David Gibson
        }
377 ee86dfee David Gibson
378 ee86dfee David Gibson
        /* Translate */
379 ee86dfee David Gibson
        txaddr = (tce & ~SPAPR_VIO_TCE_PAGE_MASK) |
380 ee86dfee David Gibson
            (taddr & SPAPR_VIO_TCE_PAGE_MASK);
381 ee86dfee David Gibson
382 ee86dfee David Gibson
#ifdef DEBUG_TCE
383 ee86dfee David Gibson
        fprintf(stderr, " -> write to txaddr=0x%llx, size=0x%x\n",
384 ee86dfee David Gibson
                (unsigned long long)txaddr, lsize);
385 ee86dfee David Gibson
#endif
386 ee86dfee David Gibson
        /* Do it */
387 ee86dfee David Gibson
        cpu_physical_memory_read(txaddr, buf, lsize);
388 ee86dfee David Gibson
        buf += lsize;
389 ee86dfee David Gibson
        taddr += lsize;
390 ee86dfee David Gibson
        size -= lsize;
391 ee86dfee David Gibson
    }
392 ee86dfee David Gibson
    return H_SUCCESS;
393 ee86dfee David Gibson
}
394 ee86dfee David Gibson
395 ee86dfee David Gibson
uint64_t ldq_tce(VIOsPAPRDevice *dev, uint64_t taddr)
396 ee86dfee David Gibson
{
397 ee86dfee David Gibson
    uint64_t val;
398 ee86dfee David Gibson
399 ee86dfee David Gibson
    spapr_tce_dma_read(dev, taddr, &val, sizeof(val));
400 ee86dfee David Gibson
    return tswap64(val);
401 ee86dfee David Gibson
}
402 ee86dfee David Gibson
403 b45d63b6 Ben Herrenschmidt
/*
404 b45d63b6 Ben Herrenschmidt
 * CRQ handling
405 b45d63b6 Ben Herrenschmidt
 */
406 e2684c0b Andreas Färber
static target_ulong h_reg_crq(CPUPPCState *env, sPAPREnvironment *spapr,
407 b45d63b6 Ben Herrenschmidt
                              target_ulong opcode, target_ulong *args)
408 b45d63b6 Ben Herrenschmidt
{
409 b45d63b6 Ben Herrenschmidt
    target_ulong reg = args[0];
410 b45d63b6 Ben Herrenschmidt
    target_ulong queue_addr = args[1];
411 b45d63b6 Ben Herrenschmidt
    target_ulong queue_len = args[2];
412 b45d63b6 Ben Herrenschmidt
    VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
413 b45d63b6 Ben Herrenschmidt
414 b45d63b6 Ben Herrenschmidt
    if (!dev) {
415 d9599c92 David Gibson
        hcall_dprintf("Unit 0x" TARGET_FMT_lx " does not exist\n", reg);
416 b45d63b6 Ben Herrenschmidt
        return H_PARAMETER;
417 b45d63b6 Ben Herrenschmidt
    }
418 b45d63b6 Ben Herrenschmidt
419 b45d63b6 Ben Herrenschmidt
    /* We can't grok a queue size bigger than 256M for now */
420 b45d63b6 Ben Herrenschmidt
    if (queue_len < 0x1000 || queue_len > 0x10000000) {
421 d9599c92 David Gibson
        hcall_dprintf("Queue size too small or too big (0x" TARGET_FMT_lx
422 d9599c92 David Gibson
                      ")\n", queue_len);
423 b45d63b6 Ben Herrenschmidt
        return H_PARAMETER;
424 b45d63b6 Ben Herrenschmidt
    }
425 b45d63b6 Ben Herrenschmidt
426 b45d63b6 Ben Herrenschmidt
    /* Check queue alignment */
427 b45d63b6 Ben Herrenschmidt
    if (queue_addr & 0xfff) {
428 d9599c92 David Gibson
        hcall_dprintf("Queue not aligned (0x" TARGET_FMT_lx ")\n", queue_addr);
429 b45d63b6 Ben Herrenschmidt
        return H_PARAMETER;
430 b45d63b6 Ben Herrenschmidt
    }
431 b45d63b6 Ben Herrenschmidt
432 b45d63b6 Ben Herrenschmidt
    /* Check if device supports CRQs */
433 b45d63b6 Ben Herrenschmidt
    if (!dev->crq.SendFunc) {
434 8e01f355 David Gibson
        hcall_dprintf("Device does not support CRQ\n");
435 b45d63b6 Ben Herrenschmidt
        return H_NOT_FOUND;
436 b45d63b6 Ben Herrenschmidt
    }
437 b45d63b6 Ben Herrenschmidt
438 b45d63b6 Ben Herrenschmidt
    /* Already a queue ? */
439 b45d63b6 Ben Herrenschmidt
    if (dev->crq.qsize) {
440 8e01f355 David Gibson
        hcall_dprintf("CRQ already registered\n");
441 b45d63b6 Ben Herrenschmidt
        return H_RESOURCE;
442 b45d63b6 Ben Herrenschmidt
    }
443 b45d63b6 Ben Herrenschmidt
    dev->crq.qladdr = queue_addr;
444 b45d63b6 Ben Herrenschmidt
    dev->crq.qsize = queue_len;
445 b45d63b6 Ben Herrenschmidt
    dev->crq.qnext = 0;
446 b45d63b6 Ben Herrenschmidt
447 b45d63b6 Ben Herrenschmidt
    dprintf("CRQ for dev 0x" TARGET_FMT_lx " registered at 0x"
448 b45d63b6 Ben Herrenschmidt
            TARGET_FMT_lx "/0x" TARGET_FMT_lx "\n",
449 b45d63b6 Ben Herrenschmidt
            reg, queue_addr, queue_len);
450 b45d63b6 Ben Herrenschmidt
    return H_SUCCESS;
451 b45d63b6 Ben Herrenschmidt
}
452 b45d63b6 Ben Herrenschmidt
453 8e01f355 David Gibson
static target_ulong free_crq(VIOsPAPRDevice *dev)
454 8e01f355 David Gibson
{
455 8e01f355 David Gibson
    dev->crq.qladdr = 0;
456 8e01f355 David Gibson
    dev->crq.qsize = 0;
457 8e01f355 David Gibson
    dev->crq.qnext = 0;
458 8e01f355 David Gibson
459 8e01f355 David Gibson
    dprintf("CRQ for dev 0x%" PRIx32 " freed\n", dev->reg);
460 8e01f355 David Gibson
461 8e01f355 David Gibson
    return H_SUCCESS;
462 8e01f355 David Gibson
}
463 8e01f355 David Gibson
464 e2684c0b Andreas Färber
static target_ulong h_free_crq(CPUPPCState *env, sPAPREnvironment *spapr,
465 b45d63b6 Ben Herrenschmidt
                               target_ulong opcode, target_ulong *args)
466 b45d63b6 Ben Herrenschmidt
{
467 b45d63b6 Ben Herrenschmidt
    target_ulong reg = args[0];
468 b45d63b6 Ben Herrenschmidt
    VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
469 b45d63b6 Ben Herrenschmidt
470 b45d63b6 Ben Herrenschmidt
    if (!dev) {
471 d9599c92 David Gibson
        hcall_dprintf("Unit 0x" TARGET_FMT_lx " does not exist\n", reg);
472 b45d63b6 Ben Herrenschmidt
        return H_PARAMETER;
473 b45d63b6 Ben Herrenschmidt
    }
474 b45d63b6 Ben Herrenschmidt
475 8e01f355 David Gibson
    return free_crq(dev);
476 b45d63b6 Ben Herrenschmidt
}
477 b45d63b6 Ben Herrenschmidt
478 e2684c0b Andreas Färber
static target_ulong h_send_crq(CPUPPCState *env, sPAPREnvironment *spapr,
479 b45d63b6 Ben Herrenschmidt
                               target_ulong opcode, target_ulong *args)
480 b45d63b6 Ben Herrenschmidt
{
481 b45d63b6 Ben Herrenschmidt
    target_ulong reg = args[0];
482 b45d63b6 Ben Herrenschmidt
    target_ulong msg_hi = args[1];
483 b45d63b6 Ben Herrenschmidt
    target_ulong msg_lo = args[2];
484 b45d63b6 Ben Herrenschmidt
    VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
485 b45d63b6 Ben Herrenschmidt
    uint64_t crq_mangle[2];
486 b45d63b6 Ben Herrenschmidt
487 b45d63b6 Ben Herrenschmidt
    if (!dev) {
488 d9599c92 David Gibson
        hcall_dprintf("Unit 0x" TARGET_FMT_lx " does not exist\n", reg);
489 b45d63b6 Ben Herrenschmidt
        return H_PARAMETER;
490 b45d63b6 Ben Herrenschmidt
    }
491 b45d63b6 Ben Herrenschmidt
    crq_mangle[0] = cpu_to_be64(msg_hi);
492 b45d63b6 Ben Herrenschmidt
    crq_mangle[1] = cpu_to_be64(msg_lo);
493 b45d63b6 Ben Herrenschmidt
494 b45d63b6 Ben Herrenschmidt
    if (dev->crq.SendFunc) {
495 b45d63b6 Ben Herrenschmidt
        return dev->crq.SendFunc(dev, (uint8_t *)crq_mangle);
496 b45d63b6 Ben Herrenschmidt
    }
497 b45d63b6 Ben Herrenschmidt
498 b45d63b6 Ben Herrenschmidt
    return H_HARDWARE;
499 b45d63b6 Ben Herrenschmidt
}
500 b45d63b6 Ben Herrenschmidt
501 e2684c0b Andreas Färber
static target_ulong h_enable_crq(CPUPPCState *env, sPAPREnvironment *spapr,
502 b45d63b6 Ben Herrenschmidt
                                 target_ulong opcode, target_ulong *args)
503 b45d63b6 Ben Herrenschmidt
{
504 b45d63b6 Ben Herrenschmidt
    target_ulong reg = args[0];
505 b45d63b6 Ben Herrenschmidt
    VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
506 b45d63b6 Ben Herrenschmidt
507 b45d63b6 Ben Herrenschmidt
    if (!dev) {
508 d9599c92 David Gibson
        hcall_dprintf("Unit 0x" TARGET_FMT_lx " does not exist\n", reg);
509 b45d63b6 Ben Herrenschmidt
        return H_PARAMETER;
510 b45d63b6 Ben Herrenschmidt
    }
511 b45d63b6 Ben Herrenschmidt
512 b45d63b6 Ben Herrenschmidt
    return 0;
513 b45d63b6 Ben Herrenschmidt
}
514 b45d63b6 Ben Herrenschmidt
515 b45d63b6 Ben Herrenschmidt
/* Returns negative error, 0 success, or positive: queue full */
516 b45d63b6 Ben Herrenschmidt
int spapr_vio_send_crq(VIOsPAPRDevice *dev, uint8_t *crq)
517 b45d63b6 Ben Herrenschmidt
{
518 b45d63b6 Ben Herrenschmidt
    int rc;
519 b45d63b6 Ben Herrenschmidt
    uint8_t byte;
520 b45d63b6 Ben Herrenschmidt
521 b45d63b6 Ben Herrenschmidt
    if (!dev->crq.qsize) {
522 b45d63b6 Ben Herrenschmidt
        fprintf(stderr, "spapr_vio_send_creq on uninitialized queue\n");
523 b45d63b6 Ben Herrenschmidt
        return -1;
524 b45d63b6 Ben Herrenschmidt
    }
525 b45d63b6 Ben Herrenschmidt
526 b45d63b6 Ben Herrenschmidt
    /* Maybe do a fast path for KVM just writing to the pages */
527 b45d63b6 Ben Herrenschmidt
    rc = spapr_tce_dma_read(dev, dev->crq.qladdr + dev->crq.qnext, &byte, 1);
528 b45d63b6 Ben Herrenschmidt
    if (rc) {
529 b45d63b6 Ben Herrenschmidt
        return rc;
530 b45d63b6 Ben Herrenschmidt
    }
531 b45d63b6 Ben Herrenschmidt
    if (byte != 0) {
532 b45d63b6 Ben Herrenschmidt
        return 1;
533 b45d63b6 Ben Herrenschmidt
    }
534 b45d63b6 Ben Herrenschmidt
535 b45d63b6 Ben Herrenschmidt
    rc = spapr_tce_dma_write(dev, dev->crq.qladdr + dev->crq.qnext + 8,
536 b45d63b6 Ben Herrenschmidt
                             &crq[8], 8);
537 b45d63b6 Ben Herrenschmidt
    if (rc) {
538 b45d63b6 Ben Herrenschmidt
        return rc;
539 b45d63b6 Ben Herrenschmidt
    }
540 b45d63b6 Ben Herrenschmidt
541 b45d63b6 Ben Herrenschmidt
    kvmppc_eieio();
542 b45d63b6 Ben Herrenschmidt
543 b45d63b6 Ben Herrenschmidt
    rc = spapr_tce_dma_write(dev, dev->crq.qladdr + dev->crq.qnext, crq, 8);
544 b45d63b6 Ben Herrenschmidt
    if (rc) {
545 b45d63b6 Ben Herrenschmidt
        return rc;
546 b45d63b6 Ben Herrenschmidt
    }
547 b45d63b6 Ben Herrenschmidt
548 b45d63b6 Ben Herrenschmidt
    dev->crq.qnext = (dev->crq.qnext + 16) % dev->crq.qsize;
549 b45d63b6 Ben Herrenschmidt
550 b45d63b6 Ben Herrenschmidt
    if (dev->signal_state & 1) {
551 b45d63b6 Ben Herrenschmidt
        qemu_irq_pulse(dev->qirq);
552 b45d63b6 Ben Herrenschmidt
    }
553 b45d63b6 Ben Herrenschmidt
554 b45d63b6 Ben Herrenschmidt
    return 0;
555 b45d63b6 Ben Herrenschmidt
}
556 b45d63b6 Ben Herrenschmidt
557 08942ac1 Ben Herrenschmidt
/* "quiesce" handling */
558 08942ac1 Ben Herrenschmidt
559 08942ac1 Ben Herrenschmidt
static void spapr_vio_quiesce_one(VIOsPAPRDevice *dev)
560 08942ac1 Ben Herrenschmidt
{
561 08942ac1 Ben Herrenschmidt
    dev->flags &= ~VIO_PAPR_FLAG_DMA_BYPASS;
562 08942ac1 Ben Herrenschmidt
563 08942ac1 Ben Herrenschmidt
    if (dev->rtce_table) {
564 08942ac1 Ben Herrenschmidt
        size_t size = (dev->rtce_window_size >> SPAPR_VIO_TCE_PAGE_SHIFT)
565 08942ac1 Ben Herrenschmidt
            * sizeof(VIOsPAPR_RTCE);
566 08942ac1 Ben Herrenschmidt
        memset(dev->rtce_table, 0, size);
567 08942ac1 Ben Herrenschmidt
    }
568 08942ac1 Ben Herrenschmidt
569 08942ac1 Ben Herrenschmidt
    dev->crq.qladdr = 0;
570 08942ac1 Ben Herrenschmidt
    dev->crq.qsize = 0;
571 08942ac1 Ben Herrenschmidt
    dev->crq.qnext = 0;
572 08942ac1 Ben Herrenschmidt
}
573 08942ac1 Ben Herrenschmidt
574 08942ac1 Ben Herrenschmidt
static void rtas_set_tce_bypass(sPAPREnvironment *spapr, uint32_t token,
575 08942ac1 Ben Herrenschmidt
                                uint32_t nargs, target_ulong args,
576 08942ac1 Ben Herrenschmidt
                                uint32_t nret, target_ulong rets)
577 08942ac1 Ben Herrenschmidt
{
578 08942ac1 Ben Herrenschmidt
    VIOsPAPRBus *bus = spapr->vio_bus;
579 08942ac1 Ben Herrenschmidt
    VIOsPAPRDevice *dev;
580 08942ac1 Ben Herrenschmidt
    uint32_t unit, enable;
581 08942ac1 Ben Herrenschmidt
582 08942ac1 Ben Herrenschmidt
    if (nargs != 2) {
583 08942ac1 Ben Herrenschmidt
        rtas_st(rets, 0, -3);
584 08942ac1 Ben Herrenschmidt
        return;
585 08942ac1 Ben Herrenschmidt
    }
586 08942ac1 Ben Herrenschmidt
    unit = rtas_ld(args, 0);
587 08942ac1 Ben Herrenschmidt
    enable = rtas_ld(args, 1);
588 08942ac1 Ben Herrenschmidt
    dev = spapr_vio_find_by_reg(bus, unit);
589 08942ac1 Ben Herrenschmidt
    if (!dev) {
590 08942ac1 Ben Herrenschmidt
        rtas_st(rets, 0, -3);
591 08942ac1 Ben Herrenschmidt
        return;
592 08942ac1 Ben Herrenschmidt
    }
593 08942ac1 Ben Herrenschmidt
    if (enable) {
594 08942ac1 Ben Herrenschmidt
        dev->flags |= VIO_PAPR_FLAG_DMA_BYPASS;
595 08942ac1 Ben Herrenschmidt
    } else {
596 08942ac1 Ben Herrenschmidt
        dev->flags &= ~VIO_PAPR_FLAG_DMA_BYPASS;
597 08942ac1 Ben Herrenschmidt
    }
598 08942ac1 Ben Herrenschmidt
599 08942ac1 Ben Herrenschmidt
    rtas_st(rets, 0, 0);
600 08942ac1 Ben Herrenschmidt
}
601 08942ac1 Ben Herrenschmidt
602 08942ac1 Ben Herrenschmidt
static void rtas_quiesce(sPAPREnvironment *spapr, uint32_t token,
603 08942ac1 Ben Herrenschmidt
                         uint32_t nargs, target_ulong args,
604 08942ac1 Ben Herrenschmidt
                         uint32_t nret, target_ulong rets)
605 08942ac1 Ben Herrenschmidt
{
606 08942ac1 Ben Herrenschmidt
    VIOsPAPRBus *bus = spapr->vio_bus;
607 08942ac1 Ben Herrenschmidt
    DeviceState *qdev;
608 08942ac1 Ben Herrenschmidt
    VIOsPAPRDevice *dev = NULL;
609 08942ac1 Ben Herrenschmidt
610 08942ac1 Ben Herrenschmidt
    if (nargs != 0) {
611 08942ac1 Ben Herrenschmidt
        rtas_st(rets, 0, -3);
612 08942ac1 Ben Herrenschmidt
        return;
613 08942ac1 Ben Herrenschmidt
    }
614 08942ac1 Ben Herrenschmidt
615 d8bb00d6 Paolo Bonzini
    QTAILQ_FOREACH(qdev, &bus->bus.children, sibling) {
616 08942ac1 Ben Herrenschmidt
        dev = (VIOsPAPRDevice *)qdev;
617 08942ac1 Ben Herrenschmidt
        spapr_vio_quiesce_one(dev);
618 08942ac1 Ben Herrenschmidt
    }
619 08942ac1 Ben Herrenschmidt
620 08942ac1 Ben Herrenschmidt
    rtas_st(rets, 0, 0);
621 08942ac1 Ben Herrenschmidt
}
622 08942ac1 Ben Herrenschmidt
623 d601fac4 David Gibson
static VIOsPAPRDevice *reg_conflict(VIOsPAPRDevice *dev)
624 9fc380d3 Michael Ellerman
{
625 d601fac4 David Gibson
    VIOsPAPRBus *bus = DO_UPCAST(VIOsPAPRBus, bus, dev->qdev.parent_bus);
626 9fc380d3 Michael Ellerman
    DeviceState *qdev;
627 d601fac4 David Gibson
    VIOsPAPRDevice *other;
628 9fc380d3 Michael Ellerman
629 9fc380d3 Michael Ellerman
    /*
630 d601fac4 David Gibson
     * Check for a device other than the given one which is already
631 d601fac4 David Gibson
     * using the requested address. We have to open code this because
632 d601fac4 David Gibson
     * the given dev might already be in the list.
633 9fc380d3 Michael Ellerman
     */
634 d601fac4 David Gibson
    QTAILQ_FOREACH(qdev, &bus->bus.children, sibling) {
635 d601fac4 David Gibson
        other = DO_UPCAST(VIOsPAPRDevice, qdev, qdev);
636 9fc380d3 Michael Ellerman
637 d601fac4 David Gibson
        if (other != dev && other->reg == dev->reg) {
638 d601fac4 David Gibson
            return other;
639 9fc380d3 Michael Ellerman
        }
640 9fc380d3 Michael Ellerman
    }
641 9fc380d3 Michael Ellerman
642 9fc380d3 Michael Ellerman
    return 0;
643 9fc380d3 Michael Ellerman
}
644 9fc380d3 Michael Ellerman
645 b1c7f725 David Gibson
static void spapr_vio_busdev_reset(DeviceState *qdev)
646 8e01f355 David Gibson
{
647 b1c7f725 David Gibson
    VIOsPAPRDevice *dev = DO_UPCAST(VIOsPAPRDevice, qdev, qdev);
648 b1c7f725 David Gibson
    VIOsPAPRDeviceClass *pc = VIO_SPAPR_DEVICE_GET_CLASS(dev);
649 8e01f355 David Gibson
650 8e01f355 David Gibson
    if (dev->crq.qsize) {
651 8e01f355 David Gibson
        free_crq(dev);
652 8e01f355 David Gibson
    }
653 b1c7f725 David Gibson
654 b1c7f725 David Gibson
    if (pc->reset) {
655 b1c7f725 David Gibson
        pc->reset(dev);
656 b1c7f725 David Gibson
    }
657 8e01f355 David Gibson
}
658 8e01f355 David Gibson
659 d307af79 Anthony Liguori
static int spapr_vio_busdev_init(DeviceState *qdev)
660 4040ab72 David Gibson
{
661 4040ab72 David Gibson
    VIOsPAPRDevice *dev = (VIOsPAPRDevice *)qdev;
662 3954d33a Anthony Liguori
    VIOsPAPRDeviceClass *pc = VIO_SPAPR_DEVICE_GET_CLASS(dev);
663 4040ab72 David Gibson
    char *id;
664 9fc380d3 Michael Ellerman
665 d601fac4 David Gibson
    if (dev->reg != -1) {
666 d601fac4 David Gibson
        /*
667 d601fac4 David Gibson
         * Explicitly assigned address, just verify that no-one else
668 d601fac4 David Gibson
         * is using it.  other mechanism). We have to open code this
669 d601fac4 David Gibson
         * rather than using spapr_vio_find_by_reg() because sdev
670 d601fac4 David Gibson
         * itself is already in the list.
671 d601fac4 David Gibson
         */
672 d601fac4 David Gibson
        VIOsPAPRDevice *other = reg_conflict(dev);
673 d601fac4 David Gibson
674 d601fac4 David Gibson
        if (other) {
675 d601fac4 David Gibson
            fprintf(stderr, "vio: %s and %s devices conflict at address %#x\n",
676 d601fac4 David Gibson
                    object_get_typename(OBJECT(qdev)),
677 d601fac4 David Gibson
                    object_get_typename(OBJECT(&other->qdev)),
678 d601fac4 David Gibson
                    dev->reg);
679 d601fac4 David Gibson
            return -1;
680 d601fac4 David Gibson
        }
681 d601fac4 David Gibson
    } else {
682 d601fac4 David Gibson
        /* Need to assign an address */
683 d601fac4 David Gibson
        VIOsPAPRBus *bus = DO_UPCAST(VIOsPAPRBus, bus, dev->qdev.parent_bus);
684 d601fac4 David Gibson
685 d601fac4 David Gibson
        do {
686 d601fac4 David Gibson
            dev->reg = bus->next_reg++;
687 d601fac4 David Gibson
        } while (reg_conflict(dev));
688 9fc380d3 Michael Ellerman
    }
689 4040ab72 David Gibson
690 1e34d859 Michael Ellerman
    /* Don't overwrite ids assigned on the command line */
691 1e34d859 Michael Ellerman
    if (!dev->qdev.id) {
692 1e34d859 Michael Ellerman
        id = vio_format_dev_name(dev);
693 1e34d859 Michael Ellerman
        if (!id) {
694 1e34d859 Michael Ellerman
            return -1;
695 1e34d859 Michael Ellerman
        }
696 1e34d859 Michael Ellerman
        dev->qdev.id = id;
697 4040ab72 David Gibson
    }
698 4040ab72 David Gibson
699 d07fee7e David Gibson
    dev->qirq = spapr_allocate_msi(dev->vio_irq_num, &dev->vio_irq_num);
700 e6c866d4 David Gibson
    if (!dev->qirq) {
701 e6c866d4 David Gibson
        return -1;
702 416343b1 Paolo Bonzini
    }
703 4040ab72 David Gibson
704 ee86dfee David Gibson
    rtce_init(dev);
705 ee86dfee David Gibson
706 3954d33a Anthony Liguori
    return pc->init(dev);
707 4040ab72 David Gibson
}
708 4040ab72 David Gibson
709 e2684c0b Andreas Färber
static target_ulong h_vio_signal(CPUPPCState *env, sPAPREnvironment *spapr,
710 00dc738d David Gibson
                                 target_ulong opcode,
711 00dc738d David Gibson
                                 target_ulong *args)
712 00dc738d David Gibson
{
713 00dc738d David Gibson
    target_ulong reg = args[0];
714 00dc738d David Gibson
    target_ulong mode = args[1];
715 00dc738d David Gibson
    VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
716 3954d33a Anthony Liguori
    VIOsPAPRDeviceClass *pc;
717 00dc738d David Gibson
718 00dc738d David Gibson
    if (!dev) {
719 00dc738d David Gibson
        return H_PARAMETER;
720 00dc738d David Gibson
    }
721 00dc738d David Gibson
722 3954d33a Anthony Liguori
    pc = VIO_SPAPR_DEVICE_GET_CLASS(dev);
723 00dc738d David Gibson
724 3954d33a Anthony Liguori
    if (mode & ~pc->signal_mask) {
725 00dc738d David Gibson
        return H_PARAMETER;
726 00dc738d David Gibson
    }
727 00dc738d David Gibson
728 00dc738d David Gibson
    dev->signal_state = mode;
729 00dc738d David Gibson
730 00dc738d David Gibson
    return H_SUCCESS;
731 00dc738d David Gibson
}
732 00dc738d David Gibson
733 4040ab72 David Gibson
VIOsPAPRBus *spapr_vio_bus_init(void)
734 4040ab72 David Gibson
{
735 4040ab72 David Gibson
    VIOsPAPRBus *bus;
736 4040ab72 David Gibson
    BusState *qbus;
737 4040ab72 David Gibson
    DeviceState *dev;
738 4040ab72 David Gibson
739 4040ab72 David Gibson
    /* Create bridge device */
740 4040ab72 David Gibson
    dev = qdev_create(NULL, "spapr-vio-bridge");
741 4040ab72 David Gibson
    qdev_init_nofail(dev);
742 4040ab72 David Gibson
743 4040ab72 David Gibson
    /* Create bus on bridge device */
744 4040ab72 David Gibson
745 4040ab72 David Gibson
    qbus = qbus_create(&spapr_vio_bus_info, dev, "spapr-vio");
746 4040ab72 David Gibson
    bus = DO_UPCAST(VIOsPAPRBus, bus, qbus);
747 d601fac4 David Gibson
    bus->next_reg = 0x1000;
748 4040ab72 David Gibson
749 00dc738d David Gibson
    /* hcall-vio */
750 00dc738d David Gibson
    spapr_register_hypercall(H_VIO_SIGNAL, h_vio_signal);
751 00dc738d David Gibson
752 ee86dfee David Gibson
    /* hcall-tce */
753 ee86dfee David Gibson
    spapr_register_hypercall(H_PUT_TCE, h_put_tce);
754 ee86dfee David Gibson
755 b45d63b6 Ben Herrenschmidt
    /* hcall-crq */
756 b45d63b6 Ben Herrenschmidt
    spapr_register_hypercall(H_REG_CRQ, h_reg_crq);
757 b45d63b6 Ben Herrenschmidt
    spapr_register_hypercall(H_FREE_CRQ, h_free_crq);
758 b45d63b6 Ben Herrenschmidt
    spapr_register_hypercall(H_SEND_CRQ, h_send_crq);
759 b45d63b6 Ben Herrenschmidt
    spapr_register_hypercall(H_ENABLE_CRQ, h_enable_crq);
760 b45d63b6 Ben Herrenschmidt
761 08942ac1 Ben Herrenschmidt
    /* RTAS calls */
762 08942ac1 Ben Herrenschmidt
    spapr_rtas_register("ibm,set-tce-bypass", rtas_set_tce_bypass);
763 08942ac1 Ben Herrenschmidt
    spapr_rtas_register("quiesce", rtas_quiesce);
764 08942ac1 Ben Herrenschmidt
765 4040ab72 David Gibson
    return bus;
766 4040ab72 David Gibson
}
767 4040ab72 David Gibson
768 4040ab72 David Gibson
/* Represents sPAPR hcall VIO devices */
769 4040ab72 David Gibson
770 4040ab72 David Gibson
static int spapr_vio_bridge_init(SysBusDevice *dev)
771 4040ab72 David Gibson
{
772 4040ab72 David Gibson
    /* nothing */
773 4040ab72 David Gibson
    return 0;
774 4040ab72 David Gibson
}
775 4040ab72 David Gibson
776 999e12bb Anthony Liguori
static void spapr_vio_bridge_class_init(ObjectClass *klass, void *data)
777 999e12bb Anthony Liguori
{
778 39bffca2 Anthony Liguori
    DeviceClass *dc = DEVICE_CLASS(klass);
779 39bffca2 Anthony Liguori
    SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
780 999e12bb Anthony Liguori
781 39bffca2 Anthony Liguori
    k->init = spapr_vio_bridge_init;
782 39bffca2 Anthony Liguori
    dc->no_user = 1;
783 999e12bb Anthony Liguori
}
784 999e12bb Anthony Liguori
785 39bffca2 Anthony Liguori
static TypeInfo spapr_vio_bridge_info = {
786 39bffca2 Anthony Liguori
    .name          = "spapr-vio-bridge",
787 39bffca2 Anthony Liguori
    .parent        = TYPE_SYS_BUS_DEVICE,
788 39bffca2 Anthony Liguori
    .instance_size = sizeof(SysBusDevice),
789 39bffca2 Anthony Liguori
    .class_init    = spapr_vio_bridge_class_init,
790 4040ab72 David Gibson
};
791 4040ab72 David Gibson
792 39bffca2 Anthony Liguori
static void vio_spapr_device_class_init(ObjectClass *klass, void *data)
793 39bffca2 Anthony Liguori
{
794 39bffca2 Anthony Liguori
    DeviceClass *k = DEVICE_CLASS(klass);
795 39bffca2 Anthony Liguori
    k->init = spapr_vio_busdev_init;
796 b1c7f725 David Gibson
    k->reset = spapr_vio_busdev_reset;
797 39bffca2 Anthony Liguori
    k->bus_info = &spapr_vio_bus_info;
798 39bffca2 Anthony Liguori
}
799 39bffca2 Anthony Liguori
800 3954d33a Anthony Liguori
static TypeInfo spapr_vio_type_info = {
801 3954d33a Anthony Liguori
    .name = TYPE_VIO_SPAPR_DEVICE,
802 3954d33a Anthony Liguori
    .parent = TYPE_DEVICE,
803 3954d33a Anthony Liguori
    .instance_size = sizeof(VIOsPAPRDevice),
804 3954d33a Anthony Liguori
    .abstract = true,
805 3954d33a Anthony Liguori
    .class_size = sizeof(VIOsPAPRDeviceClass),
806 39bffca2 Anthony Liguori
    .class_init = vio_spapr_device_class_init,
807 3954d33a Anthony Liguori
};
808 3954d33a Anthony Liguori
809 83f7d43a Andreas Färber
static void spapr_vio_register_types(void)
810 4040ab72 David Gibson
{
811 39bffca2 Anthony Liguori
    type_register_static(&spapr_vio_bridge_info);
812 3954d33a Anthony Liguori
    type_register_static(&spapr_vio_type_info);
813 4040ab72 David Gibson
}
814 4040ab72 David Gibson
815 83f7d43a Andreas Färber
type_init(spapr_vio_register_types)
816 4040ab72 David Gibson
817 4040ab72 David Gibson
#ifdef CONFIG_FDT
818 05c19438 David Gibson
static int compare_reg(const void *p1, const void *p2)
819 05c19438 David Gibson
{
820 05c19438 David Gibson
    VIOsPAPRDevice const *dev1, *dev2;
821 05c19438 David Gibson
822 05c19438 David Gibson
    dev1 = (VIOsPAPRDevice *)*(DeviceState **)p1;
823 05c19438 David Gibson
    dev2 = (VIOsPAPRDevice *)*(DeviceState **)p2;
824 05c19438 David Gibson
825 05c19438 David Gibson
    if (dev1->reg < dev2->reg) {
826 05c19438 David Gibson
        return -1;
827 05c19438 David Gibson
    }
828 05c19438 David Gibson
    if (dev1->reg == dev2->reg) {
829 05c19438 David Gibson
        return 0;
830 05c19438 David Gibson
    }
831 05c19438 David Gibson
832 05c19438 David Gibson
    /* dev1->reg > dev2->reg */
833 05c19438 David Gibson
    return 1;
834 05c19438 David Gibson
}
835 05c19438 David Gibson
836 4040ab72 David Gibson
int spapr_populate_vdevice(VIOsPAPRBus *bus, void *fdt)
837 4040ab72 David Gibson
{
838 05c19438 David Gibson
    DeviceState *qdev, **qdevs;
839 05c19438 David Gibson
    int i, num, ret = 0;
840 4040ab72 David Gibson
841 05c19438 David Gibson
    /* Count qdevs on the bus list */
842 05c19438 David Gibson
    num = 0;
843 d8bb00d6 Paolo Bonzini
    QTAILQ_FOREACH(qdev, &bus->bus.children, sibling) {
844 05c19438 David Gibson
        num++;
845 05c19438 David Gibson
    }
846 05c19438 David Gibson
847 05c19438 David Gibson
    /* Copy out into an array of pointers */
848 05c19438 David Gibson
    qdevs = g_malloc(sizeof(qdev) * num);
849 05c19438 David Gibson
    num = 0;
850 05c19438 David Gibson
    QTAILQ_FOREACH(qdev, &bus->bus.children, sibling) {
851 05c19438 David Gibson
        qdevs[num++] = qdev;
852 05c19438 David Gibson
    }
853 05c19438 David Gibson
854 05c19438 David Gibson
    /* Sort the array */
855 05c19438 David Gibson
    qsort(qdevs, num, sizeof(qdev), compare_reg);
856 05c19438 David Gibson
857 05c19438 David Gibson
    /* Hack alert. Give the devices to libfdt in reverse order, we happen
858 05c19438 David Gibson
     * to know that will mean they are in forward order in the tree. */
859 05c19438 David Gibson
    for (i = num - 1; i >= 0; i--) {
860 05c19438 David Gibson
        VIOsPAPRDevice *dev = (VIOsPAPRDevice *)(qdevs[i]);
861 4040ab72 David Gibson
862 4040ab72 David Gibson
        ret = vio_make_devnode(dev, fdt);
863 4040ab72 David Gibson
864 4040ab72 David Gibson
        if (ret < 0) {
865 05c19438 David Gibson
            goto out;
866 4040ab72 David Gibson
        }
867 4040ab72 David Gibson
    }
868 4040ab72 David Gibson
869 05c19438 David Gibson
    ret = 0;
870 05c19438 David Gibson
out:
871 05c19438 David Gibson
    free(qdevs);
872 05c19438 David Gibson
873 05c19438 David Gibson
    return ret;
874 4040ab72 David Gibson
}
875 68f3a94c David Gibson
876 68f3a94c David Gibson
int spapr_populate_chosen_stdout(void *fdt, VIOsPAPRBus *bus)
877 68f3a94c David Gibson
{
878 68f3a94c David Gibson
    VIOsPAPRDevice *dev;
879 68f3a94c David Gibson
    char *name, *path;
880 68f3a94c David Gibson
    int ret, offset;
881 68f3a94c David Gibson
882 68f3a94c David Gibson
    dev = spapr_vty_get_default(bus);
883 68f3a94c David Gibson
    if (!dev)
884 68f3a94c David Gibson
        return 0;
885 68f3a94c David Gibson
886 68f3a94c David Gibson
    offset = fdt_path_offset(fdt, "/chosen");
887 68f3a94c David Gibson
    if (offset < 0) {
888 68f3a94c David Gibson
        return offset;
889 68f3a94c David Gibson
    }
890 68f3a94c David Gibson
891 68f3a94c David Gibson
    name = vio_format_dev_name(dev);
892 68f3a94c David Gibson
    if (!name) {
893 68f3a94c David Gibson
        return -ENOMEM;
894 68f3a94c David Gibson
    }
895 68f3a94c David Gibson
896 68f3a94c David Gibson
    if (asprintf(&path, "/vdevice/%s", name) < 0) {
897 68f3a94c David Gibson
        path = NULL;
898 68f3a94c David Gibson
        ret = -ENOMEM;
899 68f3a94c David Gibson
        goto out;
900 68f3a94c David Gibson
    }
901 68f3a94c David Gibson
902 68f3a94c David Gibson
    ret = fdt_setprop_string(fdt, offset, "linux,stdout-path", path);
903 68f3a94c David Gibson
out:
904 68f3a94c David Gibson
    free(name);
905 68f3a94c David Gibson
    free(path);
906 68f3a94c David Gibson
907 68f3a94c David Gibson
    return ret;
908 68f3a94c David Gibson
}
909 4040ab72 David Gibson
#endif /* CONFIG_FDT */