drivers/misc/gdsys_soc.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2017
   4  * Mario Six,  Guntermann & Drunck GmbH, mario.six@gdsys.cc
   5  */
   6
   7 #include <common.h>
   8 #include <dm.h>
   9 #include <log.h>
  10 #include <dm/lists.h>
  11
  12 #include "gdsys_soc.h"
  13
  14 /**
  15  * struct gdsys_soc_priv - Private data for gdsys soc bus
  16  * @fpga: The gdsys IHS FPGA this bus is associated with
  17  */
  18 struct gdsys_soc_priv {
  19         struct udevice *fpga;
  20 };
  21
  22 static const struct udevice_id gdsys_soc_ids[] = {
  23         { .compatible = "gdsys,soc" },
  24         { /* sentinel */ }
  25 };
  26
  27 int gdsys_soc_get_fpga(struct udevice *child, struct udevice **fpga)
  28 {
  29         struct gdsys_soc_priv *bus_priv;
  30
  31         if (!child->parent) {
  32                 debug("%s: Invalid parent\n", child->name);
  33                 return -EINVAL;
  34         }
  35
  36         if (!device_is_compatible(child->parent, "gdsys,soc")) {
  37                 debug("%s: Not child of a gdsys soc\n", child->name);
  38                 return -EINVAL;
  39         }
  40
  41         bus_priv = dev_get_priv(child->parent);
  42
  43         *fpga = bus_priv->fpga;
  44
  45         return 0;
  46 }
  47
  48 static int gdsys_soc_probe(struct udevice *dev)
  49 {
  50         struct gdsys_soc_priv *priv = dev_get_priv(dev);
  51         struct udevice *fpga;
  52         int res = uclass_get_device_by_phandle(UCLASS_MISC, dev, "fpga",
  53                                                &fpga);
  54         if (res == -ENOENT) {
  55                 debug("%s: Could not find 'fpga' phandle\n", dev->name);
  56                 return -EINVAL;
  57         }
  58
  59         if (res == -ENODEV) {
  60                 debug("%s: Could not get FPGA device\n", dev->name);
  61                 return -EINVAL;
  62         }
  63
  64         priv->fpga = fpga;
  65
  66         return 0;
  67 }
  68
  69 U_BOOT_DRIVER(gdsys_soc_bus) = {
  70         .name           = "gdsys_soc_bus",
  71         .id             = UCLASS_SIMPLE_BUS,
  72         .of_match       = gdsys_soc_ids,
  73         .probe          = gdsys_soc_probe,
  74         .priv_auto_alloc_size = sizeof(struct gdsys_soc_priv),
  75 };