drivers/net/mdio_mux_sandbox.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2019
   4  * Alex Marginean, NXP
   5  */
   6
   7 #include <dm.h>
   8 #include <errno.h>
   9 #include <miiphy.h>
  10
  11 /* macros copied over from mdio_sandbox.c */
  12 #define SANDBOX_PHY_ADDR        5
  13 #define SANDBOX_PHY_REG_CNT     2
  14
  15 struct mdio_mux_sandbox_priv {
  16         int enabled;
  17         int sel;
  18 };
  19
  20 static int mdio_mux_sandbox_mark_selection(struct udevice *dev, int sel)
  21 {
  22         struct udevice *mdio;
  23         int err;
  24
  25         /*
  26          * find the sandbox parent mdio and write a register on the PHY there
  27          * so the mux test can verify selection.
  28          */
  29         err = uclass_get_device_by_name(UCLASS_MDIO, "mdio-test", &mdio);
  30         if (err)
  31                 return err;
  32         return dm_mdio_write(mdio, SANDBOX_PHY_ADDR, MDIO_DEVAD_NONE,
  33                              SANDBOX_PHY_REG_CNT - 1, (u16)sel);
  34 }
  35
  36 static int mdio_mux_sandbox_select(struct udevice *dev, int cur, int sel)
  37 {
  38         struct mdio_mux_sandbox_priv *priv = dev_get_priv(dev);
  39
  40         if (!priv->enabled)
  41                 return -ENODEV;
  42
  43         if (cur != priv->sel)
  44                 return -EINVAL;
  45
  46         priv->sel = sel;
  47         mdio_mux_sandbox_mark_selection(dev, priv->sel);
  48
  49         return 0;
  50 }
  51
  52 static int mdio_mux_sandbox_deselect(struct udevice *dev, int sel)
  53 {
  54         struct mdio_mux_sandbox_priv *priv = dev_get_priv(dev);
  55
  56         if (!priv->enabled)
  57                 return -ENODEV;
  58
  59         if (sel != priv->sel)
  60                 return -EINVAL;
  61
  62         priv->sel = -1;
  63         mdio_mux_sandbox_mark_selection(dev, priv->sel);
  64
  65         return 0;
  66 }
  67
  68 static const struct mdio_mux_ops mdio_mux_sandbox_ops = {
  69         .select = mdio_mux_sandbox_select,
  70         .deselect = mdio_mux_sandbox_deselect,
  71 };
  72
  73 static int mdio_mux_sandbox_probe(struct udevice *dev)
  74 {
  75         struct mdio_mux_sandbox_priv *priv = dev_get_priv(dev);
  76
  77         priv->enabled = 1;
  78         priv->sel = -1;
  79
  80         return 0;
  81 }
  82
  83 static const struct udevice_id mdio_mux_sandbox_ids[] = {
  84         { .compatible = "sandbox,mdio-mux" },
  85         { }
  86 };
  87
  88 U_BOOT_DRIVER(mdio_mux_sandbox) = {
  89         .name           = "mdio_mux_sandbox",
  90         .id             = UCLASS_MDIO_MUX,
  91         .of_match       = mdio_mux_sandbox_ids,
  92         .probe          = mdio_mux_sandbox_probe,
  93         .ops            = &mdio_mux_sandbox_ops,
  94         .priv_auto      = sizeof(struct mdio_mux_sandbox_priv),
  95 };