Linux Audio

Check our new training course

Loading...
v3.15
 
  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 *
 26 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
 27 *
 
 
 
 
 28 */
 29
 30#include <linux/module.h>
 
 
 31#include <linux/moduleparam.h>
 32#include <linux/kernel.h>
 33#include <linux/slab.h>
 34#include <linux/types.h>
 35#include <linux/pci.h>
 36#include "pciehp.h"
 37#include <linux/interrupt.h>
 38#include <linux/time.h>
 39
 40/* Global variables */
 41bool pciehp_debug;
 42bool pciehp_poll_mode;
 43int pciehp_poll_time;
 44static bool pciehp_force;
 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
 50MODULE_AUTHOR(DRIVER_AUTHOR);
 51MODULE_DESCRIPTION(DRIVER_DESC);
 52MODULE_LICENSE("GPL");
 53
 54module_param(pciehp_debug, bool, 0644);
 55module_param(pciehp_poll_mode, bool, 0644);
 56module_param(pciehp_poll_time, int, 0644);
 57module_param(pciehp_force, bool, 0644);
 58MODULE_PARM_DESC(pciehp_debug, "Debugging mode enabled or not");
 59MODULE_PARM_DESC(pciehp_poll_mode, "Using polling mechanism for hot-plug events or not");
 60MODULE_PARM_DESC(pciehp_poll_time, "Polling mechanism frequency, in seconds");
 61MODULE_PARM_DESC(pciehp_force, "Force pciehp, even if OSHP is missing");
 62
 63#define PCIE_MODULE_NAME "pciehp"
 64
 65static int set_attention_status (struct hotplug_slot *slot, u8 value);
 66static int enable_slot		(struct hotplug_slot *slot);
 67static int disable_slot		(struct hotplug_slot *slot);
 68static int get_power_status	(struct hotplug_slot *slot, u8 *value);
 69static int get_attention_status	(struct hotplug_slot *slot, u8 *value);
 70static int get_latch_status	(struct hotplug_slot *slot, u8 *value);
 71static int get_adapter_status	(struct hotplug_slot *slot, u8 *value);
 72static int reset_slot		(struct hotplug_slot *slot, int probe);
 73
 74/**
 75 * release_slot - free up the memory used by a slot
 76 * @hotplug_slot: slot to free
 77 */
 78static void release_slot(struct hotplug_slot *hotplug_slot)
 79{
 80	struct slot *slot = hotplug_slot->private;
 81
 82	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
 83		 __func__, hotplug_slot_name(hotplug_slot));
 84
 85	kfree(hotplug_slot->ops);
 86	kfree(hotplug_slot->info);
 87	kfree(hotplug_slot);
 88}
 89
 90static int init_slot(struct controller *ctrl)
 91{
 92	struct slot *slot = ctrl->slot;
 93	struct hotplug_slot *hotplug = NULL;
 94	struct hotplug_slot_info *info = NULL;
 95	struct hotplug_slot_ops *ops = NULL;
 96	char name[SLOT_NAME_SIZE];
 97	int retval = -ENOMEM;
 98
 99	hotplug = kzalloc(sizeof(*hotplug), GFP_KERNEL);
100	if (!hotplug)
101		goto out;
102
103	info = kzalloc(sizeof(*info), GFP_KERNEL);
104	if (!info)
105		goto out;
106
107	/* Setup hotplug slot ops */
108	ops = kzalloc(sizeof(*ops), GFP_KERNEL);
109	if (!ops)
110		goto out;
111
112	ops->enable_slot = enable_slot;
113	ops->disable_slot = disable_slot;
114	ops->get_power_status = get_power_status;
115	ops->get_adapter_status = get_adapter_status;
116	ops->reset_slot = reset_slot;
117	if (MRL_SENS(ctrl))
118		ops->get_latch_status = get_latch_status;
119	if (ATTN_LED(ctrl)) {
120		ops->get_attention_status = get_attention_status;
121		ops->set_attention_status = set_attention_status;
 
 
 
122	}
123
124	/* register this slot with the hotplug pci core */
125	hotplug->info = info;
126	hotplug->private = slot;
127	hotplug->release = &release_slot;
128	hotplug->ops = ops;
129	slot->hotplug_slot = hotplug;
130	snprintf(name, SLOT_NAME_SIZE, "%u", PSN(ctrl));
131
132	ctrl_dbg(ctrl, "Registering domain:bus:dev=%04x:%02x:00 sun=%x\n",
133		 pci_domain_nr(ctrl->pcie->port->subordinate),
134		 ctrl->pcie->port->subordinate->number, PSN(ctrl));
135	retval = pci_hp_register(hotplug,
136				 ctrl->pcie->port->subordinate, 0, name);
137	if (retval)
138		ctrl_err(ctrl,
139			 "pci_hp_register failed with error %d\n", retval);
140out:
141	if (retval) {
 
142		kfree(ops);
143		kfree(info);
144		kfree(hotplug);
145	}
146	return retval;
147}
148
149static void cleanup_slot(struct controller *ctrl)
150{
151	pci_hp_deregister(ctrl->slot->hotplug_slot);
 
 
 
152}
153
154/*
155 * set_attention_status - Turns the Amber LED for a slot on, off or blink
156 */
157static int set_attention_status(struct hotplug_slot *hotplug_slot, u8 status)
158{
159	struct slot *slot = hotplug_slot->private;
 
160
161	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
162		  __func__, slot_name(slot));
 
 
163
164	pciehp_set_attention_status(slot, status);
 
 
165	return 0;
166}
167
168
169static int enable_slot(struct hotplug_slot *hotplug_slot)
170{
171	struct slot *slot = hotplug_slot->private;
172
173	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
174		 __func__, slot_name(slot));
175
176	return pciehp_sysfs_enable_slot(slot);
177}
178
179
180static int disable_slot(struct hotplug_slot *hotplug_slot)
181{
182	struct slot *slot = hotplug_slot->private;
183
184	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
185		  __func__, slot_name(slot));
186
187	return pciehp_sysfs_disable_slot(slot);
188}
189
190static int get_power_status(struct hotplug_slot *hotplug_slot, u8 *value)
191{
192	struct slot *slot = hotplug_slot->private;
193
194	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
195		  __func__, slot_name(slot));
196
197	pciehp_get_power_status(slot, value);
198	return 0;
199}
200
201static int get_attention_status(struct hotplug_slot *hotplug_slot, u8 *value)
202{
203	struct slot *slot = hotplug_slot->private;
204
205	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
206		  __func__, slot_name(slot));
207
208	pciehp_get_attention_status(slot, value);
209	return 0;
210}
211
212static int get_latch_status(struct hotplug_slot *hotplug_slot, u8 *value)
213{
214	struct slot *slot = hotplug_slot->private;
215
216	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
217		 __func__, slot_name(slot));
218
219	pciehp_get_latch_status(slot, value);
 
 
220	return 0;
221}
222
223static int get_adapter_status(struct hotplug_slot *hotplug_slot, u8 *value)
224{
225	struct slot *slot = hotplug_slot->private;
226
227	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
228		 __func__, slot_name(slot));
 
 
 
 
 
229
230	pciehp_get_adapter_status(slot, value);
231	return 0;
232}
233
234static int reset_slot(struct hotplug_slot *hotplug_slot, int probe)
 
 
 
 
 
 
 
 
 
 
 
235{
236	struct slot *slot = hotplug_slot->private;
237
238	ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
239		 __func__, slot_name(slot));
240
241	return pciehp_reset_slot(slot, probe);
 
 
 
 
 
 
 
 
242}
243
244static int pciehp_probe(struct pcie_device *dev)
245{
246	int rc;
247	struct controller *ctrl;
248	struct slot *slot;
249	u8 occupied, poweron;
250
251	if (pciehp_force)
252		dev_info(&dev->device,
253			 "Bypassing BIOS check for pciehp use on %s\n",
254			 pci_name(dev->port));
255	else if (pciehp_acpi_slot_detection_check(dev->port))
256		goto err_out_none;
 
 
 
 
257
258	ctrl = pcie_init(dev);
259	if (!ctrl) {
260		dev_err(&dev->device, "Controller initialization failed\n");
261		goto err_out_none;
262	}
263	set_service_data(dev, ctrl);
264
265	/* Setup the slot information structures */
266	rc = init_slot(ctrl);
267	if (rc) {
268		if (rc == -EBUSY)
269			ctrl_warn(ctrl, "Slot already registered by another "
270				  "hotplug driver\n");
271		else
272			ctrl_err(ctrl, "Slot initialization failed\n");
273		goto err_out_release_ctlr;
274	}
275
276	/* Enable events after we have setup the data structures */
277	rc = pcie_init_notification(ctrl);
278	if (rc) {
279		ctrl_err(ctrl, "Notification initialization failed\n");
280		goto err_out_free_ctrl_slot;
281	}
282
283	/* Check if slot is occupied */
284	slot = ctrl->slot;
285	pciehp_get_adapter_status(slot, &occupied);
286	pciehp_get_power_status(slot, &poweron);
287	if (occupied && pciehp_force) {
288		mutex_lock(&slot->hotplug_lock);
289		pciehp_enable_slot(slot);
290		mutex_unlock(&slot->hotplug_lock);
291	}
292	/* If empty slot's power status is on, turn power off */
293	if (!occupied && poweron && POWER_CTRL(ctrl))
294		pciehp_power_off_slot(slot);
295
296	return 0;
297
 
 
298err_out_free_ctrl_slot:
299	cleanup_slot(ctrl);
300err_out_release_ctlr:
301	pciehp_release_ctrl(ctrl);
302err_out_none:
303	return -ENODEV;
304}
305
306static void pciehp_remove(struct pcie_device *dev)
307{
308	struct controller *ctrl = get_service_data(dev);
309
 
 
310	cleanup_slot(ctrl);
311	pciehp_release_ctrl(ctrl);
312}
313
314#ifdef CONFIG_PM
315static int pciehp_suspend (struct pcie_device *dev)
316{
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
317	return 0;
318}
319
320static int pciehp_resume (struct pcie_device *dev)
321{
322	struct controller *ctrl;
323	struct slot *slot;
324	u8 status;
 
 
 
 
 
 
325
326	ctrl = get_service_data(dev);
 
 
327
328	/* reinitialize the chipset's event detection logic */
329	pcie_enable_notification(ctrl);
 
330
331	slot = ctrl->slot;
 
332
333	/* Check if slot is occupied */
334	pciehp_get_adapter_status(slot, &status);
335	mutex_lock(&slot->hotplug_lock);
336	if (status)
337		pciehp_enable_slot(slot);
338	else
339		pciehp_disable_slot(slot);
340	mutex_unlock(&slot->hotplug_lock);
341	return 0;
342}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
343#endif /* PM */
344
345static struct pcie_port_service_driver hpdriver_portdrv = {
346	.name		= PCIE_MODULE_NAME,
347	.port_type	= PCIE_ANY_PORT,
348	.service	= PCIE_PORT_SERVICE_HP,
349
350	.probe		= pciehp_probe,
351	.remove		= pciehp_remove,
352
353#ifdef	CONFIG_PM
 
354	.suspend	= pciehp_suspend,
 
355	.resume		= pciehp_resume,
 
 
 
356#endif	/* PM */
357};
358
359static int __init pcied_init(void)
360{
361	int retval = 0;
362
363	pciehp_firmware_init();
364	retval = pcie_port_service_register(&hpdriver_portdrv);
365	dbg("pcie_port_service_register = %d\n", retval);
366	info(DRIVER_DESC " version: " DRIVER_VERSION "\n");
367	if (retval)
368		dbg("Failure to register service\n");
369
370	return retval;
371}
372
373static void __exit pcied_cleanup(void)
374{
375	dbg("unload_pciehpd()\n");
376	pcie_port_service_unregister(&hpdriver_portdrv);
377	info(DRIVER_DESC " version: " DRIVER_VERSION " unloaded\n");
378}
379
380module_init(pcied_init);
381module_exit(pcied_cleanup);
v5.9
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * PCI Express Hot Plug Controller Driver
  4 *
  5 * Copyright (C) 1995,2001 Compaq Computer Corporation
  6 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
  7 * Copyright (C) 2001 IBM Corp.
  8 * Copyright (C) 2003-2004 Intel Corporation
  9 *
 10 * All rights reserved.
 11 *
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 12 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
 13 *
 14 * Authors:
 15 *   Dan Zink <dan.zink@compaq.com>
 16 *   Greg Kroah-Hartman <greg@kroah.com>
 17 *   Dely Sy <dely.l.sy@intel.com>"
 18 */
 19
 20#define pr_fmt(fmt) "pciehp: " fmt
 21#define dev_fmt pr_fmt
 22
 23#include <linux/moduleparam.h>
 24#include <linux/kernel.h>
 25#include <linux/slab.h>
 26#include <linux/types.h>
 27#include <linux/pci.h>
 28#include "pciehp.h"
 29
 30#include "../pci.h"
 31
 32/* Global variables */
 
 33bool pciehp_poll_mode;
 34int pciehp_poll_time;
 
 
 
 
 
 35
 36/*
 37 * not really modular, but the easiest way to keep compat with existing
 38 * bootargs behaviour is to continue using module_param here.
 39 */
 
 40module_param(pciehp_poll_mode, bool, 0644);
 41module_param(pciehp_poll_time, int, 0644);
 
 
 42MODULE_PARM_DESC(pciehp_poll_mode, "Using polling mechanism for hot-plug events or not");
 43MODULE_PARM_DESC(pciehp_poll_time, "Polling mechanism frequency, in seconds");
 
 44
 45static int set_attention_status(struct hotplug_slot *slot, u8 value);
 46static int get_power_status(struct hotplug_slot *slot, u8 *value);
 47static int get_latch_status(struct hotplug_slot *slot, u8 *value);
 48static int get_adapter_status(struct hotplug_slot *slot, u8 *value);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 49
 50static int init_slot(struct controller *ctrl)
 51{
 52	struct hotplug_slot_ops *ops;
 
 
 
 53	char name[SLOT_NAME_SIZE];
 54	int retval;
 
 
 
 
 
 
 
 
 55
 56	/* Setup hotplug slot ops */
 57	ops = kzalloc(sizeof(*ops), GFP_KERNEL);
 58	if (!ops)
 59		return -ENOMEM;
 60
 61	ops->enable_slot = pciehp_sysfs_enable_slot;
 62	ops->disable_slot = pciehp_sysfs_disable_slot;
 63	ops->get_power_status = get_power_status;
 64	ops->get_adapter_status = get_adapter_status;
 65	ops->reset_slot = pciehp_reset_slot;
 66	if (MRL_SENS(ctrl))
 67		ops->get_latch_status = get_latch_status;
 68	if (ATTN_LED(ctrl)) {
 69		ops->get_attention_status = pciehp_get_attention_status;
 70		ops->set_attention_status = set_attention_status;
 71	} else if (ctrl->pcie->port->hotplug_user_indicators) {
 72		ops->get_attention_status = pciehp_get_raw_indicator_status;
 73		ops->set_attention_status = pciehp_set_raw_indicator_status;
 74	}
 75
 76	/* register this slot with the hotplug pci core */
 77	ctrl->hotplug_slot.ops = ops;
 
 
 
 
 78	snprintf(name, SLOT_NAME_SIZE, "%u", PSN(ctrl));
 79
 80	retval = pci_hp_initialize(&ctrl->hotplug_slot,
 81				   ctrl->pcie->port->subordinate, 0, name);
 
 
 
 
 
 
 
 82	if (retval) {
 83		ctrl_err(ctrl, "pci_hp_initialize failed: error %d\n", retval);
 84		kfree(ops);
 
 
 85	}
 86	return retval;
 87}
 88
 89static void cleanup_slot(struct controller *ctrl)
 90{
 91	struct hotplug_slot *hotplug_slot = &ctrl->hotplug_slot;
 92
 93	pci_hp_destroy(hotplug_slot);
 94	kfree(hotplug_slot->ops);
 95}
 96
 97/*
 98 * set_attention_status - Turns the Attention Indicator on, off or blinking
 99 */
100static int set_attention_status(struct hotplug_slot *hotplug_slot, u8 status)
101{
102	struct controller *ctrl = to_ctrl(hotplug_slot);
103	struct pci_dev *pdev = ctrl->pcie->port;
104
105	if (status)
106		status <<= PCI_EXP_SLTCTL_ATTN_IND_SHIFT;
107	else
108		status = PCI_EXP_SLTCTL_ATTN_IND_OFF;
109
110	pci_config_pm_runtime_get(pdev);
111	pciehp_set_indicators(ctrl, INDICATOR_NOOP, status);
112	pci_config_pm_runtime_put(pdev);
113	return 0;
114}
115
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
116static int get_power_status(struct hotplug_slot *hotplug_slot, u8 *value)
117{
118	struct controller *ctrl = to_ctrl(hotplug_slot);
119	struct pci_dev *pdev = ctrl->pcie->port;
 
 
 
 
 
 
 
 
 
 
120
121	pci_config_pm_runtime_get(pdev);
122	pciehp_get_power_status(ctrl, value);
123	pci_config_pm_runtime_put(pdev);
 
124	return 0;
125}
126
127static int get_latch_status(struct hotplug_slot *hotplug_slot, u8 *value)
128{
129	struct controller *ctrl = to_ctrl(hotplug_slot);
130	struct pci_dev *pdev = ctrl->pcie->port;
 
 
131
132	pci_config_pm_runtime_get(pdev);
133	pciehp_get_latch_status(ctrl, value);
134	pci_config_pm_runtime_put(pdev);
135	return 0;
136}
137
138static int get_adapter_status(struct hotplug_slot *hotplug_slot, u8 *value)
139{
140	struct controller *ctrl = to_ctrl(hotplug_slot);
141	struct pci_dev *pdev = ctrl->pcie->port;
142	int ret;
143
144	pci_config_pm_runtime_get(pdev);
145	ret = pciehp_card_present_or_link_active(ctrl);
146	pci_config_pm_runtime_put(pdev);
147	if (ret < 0)
148		return ret;
149
150	*value = ret;
151	return 0;
152}
153
154/**
155 * pciehp_check_presence() - synthesize event if presence has changed
156 * @ctrl: controller to check
157 *
158 * On probe and resume, an explicit presence check is necessary to bring up an
159 * occupied slot or bring down an unoccupied slot.  This can't be triggered by
160 * events in the Slot Status register, they may be stale and are therefore
161 * cleared.  Secondly, sending an interrupt for "events that occur while
162 * interrupt generation is disabled [when] interrupt generation is subsequently
163 * enabled" is optional per PCIe r4.0, sec 6.7.3.4.
164 */
165static void pciehp_check_presence(struct controller *ctrl)
166{
167	int occupied;
168
169	down_read(&ctrl->reset_lock);
170	mutex_lock(&ctrl->state_lock);
171
172	occupied = pciehp_card_present_or_link_active(ctrl);
173	if ((occupied > 0 && (ctrl->state == OFF_STATE ||
174			  ctrl->state == BLINKINGON_STATE)) ||
175	    (!occupied && (ctrl->state == ON_STATE ||
176			   ctrl->state == BLINKINGOFF_STATE)))
177		pciehp_request(ctrl, PCI_EXP_SLTSTA_PDC);
178
179	mutex_unlock(&ctrl->state_lock);
180	up_read(&ctrl->reset_lock);
181}
182
183static int pciehp_probe(struct pcie_device *dev)
184{
185	int rc;
186	struct controller *ctrl;
 
 
187
188	/* If this is not a "hotplug" service, we have no business here. */
189	if (dev->service != PCIE_PORT_SERVICE_HP)
190		return -ENODEV;
191
192	if (!dev->port->subordinate) {
193		/* Can happen if we run out of bus numbers during probe */
194		pci_err(dev->port,
195			"Hotplug bridge without secondary bus, ignoring\n");
196		return -ENODEV;
197	}
198
199	ctrl = pcie_init(dev);
200	if (!ctrl) {
201		pci_err(dev->port, "Controller initialization failed\n");
202		return -ENODEV;
203	}
204	set_service_data(dev, ctrl);
205
206	/* Setup the slot information structures */
207	rc = init_slot(ctrl);
208	if (rc) {
209		if (rc == -EBUSY)
210			ctrl_warn(ctrl, "Slot already registered by another hotplug driver\n");
 
211		else
212			ctrl_err(ctrl, "Slot initialization failed (%d)\n", rc);
213		goto err_out_release_ctlr;
214	}
215
216	/* Enable events after we have setup the data structures */
217	rc = pcie_init_notification(ctrl);
218	if (rc) {
219		ctrl_err(ctrl, "Notification initialization failed (%d)\n", rc);
220		goto err_out_free_ctrl_slot;
221	}
222
223	/* Publish to user space */
224	rc = pci_hp_add(&ctrl->hotplug_slot);
225	if (rc) {
226		ctrl_err(ctrl, "Publication to user space failed (%d)\n", rc);
227		goto err_out_shutdown_notification;
 
 
 
228	}
229
230	pciehp_check_presence(ctrl);
 
231
232	return 0;
233
234err_out_shutdown_notification:
235	pcie_shutdown_notification(ctrl);
236err_out_free_ctrl_slot:
237	cleanup_slot(ctrl);
238err_out_release_ctlr:
239	pciehp_release_ctrl(ctrl);
 
240	return -ENODEV;
241}
242
243static void pciehp_remove(struct pcie_device *dev)
244{
245	struct controller *ctrl = get_service_data(dev);
246
247	pci_hp_del(&ctrl->hotplug_slot);
248	pcie_shutdown_notification(ctrl);
249	cleanup_slot(ctrl);
250	pciehp_release_ctrl(ctrl);
251}
252
253#ifdef CONFIG_PM
254static bool pme_is_native(struct pcie_device *dev)
255{
256	const struct pci_host_bridge *host;
257
258	host = pci_find_host_bridge(dev->port->bus);
259	return pcie_ports_native || host->native_pme;
260}
261
262static void pciehp_disable_interrupt(struct pcie_device *dev)
263{
264	/*
265	 * Disable hotplug interrupt so that it does not trigger
266	 * immediately when the downstream link goes down.
267	 */
268	if (pme_is_native(dev))
269		pcie_disable_interrupt(get_service_data(dev));
270}
271
272#ifdef CONFIG_PM_SLEEP
273static int pciehp_suspend(struct pcie_device *dev)
274{
275	/*
276	 * If the port is already runtime suspended we can keep it that
277	 * way.
278	 */
279	if (dev_pm_skip_suspend(&dev->port->dev))
280		return 0;
281
282	pciehp_disable_interrupt(dev);
283	return 0;
284}
285
286static int pciehp_resume_noirq(struct pcie_device *dev)
287{
288	struct controller *ctrl = get_service_data(dev);
289
290	/* pci_restore_state() just wrote to the Slot Control register */
291	ctrl->cmd_started = jiffies;
292	ctrl->cmd_busy = true;
293
294	/* clear spurious events from rediscovery of inserted card */
295	if (ctrl->state == ON_STATE || ctrl->state == BLINKINGOFF_STATE)
296		pcie_clear_hotplug_events(ctrl);
297
298	return 0;
299}
300#endif
301
302static int pciehp_resume(struct pcie_device *dev)
303{
304	struct controller *ctrl = get_service_data(dev);
305
306	if (pme_is_native(dev))
307		pcie_enable_interrupt(ctrl);
308
309	pciehp_check_presence(ctrl);
310
311	return 0;
312}
313
314static int pciehp_runtime_suspend(struct pcie_device *dev)
315{
316	pciehp_disable_interrupt(dev);
317	return 0;
318}
319
320static int pciehp_runtime_resume(struct pcie_device *dev)
321{
322	struct controller *ctrl = get_service_data(dev);
323
324	/* pci_restore_state() just wrote to the Slot Control register */
325	ctrl->cmd_started = jiffies;
326	ctrl->cmd_busy = true;
327
328	/* clear spurious events from rediscovery of inserted card */
329	if ((ctrl->state == ON_STATE || ctrl->state == BLINKINGOFF_STATE) &&
330	     pme_is_native(dev))
331		pcie_clear_hotplug_events(ctrl);
332
333	return pciehp_resume(dev);
334}
335#endif /* PM */
336
337static struct pcie_port_service_driver hpdriver_portdrv = {
338	.name		= "pciehp",
339	.port_type	= PCIE_ANY_PORT,
340	.service	= PCIE_PORT_SERVICE_HP,
341
342	.probe		= pciehp_probe,
343	.remove		= pciehp_remove,
344
345#ifdef	CONFIG_PM
346#ifdef	CONFIG_PM_SLEEP
347	.suspend	= pciehp_suspend,
348	.resume_noirq	= pciehp_resume_noirq,
349	.resume		= pciehp_resume,
350#endif
351	.runtime_suspend = pciehp_runtime_suspend,
352	.runtime_resume	= pciehp_runtime_resume,
353#endif	/* PM */
354};
355
356int __init pcie_hp_init(void)
357{
358	int retval = 0;
359
 
360	retval = pcie_port_service_register(&hpdriver_portdrv);
361	pr_debug("pcie_port_service_register = %d\n", retval);
 
362	if (retval)
363		pr_debug("Failure to register service\n");
364
365	return retval;
366}