fdc_pccard.c revision 147580
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 147580 2005-06-24 14:36:54Z 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 const struct pccard_product *pp; 89 90 if ((pp = pccard_product_lookup(dev, fdc_pccard_products, 91 sizeof(fdc_pccard_products[0]), NULL)) != NULL) { 92 device_set_desc(dev, "PC Card Floppy"); 93 return (0); 94 } 95 return (ENXIO); 96} 97 98static int 99fdc_pccard_attach(device_t dev) 100{ 101 int error; 102 struct fdc_data *fdc; 103 device_t child; 104 105 fdc = device_get_softc(dev); 106 fdc->flags = FDC_NODMA | FDC_NOFAST; 107 fdc->fdct = FDC_NE765; 108 error = fdc_pccard_alloc_resources(dev, fdc); 109 if (error == 0) 110 error = fdc_attach(dev); 111 if (error == 0) { 112 child = fdc_add_child(dev, "fd", -1); 113 device_set_flags(child, 0x24); 114 error = bus_generic_attach(dev); 115 } 116 if (error) 117 fdc_release_resources(fdc); 118 return (error); 119} 120 121static device_method_t fdc_pccard_methods[] = { 122 /* Device interface */ 123 DEVMETHOD(device_probe, fdc_pccard_probe), 124 DEVMETHOD(device_attach, fdc_pccard_attach), 125 DEVMETHOD(device_detach, fdc_detach), 126 DEVMETHOD(device_shutdown, bus_generic_shutdown), 127 DEVMETHOD(device_suspend, bus_generic_suspend), 128 DEVMETHOD(device_resume, bus_generic_resume), 129 130 /* Bus interface */ 131 DEVMETHOD(bus_print_child, fdc_print_child), 132 DEVMETHOD(bus_read_ivar, fdc_read_ivar), 133 DEVMETHOD(bus_write_ivar, fdc_write_ivar), 134 /* Our children never use any other bus interface methods. */ 135 136 { 0, 0 } 137}; 138 139static driver_t fdc_pccard_driver = { 140 "fdc", 141 fdc_pccard_methods, 142 sizeof(struct fdc_data) 143}; 144 145DRIVER_MODULE(fdc, pccard, fdc_pccard_driver, fdc_devclass, 0, 0); 146