1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include "qemu/osdep.h"
27#include "hw/pci/pci.h"
28#include "migration/vmstate.h"
29#include "qemu/module.h"
30#include "sysemu/block-backend.h"
31#include "sysemu/blockdev.h"
32#include "sysemu/dma.h"
33
34#include "hw/ide/pci.h"
35#include "trace.h"
36
37static uint64_t bmdma_read(void *opaque, hwaddr addr, unsigned size)
38{
39 BMDMAState *bm = opaque;
40 uint32_t val;
41
42 if (size != 1) {
43 return ((uint64_t)1 << (size * 8)) - 1;
44 }
45
46 switch(addr & 3) {
47 case 0:
48 val = bm->cmd;
49 break;
50 case 2:
51 val = bm->status;
52 break;
53 default:
54 val = 0xff;
55 break;
56 }
57
58 trace_bmdma_read(addr, val);
59 return val;
60}
61
62static void bmdma_write(void *opaque, hwaddr addr,
63 uint64_t val, unsigned size)
64{
65 BMDMAState *bm = opaque;
66
67 if (size != 1) {
68 return;
69 }
70
71 trace_bmdma_write(addr, val);
72
73 switch(addr & 3) {
74 case 0:
75 bmdma_cmd_writeb(bm, val);
76 break;
77 case 2:
78 bm->status = (val & 0x60) | (bm->status & 1) | (bm->status & ~val & 0x06);
79 break;
80 }
81}
82
83static const MemoryRegionOps piix_bmdma_ops = {
84 .read = bmdma_read,
85 .write = bmdma_write,
86};
87
88static void bmdma_setup_bar(PCIIDEState *d)
89{
90 int i;
91
92 memory_region_init(&d->bmdma_bar, OBJECT(d), "piix-bmdma-container", 16);
93 for(i = 0;i < 2; i++) {
94 BMDMAState *bm = &d->bmdma[i];
95
96 memory_region_init_io(&bm->extra_io, OBJECT(d), &piix_bmdma_ops, bm,
97 "piix-bmdma", 4);
98 memory_region_add_subregion(&d->bmdma_bar, i * 8, &bm->extra_io);
99 memory_region_init_io(&bm->addr_ioport, OBJECT(d),
100 &bmdma_addr_ioport_ops, bm, "bmdma", 4);
101 memory_region_add_subregion(&d->bmdma_bar, i * 8 + 4, &bm->addr_ioport);
102 }
103}
104
105static void piix_ide_reset(DeviceState *dev)
106{
107 PCIIDEState *d = PCI_IDE(dev);
108 PCIDevice *pd = PCI_DEVICE(d);
109 uint8_t *pci_conf = pd->config;
110 int i;
111
112 for (i = 0; i < 2; i++) {
113 ide_bus_reset(&d->bus[i]);
114 }
115
116
117 pci_conf[PCI_COMMAND] = 0x00;
118
119 pci_conf[PCI_COMMAND + 1] = 0x00;
120
121 pci_conf[PCI_STATUS] = PCI_STATUS_FAST_BACK;
122 pci_conf[PCI_STATUS + 1] = PCI_STATUS_DEVSEL_MEDIUM >> 8;
123 pci_conf[0x20] = 0x01;
124}
125
126static void pci_piix_init_ports(PCIIDEState *d) {
127 static const struct {
128 int iobase;
129 int iobase2;
130 int isairq;
131 } port_info[] = {
132 {0x1f0, 0x3f6, 14},
133 {0x170, 0x376, 15},
134 };
135 int i;
136
137 for (i = 0; i < 2; i++) {
138 ide_bus_new(&d->bus[i], sizeof(d->bus[i]), DEVICE(d), i, 2);
139 ide_init_ioport(&d->bus[i], NULL, port_info[i].iobase,
140 port_info[i].iobase2);
141 ide_init2(&d->bus[i], isa_get_irq(NULL, port_info[i].isairq));
142
143 bmdma_init(&d->bus[i], &d->bmdma[i], d);
144 d->bmdma[i].bus = &d->bus[i];
145 ide_register_restart_cb(&d->bus[i]);
146 }
147}
148
149static void pci_piix_ide_realize(PCIDevice *dev, Error **errp)
150{
151 PCIIDEState *d = PCI_IDE(dev);
152 uint8_t *pci_conf = dev->config;
153
154 pci_conf[PCI_CLASS_PROG] = 0x80;
155
156 bmdma_setup_bar(d);
157 pci_register_bar(dev, 4, PCI_BASE_ADDRESS_SPACE_IO, &d->bmdma_bar);
158
159 vmstate_register(VMSTATE_IF(dev), 0, &vmstate_ide_pci, d);
160
161 pci_piix_init_ports(d);
162}
163
164int pci_piix3_xen_ide_unplug(DeviceState *dev, bool aux)
165{
166 PCIIDEState *pci_ide;
167 int i;
168 IDEDevice *idedev;
169 IDEBus *idebus;
170 BlockBackend *blk;
171
172 pci_ide = PCI_IDE(dev);
173
174 for (i = aux ? 1 : 0; i < 4; i++) {
175 idebus = &pci_ide->bus[i / 2];
176 blk = idebus->ifs[i % 2].blk;
177
178 if (blk && idebus->ifs[i % 2].drive_kind != IDE_CD) {
179 if (!(i % 2)) {
180 idedev = idebus->master;
181 } else {
182 idedev = idebus->slave;
183 }
184
185 blk_drain(blk);
186 blk_flush(blk);
187
188 blk_detach_dev(blk, DEVICE(idedev));
189 idebus->ifs[i % 2].blk = NULL;
190 idedev->conf.blk = NULL;
191 monitor_remove_blk(blk);
192 blk_unref(blk);
193 }
194 }
195 qdev_reset_all(dev);
196 return 0;
197}
198
199static void pci_piix_ide_exitfn(PCIDevice *dev)
200{
201 PCIIDEState *d = PCI_IDE(dev);
202 unsigned i;
203
204 for (i = 0; i < 2; ++i) {
205 memory_region_del_subregion(&d->bmdma_bar, &d->bmdma[i].extra_io);
206 memory_region_del_subregion(&d->bmdma_bar, &d->bmdma[i].addr_ioport);
207 }
208}
209
210
211static void piix3_ide_class_init(ObjectClass *klass, void *data)
212{
213 DeviceClass *dc = DEVICE_CLASS(klass);
214 PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
215
216 dc->reset = piix_ide_reset;
217 k->realize = pci_piix_ide_realize;
218 k->exit = pci_piix_ide_exitfn;
219 k->vendor_id = PCI_VENDOR_ID_INTEL;
220 k->device_id = PCI_DEVICE_ID_INTEL_82371SB_1;
221 k->class_id = PCI_CLASS_STORAGE_IDE;
222 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
223 dc->hotpluggable = false;
224}
225
226static const TypeInfo piix3_ide_info = {
227 .name = "piix3-ide",
228 .parent = TYPE_PCI_IDE,
229 .class_init = piix3_ide_class_init,
230};
231
232static const TypeInfo piix3_ide_xen_info = {
233 .name = "piix3-ide-xen",
234 .parent = TYPE_PCI_IDE,
235 .class_init = piix3_ide_class_init,
236};
237
238
239static void piix4_ide_class_init(ObjectClass *klass, void *data)
240{
241 DeviceClass *dc = DEVICE_CLASS(klass);
242 PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
243
244 dc->reset = piix_ide_reset;
245 k->realize = pci_piix_ide_realize;
246 k->exit = pci_piix_ide_exitfn;
247 k->vendor_id = PCI_VENDOR_ID_INTEL;
248 k->device_id = PCI_DEVICE_ID_INTEL_82371AB;
249 k->class_id = PCI_CLASS_STORAGE_IDE;
250 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
251 dc->hotpluggable = false;
252}
253
254static const TypeInfo piix4_ide_info = {
255 .name = "piix4-ide",
256 .parent = TYPE_PCI_IDE,
257 .class_init = piix4_ide_class_init,
258};
259
260static void piix_ide_register_types(void)
261{
262 type_register_static(&piix3_ide_info);
263 type_register_static(&piix3_ide_xen_info);
264 type_register_static(&piix4_ide_info);
265}
266
267type_init(piix_ide_register_types)
268
