blob: 0e0d0f7f63fdd83aa551549d38b174cdca8d034d [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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 Accardi8cf4c192005-08-16 15:16:10 -070026 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
Linus Torvalds1da177e2005-04-16 15:20:36 -070027 *
28 */
29
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#include <linux/module.h>
31#include <linux/kernel.h>
32#include <linux/types.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/pci.h>
34#include "../pci.h"
35#include "pciehp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070036
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080037int pciehp_configure_device(struct slot *p_slot)
Linus Torvalds1da177e2005-04-16 15:20:36 -070038{
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080039 struct pci_dev *dev;
Yinghai Lu9789ac92010-01-22 01:02:26 -080040 struct pci_dev *bridge = p_slot->ctrl->pcie->port;
41 struct pci_bus *parent = bridge->subordinate;
Yijing Wangba518e32013-01-15 11:12:19 +080042 int num;
Taku Izumi7f2feec2008-09-05 12:11:26 +090043 struct controller *ctrl = p_slot->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
Kenji Kaneshiged689f7e2009-09-15 17:26:56 +090045 dev = pci_get_slot(parent, PCI_DEVFN(0, 0));
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080046 if (dev) {
Taku Izumi18b341b2008-10-23 11:47:32 +090047 ctrl_err(ctrl, "Device %s already exists "
Kenji Kaneshiged689f7e2009-09-15 17:26:56 +090048 "at %04x:%02x:00, cannot hot-add\n", pci_name(dev),
49 pci_domain_nr(parent), parent->number);
Kenji Kaneshige56bfada2006-05-12 11:22:24 +090050 pci_dev_put(dev);
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080051 return -EINVAL;
52 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
Kenji Kaneshiged689f7e2009-09-15 17:26:56 +090054 num = pci_scan_slot(parent, PCI_DEVFN(0, 0));
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080055 if (num == 0) {
Taku Izumi7f2feec2008-09-05 12:11:26 +090056 ctrl_err(ctrl, "No new device found\n");
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080057 return -ENODEV;
58 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070059
Yijing Wangba518e32013-01-15 11:12:19 +080060 list_for_each_entry(dev, &parent->devices, bus_list)
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080061 if ((dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) ||
Yinghai Luc6da81a2012-05-17 18:58:41 -070062 (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS))
63 pci_hp_add_bridge(dev);
Yinghai Lu9789ac92010-01-22 01:02:26 -080064
65 pci_assign_unassigned_bridge_resources(bridge);
66
Yijing Wangba518e32013-01-15 11:12:19 +080067 list_for_each_entry(dev, &parent->devices, bus_list) {
68 if ((dev->class >> 16) == PCI_BASE_CLASS_DISPLAY)
Yinghai Lu9789ac92010-01-22 01:02:26 -080069 continue;
Yijing Wangba518e32013-01-15 11:12:19 +080070
Bjorn Helgaasd569c742009-09-14 16:35:25 -060071 pci_configure_slot(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070072 }
73
rajesh.shah@intel.com71b720c2005-10-31 16:20:06 -080074 pci_bus_add_devices(parent);
Yinghai Lu9789ac92010-01-22 01:02:26 -080075
Linus Torvalds1da177e2005-04-16 15:20:36 -070076 return 0;
77}
78
rajesh.shah@intel.comca22a5e2005-10-31 16:20:08 -080079int pciehp_unconfigure_device(struct slot *p_slot)
Linus Torvalds1da177e2005-04-16 15:20:36 -070080{
Kristen Carlson Accardi1cf53d52007-08-09 16:09:31 -070081 int ret, rc = 0;
rajesh.shah@intel.comca22a5e2005-10-31 16:20:08 -080082 u8 bctl = 0;
Kristen Carlson Accardi1cf53d52007-08-09 16:09:31 -070083 u8 presence = 0;
Yijing Wangba518e32013-01-15 11:12:19 +080084 struct pci_dev *dev, *temp;
Kenji Kaneshige385e2492009-09-15 17:30:14 +090085 struct pci_bus *parent = p_slot->ctrl->pcie->port->subordinate;
Kenji Kaneshige2326e2b2007-12-20 19:46:33 +090086 u16 command;
Taku Izumi7f2feec2008-09-05 12:11:26 +090087 struct controller *ctrl = p_slot->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -070088
Kenji Kaneshiged689f7e2009-09-15 17:26:56 +090089 ctrl_dbg(ctrl, "%s: domain:bus:dev = %04x:%02x:00\n",
90 __func__, pci_domain_nr(parent), parent->number);
Kenji Kaneshige82a9e792009-09-15 17:30:48 +090091 ret = pciehp_get_adapter_status(p_slot, &presence);
Kenji Kaneshige2326e2b2007-12-20 19:46:33 +090092 if (ret)
93 presence = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070094
Yinghai Lu29ed1f22013-07-19 12:14:16 -070095 /*
96 * Stopping an SR-IOV PF device removes all the associated VFs,
97 * which will update the bus->devices list and confuse the
98 * iterator. Therefore, iterate in reverse so we remove the VFs
99 * first, then the PF. We do the same in pci_stop_bus_device().
100 */
101 list_for_each_entry_safe_reverse(dev, temp, &parent->devices,
102 bus_list) {
Yijing Wangba518e32013-01-15 11:12:19 +0800103 pci_dev_get(dev);
104 if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE && presence) {
105 pci_read_config_byte(dev, PCI_BRIDGE_CONTROL, &bctl);
Kenji Kaneshige2326e2b2007-12-20 19:46:33 +0900106 if (bctl & PCI_BRIDGE_CTL_VGA) {
Taku Izumi7f2feec2008-09-05 12:11:26 +0900107 ctrl_err(ctrl,
108 "Cannot remove display device %s\n",
Yijing Wangba518e32013-01-15 11:12:19 +0800109 pci_name(dev));
110 pci_dev_put(dev);
Praveen Kalamegham01b666d2010-05-20 15:32:22 -0500111 rc = -EINVAL;
Praveen Kalameghamac818602010-05-19 17:03:12 -0500112 break;
rajesh.shah@intel.comca22a5e2005-10-31 16:20:08 -0800113 }
114 }
Yijing Wangba518e32013-01-15 11:12:19 +0800115 pci_stop_and_remove_bus_device(dev);
Kenji Kaneshige2326e2b2007-12-20 19:46:33 +0900116 /*
117 * Ensure that no new Requests will be generated from
118 * the device.
119 */
120 if (presence) {
Yijing Wangba518e32013-01-15 11:12:19 +0800121 pci_read_config_word(dev, PCI_COMMAND, &command);
Kenji Kaneshige2326e2b2007-12-20 19:46:33 +0900122 command &= ~(PCI_COMMAND_MASTER | PCI_COMMAND_SERR);
123 command |= PCI_COMMAND_INTX_DISABLE;
Yijing Wangba518e32013-01-15 11:12:19 +0800124 pci_write_config_word(dev, PCI_COMMAND, command);
Kenji Kaneshige2326e2b2007-12-20 19:46:33 +0900125 }
Yijing Wangba518e32013-01-15 11:12:19 +0800126 pci_dev_put(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 }
Kenji Kaneshige9fe81642007-08-09 16:09:37 -0700128
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 return rc;
130}