LXR linux/drivers/pci/hotplug/rpaphp

   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 */
  36static 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
  42void 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
  50struct 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
  77error_info:
  78        kfree(slot->hotplug_slot->info);
  79error_hpslot:
  80        kfree(slot->hotplug_slot);
  81error_slot:
  82        kfree(slot);
  83error_nomem:
  84        return NULL;
  85}
  86
  87static 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
  98int 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}
 115EXPORT_SYMBOL_GPL(rpaphp_deregister_slot);
 116
 117int 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
 149