Commit | Line | Data |
---|---|---|
736759ef | 1 | // SPDX-License-Identifier: GPL-2.0+ |
1da177e4 | 2 | /* |
f7625980 | 3 | * RPA Virtual I/O device functions |
1da177e4 LT |
4 | * Copyright (C) 2004 Linda Xie <lxie@us.ibm.com> |
5 | * | |
6 | * All rights reserved. | |
7 | * | |
1da177e4 LT |
8 | * Send feedback to <lxie@us.ibm.com> |
9 | * | |
10 | */ | |
11 | #include <linux/kernel.h> | |
12 | #include <linux/module.h> | |
1da177e4 LT |
13 | #include <linux/sysfs.h> |
14 | #include <linux/pci.h> | |
4e57b681 TS |
15 | #include <linux/string.h> |
16 | #include <linux/slab.h> | |
17 | ||
1da177e4 LT |
18 | #include <asm/rtas.h> |
19 | #include "rpaphp.h" | |
20 | ||
1da177e4 | 21 | /* free up the memory used by a slot */ |
1da177e4 LT |
22 | void dealloc_slot_struct(struct slot *slot) |
23 | { | |
b2132fec | 24 | kfree(slot->name); |
1da177e4 | 25 | kfree(slot); |
1da177e4 LT |
26 | } |
27 | ||
5fd39c35 | 28 | struct slot *alloc_slot_struct(struct device_node *dn, |
ff3ce480 | 29 | int drc_index, char *drc_name, int power_domain) |
1da177e4 LT |
30 | { |
31 | struct slot *slot; | |
f7625980 | 32 | |
f5afe806 | 33 | slot = kzalloc(sizeof(struct slot), GFP_KERNEL); |
1da177e4 LT |
34 | if (!slot) |
35 | goto error_nomem; | |
b2132fec AC |
36 | slot->name = kstrdup(drc_name, GFP_KERNEL); |
37 | if (!slot->name) | |
125450f8 | 38 | goto error_slot; |
1da177e4 LT |
39 | slot->dn = dn; |
40 | slot->index = drc_index; | |
1da177e4 | 41 | slot->power_domain = power_domain; |
125450f8 | 42 | slot->hotplug_slot.ops = &rpaphp_hotplug_slot_ops; |
f7625980 | 43 | |
1da177e4 LT |
44 | return (slot); |
45 | ||
1da177e4 LT |
46 | error_slot: |
47 | kfree(slot); | |
48 | error_nomem: | |
49 | return NULL; | |
50 | } | |
51 | ||
52 | static int is_registered(struct slot *slot) | |
53 | { | |
5fd39c35 | 54 | struct slot *tmp_slot; |
1da177e4 LT |
55 | |
56 | list_for_each_entry(tmp_slot, &rpaphp_slot_head, rpaphp_slot_list) { | |
57 | if (!strcmp(tmp_slot->name, slot->name)) | |
58 | return 1; | |
f7625980 | 59 | } |
1da177e4 LT |
60 | return 0; |
61 | } | |
62 | ||
f6afbad8 | 63 | int rpaphp_deregister_slot(struct slot *slot) |
1da177e4 LT |
64 | { |
65 | int retval = 0; | |
125450f8 | 66 | struct hotplug_slot *php_slot = &slot->hotplug_slot; |
1da177e4 LT |
67 | |
68 | dbg("%s - Entry: deregistering slot=%s\n", | |
66bef8c0 | 69 | __func__, slot->name); |
1da177e4 LT |
70 | |
71 | list_del(&slot->rpaphp_slot_list); | |
51bbf9be LW |
72 | pci_hp_deregister(php_slot); |
73 | dealloc_slot_struct(slot); | |
1da177e4 | 74 | |
66bef8c0 | 75 | dbg("%s - Exit: rc[%d]\n", __func__, retval); |
1da177e4 LT |
76 | return retval; |
77 | } | |
61ee9cd5 | 78 | EXPORT_SYMBOL_GPL(rpaphp_deregister_slot); |
1da177e4 | 79 | |
f6afbad8 | 80 | int rpaphp_register_slot(struct slot *slot) |
1da177e4 | 81 | { |
125450f8 | 82 | struct hotplug_slot *php_slot = &slot->hotplug_slot; |
e2413a7d TD |
83 | struct device_node *child; |
84 | u32 my_index; | |
1da177e4 | 85 | int retval; |
e2413a7d | 86 | int slotno = -1; |
1da177e4 | 87 | |
b63773a8 RH |
88 | dbg("%s registering slot:path[%pOF] index[%x], name[%s] pdomain[%x] type[%d]\n", |
89 | __func__, slot->dn, slot->index, slot->name, | |
1da177e4 | 90 | slot->power_domain, slot->type); |
f1e79092 | 91 | |
1da177e4 | 92 | /* should not try to register the same slot twice */ |
f1e79092 | 93 | if (is_registered(slot)) { |
f6afbad8 | 94 | err("rpaphp_register_slot: slot[%s] is already registered\n", slot->name); |
3499f072 | 95 | return -EAGAIN; |
f7625980 | 96 | } |
f1e79092 | 97 | |
e2413a7d TD |
98 | for_each_child_of_node(slot->dn, child) { |
99 | retval = of_property_read_u32(child, "ibm,my-drc-index", &my_index); | |
100 | if (my_index == slot->index) { | |
101 | slotno = PCI_SLOT(PCI_DN(child)->devfn); | |
102 | of_node_put(child); | |
103 | break; | |
104 | } | |
105 | } | |
106 | ||
1359f270 | 107 | retval = pci_hp_register(php_slot, slot->bus, slotno, slot->name); |
1da177e4 LT |
108 | if (retval) { |
109 | err("pci_hp_register failed with error %d\n", retval); | |
3499f072 | 110 | return retval; |
1da177e4 | 111 | } |
1da177e4 | 112 | |
f1e79092 | 113 | /* add slot to our internal list */ |
1da177e4 | 114 | list_add(&slot->rpaphp_slot_list, &rpaphp_slot_head); |
1b7c9fca | 115 | info("Slot [%s] registered\n", slot->name); |
1da177e4 LT |
116 | return 0; |
117 | } |