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
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	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
36static 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
52static 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
68static const struct mdio_mux_ops mdio_mux_sandbox_ops = {
69	.select = mdio_mux_sandbox_select,
70	.deselect = mdio_mux_sandbox_deselect,
71};
72
73static 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
83static const struct udevice_id mdio_mux_sandbox_ids[] = {
84	{ .compatible = "sandbox,mdio-mux" },
85	{ }
86};
87
88U_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};
96