|
@@ -0,0 +1,82 @@
|
|
|
+/*
|
|
|
+ * Fixed-Link phy
|
|
|
+ *
|
|
|
+ * Copyright 2017 Bernecker & Rainer Industrieelektronik GmbH
|
|
|
+ *
|
|
|
+ * SPDX-License-Identifier: GPL-2.0+
|
|
|
+ */
|
|
|
+
|
|
|
+#include <config.h>
|
|
|
+#include <common.h>
|
|
|
+#include <phy.h>
|
|
|
+#include <dm.h>
|
|
|
+#include <fdt_support.h>
|
|
|
+
|
|
|
+DECLARE_GLOBAL_DATA_PTR;
|
|
|
+
|
|
|
+int fixedphy_probe(struct phy_device *phydev)
|
|
|
+{
|
|
|
+ struct fixed_link *priv;
|
|
|
+ int ofnode = phydev->addr;
|
|
|
+ u32 val;
|
|
|
+
|
|
|
+ /* check for mandatory properties within fixed-link node */
|
|
|
+ val = fdt_getprop_u32_default_node(gd->fdt_blob,
|
|
|
+ ofnode, 0, "speed", 0);
|
|
|
+ if (val != SPEED_10 && val != SPEED_100 && val != SPEED_1000) {
|
|
|
+ printf("ERROR: no/invalid speed given in fixed-link node!");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ priv = malloc(sizeof(*priv));
|
|
|
+ if (!priv)
|
|
|
+ return -ENOMEM;
|
|
|
+ memset(priv, 0, sizeof(*priv));
|
|
|
+
|
|
|
+ phydev->priv = priv;
|
|
|
+ phydev->addr = 0;
|
|
|
+
|
|
|
+ priv->link_speed = val;
|
|
|
+ priv->duplex = fdtdec_get_bool(gd->fdt_blob, ofnode, "full-duplex");
|
|
|
+ priv->pause = fdtdec_get_bool(gd->fdt_blob, ofnode, "pause");
|
|
|
+ priv->asym_pause = fdtdec_get_bool(gd->fdt_blob, ofnode, "asym-pause");
|
|
|
+
|
|
|
+ /* fixed-link phy must not be reset by core phy code */
|
|
|
+ phydev->flags |= PHY_FLAG_BROKEN_RESET;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+int fixedphy_startup(struct phy_device *phydev)
|
|
|
+{
|
|
|
+ struct fixed_link *priv = phydev->priv;
|
|
|
+
|
|
|
+ phydev->asym_pause = priv->asym_pause;
|
|
|
+ phydev->pause = priv->pause;
|
|
|
+ phydev->duplex = priv->duplex;
|
|
|
+ phydev->speed = priv->link_speed;
|
|
|
+ phydev->link = 1;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+int fixedphy_shutdown(struct phy_device *phydev)
|
|
|
+{
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static struct phy_driver fixedphy_driver = {
|
|
|
+ .uid = PHY_FIXED_ID,
|
|
|
+ .mask = 0xffffffff,
|
|
|
+ .name = "Fixed PHY",
|
|
|
+ .features = PHY_GBIT_FEATURES | SUPPORTED_MII,
|
|
|
+ .probe = fixedphy_probe,
|
|
|
+ .startup = fixedphy_startup,
|
|
|
+ .shutdown = fixedphy_shutdown,
|
|
|
+};
|
|
|
+
|
|
|
+int phy_fixed_init(void)
|
|
|
+{
|
|
|
+ phy_register(&fixedphy_driver);
|
|
|
+ return 0;
|
|
|
+}
|