2 * PCI Hot Plug Controller Driver for System z
4 * Copyright 2012 IBM Corp.
7 * Jan Glauber <jang@linux.vnet.ibm.com>
10 #define COMPONENT "zPCI hpc"
11 #define pr_fmt(fmt) COMPONENT ": " fmt
13 #include <linux/module.h>
14 #include <linux/kernel.h>
15 #include <linux/slab.h>
16 #include <linux/pci.h>
17 #include <linux/pci_hotplug.h>
18 #include <linux/init.h>
19 #include <asm/pci_debug.h>
22 #define SLOT_NAME_SIZE 10
23 static LIST_HEAD(s390_hotplug_slot_list
);
25 MODULE_AUTHOR("Jan Glauber <jang@linux.vnet.ibm.com");
26 MODULE_DESCRIPTION("Hot Plug PCI Controller for System z");
27 MODULE_LICENSE("GPL");
29 static int zpci_fn_configured(enum zpci_state state
)
31 return state
== ZPCI_FN_STATE_CONFIGURED
||
32 state
== ZPCI_FN_STATE_ONLINE
;
36 * struct slot - slot information for each *physical* slot
39 struct list_head slot_list
;
40 struct hotplug_slot
*hotplug_slot
;
41 struct zpci_dev
*zdev
;
44 static inline int slot_configure(struct slot
*slot
)
46 int ret
= sclp_pci_configure(slot
->zdev
->fid
);
48 zpci_dbg(3, "conf fid:%x, rc:%d\n", slot
->zdev
->fid
, ret
);
50 slot
->zdev
->state
= ZPCI_FN_STATE_CONFIGURED
;
55 static inline int slot_deconfigure(struct slot
*slot
)
57 int ret
= sclp_pci_deconfigure(slot
->zdev
->fid
);
59 zpci_dbg(3, "deconf fid:%x, rc:%d\n", slot
->zdev
->fid
, ret
);
61 slot
->zdev
->state
= ZPCI_FN_STATE_STANDBY
;
66 static int enable_slot(struct hotplug_slot
*hotplug_slot
)
68 struct slot
*slot
= hotplug_slot
->private;
71 if (slot
->zdev
->state
!= ZPCI_FN_STATE_STANDBY
)
74 rc
= slot_configure(slot
);
78 rc
= zpci_enable_device(slot
->zdev
);
82 pci_scan_slot(slot
->zdev
->bus
, ZPCI_DEVFN
);
83 pci_lock_rescan_remove();
84 pci_bus_add_devices(slot
->zdev
->bus
);
85 pci_unlock_rescan_remove();
90 slot_deconfigure(slot
);
94 static int disable_slot(struct hotplug_slot
*hotplug_slot
)
96 struct slot
*slot
= hotplug_slot
->private;
99 if (!zpci_fn_configured(slot
->zdev
->state
))
102 if (slot
->zdev
->pdev
)
103 pci_stop_and_remove_bus_device_locked(slot
->zdev
->pdev
);
105 rc
= zpci_disable_device(slot
->zdev
);
109 return slot_deconfigure(slot
);
112 static int get_power_status(struct hotplug_slot
*hotplug_slot
, u8
*value
)
114 struct slot
*slot
= hotplug_slot
->private;
116 switch (slot
->zdev
->state
) {
117 case ZPCI_FN_STATE_STANDBY
:
127 static int get_adapter_status(struct hotplug_slot
*hotplug_slot
, u8
*value
)
129 /* if the slot exits it always contains a function */
134 static void release_slot(struct hotplug_slot
*hotplug_slot
)
136 struct slot
*slot
= hotplug_slot
->private;
138 kfree(slot
->hotplug_slot
->info
);
139 kfree(slot
->hotplug_slot
);
143 static struct hotplug_slot_ops s390_hotplug_slot_ops
= {
144 .enable_slot
= enable_slot
,
145 .disable_slot
= disable_slot
,
146 .get_power_status
= get_power_status
,
147 .get_adapter_status
= get_adapter_status
,
150 int zpci_init_slot(struct zpci_dev
*zdev
)
152 struct hotplug_slot
*hotplug_slot
;
153 struct hotplug_slot_info
*info
;
154 char name
[SLOT_NAME_SIZE
];
161 slot
= kzalloc(sizeof(*slot
), GFP_KERNEL
);
165 hotplug_slot
= kzalloc(sizeof(*hotplug_slot
), GFP_KERNEL
);
168 hotplug_slot
->private = slot
;
170 slot
->hotplug_slot
= hotplug_slot
;
173 info
= kzalloc(sizeof(*info
), GFP_KERNEL
);
176 hotplug_slot
->info
= info
;
178 hotplug_slot
->ops
= &s390_hotplug_slot_ops
;
179 hotplug_slot
->release
= &release_slot
;
181 get_power_status(hotplug_slot
, &info
->power_status
);
182 get_adapter_status(hotplug_slot
, &info
->adapter_status
);
184 snprintf(name
, SLOT_NAME_SIZE
, "%08x", zdev
->fid
);
185 rc
= pci_hp_register(slot
->hotplug_slot
, zdev
->bus
,
190 list_add(&slot
->slot_list
, &s390_hotplug_slot_list
);
203 void zpci_exit_slot(struct zpci_dev
*zdev
)
205 struct list_head
*tmp
, *n
;
208 list_for_each_safe(tmp
, n
, &s390_hotplug_slot_list
) {
209 slot
= list_entry(tmp
, struct slot
, slot_list
);
210 if (slot
->zdev
!= zdev
)
212 list_del(&slot
->slot_list
);
213 pci_hp_deregister(slot
->hotplug_slot
);