sys/dev/spibus/ofw_spibus.c

   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);