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 #define SANDBOX_PHY_ADDR 5
12 #define SANDBOX_PHY_REG_CNT 2
13
14 struct mdio_sandbox_priv {
15 int enabled;
16 u16 reg[SANDBOX_PHY_REG_CNT];
17 };
18
mdio_sandbox_read(struct udevice * dev,int addr,int devad,int reg)19 static int mdio_sandbox_read(struct udevice *dev, int addr, int devad, int reg)
20 {
21 struct mdio_sandbox_priv *priv = dev_get_priv(dev);
22
23 if (!priv->enabled)
24 return -ENODEV;
25
26 if (addr != SANDBOX_PHY_ADDR)
27 return -ENODEV;
28 if (devad != MDIO_DEVAD_NONE)
29 return -ENODEV;
30 if (reg < 0 || reg >= SANDBOX_PHY_REG_CNT)
31 return -ENODEV;
32
33 return priv->reg[reg];
34 }
35
mdio_sandbox_write(struct udevice * dev,int addr,int devad,int reg,u16 val)36 static int mdio_sandbox_write(struct udevice *dev, int addr, int devad, int reg,
37 u16 val)
38 {
39 struct mdio_sandbox_priv *priv = dev_get_priv(dev);
40
41 if (!priv->enabled)
42 return -ENODEV;
43
44 if (addr != SANDBOX_PHY_ADDR)
45 return -ENODEV;
46 if (devad != MDIO_DEVAD_NONE)
47 return -ENODEV;
48 if (reg < 0 || reg >= SANDBOX_PHY_REG_CNT)
49 return -ENODEV;
50
51 priv->reg[reg] = val;
52
53 return 0;
54 }
55
mdio_sandbox_reset(struct udevice * dev)56 static int mdio_sandbox_reset(struct udevice *dev)
57 {
58 struct mdio_sandbox_priv *priv = dev_get_priv(dev);
59 int i;
60
61 for (i = 0; i < SANDBOX_PHY_REG_CNT; i++)
62 priv->reg[i] = 0;
63
64 return 0;
65 }
66
67 static const struct mdio_ops mdio_sandbox_ops = {
68 .read = mdio_sandbox_read,
69 .write = mdio_sandbox_write,
70 .reset = mdio_sandbox_reset,
71 };
72
mdio_sandbox_probe(struct udevice * dev)73 static int mdio_sandbox_probe(struct udevice *dev)
74 {
75 struct mdio_sandbox_priv *priv = dev_get_priv(dev);
76
77 priv->enabled = 1;
78
79 return 0;
80 }
81
82 static const struct udevice_id mdio_sandbox_ids[] = {
83 { .compatible = "sandbox,mdio" },
84 { }
85 };
86
87 U_BOOT_DRIVER(mdio_sandbox) = {
88 .name = "mdio_sandbox",
89 .id = UCLASS_MDIO,
90 .of_match = mdio_sandbox_ids,
91 .probe = mdio_sandbox_probe,
92 .ops = &mdio_sandbox_ops,
93 .priv_auto = sizeof(struct mdio_sandbox_priv),
94 };
95