1 /*
2  * RPA Virtual I/O device functions
3  * Copyright (C) 2004 Linda Xie <lxie@us.ibm.com>
4  *
5  * All rights reserved.
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or (at
10  * your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful, but
13  * WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
15  * NON INFRINGEMENT.  See the GNU General Public License for more
16  * details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21  *
22  * Send feedback to <lxie@us.ibm.com>
23  *
24  */
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/sysfs.h>
28 #include <linux/pci.h>
29 #include <linux/string.h>
30 #include <linux/slab.h>
31 
32 #include <asm/rtas.h>
33 #include "rpaphp.h"
34 
35 /* free up the memory used by a slot */
36 static void rpaphp_release_slot(struct hotplug_slot *hotplug_slot)
37 {
38 	struct slot *slot = (struct slot *) hotplug_slot->private;
39 	dealloc_slot_struct(slot);
40 }
41 
42 void dealloc_slot_struct(struct slot *slot)
43 {
44 	kfree(slot->hotplug_slot->info);
45 	kfree(slot->name);
46 	kfree(slot->hotplug_slot);
47 	kfree(slot);
48 }
49 
50 struct slot *alloc_slot_struct(struct device_node *dn,
51                        int drc_index, char *drc_name, int power_domain)
52 {
53 	struct slot *slot;
54 
55 	slot = kzalloc(sizeof(struct slot), GFP_KERNEL);
56 	if (!slot)
57 		goto error_nomem;
58 	slot->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
59 	if (!slot->hotplug_slot)
60 		goto error_slot;
61 	slot->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
62 					   GFP_KERNEL);
63 	if (!slot->hotplug_slot->info)
64 		goto error_hpslot;
65 	slot->name = kstrdup(drc_name, GFP_KERNEL);
66 	if (!slot->name)
67 		goto error_info;
68 	slot->dn = dn;
69 	slot->index = drc_index;
70 	slot->power_domain = power_domain;
71 	slot->hotplug_slot->private = slot;
72 	slot->hotplug_slot->ops = &rpaphp_hotplug_slot_ops;
73 	slot->hotplug_slot->release = &rpaphp_release_slot;
74 
75 	return (slot);
76 
77 error_info:
78 	kfree(slot->hotplug_slot->info);
79 error_hpslot:
80 	kfree(slot->hotplug_slot);
81 error_slot:
82 	kfree(slot);
83 error_nomem:
84 	return NULL;
85 }
86 
87 static int is_registered(struct slot *slot)
88 {
89 	struct slot *tmp_slot;
90 
91 	list_for_each_entry(tmp_slot, &rpaphp_slot_head, rpaphp_slot_list) {
92 		if (!strcmp(tmp_slot->name, slot->name))
93 			return 1;
94 	}
95 	return 0;
96 }
97 
98 int rpaphp_deregister_slot(struct slot *slot)
99 {
100 	int retval = 0;
101 	struct hotplug_slot *php_slot = slot->hotplug_slot;
102 
103 	 dbg("%s - Entry: deregistering slot=%s\n",
104 		__func__, slot->name);
105 
106 	list_del(&slot->rpaphp_slot_list);
107 
108 	retval = pci_hp_deregister(php_slot);
109 	if (retval)
110 		err("Problem unregistering a slot %s\n", slot->name);
111 
112 	dbg("%s - Exit: rc[%d]\n", __func__, retval);
113 	return retval;
114 }
115 EXPORT_SYMBOL_GPL(rpaphp_deregister_slot);
116 
117 int rpaphp_register_slot(struct slot *slot)
118 {
119 	struct hotplug_slot *php_slot = slot->hotplug_slot;
120 	int retval;
121 	int slotno;
122 
123 	dbg("%s registering slot:path[%s] index[%x], name[%s] pdomain[%x] type[%d]\n",
124 		__func__, slot->dn->full_name, slot->index, slot->name,
125 		slot->power_domain, slot->type);
126 
127 	/* should not try to register the same slot twice */
128 	if (is_registered(slot)) {
129 		err("rpaphp_register_slot: slot[%s] is already registered\n", slot->name);
130 		return -EAGAIN;
131 	}
132 
133 	if (slot->dn->child)
134 		slotno = PCI_SLOT(PCI_DN(slot->dn->child)->devfn);
135 	else
136 		slotno = -1;
137 	retval = pci_hp_register(php_slot, slot->bus, slotno, slot->name);
138 	if (retval) {
139 		err("pci_hp_register failed with error %d\n", retval);
140 		return retval;
141 	}
142 
143 	/* add slot to our internal list */
144 	list_add(&slot->rpaphp_slot_list, &rpaphp_slot_head);
145 	info("Slot [%s] registered\n", slot->name);
146 	return 0;
147 }
148