xref: /illumos-kvm-cmd/hw/sysbus.c (revision 68396ea9)
1 /*
2  *  System (CPU) Bus device support code
3  *
4  *  Copyright (c) 2009 CodeSourcery
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 
20 #include "sysbus.h"
21 #include "sysemu.h"
22 #include "monitor.h"
23 
24 static void sysbus_dev_print(Monitor *mon, DeviceState *dev, int indent);
25 static char *sysbus_get_fw_dev_path(DeviceState *dev);
26 
27 struct BusInfo system_bus_info = {
28     .name       = "System",
29     .size       = sizeof(BusState),
30     .print_dev  = sysbus_dev_print,
31     .get_fw_dev_path = sysbus_get_fw_dev_path,
32 };
33 
sysbus_connect_irq(SysBusDevice * dev,int n,qemu_irq irq)34 void sysbus_connect_irq(SysBusDevice *dev, int n, qemu_irq irq)
35 {
36     assert(n >= 0 && n < dev->num_irq);
37     dev->irqs[n] = NULL;
38     if (dev->irqp[n]) {
39         *dev->irqp[n] = irq;
40     }
41 }
42 
sysbus_mmio_map(SysBusDevice * dev,int n,target_phys_addr_t addr)43 void sysbus_mmio_map(SysBusDevice *dev, int n, target_phys_addr_t addr)
44 {
45     assert(n >= 0 && n < dev->num_mmio);
46 
47     if (dev->mmio[n].addr == addr) {
48         /* ??? region already mapped here.  */
49         return;
50     }
51     if (dev->mmio[n].addr != (target_phys_addr_t)-1) {
52         /* Unregister previous mapping.  */
53         cpu_register_physical_memory(dev->mmio[n].addr, dev->mmio[n].size,
54                                      IO_MEM_UNASSIGNED);
55     }
56     dev->mmio[n].addr = addr;
57     if (dev->mmio[n].cb) {
58         dev->mmio[n].cb(dev, addr);
59     } else {
60         cpu_register_physical_memory(addr, dev->mmio[n].size,
61                                      dev->mmio[n].iofunc);
62     }
63 }
64 
65 
66 /* Request an IRQ source.  The actual IRQ object may be populated later.  */
sysbus_init_irq(SysBusDevice * dev,qemu_irq * p)67 void sysbus_init_irq(SysBusDevice *dev, qemu_irq *p)
68 {
69     int n;
70 
71     assert(dev->num_irq < QDEV_MAX_IRQ);
72     n = dev->num_irq++;
73     dev->irqp[n] = p;
74 }
75 
76 /* Pass IRQs from a target device.  */
sysbus_pass_irq(SysBusDevice * dev,SysBusDevice * target)77 void sysbus_pass_irq(SysBusDevice *dev, SysBusDevice *target)
78 {
79     int i;
80     assert(dev->num_irq == 0);
81     dev->num_irq = target->num_irq;
82     for (i = 0; i < dev->num_irq; i++) {
83         dev->irqp[i] = target->irqp[i];
84     }
85 }
86 
sysbus_init_mmio(SysBusDevice * dev,target_phys_addr_t size,ram_addr_t iofunc)87 void sysbus_init_mmio(SysBusDevice *dev, target_phys_addr_t size,
88                       ram_addr_t iofunc)
89 {
90     int n;
91 
92     assert(dev->num_mmio < QDEV_MAX_MMIO);
93     n = dev->num_mmio++;
94     dev->mmio[n].addr = -1;
95     dev->mmio[n].size = size;
96     dev->mmio[n].iofunc = iofunc;
97 }
98 
sysbus_init_mmio_cb(SysBusDevice * dev,target_phys_addr_t size,mmio_mapfunc cb)99 void sysbus_init_mmio_cb(SysBusDevice *dev, target_phys_addr_t size,
100                          mmio_mapfunc cb)
101 {
102     int n;
103 
104     assert(dev->num_mmio < QDEV_MAX_MMIO);
105     n = dev->num_mmio++;
106     dev->mmio[n].addr = -1;
107     dev->mmio[n].size = size;
108     dev->mmio[n].cb = cb;
109 }
110 
sysbus_init_ioports(SysBusDevice * dev,pio_addr_t ioport,pio_addr_t size)111 void sysbus_init_ioports(SysBusDevice *dev, pio_addr_t ioport, pio_addr_t size)
112 {
113     pio_addr_t i;
114 
115     for (i = 0; i < size; i++) {
116         assert(dev->num_pio < QDEV_MAX_PIO);
117         dev->pio[dev->num_pio++] = ioport++;
118     }
119 }
120 
sysbus_device_init(DeviceState * dev,DeviceInfo * base)121 static int sysbus_device_init(DeviceState *dev, DeviceInfo *base)
122 {
123     SysBusDeviceInfo *info = container_of(base, SysBusDeviceInfo, qdev);
124 
125     return info->init(sysbus_from_qdev(dev));
126 }
127 
sysbus_register_withprop(SysBusDeviceInfo * info)128 void sysbus_register_withprop(SysBusDeviceInfo *info)
129 {
130     info->qdev.init = sysbus_device_init;
131     info->qdev.bus_info = &system_bus_info;
132 
133     assert(info->qdev.size >= sizeof(SysBusDevice));
134     qdev_register(&info->qdev);
135 }
136 
sysbus_register_dev(const char * name,size_t size,sysbus_initfn init)137 void sysbus_register_dev(const char *name, size_t size, sysbus_initfn init)
138 {
139     SysBusDeviceInfo *info;
140 
141     info = qemu_mallocz(sizeof(*info));
142     info->qdev.name = qemu_strdup(name);
143     info->qdev.size = size;
144     info->init = init;
145     sysbus_register_withprop(info);
146 }
147 
sysbus_create_varargs(const char * name,target_phys_addr_t addr,...)148 DeviceState *sysbus_create_varargs(const char *name,
149                                    target_phys_addr_t addr, ...)
150 {
151     DeviceState *dev;
152     SysBusDevice *s;
153     va_list va;
154     qemu_irq irq;
155     int n;
156 
157     dev = qdev_create(NULL, name);
158     s = sysbus_from_qdev(dev);
159     qdev_init_nofail(dev);
160     if (addr != (target_phys_addr_t)-1) {
161         sysbus_mmio_map(s, 0, addr);
162     }
163     va_start(va, addr);
164     n = 0;
165     while (1) {
166         irq = va_arg(va, qemu_irq);
167         if (!irq) {
168             break;
169         }
170         sysbus_connect_irq(s, n, irq);
171         n++;
172     }
173     return dev;
174 }
175 
sysbus_dev_print(Monitor * mon,DeviceState * dev,int indent)176 static void sysbus_dev_print(Monitor *mon, DeviceState *dev, int indent)
177 {
178     SysBusDevice *s = sysbus_from_qdev(dev);
179     int i;
180 
181     for (i = 0; i < s->num_mmio; i++) {
182         monitor_printf(mon, "%*smmio " TARGET_FMT_plx "/" TARGET_FMT_plx "\n",
183                        indent, "", s->mmio[i].addr, s->mmio[i].size);
184     }
185 }
186 
sysbus_get_fw_dev_path(DeviceState * dev)187 static char *sysbus_get_fw_dev_path(DeviceState *dev)
188 {
189     SysBusDevice *s = sysbus_from_qdev(dev);
190     char path[40];
191     int off;
192 
193     off = snprintf(path, sizeof(path), "%s", qdev_fw_name(dev));
194 
195     if (s->num_mmio) {
196         snprintf(path + off, sizeof(path) - off, "@"TARGET_FMT_plx,
197                  s->mmio[0].addr);
198     } else if (s->num_pio) {
199         snprintf(path + off, sizeof(path) - off, "@i%04x", s->pio[0]);
200     }
201 
202     return strdup(path);
203 }
204