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