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