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/moduleparam.h> |
| 31 | #include <linux/kernel.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 32 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | #include <linux/types.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | #include <linux/pci.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | #include "pciehp.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | #include <linux/interrupt.h> |
Kristen Carlson Accardi | 34d0341 | 2007-01-09 13:02:36 -0800 | [diff] [blame] | 37 | #include <linux/time.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | |
| 39 | /* Global variables */ |
Rusty Russell | 90ab5ee | 2012-01-13 09:32:20 +1030 | [diff] [blame] | 40 | bool pciehp_debug; |
| 41 | bool pciehp_poll_mode; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | int pciehp_poll_time; |
Stephen Hemminger | 0b950f0 | 2014-01-10 17:14:48 -0700 | [diff] [blame] | 43 | static bool pciehp_force; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | |
| 45 | #define DRIVER_VERSION "0.4" |
| 46 | #define DRIVER_AUTHOR "Dan Zink <dan.zink@compaq.com>, Greg Kroah-Hartman <greg@kroah.com>, Dely Sy <dely.l.sy@intel.com>" |
| 47 | #define DRIVER_DESC "PCI Express Hot Plug Controller Driver" |
| 48 | |
Paul Gortmaker | 70626d8 | 2016-08-24 16:57:52 -0400 | [diff] [blame] | 49 | /* |
| 50 | * not really modular, but the easiest way to keep compat with existing |
| 51 | * bootargs behaviour is to continue using module_param here. |
| 52 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | module_param(pciehp_debug, bool, 0644); |
| 54 | module_param(pciehp_poll_mode, bool, 0644); |
| 55 | module_param(pciehp_poll_time, int, 0644); |
rajesh.shah@intel.com | a3a45ec | 2005-10-31 16:20:12 -0800 | [diff] [blame] | 56 | module_param(pciehp_force, bool, 0644); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | MODULE_PARM_DESC(pciehp_debug, "Debugging mode enabled or not"); |
| 58 | MODULE_PARM_DESC(pciehp_poll_mode, "Using polling mechanism for hot-plug events or not"); |
| 59 | MODULE_PARM_DESC(pciehp_poll_time, "Polling mechanism frequency, in seconds"); |
Rafael J. Wysocki | 28eb5f2 | 2010-08-21 22:02:38 +0200 | [diff] [blame] | 60 | MODULE_PARM_DESC(pciehp_force, "Force pciehp, even if OSHP is missing"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 | |
| 62 | #define PCIE_MODULE_NAME "pciehp" |
| 63 | |
Bogicevic Sasa | ff3ce48 | 2015-12-27 13:21:11 -0800 | [diff] [blame] | 64 | static int set_attention_status(struct hotplug_slot *slot, u8 value); |
| 65 | static int enable_slot(struct hotplug_slot *slot); |
| 66 | static int disable_slot(struct hotplug_slot *slot); |
| 67 | static int get_power_status(struct hotplug_slot *slot, u8 *value); |
| 68 | static int get_attention_status(struct hotplug_slot *slot, u8 *value); |
| 69 | static int get_latch_status(struct hotplug_slot *slot, u8 *value); |
| 70 | static int get_adapter_status(struct hotplug_slot *slot, u8 *value); |
| 71 | static int reset_slot(struct hotplug_slot *slot, int probe); |
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 | { |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 79 | kfree(hotplug_slot->ops); |
Kenji Kaneshige | c4635eb | 2008-06-20 12:07:08 +0900 | [diff] [blame] | 80 | kfree(hotplug_slot->info); |
| 81 | kfree(hotplug_slot); |
Kenji Kaneshige | a0b1725 | 2006-12-21 17:01:02 -0800 | [diff] [blame] | 82 | } |
| 83 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 84 | static int init_slot(struct controller *ctrl) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | { |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 86 | struct slot *slot = ctrl->slot; |
| 87 | struct hotplug_slot *hotplug = NULL; |
| 88 | struct hotplug_slot_info *info = NULL; |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 89 | struct hotplug_slot_ops *ops = NULL; |
Alex Chiang | e1acb24 | 2008-10-20 17:41:38 -0600 | [diff] [blame] | 90 | char name[SLOT_NAME_SIZE]; |
Kenji Kaneshige | a0b1725 | 2006-12-21 17:01:02 -0800 | [diff] [blame] | 91 | int retval = -ENOMEM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 92 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 93 | hotplug = kzalloc(sizeof(*hotplug), GFP_KERNEL); |
| 94 | if (!hotplug) |
| 95 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 97 | info = kzalloc(sizeof(*info), GFP_KERNEL); |
| 98 | if (!info) |
| 99 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 101 | /* Setup hotplug slot ops */ |
| 102 | ops = kzalloc(sizeof(*ops), GFP_KERNEL); |
| 103 | if (!ops) |
| 104 | goto out; |
Bjorn Helgaas | 9cad7f5 | 2014-02-11 15:26:29 -0700 | [diff] [blame] | 105 | |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 106 | ops->enable_slot = enable_slot; |
| 107 | ops->disable_slot = disable_slot; |
| 108 | ops->get_power_status = get_power_status; |
| 109 | ops->get_adapter_status = get_adapter_status; |
Alex Williamson | 2e35afa | 2013-08-08 14:09:37 -0600 | [diff] [blame] | 110 | ops->reset_slot = reset_slot; |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 111 | if (MRL_SENS(ctrl)) |
| 112 | ops->get_latch_status = get_latch_status; |
| 113 | if (ATTN_LED(ctrl)) { |
| 114 | ops->get_attention_status = get_attention_status; |
| 115 | ops->set_attention_status = set_attention_status; |
Keith Busch | 576243b | 2016-09-13 10:31:59 -0600 | [diff] [blame] | 116 | } else if (ctrl->pcie->port->hotplug_user_indicators) { |
| 117 | ops->get_attention_status = pciehp_get_raw_indicator_status; |
| 118 | ops->set_attention_status = pciehp_set_raw_indicator_status; |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 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 | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 129 | retval = pci_hp_register(hotplug, |
Kenji Kaneshige | 385e249 | 2009-09-15 17:30:14 +0900 | [diff] [blame] | 130 | ctrl->pcie->port->subordinate, 0, name); |
Kenji Kaneshige | 445f798 | 2009-10-05 17:42:59 +0900 | [diff] [blame] | 131 | if (retval) |
Bjorn Helgaas | 3784e0c | 2015-06-15 16:28:29 -0500 | [diff] [blame] | 132 | ctrl_err(ctrl, "pci_hp_register failed: error %d\n", retval); |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 133 | out: |
| 134 | if (retval) { |
Kenji Kaneshige | 586f1d6 | 2009-10-05 17:41:37 +0900 | [diff] [blame] | 135 | kfree(ops); |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 136 | kfree(info); |
| 137 | kfree(hotplug); |
| 138 | } |
Kenji Kaneshige | a0b1725 | 2006-12-21 17:01:02 -0800 | [diff] [blame] | 139 | return retval; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | } |
| 141 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 142 | static void cleanup_slot(struct controller *ctrl) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 | { |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 144 | pci_hp_deregister(ctrl->slot->hotplug_slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 145 | } |
| 146 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | /* |
| 148 | * set_attention_status - Turns the Amber LED for a slot on, off or blink |
| 149 | */ |
| 150 | static int set_attention_status(struct hotplug_slot *hotplug_slot, u8 status) |
| 151 | { |
| 152 | struct slot *slot = hotplug_slot->private; |
| 153 | |
Bjorn Helgaas | 6dae620 | 2013-12-14 13:06:16 -0700 | [diff] [blame] | 154 | pciehp_set_attention_status(slot, status); |
| 155 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 156 | } |
| 157 | |
| 158 | |
| 159 | static int enable_slot(struct hotplug_slot *hotplug_slot) |
| 160 | { |
| 161 | struct slot *slot = hotplug_slot->private; |
| 162 | |
Kenji Kaneshige | 5d386e1 | 2007-03-06 15:02:26 -0800 | [diff] [blame] | 163 | return pciehp_sysfs_enable_slot(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | } |
| 165 | |
| 166 | |
| 167 | static int disable_slot(struct hotplug_slot *hotplug_slot) |
| 168 | { |
| 169 | struct slot *slot = hotplug_slot->private; |
| 170 | |
Kenji Kaneshige | 5d386e1 | 2007-03-06 15:02:26 -0800 | [diff] [blame] | 171 | return pciehp_sysfs_disable_slot(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 172 | } |
| 173 | |
| 174 | static int get_power_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 175 | { |
| 176 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | |
Bjorn Helgaas | 6dae620 | 2013-12-14 13:06:16 -0700 | [diff] [blame] | 178 | pciehp_get_power_status(slot, value); |
| 179 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 | } |
| 181 | |
| 182 | static int get_attention_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 183 | { |
| 184 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | |
Bjorn Helgaas | 6dae620 | 2013-12-14 13:06:16 -0700 | [diff] [blame] | 186 | pciehp_get_attention_status(slot, value); |
| 187 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 188 | } |
| 189 | |
| 190 | static int get_latch_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 191 | { |
| 192 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 193 | |
Bjorn Helgaas | 6dae620 | 2013-12-14 13:06:16 -0700 | [diff] [blame] | 194 | pciehp_get_latch_status(slot, value); |
| 195 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 196 | } |
| 197 | |
| 198 | static int get_adapter_status(struct hotplug_slot *hotplug_slot, u8 *value) |
| 199 | { |
| 200 | struct slot *slot = hotplug_slot->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 201 | |
Bjorn Helgaas | 6dae620 | 2013-12-14 13:06:16 -0700 | [diff] [blame] | 202 | pciehp_get_adapter_status(slot, value); |
| 203 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 204 | } |
| 205 | |
Alex Williamson | 2e35afa | 2013-08-08 14:09:37 -0600 | [diff] [blame] | 206 | static int reset_slot(struct hotplug_slot *hotplug_slot, int probe) |
| 207 | { |
| 208 | struct slot *slot = hotplug_slot->private; |
| 209 | |
Alex Williamson | 2e35afa | 2013-08-08 14:09:37 -0600 | [diff] [blame] | 210 | return pciehp_reset_slot(slot, probe); |
| 211 | } |
| 212 | |
Rafael J. Wysocki | 0516c8b | 2009-01-13 14:44:19 +0100 | [diff] [blame] | 213 | static int pciehp_probe(struct pcie_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 214 | { |
| 215 | int rc; |
| 216 | struct controller *ctrl; |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 217 | struct slot *slot; |
Kenji Kaneshige | 8792e11 | 2009-10-05 17:46:43 +0900 | [diff] [blame] | 218 | u8 occupied, poweron; |
Kenji Kaneshige | 125c39f | 2008-05-28 14:57:30 +0900 | [diff] [blame] | 219 | |
Rafael J. Wysocki | e705c29 | 2015-05-19 15:27:58 +0200 | [diff] [blame] | 220 | /* If this is not a "hotplug" service, we have no business here. */ |
| 221 | if (dev->service != PCIE_PORT_SERVICE_HP) |
| 222 | return -ENODEV; |
Kenji Kaneshige | a073a82 | 2007-08-09 16:09:35 -0700 | [diff] [blame] | 223 | |
Andreas Noever | 62e4492 | 2014-06-09 23:03:32 +0200 | [diff] [blame] | 224 | if (!dev->port->subordinate) { |
| 225 | /* Can happen if we run out of bus numbers during probe */ |
| 226 | dev_err(&dev->device, |
| 227 | "Hotplug bridge without secondary bus, ignoring\n"); |
Rafael J. Wysocki | 2af31f4 | 2015-05-23 00:38:57 +0200 | [diff] [blame] | 228 | return -ENODEV; |
Andreas Noever | 62e4492 | 2014-06-09 23:03:32 +0200 | [diff] [blame] | 229 | } |
| 230 | |
Kenji Kaneshige | c4635eb | 2008-06-20 12:07:08 +0900 | [diff] [blame] | 231 | ctrl = pcie_init(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | if (!ctrl) { |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 233 | dev_err(&dev->device, "Controller initialization failed\n"); |
Rafael J. Wysocki | 2af31f4 | 2015-05-23 00:38:57 +0200 | [diff] [blame] | 234 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 | } |
Kenji Kaneshige | b970894 | 2008-06-26 20:06:24 +0900 | [diff] [blame] | 236 | set_service_data(dev, ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 237 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | /* Setup the slot information structures */ |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 239 | rc = init_slot(ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 240 | if (rc) { |
Alex Chiang | f46753c | 2008-06-10 15:28:50 -0600 | [diff] [blame] | 241 | if (rc == -EBUSY) |
Ryan Desfosses | 227f064 | 2014-04-18 20:13:50 -0400 | [diff] [blame] | 242 | ctrl_warn(ctrl, "Slot already registered by another hotplug driver\n"); |
Alex Chiang | f46753c | 2008-06-10 15:28:50 -0600 | [diff] [blame] | 243 | else |
Bjorn Helgaas | 3784e0c | 2015-06-15 16:28:29 -0500 | [diff] [blame] | 244 | ctrl_err(ctrl, "Slot initialization failed (%d)\n", rc); |
Kenji Kaneshige | a8c2b63 | 2006-12-21 17:01:05 -0800 | [diff] [blame] | 245 | goto err_out_release_ctlr; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 | } |
| 247 | |
Eric W. Biederman | dbc7e1e | 2009-01-28 19:31:18 -0800 | [diff] [blame] | 248 | /* Enable events after we have setup the data structures */ |
| 249 | rc = pcie_init_notification(ctrl); |
| 250 | if (rc) { |
Bjorn Helgaas | 3784e0c | 2015-06-15 16:28:29 -0500 | [diff] [blame] | 251 | ctrl_err(ctrl, "Notification initialization failed (%d)\n", rc); |
Kenji Kaneshige | 65b947b | 2009-10-05 17:43:29 +0900 | [diff] [blame] | 252 | goto err_out_free_ctrl_slot; |
Eric W. Biederman | dbc7e1e | 2009-01-28 19:31:18 -0800 | [diff] [blame] | 253 | } |
| 254 | |
Kenji Kaneshige | db9aaf0 | 2008-12-08 14:30:24 +0900 | [diff] [blame] | 255 | /* Check if slot is occupied */ |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 256 | slot = ctrl->slot; |
Kenji Kaneshige | 8792e11 | 2009-10-05 17:46:43 +0900 | [diff] [blame] | 257 | pciehp_get_adapter_status(slot, &occupied); |
| 258 | pciehp_get_power_status(slot, &poweron); |
Rajat Jain | 50b52fd | 2014-02-04 18:31:11 -0800 | [diff] [blame] | 259 | if (occupied && pciehp_force) { |
| 260 | mutex_lock(&slot->hotplug_lock); |
Kenji Kaneshige | 8792e11 | 2009-10-05 17:46:43 +0900 | [diff] [blame] | 261 | pciehp_enable_slot(slot); |
Rajat Jain | 50b52fd | 2014-02-04 18:31:11 -0800 | [diff] [blame] | 262 | mutex_unlock(&slot->hotplug_lock); |
| 263 | } |
Kenji Kaneshige | 8792e11 | 2009-10-05 17:46:43 +0900 | [diff] [blame] | 264 | /* If empty slot's power status is on, turn power off */ |
| 265 | if (!occupied && poweron && POWER_CTRL(ctrl)) |
| 266 | pciehp_power_off_slot(slot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 267 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | return 0; |
| 269 | |
| 270 | err_out_free_ctrl_slot: |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 271 | cleanup_slot(ctrl); |
Kenji Kaneshige | a8c2b63 | 2006-12-21 17:01:05 -0800 | [diff] [blame] | 272 | err_out_release_ctlr: |
Kenji Kaneshige | 82a9e79 | 2009-09-15 17:30:48 +0900 | [diff] [blame] | 273 | pciehp_release_ctrl(ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 274 | return -ENODEV; |
| 275 | } |
| 276 | |
Kenji Kaneshige | 82a9e79 | 2009-09-15 17:30:48 +0900 | [diff] [blame] | 277 | static void pciehp_remove(struct pcie_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 278 | { |
Kenji Kaneshige | b970894 | 2008-06-26 20:06:24 +0900 | [diff] [blame] | 279 | struct controller *ctrl = get_service_data(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 280 | |
Kenji Kaneshige | 8720d27 | 2009-09-15 17:24:46 +0900 | [diff] [blame] | 281 | cleanup_slot(ctrl); |
Kenji Kaneshige | 82a9e79 | 2009-09-15 17:30:48 +0900 | [diff] [blame] | 282 | pciehp_release_ctrl(ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 283 | } |
| 284 | |
| 285 | #ifdef CONFIG_PM |
Ryan Desfosses | 3c78bc6 | 2014-04-18 20:13:49 -0400 | [diff] [blame] | 286 | static int pciehp_suspend(struct pcie_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | return 0; |
| 289 | } |
| 290 | |
Ryan Desfosses | 3c78bc6 | 2014-04-18 20:13:49 -0400 | [diff] [blame] | 291 | static int pciehp_resume(struct pcie_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 292 | { |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 293 | struct controller *ctrl; |
| 294 | struct slot *slot; |
| 295 | u8 status; |
| 296 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 297 | ctrl = get_service_data(dev); |
Mark Lord | cd2fe83 | 2007-11-28 15:12:00 -0800 | [diff] [blame] | 298 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 299 | /* reinitialize the chipset's event detection logic */ |
| 300 | pcie_enable_notification(ctrl); |
Mark Lord | cd2fe83 | 2007-11-28 15:12:00 -0800 | [diff] [blame] | 301 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 302 | slot = ctrl->slot; |
Mark Lord | cd2fe83 | 2007-11-28 15:12:00 -0800 | [diff] [blame] | 303 | |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 304 | /* Check if slot is occupied */ |
| 305 | pciehp_get_adapter_status(slot, &status); |
Rajat Jain | 50b52fd | 2014-02-04 18:31:11 -0800 | [diff] [blame] | 306 | mutex_lock(&slot->hotplug_lock); |
Oliver Neukum | 87683e2 | 2012-09-07 23:28:30 +0200 | [diff] [blame] | 307 | if (status) |
| 308 | pciehp_enable_slot(slot); |
| 309 | else |
| 310 | pciehp_disable_slot(slot); |
Rajat Jain | 50b52fd | 2014-02-04 18:31:11 -0800 | [diff] [blame] | 311 | mutex_unlock(&slot->hotplug_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 312 | return 0; |
| 313 | } |
Rafael J. Wysocki | 3a3c244 | 2009-02-15 22:32:48 +0100 | [diff] [blame] | 314 | #endif /* PM */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 315 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | static struct pcie_port_service_driver hpdriver_portdrv = { |
Taku Izumi | 83e9ad5 | 2008-09-05 12:09:43 +0900 | [diff] [blame] | 317 | .name = PCIE_MODULE_NAME, |
Rafael J. Wysocki | 2210636 | 2009-01-13 14:46:46 +0100 | [diff] [blame] | 318 | .port_type = PCIE_ANY_PORT, |
| 319 | .service = PCIE_PORT_SERVICE_HP, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 320 | |
| 321 | .probe = pciehp_probe, |
| 322 | .remove = pciehp_remove, |
| 323 | |
| 324 | #ifdef CONFIG_PM |
| 325 | .suspend = pciehp_suspend, |
| 326 | .resume = pciehp_resume, |
| 327 | #endif /* PM */ |
| 328 | }; |
| 329 | |
| 330 | static int __init pcied_init(void) |
| 331 | { |
| 332 | int retval = 0; |
| 333 | |
rajesh.shah@intel.com | a8a2be9 | 2005-10-31 16:20:07 -0800 | [diff] [blame] | 334 | retval = pcie_port_service_register(&hpdriver_portdrv); |
Bjorn Helgaas | f762598 | 2013-11-14 11:28:18 -0700 | [diff] [blame] | 335 | dbg("pcie_port_service_register = %d\n", retval); |
| 336 | info(DRIVER_DESC " version: " DRIVER_VERSION "\n"); |
Yijing Wang | c2be6f9 | 2013-01-11 10:15:54 +0800 | [diff] [blame] | 337 | if (retval) |
Taku Izumi | 18b341b | 2008-10-23 11:47:32 +0900 | [diff] [blame] | 338 | dbg("Failure to register service\n"); |
Yijing Wang | c2be6f9 | 2013-01-11 10:15:54 +0800 | [diff] [blame] | 339 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 340 | return retval; |
| 341 | } |
Paul Gortmaker | 70626d8 | 2016-08-24 16:57:52 -0400 | [diff] [blame] | 342 | device_initcall(pcied_init); |