diff options
Diffstat (limited to 'drivers/pci/probe.c')
-rw-r--r-- | drivers/pci/probe.c | 92 |
1 files changed, 92 insertions, 0 deletions
diff --git a/drivers/pci/probe.c b/drivers/pci/probe.c index a3b0a5eb5054..e159d6604494 100644 --- a/drivers/pci/probe.c +++ b/drivers/pci/probe.c | |||
@@ -1067,3 +1067,95 @@ EXPORT_SYMBOL(pci_scan_bridge); | |||
1067 | EXPORT_SYMBOL(pci_scan_single_device); | 1067 | EXPORT_SYMBOL(pci_scan_single_device); |
1068 | EXPORT_SYMBOL_GPL(pci_scan_child_bus); | 1068 | EXPORT_SYMBOL_GPL(pci_scan_child_bus); |
1069 | #endif | 1069 | #endif |
1070 | |||
1071 | static int __init pci_sort_bf_cmp(const struct pci_dev *a, const struct pci_dev *b) | ||
1072 | { | ||
1073 | if (pci_domain_nr(a->bus) < pci_domain_nr(b->bus)) return -1; | ||
1074 | else if (pci_domain_nr(a->bus) > pci_domain_nr(b->bus)) return 1; | ||
1075 | |||
1076 | if (a->bus->number < b->bus->number) return -1; | ||
1077 | else if (a->bus->number > b->bus->number) return 1; | ||
1078 | |||
1079 | if (a->devfn < b->devfn) return -1; | ||
1080 | else if (a->devfn > b->devfn) return 1; | ||
1081 | |||
1082 | return 0; | ||
1083 | } | ||
1084 | |||
1085 | /* | ||
1086 | * Yes, this forcably breaks the klist abstraction temporarily. It | ||
1087 | * just wants to sort the klist, not change reference counts and | ||
1088 | * take/drop locks rapidly in the process. It does all this while | ||
1089 | * holding the lock for the list, so objects can't otherwise be | ||
1090 | * added/removed while we're swizzling. | ||
1091 | */ | ||
1092 | static void __init pci_insertion_sort_klist(struct pci_dev *a, struct list_head *list) | ||
1093 | { | ||
1094 | struct list_head *pos; | ||
1095 | struct klist_node *n; | ||
1096 | struct device *dev; | ||
1097 | struct pci_dev *b; | ||
1098 | |||
1099 | list_for_each(pos, list) { | ||
1100 | n = container_of(pos, struct klist_node, n_node); | ||
1101 | dev = container_of(n, struct device, knode_bus); | ||
1102 | b = to_pci_dev(dev); | ||
1103 | if (pci_sort_bf_cmp(a, b) <= 0) { | ||
1104 | list_move_tail(&a->dev.knode_bus.n_node, &b->dev.knode_bus.n_node); | ||
1105 | return; | ||
1106 | } | ||
1107 | } | ||
1108 | list_move_tail(&a->dev.knode_bus.n_node, list); | ||
1109 | } | ||
1110 | |||
1111 | static void __init pci_sort_breadthfirst_klist(void) | ||
1112 | { | ||
1113 | LIST_HEAD(sorted_devices); | ||
1114 | struct list_head *pos, *tmp; | ||
1115 | struct klist_node *n; | ||
1116 | struct device *dev; | ||
1117 | struct pci_dev *pdev; | ||
1118 | |||
1119 | spin_lock(&pci_bus_type.klist_devices.k_lock); | ||
1120 | list_for_each_safe(pos, tmp, &pci_bus_type.klist_devices.k_list) { | ||
1121 | n = container_of(pos, struct klist_node, n_node); | ||
1122 | dev = container_of(n, struct device, knode_bus); | ||
1123 | pdev = to_pci_dev(dev); | ||
1124 | pci_insertion_sort_klist(pdev, &sorted_devices); | ||
1125 | } | ||
1126 | list_splice(&sorted_devices, &pci_bus_type.klist_devices.k_list); | ||
1127 | spin_unlock(&pci_bus_type.klist_devices.k_lock); | ||
1128 | } | ||
1129 | |||
1130 | static void __init pci_insertion_sort_devices(struct pci_dev *a, struct list_head *list) | ||
1131 | { | ||
1132 | struct pci_dev *b; | ||
1133 | |||
1134 | list_for_each_entry(b, list, global_list) { | ||
1135 | if (pci_sort_bf_cmp(a, b) <= 0) { | ||
1136 | list_move_tail(&a->global_list, &b->global_list); | ||
1137 | return; | ||
1138 | } | ||
1139 | } | ||
1140 | list_move_tail(&a->global_list, list); | ||
1141 | } | ||
1142 | |||
1143 | static void __init pci_sort_breadthfirst_devices(void) | ||
1144 | { | ||
1145 | LIST_HEAD(sorted_devices); | ||
1146 | struct pci_dev *dev, *tmp; | ||
1147 | |||
1148 | down_write(&pci_bus_sem); | ||
1149 | list_for_each_entry_safe(dev, tmp, &pci_devices, global_list) { | ||
1150 | pci_insertion_sort_devices(dev, &sorted_devices); | ||
1151 | } | ||
1152 | list_splice(&sorted_devices, &pci_devices); | ||
1153 | up_write(&pci_bus_sem); | ||
1154 | } | ||
1155 | |||
1156 | void __init pci_sort_breadthfirst(void) | ||
1157 | { | ||
1158 | pci_sort_breadthfirst_devices(); | ||
1159 | pci_sort_breadthfirst_klist(); | ||
1160 | } | ||
1161 | |||