Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * PCI Express Hot Plug Controller Driver |
| 3 | * |
| 4 | * Copyright (C) 1995,2001 Compaq Computer Corporation |
| 5 | * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com) |
| 6 | * Copyright (C) 2001 IBM Corp. |
| 7 | * Copyright (C) 2003-2004 Intel Corporation |
| 8 | * |
| 9 | * All rights reserved. |
| 10 | * |
| 11 | * This program is free software; you can redistribute it and/or modify |
| 12 | * it under the terms of the GNU General Public License as published by |
| 13 | * the Free Software Foundation; either version 2 of the License, or (at |
| 14 | * your option) any later version. |
| 15 | * |
| 16 | * This program is distributed in the hope that it will be useful, but |
| 17 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 18 | * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or |
| 19 | * NON INFRINGEMENT. See the GNU General Public License for more |
| 20 | * details. |
| 21 | * |
| 22 | * You should have received a copy of the GNU General Public License |
| 23 | * along with this program; if not, write to the Free Software |
| 24 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| 25 | * |
Kristen Accardi | 8cf4c19 | 2005-08-16 15:16:10 -0700 | [diff] [blame] | 26 | * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | * |
| 28 | */ |
| 29 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | #include <linux/module.h> |
| 31 | #include <linux/moduleparam.h> |
| 32 | #include <linux/kernel.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 33 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | #include <linux/types.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | #include <linux/pci.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | #include "pciehp.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | #include <linux/interrupt.h> |
Kristen Carlson Accardi | 34d0341 | 2007-01-09 13:02:36 -0800 | [diff] [blame] | 38 | #include <linux/time.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | |
| 40 | /* Global variables */ |
Rusty Russell | 90ab5ee | 2012-01-13 09:32:20 +1030 | [diff] [blame] | 41 | bool pciehp_debug; |
| 42 | bool pciehp_poll_mode; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | int pciehp_poll_time; |
Rusty Russell | 90ab5ee | 2012-01-13 09:32:20 +1030 | [diff] [blame] | 44 | bool pciehp_force; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | |
| 46 | #define DRIVER_VERSION "0.4" |
| 47 | #define DRIVER_AUTHOR "Dan Zink <dan.zink@compaq.com>, Greg Kroah-Hartman <greg@kroah.com>, Dely Sy <dely.l.sy@intel.com>" |
| 48 | #define DRIVER_DESC "PCI Express Hot Plug Controller Driver" |
| 49 | |
| 50 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 51 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 52 | MODULE_LICENSE("GPL"); |
| 53 | |
| 54 | module_param(pciehp_debug, bool, 0644); |
| 55 | module_param(pciehp_poll_mode, bool, 0644); |
| 56 | module_param(pciehp_poll_time, int, 0644); |
rajesh.shah@intel.com | a3a45ec | 2005-10-31 16:20:12 -0800 | [diff] [blame] | 57 | module_param(pciehp_force, bool, 0644); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | MODULE_PARM_DESC(pciehp_debug, "Debugging mode enabled or not"); |
| 59 | MODULE_PARM_DESC(pciehp_poll_mode, "Using polling mechanism for hot-plug events or not"); |
| 60 | MODULE_PARM_DESC(pciehp_poll_time, "Polling mechanism frequency, in seconds"); |
Rafael J. Wysocki | 28eb5f2 | 2010-08-21 22:02:38 +0200 | [diff] [blame] | 61 | MODULE_PARM_DESC(pciehp_force, "Force pciehp, even if OSHP is missing"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | |
| 63 | #define PCIE_MODULE_NAME "pciehp" |
| 64 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 65 | static int set_attention_status (struct hotplug_slot *slot, u8 value); |
| 66 | static int enable_slot (struct hotplug_slot *slot); |
| 67 | static int disable_slot (struct hotplug_slot *slot); |
| 68 | static int get_power_status (struct hotplug_slot *slot, u8 *value); |
| 69 | static int get_attention_status (struct hotplug_slot *slot, u8 *value); |
| 70 | static int get_latch_status (struct hotplug_slot *slot, u8 *value); |
| 71 | static int get_adapter_status (struct hotplug_slot *slot, u8 *value); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | |
Dely Sy | b308240 | 2005-04-28 18:08:53 -0700 | [diff] [blame] | 73 | /** |
| 74 | * release_slot - free up the memory used by a slot |
| 75 | * @hotplug_slot: slot to free |
| 76 | */ |
| 77 | static void release_slot(struct hotplug_slot *hotplug_slot) |
| 78 | { |
Taku Izumi | 7f2feec | 2008-09-05 12:11:26 +0900 | [diff] [blame] | 79 | struct slot *slot = hotplug_slot->private; |
| 80 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 81 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 82 | __func__, hotplug_slot_name(hotplug_slot)); |
Dely Sy | b308240 | 2005-04-28 18:08:53 -0700 | [diff] [blame] | 83 | |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 84 | kfree(hotplug_slot->ops); |
Kenji Kaneshige | c4635eb | 2008-06-20 12:07:08 +0900 | [diff] [blame] | 85 | kfree(hotplug_slot->info); |
| 86 | kfree(hotplug_slot); |
Kenji Kaneshige | a0b1725 | 2006-12-21 17:01:02 -0800 | [diff] [blame] | 87 | } |
| 88 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 89 | static int init_slot(struct controller *ctrl) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 | { |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 91 | struct slot *slot = ctrl->slot; |
| 92 | struct hotplug_slot *hotplug = NULL; |
| 93 | struct hotplug_slot_info *info = NULL; |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 94 | struct hotplug_slot_ops *ops = NULL; |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 95 | char name[SLOT_NAME_SIZE]; |
Kenji Kaneshige | a0b1725 | 2006-12-21 17:01:02 -0800 | [diff] [blame] | 96 | int retval = -ENOMEM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 98 | hotplug = kzalloc(sizeof(*hotplug), GFP_KERNEL); |
| 99 | if (!hotplug) |
| 100 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 102 | info = kzalloc(sizeof(*info), GFP_KERNEL); |
| 103 | if (!info) |
| 104 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 106 | /* Setup hotplug slot ops */ |
| 107 | ops = kzalloc(sizeof(*ops), GFP_KERNEL); |
| 108 | if (!ops) |
| 109 | goto out; |
| 110 | ops->enable_slot = enable_slot; |
| 111 | ops->disable_slot = disable_slot; |
| 112 | ops->get_power_status = get_power_status; |
| 113 | ops->get_adapter_status = get_adapter_status; |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 114 | if (MRL_SENS(ctrl)) |
| 115 | ops->get_latch_status = get_latch_status; |
| 116 | if (ATTN_LED(ctrl)) { |
| 117 | ops->get_attention_status = get_attention_status; |
| 118 | ops->set_attention_status = set_attention_status; |
| 119 | } |
| 120 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 121 | /* register this slot with the hotplug pci core */ |
| 122 | hotplug->info = info; |
| 123 | hotplug->private = slot; |
| 124 | hotplug->release = &release_slot; |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 125 | hotplug->ops = ops; |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 126 | slot->hotplug_slot = hotplug; |
Kenji Kaneshige | 07a0969 | 2009-09-15 17:31:16 +0900 | [diff] [blame] | 127 | snprintf(name, SLOT_NAME_SIZE, "%u", PSN(ctrl)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 | |
Kenji Kaneshige | a2359a3 | 2009-09-15 17:28:28 +0900 | [diff] [blame] | 129 | ctrl_dbg(ctrl, "Registering domain:bus:dev=%04x:%02x:00 sun=%x\n", |
Kenji Kaneshige | 385e249 | 2009-09-15 17:30:14 +0900 | [diff] [blame] | 130 | pci_domain_nr(ctrl->pcie->port->subordinate), |
Kenji Kaneshige | 07a0969 | 2009-09-15 17:31:16 +0900 | [diff] [blame] | 131 | ctrl->pcie->port->subordinate->number, PSN(ctrl)); |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 132 | retval = pci_hp_register(hotplug, |
Kenji Kaneshige | 385e249 | 2009-09-15 17:30:14 +0900 | [diff] [blame] | 133 | ctrl->pcie->port->subordinate, 0, name); |
Kenji Kaneshige | 445f798 | 2009-10-05 17:42:59 +0900 | [diff] [blame] | 134 | if (retval) |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 135 | ctrl_err(ctrl, |
| 136 | "pci_hp_register failed with error %d\n", retval); |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 137 | out: |
| 138 | if (retval) { |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 139 | kfree(ops); |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 140 | kfree(info); |
| 141 | kfree(hotplug); |
| 142 | } |
Kenji Kaneshige | a0b1725 | 2006-12-21 17:01:02 -0800 | [diff] [blame] | 143 | return retval; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | } |
| 145 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 146 | static void cleanup_slot(struct controller *ctrl) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | { |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 148 | pci_hp_deregister(ctrl->slot->hotplug_slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | } |
| 150 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 151 | /* |
| 152 | * set_attention_status - Turns the Amber LED for a slot on, off or blink |
| 153 | */ |
| 154 | static int set_attention_status(struct hotplug_slot *hotplug_slot, u8 status) |
| 155 | { |
| 156 | struct slot *slot = hotplug_slot->private; |
| 157 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 158 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 159 | __func__, slot_name(slot)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | |
Kenji Kaneshige | 445f798 | 2009-10-05 17:42:59 +0900 | [diff] [blame] | 161 | return pciehp_set_attention_status(slot, status); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 162 | } |
| 163 | |
| 164 | |
| 165 | static int enable_slot(struct hotplug_slot *hotplug_slot) |
| 166 | { |
| 167 | struct slot *slot = hotplug_slot->private; |
| 168 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 169 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 170 | __func__, slot_name(slot)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 171 | |
Kenji Kaneshige | 5d386e1 | 2007-03-06 15:02:26 -0800 | [diff] [blame] | 172 | return pciehp_sysfs_enable_slot(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 173 | } |
| 174 | |
| 175 | |
| 176 | static int disable_slot(struct hotplug_slot *hotplug_slot) |
| 177 | { |
| 178 | struct slot *slot = hotplug_slot->private; |
| 179 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 180 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 181 | __func__, slot_name(slot)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 | |
Kenji Kaneshige | 5d386e1 | 2007-03-06 15:02:26 -0800 | [diff] [blame] | 183 | return pciehp_sysfs_disable_slot(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 184 | } |
| 185 | |
| 186 | static int get_power_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 187 | { |
| 188 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 190 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 191 | __func__, slot_name(slot)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | |
Kenji Kaneshige | 445f798 | 2009-10-05 17:42:59 +0900 | [diff] [blame] | 193 | return pciehp_get_power_status(slot, value); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | } |
| 195 | |
| 196 | static int get_attention_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 197 | { |
| 198 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 199 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 200 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 201 | __func__, slot_name(slot)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | |
Kenji Kaneshige | 445f798 | 2009-10-05 17:42:59 +0900 | [diff] [blame] | 203 | return pciehp_get_attention_status(slot, value); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 204 | } |
| 205 | |
| 206 | static int get_latch_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 207 | { |
| 208 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 209 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 210 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 211 | __func__, slot_name(slot)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | |
Kenji Kaneshige | 445f798 | 2009-10-05 17:42:59 +0900 | [diff] [blame] | 213 | return pciehp_get_latch_status(slot, value); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 214 | } |
| 215 | |
| 216 | static int get_adapter_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 217 | { |
| 218 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 219 | |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 220 | ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n", |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 221 | __func__, slot_name(slot)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 222 | |
Kenji Kaneshige | 445f798 | 2009-10-05 17:42:59 +0900 | [diff] [blame] | 223 | return pciehp_get_adapter_status(slot, value); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 224 | } |
| 225 | |
Rafael J. Wysocki | 0516c8b | 2009-01-13 14:44:19 +0100 | [diff] [blame] | 226 | static int pciehp_probe(struct pcie_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 227 | { |
| 228 | int rc; |
| 229 | struct controller *ctrl; |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 230 | struct slot *slot; |
Kenji Kaneshige | 8792e11 | 2009-10-05 17:46:43 +0900 | [diff] [blame] | 231 | u8 occupied, poweron; |
Kenji Kaneshige | 125c39f | 2008-05-28 14:57:30 +0900 | [diff] [blame] | 232 | |
| 233 | if (pciehp_force) |
Taku Izumi | 7f2feec | 2008-09-05 12:11:26 +0900 | [diff] [blame] | 234 | dev_info(&dev->device, |
| 235 | "Bypassing BIOS check for pciehp use on %s\n", |
Kenji Kaneshige | 8792e11 | 2009-10-05 17:46:43 +0900 | [diff] [blame] | 236 | pci_name(dev->port)); |
Rafael J. Wysocki | 28eb5f2 | 2010-08-21 22:02:38 +0200 | [diff] [blame] | 237 | else if (pciehp_acpi_slot_detection_check(dev->port)) |
Kenji Kaneshige | 125c39f | 2008-05-28 14:57:30 +0900 | [diff] [blame] | 238 | goto err_out_none; |
Kenji Kaneshige | a073a82 | 2007-08-09 16:09:35 -0700 | [diff] [blame] | 239 | |
Kenji Kaneshige | c4635eb | 2008-06-20 12:07:08 +0900 | [diff] [blame] | 240 | ctrl = pcie_init(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | if (!ctrl) { |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 242 | dev_err(&dev->device, "Controller initialization failed\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 243 | goto err_out_none; |
| 244 | } |
Kenji Kaneshige | b970894 | 2008-06-26 20:06:24 +0900 | [diff] [blame] | 245 | set_service_data(dev, ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 247 | /* Setup the slot information structures */ |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 248 | rc = init_slot(ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 249 | if (rc) { |
Alex Chiang | f46753c | 2008-06-10 15:28:50 -0600 | [diff] [blame] | 250 | if (rc == -EBUSY) |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 251 | ctrl_warn(ctrl, "Slot already registered by another " |
Taku Izumi | 7f2feec | 2008-09-05 12:11:26 +0900 | [diff] [blame] | 252 | "hotplug driver\n"); |
Alex Chiang | f46753c | 2008-06-10 15:28:50 -0600 | [diff] [blame] | 253 | else |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 254 | ctrl_err(ctrl, "Slot initialization failed\n"); |
Kenji Kaneshige | a8c2b63 | 2006-12-21 17:01:05 -0800 | [diff] [blame] | 255 | goto err_out_release_ctlr; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 256 | } |
| 257 | |
Eric W. Biederman | dbc7e1e | 2009-01-28 19:31:18 -0800 | [diff] [blame] | 258 | /* Enable events after we have setup the data structures */ |
| 259 | rc = pcie_init_notification(ctrl); |
| 260 | if (rc) { |
| 261 | ctrl_err(ctrl, "Notification initialization failed\n"); |
Kenji Kaneshige | 65b947b | 2009-10-05 17:43:29 +0900 | [diff] [blame] | 262 | goto err_out_free_ctrl_slot; |
Eric W. Biederman | dbc7e1e | 2009-01-28 19:31:18 -0800 | [diff] [blame] | 263 | } |
| 264 | |
Kenji Kaneshige | db9aaf0 | 2008-12-08 14:30:24 +0900 | [diff] [blame] | 265 | /* Check if slot is occupied */ |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 266 | slot = ctrl->slot; |
Kenji Kaneshige | 8792e11 | 2009-10-05 17:46:43 +0900 | [diff] [blame] | 267 | pciehp_get_adapter_status(slot, &occupied); |
| 268 | pciehp_get_power_status(slot, &poweron); |
| 269 | if (occupied && pciehp_force) |
| 270 | pciehp_enable_slot(slot); |
| 271 | /* If empty slot's power status is on, turn power off */ |
| 272 | if (!occupied && poweron && POWER_CTRL(ctrl)) |
| 273 | pciehp_power_off_slot(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 274 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 275 | return 0; |
| 276 | |
| 277 | err_out_free_ctrl_slot: |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 278 | cleanup_slot(ctrl); |
Kenji Kaneshige | a8c2b63 | 2006-12-21 17:01:05 -0800 | [diff] [blame] | 279 | err_out_release_ctlr: |
Kenji Kaneshige | 82a9e79 | 2009-09-15 17:30:48 +0900 | [diff] [blame] | 280 | pciehp_release_ctrl(ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 281 | err_out_none: |
| 282 | return -ENODEV; |
| 283 | } |
| 284 | |
Kenji Kaneshige | 82a9e79 | 2009-09-15 17:30:48 +0900 | [diff] [blame] | 285 | static void pciehp_remove(struct pcie_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 286 | { |
Kenji Kaneshige | b970894 | 2008-06-26 20:06:24 +0900 | [diff] [blame] | 287 | struct controller *ctrl = get_service_data(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 289 | cleanup_slot(ctrl); |
Kenji Kaneshige | 82a9e79 | 2009-09-15 17:30:48 +0900 | [diff] [blame] | 290 | pciehp_release_ctrl(ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 291 | } |
| 292 | |
| 293 | #ifdef CONFIG_PM |
Rafael J. Wysocki | 3a3c244 | 2009-02-15 22:32:48 +0100 | [diff] [blame] | 294 | static int pciehp_suspend (struct pcie_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | return 0; |
| 297 | } |
| 298 | |
| 299 | static int pciehp_resume (struct pcie_device *dev) |
| 300 | { |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 301 | struct controller *ctrl; |
| 302 | struct slot *slot; |
| 303 | u8 status; |
| 304 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 305 | ctrl = get_service_data(dev); |
Mark Lord | cd2fe83 | 2007-11-28 15:12:00 -0800 | [diff] [blame] | 306 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 307 | /* reinitialize the chipset's event detection logic */ |
| 308 | pcie_enable_notification(ctrl); |
Mark Lord | cd2fe83 | 2007-11-28 15:12:00 -0800 | [diff] [blame] | 309 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 310 | slot = ctrl->slot; |
Mark Lord | cd2fe83 | 2007-11-28 15:12:00 -0800 | [diff] [blame] | 311 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 312 | /* Check if slot is occupied */ |
| 313 | pciehp_get_adapter_status(slot, &status); |
| 314 | if (status) |
| 315 | pciehp_enable_slot(slot); |
| 316 | else |
| 317 | pciehp_disable_slot(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 318 | return 0; |
| 319 | } |
Rafael J. Wysocki | 3a3c244 | 2009-02-15 22:32:48 +0100 | [diff] [blame] | 320 | #endif /* PM */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 322 | static struct pcie_port_service_driver hpdriver_portdrv = { |
Taku Izumi | 83e9ad5 | 2008-09-05 12:09:43 +0900 | [diff] [blame] | 323 | .name = PCIE_MODULE_NAME, |
Rafael J. Wysocki | 2210636 | 2009-01-13 14:46:46 +0100 | [diff] [blame] | 324 | .port_type = PCIE_ANY_PORT, |
| 325 | .service = PCIE_PORT_SERVICE_HP, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 326 | |
| 327 | .probe = pciehp_probe, |
| 328 | .remove = pciehp_remove, |
| 329 | |
| 330 | #ifdef CONFIG_PM |
| 331 | .suspend = pciehp_suspend, |
| 332 | .resume = pciehp_resume, |
| 333 | #endif /* PM */ |
| 334 | }; |
| 335 | |
| 336 | static int __init pcied_init(void) |
| 337 | { |
| 338 | int retval = 0; |
| 339 | |
Kenji Kaneshige | c9ffa5a | 2008-12-17 12:07:38 +0900 | [diff] [blame] | 340 | pciehp_firmware_init(); |
rajesh.shah@intel.com | a8a2be9 | 2005-10-31 16:20:07 -0800 | [diff] [blame] | 341 | retval = pcie_port_service_register(&hpdriver_portdrv); |
| 342 | dbg("pcie_port_service_register = %d\n", retval); |
| 343 | info(DRIVER_DESC " version: " DRIVER_VERSION "\n"); |
Yijing Wang | c2be6f9 | 2013-01-11 10:15:54 +0800 | [diff] [blame] | 344 | if (retval) |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 345 | dbg("Failure to register service\n"); |
Yijing Wang | c2be6f9 | 2013-01-11 10:15:54 +0800 | [diff] [blame] | 346 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 347 | return retval; |
| 348 | } |
| 349 | |
| 350 | static void __exit pcied_cleanup(void) |
| 351 | { |
| 352 | dbg("unload_pciehpd()\n"); |
Kenji Kaneshige | 027e8d5 | 2011-11-07 20:55:46 +0900 | [diff] [blame] | 353 | pcie_port_service_unregister(&hpdriver_portdrv); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | info(DRIVER_DESC " version: " DRIVER_VERSION " unloaded\n"); |
| 355 | } |
| 356 | |
| 357 | module_init(pcied_init); |
| 358 | module_exit(pcied_cleanup); |