mirror of
				git://git.openwrt.org/openwrt/openwrt.git
				synced 2025-10-31 14:04:26 -04:00 
			
		
		
		
	
		
			
				
	
	
		
			117 lines
		
	
	
		
			2.8 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
			
		
		
	
	
			117 lines
		
	
	
		
			2.8 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
| --- a/drivers/net/phy/Kconfig
 | |
| +++ b/drivers/net/phy/Kconfig
 | |
| @@ -51,6 +51,12 @@ config VITESSE_PHY
 | |
|          ---help---
 | |
|            Currently supports the vsc8244
 | |
|  
 | |
| +config VITESSE_PHY_8601_SKEW
 | |
| +	bool "Enable skew timing to vsc8601"
 | |
| +	depends on VITESSE_PHY
 | |
| +	---help---
 | |
| +	  Apply clock timing adjustments for vsc8601
 | |
| +
 | |
|  config SMSC_PHY
 | |
|  	tristate "Drivers for SMSC PHYs"
 | |
|  	---help---
 | |
| --- a/drivers/net/phy/vitesse.c
 | |
| +++ b/drivers/net/phy/vitesse.c
 | |
| @@ -26,6 +26,11 @@
 | |
|  #define MII_VSC8244_EXTCON1_TX_SKEW	0x0800
 | |
|  #define MII_VSC8244_EXTCON1_RX_SKEW	0x0200
 | |
|  
 | |
| +/* EXT_CON1 Register values for VSC8601 */
 | |
| +#define MII_VSC8601_EXTCON1_INIT       0x0000
 | |
| +#define MII_VSC8601_EXTCON1_SKEW       0x0100
 | |
| +#define MII_VSC8601_EXTCON1_ACTIPHY    0x0020
 | |
| +
 | |
|  /* Vitesse Interrupt Mask Register */
 | |
|  #define MII_VSC8244_IMASK		0x19
 | |
|  #define MII_VSC8244_IMASK_IEN		0x8000
 | |
| @@ -88,6 +93,30 @@ static int vsc824x_config_init(struct ph
 | |
|  	return err;
 | |
|  }
 | |
|  
 | |
| +static int vsc8601_config_init(struct phy_device *phydev)
 | |
| +{
 | |
| +	int err;
 | |
| +	int extcon;
 | |
| +
 | |
| +	err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
 | |
| +					MII_VSC8244_AUXCONSTAT_INIT);
 | |
| +
 | |
| +	if (err < 0)
 | |
| +		return err;
 | |
| +
 | |
| +#ifdef CONFIG_VITESSE_PHY_8601_SKEW
 | |
| +	extcon = phy_read(phydev, MII_VSC8244_EXT_CON1);
 | |
| +	if (err < 0)
 | |
| +		return err;
 | |
| +
 | |
| +	extcon |= MII_VSC8601_EXTCON1_SKEW;
 | |
| +
 | |
| +	err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon);
 | |
| +#endif
 | |
| +
 | |
| +	return err;
 | |
| +}
 | |
| +
 | |
|  static int vsc824x_ack_interrupt(struct phy_device *phydev)
 | |
|  {
 | |
|  	int err = 0;
 | |
| @@ -143,6 +172,21 @@ static struct phy_driver vsc8244_driver
 | |
|  	.driver 	= { .owner = THIS_MODULE,},
 | |
|  };
 | |
|  
 | |
| +/* Vitesse 8601 */
 | |
| +static struct phy_driver vsc8601_driver = {
 | |
| +	.phy_id         = 0x00070420,
 | |
| +	.name           = "Vitesse VSC8601",
 | |
| +	.phy_id_mask    = 0x000ffff8,
 | |
| +	.features       = PHY_GBIT_FEATURES,
 | |
| +	.flags          = PHY_HAS_INTERRUPT,
 | |
| +	.config_init    = &vsc8601_config_init,
 | |
| +	.config_aneg    = &genphy_config_aneg,
 | |
| +	.read_status    = &genphy_read_status,
 | |
| +	.ack_interrupt  = &vsc824x_ack_interrupt,
 | |
| +	.config_intr    = &vsc82xx_config_intr,
 | |
| +	.driver         = { .owner = THIS_MODULE,},
 | |
| +};
 | |
| +
 | |
|  static int vsc8221_config_init(struct phy_device *phydev)
 | |
|  {
 | |
|  	int err;
 | |
| @@ -176,10 +220,23 @@ static int __init vsc82xx_init(void)
 | |
|  
 | |
|  	err = phy_driver_register(&vsc8244_driver);
 | |
|  	if (err < 0)
 | |
| -		return err;
 | |
| +		goto err;
 | |
| +
 | |
|  	err = phy_driver_register(&vsc8221_driver);
 | |
|  	if (err < 0)
 | |
| -		phy_driver_unregister(&vsc8244_driver);
 | |
| +		goto err1;
 | |
| +
 | |
| +	err = phy_driver_register(&vsc8601_driver);
 | |
| +	if (err < 0)
 | |
| +		goto err2;
 | |
| +
 | |
| +	return 0;
 | |
| +
 | |
| +err2:
 | |
| +	phy_driver_unregister(&vsc8221_driver);
 | |
| +err1:
 | |
| +	phy_driver_unregister(&vsc8244_driver);
 | |
| +err:
 | |
|  	return err;
 | |
|  }
 | |
|  
 | |
| @@ -187,6 +244,7 @@ static void __exit vsc82xx_exit(void)
 | |
|  {
 | |
|  	phy_driver_unregister(&vsc8244_driver);
 | |
|  	phy_driver_unregister(&vsc8221_driver);
 | |
| +	phy_driver_unregister(&vsc8601_driver);
 | |
|  }
 | |
|  
 | |
|  module_init(vsc82xx_init);
 |