1 /*- 2 * Copyright (c) 2003-2008 M. Warner Losh. All Rights Reserved. 3 * Copyright (c) 2000,2001 Jonathan Chen. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include <sys/param.h> 31 #include <sys/systm.h> 32 #include <sys/malloc.h> 33 #include <sys/module.h> 34 #include <sys/kernel.h> 35 #include <sys/sysctl.h> 36 37 #include <sys/bus.h> 38 #include <machine/bus.h> 39 #include <sys/rman.h> 40 #include <machine/resource.h> 41 42 #include <sys/pciio.h> 43 #include <dev/pci/pcivar.h> 44 #include <dev/pci/pcireg.h> 45 #include <dev/pci/pci_private.h> 46 47 #include <dev/cardbus/cardbusreg.h> 48 #include <dev/cardbus/cardbusvar.h> 49 #include <dev/cardbus/cardbus_cis.h> 50 #include <dev/pccard/pccard_cis.h> 51 #include <dev/pccard/pccardvar.h> 52 53 #include "power_if.h" 54 #include "pcib_if.h" 55 56 /* sysctl vars */ 57 static SYSCTL_NODE(_hw, OID_AUTO, cardbus, CTLFLAG_RD, 0, "CardBus parameters"); 58 59 int cardbus_debug = 0; 60 SYSCTL_INT(_hw_cardbus, OID_AUTO, debug, CTLFLAG_RWTUN, 61 &cardbus_debug, 0, "CardBus debug"); 62 63 int cardbus_cis_debug = 0; 64 SYSCTL_INT(_hw_cardbus, OID_AUTO, cis_debug, CTLFLAG_RWTUN, 65 &cardbus_cis_debug, 0, "CardBus CIS debug"); 66 67 #define DPRINTF(a) if (cardbus_debug) printf a 68 #define DEVPRINTF(x) if (cardbus_debug) device_printf x 69 70 static int cardbus_attach(device_t cbdev); 71 static int cardbus_attach_card(device_t cbdev); 72 static int cardbus_detach(device_t cbdev); 73 static int cardbus_detach_card(device_t cbdev); 74 static void cardbus_device_setup_regs(pcicfgregs *cfg); 75 static void cardbus_driver_added(device_t cbdev, driver_t *driver); 76 static int cardbus_probe(device_t cbdev); 77 static int cardbus_read_ivar(device_t cbdev, device_t child, int which, 78 uintptr_t *result); 79 80 /************************************************************************/ 81 /* Probe/Attach */ 82 /************************************************************************/ 83 84 static int 85 cardbus_probe(device_t cbdev) 86 { 87 device_set_desc(cbdev, "CardBus bus"); 88 return (0); 89 } 90 91 static int 92 cardbus_attach(device_t cbdev) 93 { 94 struct cardbus_softc *sc; 95 #ifdef PCI_RES_BUS 96 int rid; 97 #endif 98 99 sc = device_get_softc(cbdev); 100 sc->sc_dev = cbdev; 101 #ifdef PCI_RES_BUS 102 rid = 0; 103 sc->sc_bus = bus_alloc_resource(cbdev, PCI_RES_BUS, &rid, 104 pcib_get_bus(cbdev), pcib_get_bus(cbdev), 1, 0); 105 if (sc->sc_bus == NULL) { 106 device_printf(cbdev, "failed to allocate bus number\n"); 107 return (ENXIO); 108 } 109 #else 110 device_printf(cbdev, "Your bus numbers may be AFU\n"); 111 #endif 112 return (0); 113 } 114 115 static int 116 cardbus_detach(device_t cbdev) 117 { 118 #ifdef PCI_RES_BUS 119 struct cardbus_softc *sc; 120 #endif 121 122 cardbus_detach_card(cbdev); 123 #ifdef PCI_RES_BUS 124 sc = device_get_softc(cbdev); 125 (void)bus_release_resource(cbdev, PCI_RES_BUS, 0, sc->sc_bus); 126 #endif 127 return (0); 128 } 129 130 static int 131 cardbus_suspend(device_t self) 132 { 133 134 cardbus_detach_card(self); 135 return (0); 136 } 137 138 static int 139 cardbus_resume(device_t self) 140 { 141 142 return (0); 143 } 144 145 /************************************************************************/ 146 /* Attach/Detach card */ 147 /************************************************************************/ 148 149 static void 150 cardbus_device_setup_regs(pcicfgregs *cfg) 151 { 152 device_t dev = cfg->dev; 153 int i; 154 155 /* 156 * Some cards power up with garbage in their BARs. This 157 * code clears all that junk out. 158 */ 159 for (i = 0; i < PCIR_MAX_BAR_0; i++) 160 pci_write_config(dev, PCIR_BAR(i), 0, 4); 161 162 cfg->intline = 163 pci_get_irq(device_get_parent(device_get_parent(dev))); 164 pci_write_config(dev, PCIR_INTLINE, cfg->intline, 1); 165 pci_write_config(dev, PCIR_CACHELNSZ, 0x08, 1); 166 pci_write_config(dev, PCIR_LATTIMER, 0xa8, 1); 167 pci_write_config(dev, PCIR_MINGNT, 0x14, 1); 168 pci_write_config(dev, PCIR_MAXLAT, 0x14, 1); 169 } 170 171 static int 172 cardbus_attach_card(device_t cbdev) 173 { 174 device_t brdev = device_get_parent(cbdev); 175 device_t child; 176 int bus, domain, slot, func; 177 int cardattached = 0; 178 int cardbusfunchigh = 0; 179 struct cardbus_softc *sc; 180 181 sc = device_get_softc(cbdev); 182 cardbus_detach_card(cbdev); /* detach existing cards */ 183 POWER_ENABLE_SOCKET(brdev, cbdev); 184 domain = pcib_get_domain(cbdev); 185 bus = pcib_get_bus(cbdev); 186 slot = 0; 187 /* For each function, set it up and try to attach a driver to it */ 188 for (func = 0; func <= cardbusfunchigh; func++) { 189 struct cardbus_devinfo *dinfo; 190 191 dinfo = (struct cardbus_devinfo *) 192 pci_read_device(brdev, domain, bus, slot, func, 193 sizeof(struct cardbus_devinfo)); 194 if (dinfo == NULL) 195 continue; 196 if (dinfo->pci.cfg.mfdev) 197 cardbusfunchigh = PCI_FUNCMAX; 198 199 child = device_add_child(cbdev, NULL, -1); 200 if (child == NULL) { 201 DEVPRINTF((cbdev, "Cannot add child!\n")); 202 pci_freecfg((struct pci_devinfo *)dinfo); 203 continue; 204 } 205 dinfo->pci.cfg.dev = child; 206 resource_list_init(&dinfo->pci.resources); 207 device_set_ivars(child, dinfo); 208 cardbus_device_create(sc, dinfo, cbdev, child); 209 if (cardbus_do_cis(cbdev, child) != 0) 210 DEVPRINTF((cbdev, "Warning: Bogus CIS ignored\n")); 211 pci_cfg_save(dinfo->pci.cfg.dev, &dinfo->pci, 0); 212 pci_cfg_restore(dinfo->pci.cfg.dev, &dinfo->pci); 213 cardbus_device_setup_regs(&dinfo->pci.cfg); 214 pci_add_resources(cbdev, child, 1, dinfo->mprefetchable); 215 pci_print_verbose(&dinfo->pci); 216 if (device_probe_and_attach(child) == 0) 217 cardattached++; 218 else 219 pci_cfg_save(dinfo->pci.cfg.dev, &dinfo->pci, 1); 220 } 221 if (cardattached > 0) 222 return (0); 223 /* POWER_DISABLE_SOCKET(brdev, cbdev); */ 224 return (ENOENT); 225 } 226 227 static int 228 cardbus_detach_card(device_t cbdev) 229 { 230 int numdevs; 231 device_t *devlist; 232 int tmp; 233 int err = 0; 234 235 if (device_get_children(cbdev, &devlist, &numdevs) != 0) 236 return (ENOENT); 237 if (numdevs == 0) { 238 free(devlist, M_TEMP); 239 return (ENOENT); 240 } 241 242 for (tmp = 0; tmp < numdevs; tmp++) { 243 struct cardbus_devinfo *dinfo = device_get_ivars(devlist[tmp]); 244 245 if (dinfo->pci.cfg.dev != devlist[tmp]) 246 device_printf(cbdev, "devinfo dev mismatch\n"); 247 cardbus_device_destroy(dinfo); 248 pci_delete_child(cbdev, devlist[tmp]); 249 } 250 POWER_DISABLE_SOCKET(device_get_parent(cbdev), cbdev); 251 free(devlist, M_TEMP); 252 return (err); 253 } 254 255 static void 256 cardbus_driver_added(device_t cbdev, driver_t *driver) 257 { 258 int numdevs; 259 device_t *devlist; 260 device_t dev; 261 int i; 262 struct cardbus_devinfo *dinfo; 263 264 DEVICE_IDENTIFY(driver, cbdev); 265 if (device_get_children(cbdev, &devlist, &numdevs) != 0) 266 return; 267 268 /* 269 * If there are no drivers attached, but there are children, 270 * then power the card up. 271 */ 272 for (i = 0; i < numdevs; i++) { 273 dev = devlist[i]; 274 if (device_get_state(dev) != DS_NOTPRESENT) 275 break; 276 } 277 if (i > 0 && i == numdevs) 278 POWER_ENABLE_SOCKET(device_get_parent(cbdev), cbdev); 279 for (i = 0; i < numdevs; i++) { 280 dev = devlist[i]; 281 if (device_get_state(dev) != DS_NOTPRESENT) 282 continue; 283 dinfo = device_get_ivars(dev); 284 pci_print_verbose(&dinfo->pci); 285 if (bootverbose) 286 printf("pci%d:%d:%d:%d: reprobing on driver added\n", 287 dinfo->pci.cfg.domain, dinfo->pci.cfg.bus, 288 dinfo->pci.cfg.slot, dinfo->pci.cfg.func); 289 pci_cfg_restore(dinfo->pci.cfg.dev, &dinfo->pci); 290 if (device_probe_and_attach(dev) != 0) 291 pci_cfg_save(dev, &dinfo->pci, 1); 292 } 293 free(devlist, M_TEMP); 294 } 295 296 /************************************************************************/ 297 /* Other Bus Methods */ 298 /************************************************************************/ 299 300 static int 301 cardbus_read_ivar(device_t cbdev, device_t child, int which, uintptr_t *result) 302 { 303 struct cardbus_devinfo *dinfo; 304 pcicfgregs *cfg; 305 306 dinfo = device_get_ivars(child); 307 cfg = &dinfo->pci.cfg; 308 309 switch (which) { 310 case PCI_IVAR_ETHADDR: 311 /* 312 * The generic accessor doesn't deal with failure, so 313 * we set the return value, then return an error. 314 */ 315 if (dinfo->fepresent & (1 << PCCARD_TPLFE_TYPE_LAN_NID)) { 316 *((uint8_t **) result) = dinfo->funce.lan.nid; 317 break; 318 } 319 *((uint8_t **) result) = NULL; 320 return (EINVAL); 321 default: 322 return (pci_read_ivar(cbdev, child, which, result)); 323 } 324 return 0; 325 } 326 327 static device_method_t cardbus_methods[] = { 328 /* Device interface */ 329 DEVMETHOD(device_probe, cardbus_probe), 330 DEVMETHOD(device_attach, cardbus_attach), 331 DEVMETHOD(device_detach, cardbus_detach), 332 DEVMETHOD(device_suspend, cardbus_suspend), 333 DEVMETHOD(device_resume, cardbus_resume), 334 335 /* Bus interface */ 336 DEVMETHOD(bus_get_dma_tag, bus_generic_get_dma_tag), 337 DEVMETHOD(bus_read_ivar, cardbus_read_ivar), 338 DEVMETHOD(bus_driver_added, cardbus_driver_added), 339 340 /* Card Interface */ 341 DEVMETHOD(card_attach_card, cardbus_attach_card), 342 DEVMETHOD(card_detach_card, cardbus_detach_card), 343 344 {0,0} 345 }; 346 347 DEFINE_CLASS_1(cardbus, cardbus_driver, cardbus_methods, 348 sizeof(struct cardbus_softc), pci_driver); 349 350 static devclass_t cardbus_devclass; 351 352 DRIVER_MODULE(cardbus, cbb, cardbus_driver, cardbus_devclass, 0, 0); 353 MODULE_VERSION(cardbus, 1); 354