PCI: rpaphp: Remove another wrappered function
[platform/kernel/linux-starfive.git] / drivers / pci / hotplug / rpaphp_core.c
1 /*
2  * PCI Hot Plug Controller Driver for RPA-compliant PPC64 platform.
3  * Copyright (C) 2003 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/moduleparam.h>
28 #include <linux/pci.h>
29 #include <linux/pci_hotplug.h>
30 #include <linux/slab.h>
31 #include <linux/smp.h>
32 #include <linux/smp_lock.h>
33 #include <linux/init.h>
34 #include <asm/eeh.h>       /* for eeh_add_device() */
35 #include <asm/rtas.h>           /* rtas_call */
36 #include <asm/pci-bridge.h>     /* for pci_controller */
37 #include "../pci.h"             /* for pci_add_new_bus */
38                                 /* and pci_do_scan_bus */
39 #include "rpaphp.h"
40
41 int debug;
42 static struct semaphore rpaphp_sem;
43 LIST_HEAD(rpaphp_slot_head);
44
45 #define DRIVER_VERSION  "0.1"
46 #define DRIVER_AUTHOR   "Linda Xie <lxie@us.ibm.com>"
47 #define DRIVER_DESC     "RPA HOT Plug PCI Controller Driver"
48
49 #define MAX_LOC_CODE 128
50
51 MODULE_AUTHOR(DRIVER_AUTHOR);
52 MODULE_DESCRIPTION(DRIVER_DESC);
53 MODULE_LICENSE("GPL");
54
55 module_param(debug, bool, 0644);
56
57 static int rpaphp_get_attention_status(struct slot *slot)
58 {
59         return slot->hotplug_slot->info->attention_status;
60 }
61
62 /**
63  * set_attention_status - set attention LED
64  * echo 0 > attention -- set LED OFF
65  * echo 1 > attention -- set LED ON
66  * echo 2 > attention -- set LED ID(identify, light is blinking)
67  *
68  */
69 static int set_attention_status(struct hotplug_slot *hotplug_slot, u8 value)
70 {
71         int retval = 0;
72         struct slot *slot = (struct slot *)hotplug_slot->private;
73
74         down(&rpaphp_sem);
75         switch (value) {
76         case 0:
77                 retval = rpaphp_set_attention_status(slot, LED_OFF);
78                 hotplug_slot->info->attention_status = 0;
79                 break;
80         case 1:
81         default:
82                 retval = rpaphp_set_attention_status(slot, LED_ON);
83                 hotplug_slot->info->attention_status = 1;
84                 break;
85         case 2:
86                 retval = rpaphp_set_attention_status(slot, LED_ID);
87                 hotplug_slot->info->attention_status = 2;
88                 break;
89         }
90         up(&rpaphp_sem);
91         return retval;
92 }
93
94 /**
95  * get_power_status - get power status of a slot
96  * @hotplug_slot: slot to get status
97  * @value: pointer to store status
98  *
99  *
100  */
101 static int get_power_status(struct hotplug_slot *hotplug_slot, u8 * value)
102 {
103         int retval, level;
104         struct slot *slot = (struct slot *)hotplug_slot->private;
105
106         down(&rpaphp_sem);
107         retval = rtas_get_power_level (slot->power_domain, &level);
108         if (!retval)
109                 *value = level;
110         up(&rpaphp_sem);
111         return retval;
112 }
113
114 /**
115  * get_attention_status - get attention LED status
116  *
117  *
118  */
119 static int get_attention_status(struct hotplug_slot *hotplug_slot, u8 * value)
120 {
121         int retval = 0;
122         struct slot *slot = (struct slot *)hotplug_slot->private;
123
124         down(&rpaphp_sem);
125         *value = rpaphp_get_attention_status(slot);
126         up(&rpaphp_sem);
127         return retval;
128 }
129
130 static int get_adapter_status(struct hotplug_slot *hotplug_slot, u8 * value)
131 {
132         struct slot *slot = (struct slot *)hotplug_slot->private;
133         int rc, state;
134
135         down(&rpaphp_sem);
136         rc = rpaphp_get_sensor_state(slot, &state);
137         up(&rpaphp_sem);
138
139         *value = NOT_VALID;
140         if (rc)
141                 return rc;
142
143         if (state == EMPTY)
144                 *value = EMPTY;
145         else if (state == PRESENT)
146                 *value = slot->state;
147
148         return 0;
149 }
150
151 static int get_max_bus_speed(struct hotplug_slot *hotplug_slot, enum pci_bus_speed *value)
152 {
153         struct slot *slot = (struct slot *)hotplug_slot->private;
154
155         down(&rpaphp_sem);
156         switch (slot->type) {
157         case 1:
158         case 2:
159         case 3:
160         case 4:
161         case 5:
162         case 6:
163                 *value = PCI_SPEED_33MHz;       /* speed for case 1-6 */
164                 break;
165         case 7:
166         case 8:
167                 *value = PCI_SPEED_66MHz;
168                 break;
169         case 11:
170         case 14:
171                 *value = PCI_SPEED_66MHz_PCIX;
172                 break;
173         case 12:
174         case 15:
175                 *value = PCI_SPEED_100MHz_PCIX;
176                 break;
177         case 13:
178         case 16:
179                 *value = PCI_SPEED_133MHz_PCIX;
180                 break;
181         default:
182                 *value = PCI_SPEED_UNKNOWN;
183                 break;
184
185         }
186         up(&rpaphp_sem);
187         return 0;
188 }
189
190 static int get_children_props(struct device_node *dn, const int **drc_indexes,
191                 const int **drc_names, const int **drc_types,
192                 const int **drc_power_domains)
193 {
194         const int *indexes, *names, *types, *domains;
195
196         indexes = get_property(dn, "ibm,drc-indexes", NULL);
197         names = get_property(dn, "ibm,drc-names", NULL);
198         types = get_property(dn, "ibm,drc-types", NULL);
199         domains = get_property(dn, "ibm,drc-power-domains", NULL);
200
201         if (!indexes || !names || !types || !domains) {
202                 /* Slot does not have dynamically-removable children */
203                 return -EINVAL;
204         }
205         if (drc_indexes)
206                 *drc_indexes = indexes;
207         if (drc_names)
208                 /* &drc_names[1] contains NULL terminated slot names */
209                 *drc_names = names;
210         if (drc_types)
211                 /* &drc_types[1] contains NULL terminated slot types */
212                 *drc_types = types;
213         if (drc_power_domains)
214                 *drc_power_domains = domains;
215
216         return 0;
217 }
218
219 /* To get the DRC props describing the current node, first obtain it's
220  * my-drc-index property.  Next obtain the DRC list from it's parent.  Use
221  * the my-drc-index for correlation, and obtain the requested properties.
222  */
223 int rpaphp_get_drc_props(struct device_node *dn, int *drc_index,
224                 char **drc_name, char **drc_type, int *drc_power_domain)
225 {
226         const int *indexes, *names;
227         const int *types, *domains;
228         const unsigned int *my_index;
229         char *name_tmp, *type_tmp;
230         int i, rc;
231
232         my_index = get_property(dn, "ibm,my-drc-index", NULL);
233         if (!my_index) {
234                 /* Node isn't DLPAR/hotplug capable */
235                 return -EINVAL;
236         }
237
238         rc = get_children_props(dn->parent, &indexes, &names, &types, &domains);
239         if (rc < 0) {
240                 return -EINVAL;
241         }
242
243         name_tmp = (char *) &names[1];
244         type_tmp = (char *) &types[1];
245
246         /* Iterate through parent properties, looking for my-drc-index */
247         for (i = 0; i < indexes[0]; i++) {
248                 if ((unsigned int) indexes[i + 1] == *my_index) {
249                         if (drc_name)
250                                 *drc_name = name_tmp;
251                         if (drc_type)
252                                 *drc_type = type_tmp;
253                         if (drc_index)
254                                 *drc_index = *my_index;
255                         if (drc_power_domain)
256                                 *drc_power_domain = domains[i+1];
257                         return 0;
258                 }
259                 name_tmp += (strlen(name_tmp) + 1);
260                 type_tmp += (strlen(type_tmp) + 1);
261         }
262
263         return -EINVAL;
264 }
265
266 static int is_php_type(char *drc_type)
267 {
268         unsigned long value;
269         char *endptr;
270
271         /* PCI Hotplug nodes have an integer for drc_type */
272         value = simple_strtoul(drc_type, &endptr, 10);
273         if (endptr == drc_type)
274                 return 0;
275
276         return 1;
277 }
278
279 static int is_php_dn(struct device_node *dn, const int **indexes,
280                 const int **names, const int **types, const int **power_domains)
281 {
282         const int *drc_types;
283         int rc;
284
285         rc = get_children_props(dn, indexes, names, &drc_types, power_domains);
286         if (rc >= 0) {
287                 if (is_php_type((char *) &drc_types[1])) {
288                         *types = drc_types;
289                         return 1;
290                 }
291         }
292
293         return 0;
294 }
295
296 /**
297  * rpaphp_add_slot -- add hotplug or dlpar slot
298  *
299  *      rpaphp not only registers PCI hotplug slots(HOTPLUG), 
300  *      but also logical DR slots(EMBEDDED).
301  *      HOTPLUG slot: An adapter can be physically added/removed. 
302  *      EMBEDDED slot: An adapter can be logically removed/added
303  *                from/to a partition with the slot.
304  */
305 int rpaphp_add_slot(struct device_node *dn)
306 {
307         struct slot *slot;
308         int retval = 0;
309         int i;
310         const int *indexes, *names, *types, *power_domains;
311         char *name, *type;
312
313         if (!dn->name || strcmp(dn->name, "pci"))
314                 return 0;
315
316         if (!is_php_dn(dn, &indexes, &names, &types, &power_domains))
317                 return 0;
318
319         dbg("Entry %s: dn->full_name=%s\n", __FUNCTION__, dn->full_name);
320
321         /* register PCI devices */
322         name = (char *) &names[1];
323         type = (char *) &types[1];
324         for (i = 0; i < indexes[0]; i++) {
325
326                 slot = alloc_slot_struct(dn, indexes[i + 1], name, power_domains[i + 1]);
327                 if (!slot)
328                         return -ENOMEM;
329
330                 slot->type = simple_strtoul(type, NULL, 10);
331                                 
332                 dbg("Found drc-index:0x%x drc-name:%s drc-type:%s\n",
333                                 indexes[i + 1], name, type);
334
335                 retval = rpaphp_register_pci_slot(slot);
336                 if (retval)
337                         dealloc_slot_struct(slot);
338
339                 name += strlen(name) + 1;
340                 type += strlen(type) + 1;
341         }
342         dbg("%s - Exit: rc[%d]\n", __FUNCTION__, retval);
343
344         /* XXX FIXME: reports a failure only if last entry in loop failed */
345         return retval;
346 }
347
348 static void __exit cleanup_slots(void)
349 {
350         struct list_head *tmp, *n;
351         struct slot *slot;
352
353         /*
354          * Unregister all of our slots with the pci_hotplug subsystem,
355          * and free up all memory that we had allocated.
356          * memory will be freed in release_slot callback. 
357          */
358
359         list_for_each_safe(tmp, n, &rpaphp_slot_head) {
360                 slot = list_entry(tmp, struct slot, rpaphp_slot_list);
361                 list_del(&slot->rpaphp_slot_list);
362                 pci_hp_deregister(slot->hotplug_slot);
363         }
364         return;
365 }
366
367 static int __init rpaphp_init(void)
368 {
369         struct device_node *dn = NULL;
370
371         info(DRIVER_DESC " version: " DRIVER_VERSION "\n");
372         init_MUTEX(&rpaphp_sem);
373
374         while ((dn = of_find_node_by_name(dn, "pci")))
375                 rpaphp_add_slot(dn);
376
377         return 0;
378 }
379
380 static void __exit rpaphp_exit(void)
381 {
382         cleanup_slots();
383 }
384
385 static int __enable_slot(struct slot *slot)
386 {
387         int state;
388         int retval;
389
390         if (slot->state == CONFIGURED)
391                 return 0;
392
393         retval = rpaphp_get_sensor_state(slot, &state);
394         if (retval)
395                 return retval;
396
397         if (state == PRESENT) {
398                 pcibios_add_pci_devices(slot->bus);
399                 slot->state = CONFIGURED;
400         } else if (state == EMPTY) {
401                 slot->state = EMPTY;
402         } else {
403                 err("%s: slot[%s] is in invalid state\n", __FUNCTION__, slot->name);
404                 slot->state = NOT_VALID;
405                 return -EINVAL;
406         }
407         return 0;
408 }
409
410 static int enable_slot(struct hotplug_slot *hotplug_slot)
411 {
412         int retval;
413         struct slot *slot = (struct slot *)hotplug_slot->private;
414
415         down(&rpaphp_sem);
416         retval = __enable_slot(slot);
417         up(&rpaphp_sem);
418
419         return retval;
420 }
421
422 static int __disable_slot(struct slot *slot)
423 {
424         struct pci_dev *dev, *tmp;
425
426         if (slot->state == NOT_CONFIGURED)
427                 return -EINVAL;
428
429         list_for_each_entry_safe(dev, tmp, &slot->bus->devices, bus_list) {
430                 eeh_remove_bus_device(dev);
431                 pci_remove_bus_device(dev);
432         }
433
434         slot->state = NOT_CONFIGURED;
435         return 0;
436 }
437
438 static int disable_slot(struct hotplug_slot *hotplug_slot)
439 {
440         struct slot *slot = (struct slot *)hotplug_slot->private;
441         int retval;
442
443         down(&rpaphp_sem);
444         retval = __disable_slot (slot);
445         up(&rpaphp_sem);
446
447         return retval;
448 }
449
450 struct hotplug_slot_ops rpaphp_hotplug_slot_ops = {
451         .owner = THIS_MODULE,
452         .enable_slot = enable_slot,
453         .disable_slot = disable_slot,
454         .set_attention_status = set_attention_status,
455         .get_power_status = get_power_status,
456         .get_attention_status = get_attention_status,
457         .get_adapter_status = get_adapter_status,
458         .get_max_bus_speed = get_max_bus_speed,
459 };
460
461 module_init(rpaphp_init);
462 module_exit(rpaphp_exit);
463
464 EXPORT_SYMBOL_GPL(rpaphp_add_slot);
465 EXPORT_SYMBOL_GPL(rpaphp_slot_head);
466 EXPORT_SYMBOL_GPL(rpaphp_get_drc_props);