Lines Matching refs:vmd
149 static inline unsigned int index_from_irqs(struct vmd_dev *vmd,
152 return irqs - vmd->irqs;
160 * handlers sharing that VMD IRQ. The vmd irq_domain provides the operations
167 struct vmd_dev *vmd = irq_data_get_irq_handler_data(data);
172 msg->arch_addr_lo.destid_0_7 = index_from_irqs(vmd, irq);
235 static struct vmd_irq_list *vmd_next_irq(struct vmd_dev *vmd, struct msi_desc *desc)
240 if (vmd->msix_count == 1 + vmd->first_vec)
241 return &vmd->irqs[vmd->first_vec];
251 return &vmd->irqs[vmd->first_vec];
255 best = vmd->first_vec + 1;
256 for (i = best; i < vmd->msix_count; i++)
257 if (vmd->irqs[i].count < vmd->irqs[best].count)
259 vmd->irqs[best].count++;
262 return &vmd->irqs[best];
270 struct vmd_dev *vmd = vmd_from_bus(msi_desc_to_pci_dev(desc)->bus);
277 vmdirq->irq = vmd_next_irq(vmd, desc);
281 handle_untracked_irq, vmd, NULL);
305 struct vmd_dev *vmd = vmd_from_bus(pdev->bus);
307 if (nvec > vmd->msix_count)
308 return vmd->msix_count;
334 static void vmd_set_msi_remapping(struct vmd_dev *vmd, bool enable)
338 pci_read_config_word(vmd->dev, PCI_REG_VMCONFIG, ®);
341 pci_write_config_word(vmd->dev, PCI_REG_VMCONFIG, reg);
344 static int vmd_create_irq_domain(struct vmd_dev *vmd)
348 fn = irq_domain_alloc_named_id_fwnode("VMD-MSI", vmd->sysdata.domain);
352 vmd->irq_domain = pci_msi_create_irq_domain(fn, &vmd_msi_domain_info, NULL);
353 if (!vmd->irq_domain) {
361 static void vmd_remove_irq_domain(struct vmd_dev *vmd)
367 if (!vmd->msix_count)
368 vmd_set_msi_remapping(vmd, true);
370 if (vmd->irq_domain) {
371 struct fwnode_handle *fn = vmd->irq_domain->fwnode;
373 irq_domain_remove(vmd->irq_domain);
378 static void __iomem *vmd_cfg_addr(struct vmd_dev *vmd, struct pci_bus *bus,
381 unsigned int busnr_ecam = bus->number - vmd->busn_start;
384 if (offset + len >= resource_size(&vmd->dev->resource[VMD_CFGBAR]))
387 return vmd->cfgbar + offset;
397 struct vmd_dev *vmd = vmd_from_bus(bus);
398 void __iomem *addr = vmd_cfg_addr(vmd, bus, devfn, reg, len);
405 spin_lock_irqsave(&vmd->cfg_lock, flags);
420 spin_unlock_irqrestore(&vmd->cfg_lock, flags);
432 struct vmd_dev *vmd = vmd_from_bus(bus);
433 void __iomem *addr = vmd_cfg_addr(vmd, bus, devfn, reg, len);
440 spin_lock_irqsave(&vmd->cfg_lock, flags);
458 spin_unlock_irqrestore(&vmd->cfg_lock, flags);
517 static void vmd_domain_reset(struct vmd_dev *vmd)
519 u16 bus, max_buses = resource_size(&vmd->resources[0]);
525 base = vmd->cfgbar + PCIE_ECAM_OFFSET(bus,
532 base = vmd->cfgbar + PCIE_ECAM_OFFSET(bus,
565 static void vmd_attach_resources(struct vmd_dev *vmd)
567 vmd->dev->resource[VMD_MEMBAR1].child = &vmd->resources[1];
568 vmd->dev->resource[VMD_MEMBAR2].child = &vmd->resources[2];
571 static void vmd_detach_resources(struct vmd_dev *vmd)
573 vmd->dev->resource[VMD_MEMBAR1].child = NULL;
574 vmd->dev->resource[VMD_MEMBAR2].child = NULL;
593 static int vmd_get_phys_offsets(struct vmd_dev *vmd, bool native_hint,
597 struct pci_dev *dev = vmd->dev;
647 static int vmd_get_bus_number_start(struct vmd_dev *vmd)
649 struct pci_dev *dev = vmd->dev;
658 vmd->busn_start = 0;
661 vmd->busn_start = 128;
664 vmd->busn_start = 224;
690 static int vmd_alloc_irqs(struct vmd_dev *vmd)
692 struct pci_dev *dev = vmd->dev;
695 vmd->msix_count = pci_msix_vec_count(dev);
696 if (vmd->msix_count < 0)
699 vmd->msix_count = pci_alloc_irq_vectors(dev, vmd->first_vec + 1,
700 vmd->msix_count, PCI_IRQ_MSIX);
701 if (vmd->msix_count < 0)
702 return vmd->msix_count;
704 vmd->irqs = devm_kcalloc(&dev->dev, vmd->msix_count, sizeof(*vmd->irqs),
706 if (!vmd->irqs)
709 for (i = 0; i < vmd->msix_count; i++) {
710 err = init_srcu_struct(&vmd->irqs[i].srcu);
714 INIT_LIST_HEAD(&vmd->irqs[i].irq_list);
715 vmd->irqs[i].virq = pci_irq_vector(dev, i);
716 err = devm_request_irq(&dev->dev, vmd->irqs[i].virq,
718 vmd->name, &vmd->irqs[i]);
781 static int vmd_enable_domain(struct vmd_dev *vmd, unsigned long features)
783 struct pci_sysdata *sd = &vmd->sysdata;
802 ret = vmd_get_phys_offsets(vmd, true, &offset[0], &offset[1]);
806 ret = vmd_get_phys_offsets(vmd, false, &offset[0], &offset[1]);
816 ret = vmd_get_bus_number_start(vmd);
821 res = &vmd->dev->resource[VMD_CFGBAR];
822 vmd->resources[0] = (struct resource) {
824 .start = vmd->busn_start,
825 .end = vmd->busn_start + (resource_size(res) >> 20) - 1,
846 res = &vmd->dev->resource[VMD_MEMBAR1];
851 vmd->resources[1] = (struct resource) {
859 res = &vmd->dev->resource[VMD_MEMBAR2];
864 vmd->resources[2] = (struct resource) {
872 sd->vmd_dev = vmd->dev;
877 sd->node = pcibus_to_node(vmd->dev->bus);
887 ret = vmd_alloc_irqs(vmd);
891 vmd_set_msi_remapping(vmd, true);
893 ret = vmd_create_irq_domain(vmd);
901 irq_domain_update_bus_token(vmd->irq_domain, DOMAIN_BUS_VMD_MSI);
903 vmd_set_msi_remapping(vmd, false);
906 pci_add_resource(&resources, &vmd->resources[0]);
907 pci_add_resource_offset(&resources, &vmd->resources[1], offset[0]);
908 pci_add_resource_offset(&resources, &vmd->resources[2], offset[1]);
910 vmd->bus = pci_create_root_bus(&vmd->dev->dev, vmd->busn_start,
912 if (!vmd->bus) {
914 vmd_remove_irq_domain(vmd);
918 vmd_copy_host_bridge_flags(pci_find_host_bridge(vmd->dev->bus),
919 to_pci_host_bridge(vmd->bus->bridge));
921 vmd_attach_resources(vmd);
922 if (vmd->irq_domain)
923 dev_set_msi_domain(&vmd->bus->dev, vmd->irq_domain);
925 dev_set_msi_domain(&vmd->bus->dev,
926 dev_get_msi_domain(&vmd->dev->dev));
930 pci_scan_child_bus(vmd->bus);
931 vmd_domain_reset(vmd);
940 list_for_each_entry(child, &vmd->bus->children, node) {
952 pci_assign_unassigned_bus_resources(vmd->bus);
954 pci_walk_bus(vmd->bus, vmd_pm_enable_quirk, &features);
961 list_for_each_entry(child, &vmd->bus->children, node)
964 pci_bus_add_devices(vmd->bus);
968 WARN(sysfs_create_link(&vmd->dev->dev.kobj, &vmd->bus->dev.kobj,
976 struct vmd_dev *vmd;
982 vmd = devm_kzalloc(&dev->dev, sizeof(*vmd), GFP_KERNEL);
983 if (!vmd)
986 vmd->dev = dev;
987 vmd->instance = ida_simple_get(&vmd_instance_ida, 0, 0, GFP_KERNEL);
988 if (vmd->instance < 0)
989 return vmd->instance;
991 vmd->name = devm_kasprintf(&dev->dev, GFP_KERNEL, "vmd%d",
992 vmd->instance);
993 if (!vmd->name) {
1002 vmd->cfgbar = pcim_iomap(dev, VMD_CFGBAR, 0);
1003 if (!vmd->cfgbar) {
1016 vmd->first_vec = 1;
1018 spin_lock_init(&vmd->cfg_lock);
1019 pci_set_drvdata(dev, vmd);
1020 err = vmd_enable_domain(vmd, features);
1024 dev_info(&vmd->dev->dev, "Bound to PCI domain %04x\n",
1025 vmd->sysdata.domain);
1029 ida_simple_remove(&vmd_instance_ida, vmd->instance);
1033 static void vmd_cleanup_srcu(struct vmd_dev *vmd)
1037 for (i = 0; i < vmd->msix_count; i++)
1038 cleanup_srcu_struct(&vmd->irqs[i].srcu);
1043 struct vmd_dev *vmd = pci_get_drvdata(dev);
1045 sysfs_remove_link(&vmd->dev->dev.kobj, "domain");
1046 pci_stop_root_bus(vmd->bus);
1047 pci_remove_root_bus(vmd->bus);
1048 vmd_cleanup_srcu(vmd);
1049 vmd_detach_resources(vmd);
1050 vmd_remove_irq_domain(vmd);
1051 ida_simple_remove(&vmd_instance_ida, vmd->instance);
1056 struct vmd_dev *vmd = pci_get_drvdata(dev);
1058 vmd_remove_irq_domain(vmd);
1065 struct vmd_dev *vmd = pci_get_drvdata(pdev);
1068 for (i = 0; i < vmd->msix_count; i++)
1069 devm_free_irq(dev, vmd->irqs[i].virq, &vmd->irqs[i]);
1077 struct vmd_dev *vmd = pci_get_drvdata(pdev);
1080 if (vmd->irq_domain)
1081 vmd_set_msi_remapping(vmd, true);
1083 vmd_set_msi_remapping(vmd, false);
1085 for (i = 0; i < vmd->msix_count; i++) {
1086 err = devm_request_irq(dev, vmd->irqs[i].virq,
1088 vmd->name, &vmd->irqs[i]);
1122 .name = "vmd",