console: Clean up bytes per pixel calculation
[qemu/ar7.git] / hw / ioh3420.c
blob94a537c9b395b75159ecc7b84498992b3d556b9c
1 /*
2 * ioh3420.c
3 * Intel X58 north bridge IOH
4 * PCI Express root port device id 3420
6 * Copyright (c) 2010 Isaku Yamahata <yamahata at valinux co jp>
7 * VA Linux Systems Japan K.K.
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License along
20 * with this program; if not, see <http://www.gnu.org/licenses/>.
23 #include "pci_ids.h"
24 #include "msi.h"
25 #include "pcie.h"
26 #include "ioh3420.h"
28 #define PCI_DEVICE_ID_IOH_EPORT 0x3420 /* D0:F0 express mode */
29 #define PCI_DEVICE_ID_IOH_REV 0x2
30 #define IOH_EP_SSVID_OFFSET 0x40
31 #define IOH_EP_SSVID_SVID PCI_VENDOR_ID_INTEL
32 #define IOH_EP_SSVID_SSID 0
33 #define IOH_EP_MSI_OFFSET 0x60
34 #define IOH_EP_MSI_SUPPORTED_FLAGS PCI_MSI_FLAGS_MASKBIT
35 #define IOH_EP_MSI_NR_VECTOR 2
36 #define IOH_EP_EXP_OFFSET 0x90
37 #define IOH_EP_AER_OFFSET 0x100
40 * If two MSI vector are allocated, Advanced Error Interrupt Message Number
41 * is 1. otherwise 0.
42 * 17.12.5.10 RPERRSTS, 32:27 bit Advanced Error Interrupt Message Number.
44 static uint8_t ioh3420_aer_vector(const PCIDevice *d)
46 switch (msi_nr_vectors_allocated(d)) {
47 case 1:
48 return 0;
49 case 2:
50 return 1;
51 case 4:
52 case 8:
53 case 16:
54 case 32:
55 default:
56 break;
58 abort();
59 return 0;
62 static void ioh3420_aer_vector_update(PCIDevice *d)
64 pcie_aer_root_set_vector(d, ioh3420_aer_vector(d));
67 static void ioh3420_write_config(PCIDevice *d,
68 uint32_t address, uint32_t val, int len)
70 uint32_t root_cmd =
71 pci_get_long(d->config + d->exp.aer_cap + PCI_ERR_ROOT_COMMAND);
73 pci_bridge_write_config(d, address, val, len);
74 ioh3420_aer_vector_update(d);
75 pcie_cap_slot_write_config(d, address, val, len);
76 pcie_aer_write_config(d, address, val, len);
77 pcie_aer_root_write_config(d, address, val, len, root_cmd);
80 static void ioh3420_reset(DeviceState *qdev)
82 PCIDevice *d = PCI_DEVICE(qdev);
84 ioh3420_aer_vector_update(d);
85 pcie_cap_root_reset(d);
86 pcie_cap_deverr_reset(d);
87 pcie_cap_slot_reset(d);
88 pcie_aer_root_reset(d);
89 pci_bridge_reset(qdev);
90 pci_bridge_disable_base_limit(d);
93 static int ioh3420_initfn(PCIDevice *d)
95 PCIBridge* br = DO_UPCAST(PCIBridge, dev, d);
96 PCIEPort *p = DO_UPCAST(PCIEPort, br, br);
97 PCIESlot *s = DO_UPCAST(PCIESlot, port, p);
98 int rc;
100 rc = pci_bridge_initfn(d);
101 if (rc < 0) {
102 return rc;
105 pcie_port_init_reg(d);
107 rc = pci_bridge_ssvid_init(d, IOH_EP_SSVID_OFFSET,
108 IOH_EP_SSVID_SVID, IOH_EP_SSVID_SSID);
109 if (rc < 0) {
110 goto err_bridge;
112 rc = msi_init(d, IOH_EP_MSI_OFFSET, IOH_EP_MSI_NR_VECTOR,
113 IOH_EP_MSI_SUPPORTED_FLAGS & PCI_MSI_FLAGS_64BIT,
114 IOH_EP_MSI_SUPPORTED_FLAGS & PCI_MSI_FLAGS_MASKBIT);
115 if (rc < 0) {
116 goto err_bridge;
118 rc = pcie_cap_init(d, IOH_EP_EXP_OFFSET, PCI_EXP_TYPE_ROOT_PORT, p->port);
119 if (rc < 0) {
120 goto err_msi;
122 pcie_cap_deverr_init(d);
123 pcie_cap_slot_init(d, s->slot);
124 pcie_chassis_create(s->chassis);
125 rc = pcie_chassis_add_slot(s);
126 if (rc < 0) {
127 goto err_pcie_cap;
128 return rc;
130 pcie_cap_root_init(d);
131 rc = pcie_aer_init(d, IOH_EP_AER_OFFSET);
132 if (rc < 0) {
133 goto err;
135 pcie_aer_root_init(d);
136 ioh3420_aer_vector_update(d);
137 return 0;
139 err:
140 pcie_chassis_del_slot(s);
141 err_pcie_cap:
142 pcie_cap_exit(d);
143 err_msi:
144 msi_uninit(d);
145 err_bridge:
146 pci_bridge_exitfn(d);
147 return rc;
150 static void ioh3420_exitfn(PCIDevice *d)
152 PCIBridge* br = DO_UPCAST(PCIBridge, dev, d);
153 PCIEPort *p = DO_UPCAST(PCIEPort, br, br);
154 PCIESlot *s = DO_UPCAST(PCIESlot, port, p);
156 pcie_aer_exit(d);
157 pcie_chassis_del_slot(s);
158 pcie_cap_exit(d);
159 msi_uninit(d);
160 pci_bridge_exitfn(d);
163 PCIESlot *ioh3420_init(PCIBus *bus, int devfn, bool multifunction,
164 const char *bus_name, pci_map_irq_fn map_irq,
165 uint8_t port, uint8_t chassis, uint16_t slot)
167 PCIDevice *d;
168 PCIBridge *br;
169 DeviceState *qdev;
171 d = pci_create_multifunction(bus, devfn, multifunction, "ioh3420");
172 if (!d) {
173 return NULL;
175 br = DO_UPCAST(PCIBridge, dev, d);
177 qdev = &br->dev.qdev;
178 pci_bridge_map_irq(br, bus_name, map_irq);
179 qdev_prop_set_uint8(qdev, "port", port);
180 qdev_prop_set_uint8(qdev, "chassis", chassis);
181 qdev_prop_set_uint16(qdev, "slot", slot);
182 qdev_init_nofail(qdev);
184 return DO_UPCAST(PCIESlot, port, DO_UPCAST(PCIEPort, br, br));
187 static const VMStateDescription vmstate_ioh3420 = {
188 .name = "ioh-3240-express-root-port",
189 .version_id = 1,
190 .minimum_version_id = 1,
191 .minimum_version_id_old = 1,
192 .post_load = pcie_cap_slot_post_load,
193 .fields = (VMStateField[]) {
194 VMSTATE_PCIE_DEVICE(port.br.dev, PCIESlot),
195 VMSTATE_STRUCT(port.br.dev.exp.aer_log, PCIESlot, 0,
196 vmstate_pcie_aer_log, PCIEAERLog),
197 VMSTATE_END_OF_LIST()
201 static Property ioh3420_properties[] = {
202 DEFINE_PROP_UINT8("port", PCIESlot, port.port, 0),
203 DEFINE_PROP_UINT8("chassis", PCIESlot, chassis, 0),
204 DEFINE_PROP_UINT16("slot", PCIESlot, slot, 0),
205 DEFINE_PROP_UINT16("aer_log_max", PCIESlot,
206 port.br.dev.exp.aer_log.log_max,
207 PCIE_AER_LOG_MAX_DEFAULT),
208 DEFINE_PROP_END_OF_LIST(),
211 static void ioh3420_class_init(ObjectClass *klass, void *data)
213 DeviceClass *dc = DEVICE_CLASS(klass);
214 PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
216 k->is_express = 1;
217 k->is_bridge = 1;
218 k->config_write = ioh3420_write_config;
219 k->init = ioh3420_initfn;
220 k->exit = ioh3420_exitfn;
221 k->vendor_id = PCI_VENDOR_ID_INTEL;
222 k->device_id = PCI_DEVICE_ID_IOH_EPORT;
223 k->revision = PCI_DEVICE_ID_IOH_REV;
224 dc->desc = "Intel IOH device id 3420 PCIE Root Port";
225 dc->reset = ioh3420_reset;
226 dc->vmsd = &vmstate_ioh3420;
227 dc->props = ioh3420_properties;
230 static TypeInfo ioh3420_info = {
231 .name = "ioh3420",
232 .parent = TYPE_PCI_DEVICE,
233 .instance_size = sizeof(PCIESlot),
234 .class_init = ioh3420_class_init,
237 static void ioh3420_register_types(void)
239 type_register_static(&ioh3420_info);
242 type_init(ioh3420_register_types)
245 * Local variables:
246 * c-indent-level: 4
247 * c-basic-offset: 4
248 * tab-width: 8
249 * indent-tab-mode: nil
250 * End: