blob: 3dba4d18a159ec046daf5e7a23244acfb2719d7c [file] [log] [blame]
Alex Margineanc3d9f3f2019-07-12 10:13:53 +03001// 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
15struct mdio_mux_sandbox_priv {
16 int enabled;
17 int sel;
18};
19
20static int mdio_mux_sandbox_mark_selection(struct udevice *dev, int sel)
21{
22 struct udevice *mdio;
23 struct mdio_ops *ops;
24 int err;
25
26 /*
27 * find the sandbox parent mdio and write a register on the PHY there
28 * so the mux test can verify selection.
29 */
30 err = uclass_get_device_by_name(UCLASS_MDIO, "mdio-test", &mdio);
31 if (err)
32 return err;
33 ops = mdio_get_ops(mdio);
34 return ops->write(mdio, SANDBOX_PHY_ADDR, MDIO_DEVAD_NONE,
35 SANDBOX_PHY_REG_CNT - 1, (u16)sel);
36}
37
38static int mdio_mux_sandbox_select(struct udevice *dev, int cur, int sel)
39{
40 struct mdio_mux_sandbox_priv *priv = dev_get_priv(dev);
41
42 if (!priv->enabled)
43 return -ENODEV;
44
45 if (cur != priv->sel)
46 return -EINVAL;
47
48 priv->sel = sel;
49 mdio_mux_sandbox_mark_selection(dev, priv->sel);
50
51 return 0;
52}
53
54static int mdio_mux_sandbox_deselect(struct udevice *dev, int sel)
55{
56 struct mdio_mux_sandbox_priv *priv = dev_get_priv(dev);
57
58 if (!priv->enabled)
59 return -ENODEV;
60
61 if (sel != priv->sel)
62 return -EINVAL;
63
64 priv->sel = -1;
65 mdio_mux_sandbox_mark_selection(dev, priv->sel);
66
67 return 0;
68}
69
70static const struct mdio_mux_ops mdio_mux_sandbox_ops = {
71 .select = mdio_mux_sandbox_select,
72 .deselect = mdio_mux_sandbox_deselect,
73};
74
75static int mdio_mux_sandbox_probe(struct udevice *dev)
76{
77 struct mdio_mux_sandbox_priv *priv = dev_get_priv(dev);
78
79 priv->enabled = 1;
80 priv->sel = -1;
81
82 return 0;
83}
84
85static const struct udevice_id mdio_mux_sandbox_ids[] = {
86 { .compatible = "sandbox,mdio-mux" },
87 { }
88};
89
90U_BOOT_DRIVER(mdio_mux_sandbox) = {
91 .name = "mdio_mux_sandbox",
92 .id = UCLASS_MDIO_MUX,
93 .of_match = mdio_mux_sandbox_ids,
94 .probe = mdio_mux_sandbox_probe,
95 .ops = &mdio_mux_sandbox_ops,
96 .priv_auto_alloc_size = sizeof(struct mdio_mux_sandbox_priv),
97};