drivers/pci/hotplug/rpaphp_slot.c

   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/kobject.h>
  28 #include <linux/sysfs.h>
  29 #include <linux/pci.h>
  30 #include "rpaphp.h"
  31
  32 static ssize_t location_read_file (struct hotplug_slot *php_slot, char *buf)
  33 {
  34         char *value;
  35         int retval = -ENOENT;
  36         struct slot *slot = (struct slot *)php_slot->private;
  37
  38         if (!slot)
  39                 return retval;
  40
  41         value = slot->location;
  42         retval = sprintf (buf, "%s\n", value);
  43         return retval;
  44 }
  45
  46 static struct hotplug_slot_attribute hotplug_slot_attr_location = {
  47         .attr = {.name = "phy_location", .mode = S_IFREG | S_IRUGO},
  48         .show = location_read_file,
  49 };
  50
  51 static void rpaphp_sysfs_add_attr_location (struct hotplug_slot *slot)
  52 {
  53         sysfs_create_file(&slot->kobj, &hotplug_slot_attr_location.attr);
  54 }
  55
  56 void rpaphp_sysfs_remove_attr_location (struct hotplug_slot *slot)
  57 {
  58         sysfs_remove_file(&slot->kobj, &hotplug_slot_attr_location.attr);
  59 }
  60
  61 /* free up the memory user by a slot */
  62 static void rpaphp_release_slot(struct hotplug_slot *hotplug_slot)
  63 {
  64         struct slot *slot = hotplug_slot? (struct slot *) hotplug_slot->private:NULL;
  65
  66         if (slot == NULL)
  67                 return;
  68
  69         dealloc_slot_struct(slot);
  70 }
  71
  72 void dealloc_slot_struct(struct slot *slot)
  73 {
  74         kfree(slot->hotplug_slot->info);
  75         kfree(slot->hotplug_slot->name);
  76         kfree(slot->hotplug_slot);
  77         kfree(slot);
  78         return;
  79 }
  80
  81 struct slot *alloc_slot_struct(struct device_node *dn, int drc_index, char *drc_name,
  82                   int power_domain)
  83 {
  84         struct slot *slot;
  85
  86         dbg("Enter alloc_slot_struct(): dn->full_name=%s drc_index=0x%x drc_name=%s\n",
  87                 dn->full_name, drc_index, drc_name);
  88
  89         slot = kmalloc(sizeof (struct slot), GFP_KERNEL);
  90         if (!slot)
  91                 return (NULL);
  92         memset(slot, 0, sizeof (struct slot));
  93         slot->hotplug_slot = kmalloc(sizeof (struct hotplug_slot), GFP_KERNEL);
  94         if (!slot->hotplug_slot) {
  95                 kfree(slot);
  96                 return (NULL);
  97         }
  98         memset(slot->hotplug_slot, 0, sizeof (struct hotplug_slot));
  99         slot->hotplug_slot->info = kmalloc(sizeof (struct hotplug_slot_info),
 100                                            GFP_KERNEL);
 101         if (!slot->hotplug_slot->info) {
 102                 kfree(slot->hotplug_slot);
 103                 kfree(slot);
 104                 return (NULL);
 105         }
 106         memset(slot->hotplug_slot->info, 0, sizeof (struct hotplug_slot_info));
 107         slot->hotplug_slot->name = kmalloc(BUS_ID_SIZE + 1, GFP_KERNEL);
 108         if (!slot->hotplug_slot->name) {
 109                 kfree(slot->hotplug_slot->info);
 110                 kfree(slot->hotplug_slot);
 111                 kfree(slot);
 112                 return (NULL);
 113         }
 114         slot->location = kmalloc(strlen(drc_name) + 1, GFP_KERNEL);
 115         if (!slot->location) {
 116                 kfree(slot->hotplug_slot->info);
 117                 kfree(slot->hotplug_slot->name);
 118                 kfree(slot->hotplug_slot);
 119                 kfree(slot);
 120                 return (NULL);
 121         }
 122         slot->name = slot->hotplug_slot->name;
 123         slot->dn = dn;
 124         slot->index = drc_index;
 125         strcpy(slot->location, drc_name);
 126         slot->power_domain = power_domain;
 127         slot->magic = SLOT_MAGIC;
 128         slot->hotplug_slot->private = slot;
 129         slot->hotplug_slot->ops = &rpaphp_hotplug_slot_ops;
 130         slot->hotplug_slot->release = &rpaphp_release_slot;
 131         dbg("Exit alloc_slot_struct(): slot->dn->full_name=%s drc_index=0x%x drc_name=%s\n",
 132                 slot->dn->full_name, slot->index, slot->name);
 133         return (slot);
 134 }
 135
 136 int register_slot(struct slot *slot)
 137 {
 138         int retval;
 139         char *vio_uni_addr = NULL;
 140
 141         dbg("%s registering slot:path[%s] index[%x], name[%s] pdomain[%x] type[%d]\n", __FUNCTION__, slot->dn->full_name, slot->index, slot->name, slot->power_domain, slot->type);
 142
 143         retval = pci_hp_register(slot->hotplug_slot);
 144         if (retval) {
 145                 err("pci_hp_register failed with error %d\n", retval);
 146                 rpaphp_release_slot(slot->hotplug_slot);
 147                 return (retval);
 148         }
 149
 150         /* create "phy_locatoin" file */
 151         rpaphp_sysfs_add_attr_location(slot->hotplug_slot);
 152
 153         /* add slot to our internal list */
 154         dbg("%s adding slot[%s] to rpaphp_slot_list\n",
 155             __FUNCTION__, slot->name);
 156
 157         list_add(&slot->rpaphp_slot_list, &rpaphp_slot_head);
 158
 159         if (vio_uni_addr)
 160                 info("Slot [%s](vio_uni_addr=%s) registered\n",
 161                      slot->name, vio_uni_addr);
 162         else
 163                 info("Slot [%s](bus_id=%s) registered\n",
 164                      slot->name, pci_name(slot->bridge));
 165         num_slots++;
 166         return (0);
 167 }
 168
 169 int rpaphp_get_power_status(struct slot *slot, u8 * value)
 170 {
 171         int rc;
 172
 173         rc = rtas_get_power_level(slot->power_domain, (int *) value);
 174         if (rc)
 175                 err("failed to get power-level for slot(%s), rc=0x%x\n",
 176                     slot->name, rc);
 177
 178         return rc;
 179 }
 180
 181 int rpaphp_set_attention_status(struct slot *slot, u8 status)
 182 {
 183         int rc;
 184
 185         /* status: LED_OFF or LED_ON */
 186         rc = rtas_set_indicator(DR_INDICATOR, slot->index, status);
 187         if (rc)
 188                 err("slot(%s) set attention-status(%d) failed! rc=0x%x\n",
 189                     slot->name, status, rc);
 190
 191         return rc;
 192 }