123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Fixed-Link phy
- *
- * Copyright 2017 Bernecker & Rainer Industrieelektronik GmbH
- */
- #include <config.h>
- #include <common.h>
- #include <malloc.h>
- #include <phy.h>
- #include <dm.h>
- #include <fdt_support.h>
- #include <asm/global_data.h>
- DECLARE_GLOBAL_DATA_PTR;
- static int fixedphy_probe(struct phy_device *phydev)
- {
- /* fixed-link phy must not be reset by core phy code */
- phydev->flags |= PHY_FLAG_BROKEN_RESET;
- return 0;
- }
- static int fixedphy_config(struct phy_device *phydev)
- {
- ofnode node = phy_get_ofnode(phydev);
- struct fixed_link *priv;
- bool old_binding = false;
- u32 old_val[5];
- u32 val;
- if (!ofnode_valid(node))
- return -EINVAL;
- /* check for mandatory properties within fixed-link node */
- val = ofnode_read_u32_default(node, "speed", 0);
- if (!val) {
- /* try old binding */
- old_binding = true;
- if (ofnode_read_u32_array(node, "fixed-link", old_val,
- ARRAY_SIZE(old_val))) {
- printf("ERROR: no/invalid <fixed-link> property!\n");
- return -ENOENT;
- }
- val = old_val[2];
- }
- if (val != SPEED_10 && val != SPEED_100 && val != SPEED_1000 &&
- val != SPEED_2500 && val != SPEED_10000) {
- printf("ERROR: no/invalid speed given in fixed-link node!\n");
- return -EINVAL;
- }
- priv = malloc(sizeof(*priv));
- if (!priv)
- return -ENOMEM;
- memset(priv, 0, sizeof(*priv));
- phydev->priv = priv;
- priv->link_speed = val;
- if (!old_binding) {
- priv->duplex = ofnode_read_bool(node, "full-duplex");
- priv->pause = ofnode_read_bool(node, "pause");
- priv->asym_pause = ofnode_read_bool(node, "asym-pause");
- } else {
- priv->duplex = old_val[1];
- priv->pause = old_val[3];
- priv->asym_pause = old_val[4];
- }
- return 0;
- }
- static 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;
- }
- static 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,
- .config = fixedphy_config,
- .startup = fixedphy_startup,
- .shutdown = fixedphy_shutdown,
- };
- int phy_fixed_init(void)
- {
- phy_register(&fixedphy_driver);
- return 0;
- }
|