fdc_pccard.c revision 185235
1/*- 2 * Copyright (c) 2004-2005 M. Warner Losh. 3 * 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: head/sys/dev/fdc/fdc_pccard.c 185235 2008-11-23 23:04:28Z imp $"); 29 30#include <sys/param.h> 31#include <sys/bio.h> 32#include <sys/bus.h> 33#include <sys/kernel.h> 34#include <sys/lock.h> 35#include <sys/module.h> 36#include <sys/mutex.h> 37#include <sys/rman.h> 38#include <sys/systm.h> 39#include <machine/bus.h> 40 41#include <machine/bus.h> 42 43#include <dev/fdc/fdcvar.h> 44#include <dev/pccard/pccardvar.h> 45#include "pccarddevs.h" 46 47static int fdc_pccard_probe(device_t); 48static int fdc_pccard_attach(device_t); 49 50static const struct pccard_product fdc_pccard_products[] = { 51 PCMCIA_CARD(YEDATA, EXTERNAL_FDD), 52}; 53 54static int 55fdc_pccard_alloc_resources(device_t dev, struct fdc_data *fdc) 56{ 57 struct resource *res; 58 int rid, i; 59 60 rid = 0; 61 res = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0ul, ~0ul, 1, 62 RF_ACTIVE); 63 if (res == NULL) { 64 device_printf(dev, "cannot alloc I/O port range\n"); 65 return (ENXIO); 66 } 67 for (i = 0; i < FDC_MAXREG; i++) { 68 fdc->resio[i] = res; 69 fdc->ridio[i] = rid; 70 fdc->ioff[i] = i; 71 fdc->ioh[i] = rman_get_bushandle(res); 72 } 73 fdc->iot = rman_get_bustag(res); 74 75 fdc->rid_irq = 0; 76 fdc->res_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &fdc->rid_irq, 77 RF_ACTIVE | RF_SHAREABLE); 78 if (fdc->res_irq == NULL) { 79 device_printf(dev, "cannot reserve interrupt line\n"); 80 return (ENXIO); 81 } 82 return (0); 83} 84 85static int 86fdc_pccard_probe(device_t dev) 87{ 88 if (pccard_product_lookup(dev, fdc_pccard_products, 89 sizeof(fdc_pccard_products[0]), NULL) != NULL) { 90 device_set_desc(dev, "PC Card Floppy"); 91 return (0); 92 } 93 return (ENXIO); 94} 95 96static int 97fdc_pccard_attach(device_t dev) 98{ 99 int error; 100 struct fdc_data *fdc; 101 device_t child; 102 103 fdc = device_get_softc(dev); 104 fdc->flags = FDC_NODMA | FDC_NOFAST; 105 fdc->fdct = FDC_NE765; 106 error = fdc_pccard_alloc_resources(dev, fdc); 107 if (error == 0) 108 error = fdc_attach(dev); 109 if (error == 0) { 110 child = fdc_add_child(dev, "fd", -1); 111 device_set_flags(child, 0x24); 112 error = bus_generic_attach(dev); 113 } 114 if (error) 115 fdc_release_resources(fdc); 116 return (error); 117} 118 119static device_method_t fdc_pccard_methods[] = { 120 /* Device interface */ 121 DEVMETHOD(device_probe, fdc_pccard_probe), 122 DEVMETHOD(device_attach, fdc_pccard_attach), 123 DEVMETHOD(device_detach, fdc_detach), 124 DEVMETHOD(device_shutdown, bus_generic_shutdown), 125 DEVMETHOD(device_suspend, bus_generic_suspend), 126 DEVMETHOD(device_resume, bus_generic_resume), 127 128 /* Bus interface */ 129 DEVMETHOD(bus_print_child, fdc_print_child), 130 DEVMETHOD(bus_read_ivar, fdc_read_ivar), 131 DEVMETHOD(bus_write_ivar, fdc_write_ivar), 132 /* Our children never use any other bus interface methods. */ 133 134 { 0, 0 } 135}; 136 137static driver_t fdc_pccard_driver = { 138 "fdc", 139 fdc_pccard_methods, 140 sizeof(struct fdc_data) 141}; 142 143DRIVER_MODULE(fdc, pccard, fdc_pccard_driver, fdc_devclass, 0, 0); 144