mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-10-31 03:58:17 +00:00 
			
		
		
		
	Update fixedphy_probe() to support the old DT binding. Signed-off-by: Bin Meng <bmeng.cn@gmail.com> Reviewed-by: Ramon Fried <rfried.dev@gmail.com> Reviewed-by: Vladimir Oltean <vladimir.oltean@nxp.com> Reviewed-by: Priyanka Jain <priyanka.jain@nxp.com>
		
			
				
	
	
		
			112 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			112 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // 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;
 | |
| }
 |