4 * Copyright (c) 2010 David Gibson, IBM Corporation <dwg@au1.ibm.com>
5 * Based on the s390 virtio bus code:
6 * Copyright (c) 2009 Alexander Graf <agraf@suse.de>
8 * This library is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU Lesser General Public
10 * License as published by the Free Software Foundation; either
11 * version 2 of the License, or (at your option) any later version.
13 * This library 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 GNU
16 * Lesser General Public License for more details.
18 * You should have received a copy of the GNU Lesser General Public
19 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
23 #include "sysemu/sysemu.h"
24 #include "hw/boards.h"
25 #include "monitor/monitor.h"
26 #include "hw/loader.h"
28 #include "hw/sysbus.h"
29 #include "sysemu/kvm.h"
30 #include "sysemu/device_tree.h"
33 #include "hw/ppc/spapr.h"
34 #include "hw/ppc/spapr_vio.h"
35 #include "hw/ppc/xics.h"
39 /* #define DEBUG_SPAPR */
42 #define DPRINTF(fmt, ...) \
43 do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
45 #define DPRINTF(fmt, ...) \
49 static Property spapr_vio_props
[] = {
50 DEFINE_PROP_UINT32("irq", VIOsPAPRDevice
, irq
, 0), \
51 DEFINE_PROP_END_OF_LIST(),
54 static char *spapr_vio_get_dev_name(DeviceState
*qdev
)
56 VIOsPAPRDevice
*dev
= VIO_SPAPR_DEVICE(qdev
);
57 VIOsPAPRDeviceClass
*pc
= VIO_SPAPR_DEVICE_GET_CLASS(dev
);
60 /* Device tree style name device@reg */
61 name
= g_strdup_printf("%s@%x", pc
->dt_name
, dev
->reg
);
66 static void spapr_vio_bus_class_init(ObjectClass
*klass
, void *data
)
68 BusClass
*k
= BUS_CLASS(klass
);
70 k
->get_dev_path
= spapr_vio_get_dev_name
;
71 k
->get_fw_dev_path
= spapr_vio_get_dev_name
;
74 static const TypeInfo spapr_vio_bus_info
= {
75 .name
= TYPE_SPAPR_VIO_BUS
,
77 .class_init
= spapr_vio_bus_class_init
,
78 .instance_size
= sizeof(VIOsPAPRBus
),
81 VIOsPAPRDevice
*spapr_vio_find_by_reg(VIOsPAPRBus
*bus
, uint32_t reg
)
84 VIOsPAPRDevice
*dev
= NULL
;
86 QTAILQ_FOREACH(kid
, &bus
->bus
.children
, sibling
) {
87 dev
= (VIOsPAPRDevice
*)kid
->child
;
88 if (dev
->reg
== reg
) {
96 static int vio_make_devnode(VIOsPAPRDevice
*dev
,
99 VIOsPAPRDeviceClass
*pc
= VIO_SPAPR_DEVICE_GET_CLASS(dev
);
100 int vdevice_off
, node_off
, ret
;
103 vdevice_off
= fdt_path_offset(fdt
, "/vdevice");
104 if (vdevice_off
< 0) {
108 dt_name
= spapr_vio_get_dev_name(DEVICE(dev
));
109 node_off
= fdt_add_subnode(fdt
, vdevice_off
, dt_name
);
115 ret
= fdt_setprop_cell(fdt
, node_off
, "reg", dev
->reg
);
121 ret
= fdt_setprop_string(fdt
, node_off
, "device_type",
128 if (pc
->dt_compatible
) {
129 ret
= fdt_setprop_string(fdt
, node_off
, "compatible",
137 uint32_t ints_prop
[] = {cpu_to_be32(dev
->irq
), 0};
139 ret
= fdt_setprop(fdt
, node_off
, "interrupts", ints_prop
,
146 ret
= spapr_tcet_dma_dt(fdt
, node_off
, "ibm,my-dma-window", dev
->tcet
);
152 ret
= (pc
->devnode
)(dev
, fdt
, node_off
);
164 static target_ulong
h_reg_crq(PowerPCCPU
*cpu
, sPAPREnvironment
*spapr
,
165 target_ulong opcode
, target_ulong
*args
)
167 target_ulong reg
= args
[0];
168 target_ulong queue_addr
= args
[1];
169 target_ulong queue_len
= args
[2];
170 VIOsPAPRDevice
*dev
= spapr_vio_find_by_reg(spapr
->vio_bus
, reg
);
173 hcall_dprintf("Unit 0x" TARGET_FMT_lx
" does not exist\n", reg
);
177 /* We can't grok a queue size bigger than 256M for now */
178 if (queue_len
< 0x1000 || queue_len
> 0x10000000) {
179 hcall_dprintf("Queue size too small or too big (0x" TARGET_FMT_lx
184 /* Check queue alignment */
185 if (queue_addr
& 0xfff) {
186 hcall_dprintf("Queue not aligned (0x" TARGET_FMT_lx
")\n", queue_addr
);
190 /* Check if device supports CRQs */
191 if (!dev
->crq
.SendFunc
) {
192 hcall_dprintf("Device does not support CRQ\n");
196 /* Already a queue ? */
197 if (dev
->crq
.qsize
) {
198 hcall_dprintf("CRQ already registered\n");
201 dev
->crq
.qladdr
= queue_addr
;
202 dev
->crq
.qsize
= queue_len
;
205 DPRINTF("CRQ for dev 0x" TARGET_FMT_lx
" registered at 0x"
206 TARGET_FMT_lx
"/0x" TARGET_FMT_lx
"\n",
207 reg
, queue_addr
, queue_len
);
211 static target_ulong
free_crq(VIOsPAPRDevice
*dev
)
217 DPRINTF("CRQ for dev 0x%" PRIx32
" freed\n", dev
->reg
);
222 static target_ulong
h_free_crq(PowerPCCPU
*cpu
, sPAPREnvironment
*spapr
,
223 target_ulong opcode
, target_ulong
*args
)
225 target_ulong reg
= args
[0];
226 VIOsPAPRDevice
*dev
= spapr_vio_find_by_reg(spapr
->vio_bus
, reg
);
229 hcall_dprintf("Unit 0x" TARGET_FMT_lx
" does not exist\n", reg
);
233 return free_crq(dev
);
236 static target_ulong
h_send_crq(PowerPCCPU
*cpu
, sPAPREnvironment
*spapr
,
237 target_ulong opcode
, target_ulong
*args
)
239 target_ulong reg
= args
[0];
240 target_ulong msg_hi
= args
[1];
241 target_ulong msg_lo
= args
[2];
242 VIOsPAPRDevice
*dev
= spapr_vio_find_by_reg(spapr
->vio_bus
, reg
);
243 uint64_t crq_mangle
[2];
246 hcall_dprintf("Unit 0x" TARGET_FMT_lx
" does not exist\n", reg
);
249 crq_mangle
[0] = cpu_to_be64(msg_hi
);
250 crq_mangle
[1] = cpu_to_be64(msg_lo
);
252 if (dev
->crq
.SendFunc
) {
253 return dev
->crq
.SendFunc(dev
, (uint8_t *)crq_mangle
);
259 static target_ulong
h_enable_crq(PowerPCCPU
*cpu
, sPAPREnvironment
*spapr
,
260 target_ulong opcode
, target_ulong
*args
)
262 target_ulong reg
= args
[0];
263 VIOsPAPRDevice
*dev
= spapr_vio_find_by_reg(spapr
->vio_bus
, reg
);
266 hcall_dprintf("Unit 0x" TARGET_FMT_lx
" does not exist\n", reg
);
273 /* Returns negative error, 0 success, or positive: queue full */
274 int spapr_vio_send_crq(VIOsPAPRDevice
*dev
, uint8_t *crq
)
279 if (!dev
->crq
.qsize
) {
280 fprintf(stderr
, "spapr_vio_send_creq on uninitialized queue\n");
284 /* Maybe do a fast path for KVM just writing to the pages */
285 rc
= spapr_vio_dma_read(dev
, dev
->crq
.qladdr
+ dev
->crq
.qnext
, &byte
, 1);
293 rc
= spapr_vio_dma_write(dev
, dev
->crq
.qladdr
+ dev
->crq
.qnext
+ 8,
301 rc
= spapr_vio_dma_write(dev
, dev
->crq
.qladdr
+ dev
->crq
.qnext
, crq
, 8);
306 dev
->crq
.qnext
= (dev
->crq
.qnext
+ 16) % dev
->crq
.qsize
;
308 if (dev
->signal_state
& 1) {
309 qemu_irq_pulse(spapr_vio_qirq(dev
));
315 /* "quiesce" handling */
317 static void spapr_vio_quiesce_one(VIOsPAPRDevice
*dev
)
320 device_reset(DEVICE(dev
->tcet
));
325 static void rtas_set_tce_bypass(PowerPCCPU
*cpu
, sPAPREnvironment
*spapr
,
327 uint32_t nargs
, target_ulong args
,
328 uint32_t nret
, target_ulong rets
)
330 VIOsPAPRBus
*bus
= spapr
->vio_bus
;
332 uint32_t unit
, enable
;
335 rtas_st(rets
, 0, RTAS_OUT_PARAM_ERROR
);
338 unit
= rtas_ld(args
, 0);
339 enable
= rtas_ld(args
, 1);
340 dev
= spapr_vio_find_by_reg(bus
, unit
);
342 rtas_st(rets
, 0, RTAS_OUT_PARAM_ERROR
);
347 rtas_st(rets
, 0, RTAS_OUT_PARAM_ERROR
);
351 spapr_tce_set_bypass(dev
->tcet
, !!enable
);
353 rtas_st(rets
, 0, RTAS_OUT_SUCCESS
);
356 static void rtas_quiesce(PowerPCCPU
*cpu
, sPAPREnvironment
*spapr
,
358 uint32_t nargs
, target_ulong args
,
359 uint32_t nret
, target_ulong rets
)
361 VIOsPAPRBus
*bus
= spapr
->vio_bus
;
363 VIOsPAPRDevice
*dev
= NULL
;
366 rtas_st(rets
, 0, RTAS_OUT_PARAM_ERROR
);
370 QTAILQ_FOREACH(kid
, &bus
->bus
.children
, sibling
) {
371 dev
= (VIOsPAPRDevice
*)kid
->child
;
372 spapr_vio_quiesce_one(dev
);
375 rtas_st(rets
, 0, RTAS_OUT_SUCCESS
);
378 static VIOsPAPRDevice
*reg_conflict(VIOsPAPRDevice
*dev
)
380 VIOsPAPRBus
*bus
= DO_UPCAST(VIOsPAPRBus
, bus
, dev
->qdev
.parent_bus
);
382 VIOsPAPRDevice
*other
;
385 * Check for a device other than the given one which is already
386 * using the requested address. We have to open code this because
387 * the given dev might already be in the list.
389 QTAILQ_FOREACH(kid
, &bus
->bus
.children
, sibling
) {
390 other
= VIO_SPAPR_DEVICE(kid
->child
);
392 if (other
!= dev
&& other
->reg
== dev
->reg
) {
400 static void spapr_vio_busdev_reset(DeviceState
*qdev
)
402 VIOsPAPRDevice
*dev
= VIO_SPAPR_DEVICE(qdev
);
403 VIOsPAPRDeviceClass
*pc
= VIO_SPAPR_DEVICE_GET_CLASS(dev
);
405 /* Shut down the request queue and TCEs if necessary */
406 spapr_vio_quiesce_one(dev
);
408 dev
->signal_state
= 0;
415 static int spapr_vio_busdev_init(DeviceState
*qdev
)
417 VIOsPAPRDevice
*dev
= (VIOsPAPRDevice
*)qdev
;
418 VIOsPAPRDeviceClass
*pc
= VIO_SPAPR_DEVICE_GET_CLASS(dev
);
421 if (dev
->reg
!= -1) {
423 * Explicitly assigned address, just verify that no-one else
424 * is using it. other mechanism). We have to open code this
425 * rather than using spapr_vio_find_by_reg() because sdev
426 * itself is already in the list.
428 VIOsPAPRDevice
*other
= reg_conflict(dev
);
431 fprintf(stderr
, "vio: %s and %s devices conflict at address %#x\n",
432 object_get_typename(OBJECT(qdev
)),
433 object_get_typename(OBJECT(&other
->qdev
)),
438 /* Need to assign an address */
439 VIOsPAPRBus
*bus
= DO_UPCAST(VIOsPAPRBus
, bus
, dev
->qdev
.parent_bus
);
442 dev
->reg
= bus
->next_reg
++;
443 } while (reg_conflict(dev
));
446 /* Don't overwrite ids assigned on the command line */
448 id
= spapr_vio_get_dev_name(DEVICE(dev
));
452 dev
->irq
= xics_alloc(spapr
->icp
, 0, dev
->irq
, false);
457 if (pc
->rtce_window_size
) {
458 uint32_t liobn
= SPAPR_VIO_BASE_LIOBN
| dev
->reg
;
459 dev
->tcet
= spapr_tce_new_table(qdev
, liobn
,
461 SPAPR_TCE_PAGE_SHIFT
,
462 pc
->rtce_window_size
>>
463 SPAPR_TCE_PAGE_SHIFT
, false);
464 address_space_init(&dev
->as
, spapr_tce_get_iommu(dev
->tcet
), qdev
->id
);
467 return pc
->init(dev
);
470 static target_ulong
h_vio_signal(PowerPCCPU
*cpu
, sPAPREnvironment
*spapr
,
474 target_ulong reg
= args
[0];
475 target_ulong mode
= args
[1];
476 VIOsPAPRDevice
*dev
= spapr_vio_find_by_reg(spapr
->vio_bus
, reg
);
477 VIOsPAPRDeviceClass
*pc
;
483 pc
= VIO_SPAPR_DEVICE_GET_CLASS(dev
);
485 if (mode
& ~pc
->signal_mask
) {
489 dev
->signal_state
= mode
;
494 VIOsPAPRBus
*spapr_vio_bus_init(void)
500 /* Create bridge device */
501 dev
= qdev_create(NULL
, "spapr-vio-bridge");
502 qdev_init_nofail(dev
);
504 /* Create bus on bridge device */
506 qbus
= qbus_create(TYPE_SPAPR_VIO_BUS
, dev
, "spapr-vio");
507 bus
= DO_UPCAST(VIOsPAPRBus
, bus
, qbus
);
508 bus
->next_reg
= 0x71000000;
511 spapr_register_hypercall(H_VIO_SIGNAL
, h_vio_signal
);
514 spapr_register_hypercall(H_REG_CRQ
, h_reg_crq
);
515 spapr_register_hypercall(H_FREE_CRQ
, h_free_crq
);
516 spapr_register_hypercall(H_SEND_CRQ
, h_send_crq
);
517 spapr_register_hypercall(H_ENABLE_CRQ
, h_enable_crq
);
520 spapr_rtas_register(RTAS_IBM_SET_TCE_BYPASS
, "ibm,set-tce-bypass",
521 rtas_set_tce_bypass
);
522 spapr_rtas_register(RTAS_QUIESCE
, "quiesce", rtas_quiesce
);
527 /* Represents sPAPR hcall VIO devices */
529 static int spapr_vio_bridge_init(SysBusDevice
*dev
)
535 static void spapr_vio_bridge_class_init(ObjectClass
*klass
, void *data
)
537 SysBusDeviceClass
*k
= SYS_BUS_DEVICE_CLASS(klass
);
538 DeviceClass
*dc
= DEVICE_CLASS(klass
);
540 dc
->fw_name
= "vdevice";
541 k
->init
= spapr_vio_bridge_init
;
544 static const TypeInfo spapr_vio_bridge_info
= {
545 .name
= "spapr-vio-bridge",
546 .parent
= TYPE_SYS_BUS_DEVICE
,
547 .instance_size
= sizeof(SysBusDevice
),
548 .class_init
= spapr_vio_bridge_class_init
,
551 const VMStateDescription vmstate_spapr_vio
= {
554 .minimum_version_id
= 1,
555 .fields
= (VMStateField
[]) {
557 VMSTATE_UINT32_EQUAL(reg
, VIOsPAPRDevice
),
558 VMSTATE_UINT32_EQUAL(irq
, VIOsPAPRDevice
),
560 /* General VIO device state */
561 VMSTATE_UINTTL(signal_state
, VIOsPAPRDevice
),
562 VMSTATE_UINT64(crq
.qladdr
, VIOsPAPRDevice
),
563 VMSTATE_UINT32(crq
.qsize
, VIOsPAPRDevice
),
564 VMSTATE_UINT32(crq
.qnext
, VIOsPAPRDevice
),
566 VMSTATE_END_OF_LIST()
570 static void vio_spapr_device_class_init(ObjectClass
*klass
, void *data
)
572 DeviceClass
*k
= DEVICE_CLASS(klass
);
573 k
->init
= spapr_vio_busdev_init
;
574 k
->reset
= spapr_vio_busdev_reset
;
575 k
->bus_type
= TYPE_SPAPR_VIO_BUS
;
576 k
->props
= spapr_vio_props
;
579 static const TypeInfo spapr_vio_type_info
= {
580 .name
= TYPE_VIO_SPAPR_DEVICE
,
581 .parent
= TYPE_DEVICE
,
582 .instance_size
= sizeof(VIOsPAPRDevice
),
584 .class_size
= sizeof(VIOsPAPRDeviceClass
),
585 .class_init
= vio_spapr_device_class_init
,
588 static void spapr_vio_register_types(void)
590 type_register_static(&spapr_vio_bus_info
);
591 type_register_static(&spapr_vio_bridge_info
);
592 type_register_static(&spapr_vio_type_info
);
595 type_init(spapr_vio_register_types
)
597 static int compare_reg(const void *p1
, const void *p2
)
599 VIOsPAPRDevice
const *dev1
, *dev2
;
601 dev1
= (VIOsPAPRDevice
*)*(DeviceState
**)p1
;
602 dev2
= (VIOsPAPRDevice
*)*(DeviceState
**)p2
;
604 if (dev1
->reg
< dev2
->reg
) {
607 if (dev1
->reg
== dev2
->reg
) {
611 /* dev1->reg > dev2->reg */
615 int spapr_populate_vdevice(VIOsPAPRBus
*bus
, void *fdt
)
617 DeviceState
*qdev
, **qdevs
;
621 /* Count qdevs on the bus list */
623 QTAILQ_FOREACH(kid
, &bus
->bus
.children
, sibling
) {
627 /* Copy out into an array of pointers */
628 qdevs
= g_malloc(sizeof(qdev
) * num
);
630 QTAILQ_FOREACH(kid
, &bus
->bus
.children
, sibling
) {
631 qdevs
[num
++] = kid
->child
;
635 qsort(qdevs
, num
, sizeof(qdev
), compare_reg
);
637 /* Hack alert. Give the devices to libfdt in reverse order, we happen
638 * to know that will mean they are in forward order in the tree. */
639 for (i
= num
- 1; i
>= 0; i
--) {
640 VIOsPAPRDevice
*dev
= (VIOsPAPRDevice
*)(qdevs
[i
]);
642 ret
= vio_make_devnode(dev
, fdt
);
656 int spapr_populate_chosen_stdout(void *fdt
, VIOsPAPRBus
*bus
)
662 dev
= spapr_vty_get_default(bus
);
666 offset
= fdt_path_offset(fdt
, "/chosen");
671 name
= spapr_vio_get_dev_name(DEVICE(dev
));
672 path
= g_strdup_printf("/vdevice/%s", name
);
674 ret
= fdt_setprop_string(fdt
, offset
, "linux,stdout-path", path
);