cpci_hotplug_pci.c revision c4ec84c7db0e4b01ed40cc2388f16ae5c6513cc0
1/* 2 * CompactPCI Hot Plug Driver PCI functions 3 * 4 * Copyright (C) 2002,2005 by SOMA Networks, Inc. 5 * 6 * All rights reserved. 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License as published by 10 * the Free Software Foundation; either version 2 of the License, or (at 11 * your option) any later version. 12 * 13 * This program is distributed in the hope that it will be useful, but 14 * WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or 16 * NON INFRINGEMENT. See the GNU General Public License for more 17 * details. 18 * 19 * You should have received a copy of the GNU General Public License 20 * along with this program; if not, write to the Free Software 21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 22 * 23 * Send feedback to <scottm@somanetworks.com> 24 */ 25 26#include <linux/module.h> 27#include <linux/kernel.h> 28#include <linux/pci.h> 29#include <linux/pci_hotplug.h> 30#include <linux/proc_fs.h> 31#include "../pci.h" 32#include "cpci_hotplug.h" 33 34#define MY_NAME "cpci_hotplug" 35 36extern int cpci_debug; 37 38#define dbg(format, arg...) \ 39 do { \ 40 if (cpci_debug) \ 41 printk (KERN_DEBUG "%s: " format "\n", \ 42 MY_NAME , ## arg); \ 43 } while (0) 44#define err(format, arg...) printk(KERN_ERR "%s: " format "\n", MY_NAME , ## arg) 45#define info(format, arg...) printk(KERN_INFO "%s: " format "\n", MY_NAME , ## arg) 46#define warn(format, arg...) printk(KERN_WARNING "%s: " format "\n", MY_NAME , ## arg) 47 48 49u8 cpci_get_attention_status(struct slot* slot) 50{ 51 int hs_cap; 52 u16 hs_csr; 53 54 hs_cap = pci_bus_find_capability(slot->bus, 55 slot->devfn, 56 PCI_CAP_ID_CHSWP); 57 if (!hs_cap) 58 return 0; 59 60 if (pci_bus_read_config_word(slot->bus, 61 slot->devfn, 62 hs_cap + 2, 63 &hs_csr)) 64 return 0; 65 66 return hs_csr & 0x0008 ? 1 : 0; 67} 68 69int cpci_set_attention_status(struct slot* slot, int status) 70{ 71 int hs_cap; 72 u16 hs_csr; 73 74 hs_cap = pci_bus_find_capability(slot->bus, 75 slot->devfn, 76 PCI_CAP_ID_CHSWP); 77 if (!hs_cap) 78 return 0; 79 if (pci_bus_read_config_word(slot->bus, 80 slot->devfn, 81 hs_cap + 2, 82 &hs_csr)) 83 return 0; 84 if (status) 85 hs_csr |= HS_CSR_LOO; 86 else 87 hs_csr &= ~HS_CSR_LOO; 88 if (pci_bus_write_config_word(slot->bus, 89 slot->devfn, 90 hs_cap + 2, 91 hs_csr)) 92 return 0; 93 return 1; 94} 95 96u16 cpci_get_hs_csr(struct slot* slot) 97{ 98 int hs_cap; 99 u16 hs_csr; 100 101 hs_cap = pci_bus_find_capability(slot->bus, 102 slot->devfn, 103 PCI_CAP_ID_CHSWP); 104 if (!hs_cap) 105 return 0xFFFF; 106 if (pci_bus_read_config_word(slot->bus, 107 slot->devfn, 108 hs_cap + 2, 109 &hs_csr)) 110 return 0xFFFF; 111 return hs_csr; 112} 113 114int cpci_check_and_clear_ins(struct slot* slot) 115{ 116 int hs_cap; 117 u16 hs_csr; 118 int ins = 0; 119 120 hs_cap = pci_bus_find_capability(slot->bus, 121 slot->devfn, 122 PCI_CAP_ID_CHSWP); 123 if (!hs_cap) 124 return 0; 125 if (pci_bus_read_config_word(slot->bus, 126 slot->devfn, 127 hs_cap + 2, 128 &hs_csr)) 129 return 0; 130 if (hs_csr & HS_CSR_INS) { 131 /* Clear INS (by setting it) */ 132 if (pci_bus_write_config_word(slot->bus, 133 slot->devfn, 134 hs_cap + 2, 135 hs_csr)) 136 ins = 0; 137 else 138 ins = 1; 139 } 140 return ins; 141} 142 143int cpci_check_ext(struct slot* slot) 144{ 145 int hs_cap; 146 u16 hs_csr; 147 int ext = 0; 148 149 hs_cap = pci_bus_find_capability(slot->bus, 150 slot->devfn, 151 PCI_CAP_ID_CHSWP); 152 if (!hs_cap) 153 return 0; 154 if (pci_bus_read_config_word(slot->bus, 155 slot->devfn, 156 hs_cap + 2, 157 &hs_csr)) 158 return 0; 159 if (hs_csr & HS_CSR_EXT) 160 ext = 1; 161 return ext; 162} 163 164int cpci_clear_ext(struct slot* slot) 165{ 166 int hs_cap; 167 u16 hs_csr; 168 169 hs_cap = pci_bus_find_capability(slot->bus, 170 slot->devfn, 171 PCI_CAP_ID_CHSWP); 172 if (!hs_cap) 173 return -ENODEV; 174 if (pci_bus_read_config_word(slot->bus, 175 slot->devfn, 176 hs_cap + 2, 177 &hs_csr)) 178 return -ENODEV; 179 if (hs_csr & HS_CSR_EXT) { 180 /* Clear EXT (by setting it) */ 181 if (pci_bus_write_config_word(slot->bus, 182 slot->devfn, 183 hs_cap + 2, 184 hs_csr)) 185 return -ENODEV; 186 } 187 return 0; 188} 189 190int cpci_led_on(struct slot* slot) 191{ 192 int hs_cap; 193 u16 hs_csr; 194 195 hs_cap = pci_bus_find_capability(slot->bus, 196 slot->devfn, 197 PCI_CAP_ID_CHSWP); 198 if (!hs_cap) 199 return -ENODEV; 200 if (pci_bus_read_config_word(slot->bus, 201 slot->devfn, 202 hs_cap + 2, 203 &hs_csr)) 204 return -ENODEV; 205 if ((hs_csr & HS_CSR_LOO) != HS_CSR_LOO) { 206 hs_csr |= HS_CSR_LOO; 207 if (pci_bus_write_config_word(slot->bus, 208 slot->devfn, 209 hs_cap + 2, 210 hs_csr)) { 211 err("Could not set LOO for slot %s", 212 hotplug_slot_name(slot->hotplug_slot)); 213 return -ENODEV; 214 } 215 } 216 return 0; 217} 218 219int cpci_led_off(struct slot* slot) 220{ 221 int hs_cap; 222 u16 hs_csr; 223 224 hs_cap = pci_bus_find_capability(slot->bus, 225 slot->devfn, 226 PCI_CAP_ID_CHSWP); 227 if (!hs_cap) 228 return -ENODEV; 229 if (pci_bus_read_config_word(slot->bus, 230 slot->devfn, 231 hs_cap + 2, 232 &hs_csr)) 233 return -ENODEV; 234 if (hs_csr & HS_CSR_LOO) { 235 hs_csr &= ~HS_CSR_LOO; 236 if (pci_bus_write_config_word(slot->bus, 237 slot->devfn, 238 hs_cap + 2, 239 hs_csr)) { 240 err("Could not clear LOO for slot %s", 241 hotplug_slot_name(slot->hotplug_slot)); 242 return -ENODEV; 243 } 244 } 245 return 0; 246} 247 248 249/* 250 * Device configuration functions 251 */ 252 253int __ref cpci_configure_slot(struct slot *slot) 254{ 255 struct pci_dev *dev; 256 struct pci_bus *parent; 257 int ret = 0; 258 259 dbg("%s - enter", __func__); 260 261 pci_lock_rescan_remove(); 262 263 if (slot->dev == NULL) { 264 dbg("pci_dev null, finding %02x:%02x:%x", 265 slot->bus->number, PCI_SLOT(slot->devfn), PCI_FUNC(slot->devfn)); 266 slot->dev = pci_get_slot(slot->bus, slot->devfn); 267 } 268 269 /* Still NULL? Well then scan for it! */ 270 if (slot->dev == NULL) { 271 int n; 272 dbg("pci_dev still null"); 273 274 /* 275 * This will generate pci_dev structures for all functions, but 276 * we will only call this case when lookup fails. 277 */ 278 n = pci_scan_slot(slot->bus, slot->devfn); 279 dbg("%s: pci_scan_slot returned %d", __func__, n); 280 slot->dev = pci_get_slot(slot->bus, slot->devfn); 281 if (slot->dev == NULL) { 282 err("Could not find PCI device for slot %02x", slot->number); 283 ret = -ENODEV; 284 goto out; 285 } 286 } 287 parent = slot->dev->bus; 288 289 list_for_each_entry(dev, &parent->devices, bus_list) 290 if (PCI_SLOT(dev->devfn) != PCI_SLOT(slot->devfn)) 291 continue; 292 if ((dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) || 293 (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)) 294 pci_hp_add_bridge(dev); 295 296 297 pci_assign_unassigned_bridge_resources(parent->self); 298 299 pci_bus_add_devices(parent); 300 301 out: 302 pci_unlock_rescan_remove(); 303 dbg("%s - exit", __func__); 304 return ret; 305} 306 307int cpci_unconfigure_slot(struct slot* slot) 308{ 309 struct pci_dev *dev, *temp; 310 311 dbg("%s - enter", __func__); 312 if (!slot->dev) { 313 err("No device for slot %02x\n", slot->number); 314 return -ENODEV; 315 } 316 317 pci_lock_rescan_remove(); 318 319 list_for_each_entry_safe(dev, temp, &slot->bus->devices, bus_list) { 320 if (PCI_SLOT(dev->devfn) != PCI_SLOT(slot->devfn)) 321 continue; 322 pci_dev_get(dev); 323 pci_stop_and_remove_bus_device(dev); 324 pci_dev_put(dev); 325 } 326 pci_dev_put(slot->dev); 327 slot->dev = NULL; 328 329 pci_unlock_rescan_remove(); 330 331 dbg("%s - exit", __func__); 332 return 0; 333} 334