82 lines
		
	
	
		
			1.7 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			82 lines
		
	
	
		
			1.7 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * 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;
 | 
						|
 | 
						|
	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;
 | 
						|
}
 |