spibus.c revision 160370
1#include <sys/cdefs.h> 2__FBSDID("$FreeBSD: head/sys/dev/spibus/spibus.c 160370 2006-07-14 22:47:07Z imp $"); 3 4#include <sys/param.h> 5#include <sys/systm.h> 6#include <sys/malloc.h> 7#include <sys/module.h> 8#include <sys/kernel.h> 9#include <sys/queue.h> 10#include <sys/sysctl.h> 11#include <sys/types.h> 12 13#include <sys/bus.h> 14#include <machine/bus.h> 15#include <sys/rman.h> 16#include <machine/resource.h> 17 18#include <dev/spibus/spibusvar.h> 19#include <dev/spibus/spi.h> 20#include "spibus_if.h" 21 22static int 23spibus_probe(device_t dev) 24{ 25 device_set_desc(dev, "spibus bus"); 26 return (0); 27} 28 29static int 30spibus_attach(device_t dev) 31{ 32 struct spibus_softc *sc = SPIBUS_SOFTC(dev); 33 34 sc->dev = dev; 35 bus_enumerate_hinted_children(dev); 36 return (bus_generic_attach(dev)); 37} 38 39/* 40 * Since this is not a self-enumerating bus, and since we always add 41 * children in attach, we have to always delete children here. 42 */ 43static int 44spibus_detach(device_t dev) 45{ 46 int err, ndevs, i; 47 device_t *devlist; 48 49 if ((err = bus_generic_detach(dev)) != 0) 50 return (err); 51 if ((err = device_get_children(dev, &devlist, &ndevs)) != 0) 52 return (err); 53 for (i = 0; i < ndevs; i++) 54 device_delete_child(dev, devlist[i]); 55 free(devlist, M_TEMP); 56 57 return (0); 58} 59 60static int 61spibus_suspend(device_t dev) 62{ 63 return (bus_generic_suspend(dev)); 64} 65 66static 67int 68spibus_resume(device_t dev) 69{ 70 return (bus_generic_resume(dev)); 71} 72 73static int 74spibus_print_child(device_t dev, device_t child) 75{ 76 struct spibus_ivar *devi = SPIBUS_IVAR(child); 77 int retval = 0; 78 79 retval += bus_print_child_header(dev, child); 80 retval += printf(" at cs %d", devi->cs); 81 retval += bus_print_child_footer(dev, child); 82 83 return (retval); 84} 85 86static void 87spibus_probe_nomatch(device_t bus, device_t child) 88{ 89 struct spibus_ivar *devi = SPIBUS_IVAR(child); 90 91 device_printf(bus, "<unknown card>"); 92 printf(" at cs %d\n", devi->cs); 93 return; 94} 95 96static int 97spibus_child_location_str(device_t bus, device_t child, char *buf, 98 size_t buflen) 99{ 100 struct spibus_ivar *devi = SPIBUS_IVAR(child); 101 102 snprintf(buf, buflen, "cs=%d", devi->cs); 103 return (0); 104} 105 106static int 107spibus_child_pnpinfo_str(device_t bus, device_t child, char *buf, 108 size_t buflen) 109{ 110 *buf = '\0'; 111 return (0); 112} 113 114static int 115spibus_read_ivar(device_t bus, device_t child, int which, u_char *result) 116{ 117 struct spibus_ivar *devi = SPIBUS_IVAR(child); 118 119 switch (which) { 120 default: 121 return (EINVAL); 122 case SPIBUS_IVAR_CS: 123 *(uint32_t *)result = devi->cs; 124 break; 125 } 126 return (0); 127} 128 129static device_t 130spibus_add_child(device_t dev, int order, const char *name, int unit) 131{ 132 device_t child; 133 struct spibus_ivar *devi; 134 135 child = device_add_child_ordered(dev, order, name, unit); 136 if (child == NULL) 137 return (child); 138 devi = malloc(sizeof(struct spibus_ivar), M_DEVBUF, M_NOWAIT | M_ZERO); 139 if (devi != NULL) 140 return (0); 141 device_set_ivars(child, devi); 142 return (child); 143} 144 145static void 146spibus_hinted_child(device_t bus, const char *dname, int dunit) 147{ 148 device_t child; 149 struct spibus_ivar *devi; 150 151 child = BUS_ADD_CHILD(bus, 0, dname, dunit); 152 devi = SPIBUS_IVAR(child); 153 resource_int_value(dname, dunit, "cs", &devi->cs); 154} 155 156static int 157spibus_transfer_impl(device_t dev, device_t child, struct spi_command *cmd) 158{ 159 return (SPIBUS_TRANSFER(dev, child, cmd)); 160} 161 162static device_method_t spibus_methods[] = { 163 /* Device interface */ 164 DEVMETHOD(device_probe, spibus_probe), 165 DEVMETHOD(device_attach, spibus_attach), 166 DEVMETHOD(device_detach, spibus_detach), 167 DEVMETHOD(device_shutdown, bus_generic_shutdown), 168 DEVMETHOD(device_suspend, spibus_suspend), 169 DEVMETHOD(device_resume, spibus_resume), 170 171 /* Bus interface */ 172 DEVMETHOD(bus_add_child, spibus_add_child), 173 DEVMETHOD(bus_print_child, spibus_print_child), 174 DEVMETHOD(bus_driver_added, bus_generic_driver_added), 175 DEVMETHOD(bus_probe_nomatch, spibus_probe_nomatch), 176 DEVMETHOD(bus_read_ivar, spibus_read_ivar), 177 DEVMETHOD(bus_child_pnpinfo_str, spibus_child_pnpinfo_str), 178 DEVMETHOD(bus_child_location_str, spibus_child_location_str), 179 DEVMETHOD(bus_hinted_child, spibus_hinted_child), 180 181 /* spibus interface */ 182 DEVMETHOD(spibus_transfer, spibus_transfer_impl), 183 184 { 0, 0 } 185}; 186 187static driver_t spibus_driver = { 188 "spibus", 189 spibus_methods, 190 sizeof(struct spibus_softc) 191}; 192 193devclass_t spibus_devclass; 194 195DRIVER_MODULE(spibus, at91_spi, spibus_driver, spibus_devclass, 0, 0); 196MODULE_VERSION(spibus, 1); 197