xref: /kvmtool/pci.c (revision 3a60be06942944e25fe39726b1849d7e3bf252b6)
160742802SPekka Enberg #include "kvm/pci.h"
260742802SPekka Enberg #include "kvm/ioport.h"
376f9c841SCyrill Gorcunov #include "kvm/util.h"
49575e724SSasha Levin #include "kvm/kvm.h"
560742802SPekka Enberg 
6b30d05adSPekka Enberg #include <assert.h>
760742802SPekka Enberg 
89575e724SSasha Levin #define PCI_BAR_OFFSET(b)		(offsetof(struct pci_device_header, bar[b]))
9b30d05adSPekka Enberg 
10b30d05adSPekka Enberg static struct pci_device_header		*pci_devices[PCI_MAX_DEVICES];
11b30d05adSPekka Enberg 
12aa73be70SMatt Evans static union pci_config_address		pci_config_address;
1360742802SPekka Enberg 
1440f2fd06SMatt Evans /* This is within our PCI gap - in an unused area.
1540f2fd06SMatt Evans  * Note this is a PCI *bus address*, is used to assign BARs etc.!
1640f2fd06SMatt Evans  * (That's why it can still 32bit even with 64bit guests-- 64bit
1740f2fd06SMatt Evans  * PCI isn't currently supported.)
1840f2fd06SMatt Evans  */
1940f2fd06SMatt Evans static u32 io_space_blocks		= KVM_PCI_MMIO_AREA;
209575e724SSasha Levin 
2195d13a52SSasha Levin u32 pci_get_io_space_block(u32 size)
229575e724SSasha Levin {
239575e724SSasha Levin 	u32 block = io_space_blocks;
2495d13a52SSasha Levin 	io_space_blocks += size;
259575e724SSasha Levin 
269575e724SSasha Levin 	return block;
279575e724SSasha Levin }
289575e724SSasha Levin 
293fdf659dSSasha Levin static void *pci_config_address_ptr(u16 port)
30ba824677SPekka Enberg {
31ba824677SPekka Enberg 	unsigned long offset;
32ba824677SPekka Enberg 	void *base;
33ba824677SPekka Enberg 
34ba824677SPekka Enberg 	offset		= port - PCI_CONFIG_ADDRESS;
35ba824677SPekka Enberg 	base		= &pci_config_address;
36ba824677SPekka Enberg 
37ba824677SPekka Enberg 	return base + offset;
38ba824677SPekka Enberg }
39ba824677SPekka Enberg 
40c9f6a037SXiao Guangrong static bool pci_config_address_out(struct ioport *ioport, struct kvm *kvm, u16 port, void *data, int size)
4160742802SPekka Enberg {
42ba824677SPekka Enberg 	void *p = pci_config_address_ptr(port);
4360742802SPekka Enberg 
44ba824677SPekka Enberg 	memcpy(p, data, size);
4560742802SPekka Enberg 
4660742802SPekka Enberg 	return true;
4760742802SPekka Enberg }
4860742802SPekka Enberg 
49c9f6a037SXiao Guangrong static bool pci_config_address_in(struct ioport *ioport, struct kvm *kvm, u16 port, void *data, int size)
5060742802SPekka Enberg {
51ba824677SPekka Enberg 	void *p = pci_config_address_ptr(port);
5260742802SPekka Enberg 
53ba824677SPekka Enberg 	memcpy(data, p, size);
5460742802SPekka Enberg 
5560742802SPekka Enberg 	return true;
5660742802SPekka Enberg }
5760742802SPekka Enberg 
58305b72ceSCyrill Gorcunov static struct ioport_operations pci_config_address_ops = {
59305b72ceSCyrill Gorcunov 	.io_in		= pci_config_address_in,
60305b72ceSCyrill Gorcunov 	.io_out		= pci_config_address_out,
6160742802SPekka Enberg };
6260742802SPekka Enberg 
633fdf659dSSasha Levin static bool pci_device_exists(u8 bus_number, u8 device_number, u8 function_number)
6476f9c841SCyrill Gorcunov {
65b30d05adSPekka Enberg 	struct pci_device_header *dev;
66b30d05adSPekka Enberg 
6776f9c841SCyrill Gorcunov 	if (pci_config_address.bus_number != bus_number)
6876f9c841SCyrill Gorcunov 		return false;
6976f9c841SCyrill Gorcunov 
70b30d05adSPekka Enberg 	if (pci_config_address.function_number != function_number)
7176f9c841SCyrill Gorcunov 		return false;
7276f9c841SCyrill Gorcunov 
73b30d05adSPekka Enberg 	if (device_number >= PCI_MAX_DEVICES)
74b30d05adSPekka Enberg 		return false;
75b30d05adSPekka Enberg 
76b30d05adSPekka Enberg 	dev		= pci_devices[device_number];
77b30d05adSPekka Enberg 
78b30d05adSPekka Enberg 	return dev != NULL;
7976f9c841SCyrill Gorcunov }
8076f9c841SCyrill Gorcunov 
81c9f6a037SXiao Guangrong static bool pci_config_data_out(struct ioport *ioport, struct kvm *kvm, u16 port, void *data, int size)
829575e724SSasha Levin {
839575e724SSasha Levin 	/*
849575e724SSasha Levin 	 * If someone accesses PCI configuration space offsets that are not
859575e724SSasha Levin 	 * aligned to 4 bytes, it uses ioports to signify that.
869575e724SSasha Levin 	 */
87d0297a59SMatt Evans 	pci_config_address.reg_offset = port - PCI_CONFIG_DATA;
889575e724SSasha Levin 
89d0297a59SMatt Evans 	pci__config_wr(kvm, pci_config_address, data, size);
90d0297a59SMatt Evans 
91d0297a59SMatt Evans 	return true;
92d0297a59SMatt Evans }
93d0297a59SMatt Evans 
94d0297a59SMatt Evans static bool pci_config_data_in(struct ioport *ioport, struct kvm *kvm, u16 port, void *data, int size)
95d0297a59SMatt Evans {
96d0297a59SMatt Evans 	/*
97d0297a59SMatt Evans 	 * If someone accesses PCI configuration space offsets that are not
98d0297a59SMatt Evans 	 * aligned to 4 bytes, it uses ioports to signify that.
99d0297a59SMatt Evans 	 */
100d0297a59SMatt Evans 	pci_config_address.reg_offset = port - PCI_CONFIG_DATA;
101d0297a59SMatt Evans 
102d0297a59SMatt Evans 	pci__config_rd(kvm, pci_config_address, data, size);
103d0297a59SMatt Evans 
104d0297a59SMatt Evans 	return true;
105d0297a59SMatt Evans }
106d0297a59SMatt Evans 
107d0297a59SMatt Evans static struct ioport_operations pci_config_data_ops = {
108d0297a59SMatt Evans 	.io_in		= pci_config_data_in,
109d0297a59SMatt Evans 	.io_out		= pci_config_data_out,
110d0297a59SMatt Evans };
111d0297a59SMatt Evans 
112d0297a59SMatt Evans void pci__config_wr(struct kvm *kvm, union pci_config_address addr, void *data, int size)
113d0297a59SMatt Evans {
114d0297a59SMatt Evans 	u8 dev_num;
115d0297a59SMatt Evans 
116d0297a59SMatt Evans 	dev_num		= addr.device_number;
1179575e724SSasha Levin 
1189575e724SSasha Levin 	if (pci_device_exists(0, dev_num, 0)) {
1199575e724SSasha Levin 		unsigned long offset;
1209575e724SSasha Levin 
121d0297a59SMatt Evans 		offset = addr.w & 0xff;
1229575e724SSasha Levin 		if (offset < sizeof(struct pci_device_header)) {
1239575e724SSasha Levin 			void *p = pci_devices[dev_num];
1247e012d3cSSasha Levin 			u8 bar = (offset - PCI_BAR_OFFSET(0)) / (sizeof(u32));
1259575e724SSasha Levin 			u32 sz = PCI_IO_SIZE;
1269575e724SSasha Levin 
127c64f7ff0SSasha Levin 			if (bar < 6 && pci_devices[dev_num]->bar_size[bar])
128c64f7ff0SSasha Levin 				sz = pci_devices[dev_num]->bar_size[bar];
129c64f7ff0SSasha Levin 
1309575e724SSasha Levin 			/*
1319575e724SSasha Levin 			 * If the kernel masks the BAR it would expect to find the
1329575e724SSasha Levin 			 * size of the BAR there next time it reads from it.
1339575e724SSasha Levin 			 * When the kernel got the size it would write the address
1349575e724SSasha Levin 			 * back.
1359575e724SSasha Levin 			 */
136aa73be70SMatt Evans 			if (*(u32 *)(p + offset)) {
1379575e724SSasha Levin 				/* See if kernel tries to mask one of the BARs */
1389575e724SSasha Levin 				if ((offset >= PCI_BAR_OFFSET(0)) &&
139c64f7ff0SSasha Levin 				    (offset <= PCI_BAR_OFFSET(6)) &&
140c64f7ff0SSasha Levin 				    (ioport__read32(data)  == 0xFFFFFFFF))
1419575e724SSasha Levin 					memcpy(p + offset, &sz, sizeof(sz));
1429575e724SSasha Levin 				    else
1439575e724SSasha Levin 					memcpy(p + offset, data, size);
1449575e724SSasha Levin 			}
1459575e724SSasha Levin 		}
1469575e724SSasha Levin 	}
1479575e724SSasha Levin }
1489575e724SSasha Levin 
149d0297a59SMatt Evans void pci__config_rd(struct kvm *kvm, union pci_config_address addr, void *data, int size)
15060742802SPekka Enberg {
1513fdf659dSSasha Levin 	u8 dev_num;
152e4d2cea2SPekka Enberg 
153d0297a59SMatt Evans 	dev_num		= addr.device_number;
154b30d05adSPekka Enberg 
155b30d05adSPekka Enberg 	if (pci_device_exists(0, dev_num, 0)) {
156598419d5SPekka Enberg 		unsigned long offset;
157598419d5SPekka Enberg 
158d0297a59SMatt Evans 		offset = addr.w & 0xff;
159598419d5SPekka Enberg 		if (offset < sizeof(struct pci_device_header)) {
160b30d05adSPekka Enberg 			void *p = pci_devices[dev_num];
161b30d05adSPekka Enberg 
16218ae021aSPekka Enberg 			memcpy(data, p + offset, size);
163*3a60be06SSasha Levin 		} else {
164598419d5SPekka Enberg 			memset(data, 0x00, size);
165*3a60be06SSasha Levin 		}
166*3a60be06SSasha Levin 	} else {
167e498ea08SPekka Enberg 		memset(data, 0xff, size);
16860742802SPekka Enberg 	}
169*3a60be06SSasha Levin }
17060742802SPekka Enberg 
1713fdf659dSSasha Levin void pci__register(struct pci_device_header *dev, u8 dev_num)
172beb095ebSCyrill Gorcunov {
173b30d05adSPekka Enberg 	assert(dev_num < PCI_MAX_DEVICES);
174b30d05adSPekka Enberg 	pci_devices[dev_num]	= dev;
175beb095ebSCyrill Gorcunov }
176beb095ebSCyrill Gorcunov 
177d0297a59SMatt Evans struct pci_device_header *pci__find_dev(u8 dev_num)
178d0297a59SMatt Evans {
179d0297a59SMatt Evans 	assert(dev_num < PCI_MAX_DEVICES);
180d0297a59SMatt Evans 	return pci_devices[dev_num];
181d0297a59SMatt Evans }
182d0297a59SMatt Evans 
18360742802SPekka Enberg void pci__init(void)
18460742802SPekka Enberg {
1853d62dea6SSasha Levin 	ioport__register(PCI_CONFIG_DATA + 0, &pci_config_data_ops, 4, NULL);
1863d62dea6SSasha Levin 	ioport__register(PCI_CONFIG_ADDRESS + 0, &pci_config_address_ops, 4, NULL);
18760742802SPekka Enberg }
188