1 #include <sys/cdefs.h> 2 __FBSDID("$FreeBSD$"); 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 22 static int 23 spibus_probe(device_t dev) 24 { 25 device_set_desc(dev, "spibus bus"); 26 return (BUS_PROBE_GENERIC); 27 } 28 29 static int 30 spibus_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 */ 43 static int 44 spibus_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 60 static int 61 spibus_suspend(device_t dev) 62 { 63 return (bus_generic_suspend(dev)); 64 } 65 66 static 67 int 68 spibus_resume(device_t dev) 69 { 70 return (bus_generic_resume(dev)); 71 } 72 73 static int 74 spibus_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 86 static void 87 spibus_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 96 static int 97 spibus_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 106 static int 107 spibus_child_pnpinfo_str(device_t bus, device_t child, char *buf, 108 size_t buflen) 109 { 110 *buf = '\0'; 111 return (0); 112 } 113 114 static int 115 spibus_read_ivar(device_t bus, device_t child, int which, u_int *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 129 static device_t 130 spibus_add_child(device_t dev, u_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 device_delete_child(dev, child); 141 return (0); 142 } 143 device_set_ivars(child, devi); 144 return (child); 145 } 146 147 static void 148 spibus_hinted_child(device_t bus, const char *dname, int dunit) 149 { 150 device_t child; 151 struct spibus_ivar *devi; 152 153 child = BUS_ADD_CHILD(bus, 0, dname, dunit); 154 devi = SPIBUS_IVAR(child); 155 resource_int_value(dname, dunit, "cs", &devi->cs); 156 } 157 158 static int 159 spibus_transfer_impl(device_t dev, device_t child, struct spi_command *cmd) 160 { 161 return (SPIBUS_TRANSFER(device_get_parent(dev), child, cmd)); 162 } 163 164 static device_method_t spibus_methods[] = { 165 /* Device interface */ 166 DEVMETHOD(device_probe, spibus_probe), 167 DEVMETHOD(device_attach, spibus_attach), 168 DEVMETHOD(device_detach, spibus_detach), 169 DEVMETHOD(device_shutdown, bus_generic_shutdown), 170 DEVMETHOD(device_suspend, spibus_suspend), 171 DEVMETHOD(device_resume, spibus_resume), 172 173 /* Bus interface */ 174 DEVMETHOD(bus_add_child, spibus_add_child), 175 DEVMETHOD(bus_print_child, spibus_print_child), 176 DEVMETHOD(bus_probe_nomatch, spibus_probe_nomatch), 177 DEVMETHOD(bus_read_ivar, spibus_read_ivar), 178 DEVMETHOD(bus_child_pnpinfo_str, spibus_child_pnpinfo_str), 179 DEVMETHOD(bus_child_location_str, spibus_child_location_str), 180 DEVMETHOD(bus_hinted_child, spibus_hinted_child), 181 182 /* spibus interface */ 183 DEVMETHOD(spibus_transfer, spibus_transfer_impl), 184 185 DEVMETHOD_END 186 }; 187 188 driver_t spibus_driver = { 189 "spibus", 190 spibus_methods, 191 sizeof(struct spibus_softc) 192 }; 193 194 devclass_t spibus_devclass; 195 196 DRIVER_MODULE(spibus, spi, spibus_driver, spibus_devclass, 0, 0); 197 MODULE_VERSION(spibus, 1); 198