1 /*- 2 * Copyright (c) 2009, Nathan Whitehorn <nwhitehorn@FreeBSD.org> 3 * Copyright (c) 2013 The FreeBSD Foundation 4 * All rights reserved. 5 * 6 * Portions of this software were developed by Oleksandr Rybalko 7 * under sponsorship from the FreeBSD Foundation. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice unmodified, this list of conditions, and the following 14 * disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 22 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 28 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 29 */ 30 31 #include <sys/cdefs.h> 32 __FBSDID("$FreeBSD$"); 33 34 #include <sys/param.h> 35 #include <sys/bus.h> 36 #include <sys/kernel.h> 37 #include <sys/libkern.h> 38 #include <sys/lock.h> 39 #include <sys/module.h> 40 #include <sys/mutex.h> 41 42 #include <dev/fdt/fdt_common.h> 43 #include <dev/spibus/spi.h> 44 #include <dev/spibus/spibusvar.h> 45 #include <dev/ofw/ofw_bus.h> 46 #include <dev/ofw/ofw_bus_subr.h> 47 #include <dev/ofw/openfirm.h> 48 49 #include "spibus_if.h" 50 51 struct ofw_spibus_devinfo { 52 struct spibus_ivar opd_dinfo; 53 struct ofw_bus_devinfo opd_obdinfo; 54 }; 55 56 /* Methods */ 57 static device_probe_t ofw_spibus_probe; 58 static device_attach_t ofw_spibus_attach; 59 static device_t ofw_spibus_add_child(device_t dev, u_int order, 60 const char *name, int unit); 61 static const struct ofw_bus_devinfo *ofw_spibus_get_devinfo(device_t bus, 62 device_t dev); 63 64 static int 65 ofw_spibus_probe(device_t dev) 66 { 67 68 if (ofw_bus_get_node(dev) == -1) 69 return (ENXIO); 70 device_set_desc(dev, "OFW SPI bus"); 71 72 return (0); 73 } 74 75 static int 76 ofw_spibus_attach(device_t dev) 77 { 78 struct spibus_softc *sc = device_get_softc(dev); 79 struct ofw_spibus_devinfo *dinfo; 80 phandle_t child; 81 pcell_t clock, paddr; 82 device_t childdev; 83 uint32_t mode = SPIBUS_MODE_NONE; 84 85 sc->dev = dev; 86 87 bus_generic_probe(dev); 88 bus_enumerate_hinted_children(dev); 89 90 /* 91 * Attach those children represented in the device tree. 92 */ 93 for (child = OF_child(ofw_bus_get_node(dev)); child != 0; 94 child = OF_peer(child)) { 95 /* 96 * Try to get the CS number first from the spi-chipselect 97 * property, then try the reg property. 98 */ 99 if (OF_getencprop(child, "spi-chipselect", &paddr, 100 sizeof(paddr)) == -1) { 101 if (OF_getencprop(child, "reg", &paddr, 102 sizeof(paddr)) == -1) 103 continue; 104 } 105 106 /* 107 * Try to get the cpol/cpha mode 108 */ 109 if (OF_hasprop(child, "spi-cpol")) 110 mode = SPIBUS_MODE_CPOL; 111 if (OF_hasprop(child, "spi-cpha")) { 112 if (mode == SPIBUS_MODE_CPOL) 113 mode = SPIBUS_MODE_CPOL_CPHA; 114 else 115 mode = SPIBUS_MODE_CPHA; 116 } 117 118 /* 119 * Try to get the CS polarity 120 */ 121 if (OF_hasprop(child, "spi-cs-high")) 122 paddr |= SPIBUS_CS_HIGH; 123 124 /* 125 * Get the maximum clock frequency for device, zero means 126 * use the default bus speed. 127 */ 128 if (OF_getencprop(child, "spi-max-frequency", &clock, 129 sizeof(clock)) == -1) 130 clock = 0; 131 132 /* 133 * Now set up the SPI and OFW bus layer devinfo and add it 134 * to the bus. 135 */ 136 dinfo = malloc(sizeof(struct ofw_spibus_devinfo), M_DEVBUF, 137 M_NOWAIT | M_ZERO); 138 if (dinfo == NULL) 139 continue; 140 dinfo->opd_dinfo.cs = paddr; 141 dinfo->opd_dinfo.clock = clock; 142 dinfo->opd_dinfo.mode = mode; 143 if (ofw_bus_gen_setup_devinfo(&dinfo->opd_obdinfo, child) != 144 0) { 145 free(dinfo, M_DEVBUF); 146 continue; 147 } 148 childdev = device_add_child(dev, NULL, -1); 149 device_set_ivars(childdev, dinfo); 150 } 151 152 return (bus_generic_attach(dev)); 153 } 154 155 static device_t 156 ofw_spibus_add_child(device_t dev, u_int order, const char *name, int unit) 157 { 158 device_t child; 159 struct ofw_spibus_devinfo *devi; 160 161 child = device_add_child_ordered(dev, order, name, unit); 162 if (child == NULL) 163 return (child); 164 devi = malloc(sizeof(struct ofw_spibus_devinfo), M_DEVBUF, 165 M_NOWAIT | M_ZERO); 166 if (devi == NULL) { 167 device_delete_child(dev, child); 168 return (0); 169 } 170 171 /* 172 * NULL all the OFW-related parts of the ivars for non-OFW 173 * children. 174 */ 175 devi->opd_obdinfo.obd_node = -1; 176 devi->opd_obdinfo.obd_name = NULL; 177 devi->opd_obdinfo.obd_compat = NULL; 178 devi->opd_obdinfo.obd_type = NULL; 179 devi->opd_obdinfo.obd_model = NULL; 180 181 device_set_ivars(child, devi); 182 183 return (child); 184 } 185 186 static const struct ofw_bus_devinfo * 187 ofw_spibus_get_devinfo(device_t bus, device_t dev) 188 { 189 struct ofw_spibus_devinfo *dinfo; 190 191 dinfo = device_get_ivars(dev); 192 return (&dinfo->opd_obdinfo); 193 } 194 195 static device_method_t ofw_spibus_methods[] = { 196 /* Device interface */ 197 DEVMETHOD(device_probe, ofw_spibus_probe), 198 DEVMETHOD(device_attach, ofw_spibus_attach), 199 200 /* Bus interface */ 201 DEVMETHOD(bus_child_pnpinfo_str, ofw_bus_gen_child_pnpinfo_str), 202 DEVMETHOD(bus_add_child, ofw_spibus_add_child), 203 204 /* ofw_bus interface */ 205 DEVMETHOD(ofw_bus_get_devinfo, ofw_spibus_get_devinfo), 206 DEVMETHOD(ofw_bus_get_compat, ofw_bus_gen_get_compat), 207 DEVMETHOD(ofw_bus_get_model, ofw_bus_gen_get_model), 208 DEVMETHOD(ofw_bus_get_name, ofw_bus_gen_get_name), 209 DEVMETHOD(ofw_bus_get_node, ofw_bus_gen_get_node), 210 DEVMETHOD(ofw_bus_get_type, ofw_bus_gen_get_type), 211 212 DEVMETHOD_END 213 }; 214 215 static devclass_t ofwspibus_devclass; 216 217 DEFINE_CLASS_1(spibus, ofw_spibus_driver, ofw_spibus_methods, 218 sizeof(struct spibus_softc), spibus_driver); 219 DRIVER_MODULE(ofw_spibus, spi, ofw_spibus_driver, ofwspibus_devclass, 0, 0); 220 MODULE_VERSION(ofw_spibus, 1); 221 MODULE_DEPEND(ofw_spibus, spibus, 1, 1, 1); 222