Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 15b9e533 authored by Bogdan Purcareata's avatar Bogdan Purcareata Committed by David S. Miller
Browse files

net: phy: Add Cortina CS4340 driver 



Add basic support for Cortina PHY drivers. Support only CS4340 for now.
The phys are not compatible with IEEE 802.3 clause 22/45 registers.

Implement proper read_status support. The generic 10G phy driver causes
bus register access errors.

The driver should be described using the "ethernet-phy-id" device tree
compatible.

Signed-off-by: default avatarBogdan Purcareata <bogdan.purcareata@nxp.com>
Reviewed-by: default avatarFlorian Fainelli <f.fainelli@gmail.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent eb67e07a

drivers/net/phy/Kconfig

+5 −0
Original line number Diff line number Diff line
@@ -234,6 +234,11 @@ config CICADA_PHY 
	---help---

	  Currently supports the cis8204



config CORTINA_PHY

	tristate "Cortina EDC CDR 10G Ethernet PHY"

	---help---

	  Currently supports the CS4340 phy.



config DAVICOM_PHY

	tristate "Davicom PHYs"

	---help---

drivers/net/phy/Makefile

+1 −0
Original line number Diff line number Diff line
@@ -46,6 +46,7 @@ obj-$(CONFIG_BCM_CYGNUS_PHY) += bcm-cygnus.o 
obj-$(CONFIG_BCM_NET_PHYLIB)	+= bcm-phy-lib.o

obj-$(CONFIG_BROADCOM_PHY)	+= broadcom.o

obj-$(CONFIG_CICADA_PHY)	+= cicada.o

obj-$(CONFIG_CORTINA_PHY)	+= cortina.o

obj-$(CONFIG_DAVICOM_PHY)	+= davicom.o

obj-$(CONFIG_DP83640_PHY)	+= dp83640.o

obj-$(CONFIG_DP83848_PHY)	+= dp83848.o

drivers/net/phy/cortina.c

0 → 100644
+118 −0
Original line number Diff line number Diff line 
/*

 *    Copyright 2017 NXP

 *

 *    This program is free software; you can redistribute it and/or modify

 *    it under the terms of the GNU General Public License as published by

 *    the Free Software Foundation; either version 2 of the License, or

 *    (at your option) any later version.

 *

 *    This program is distributed in the hope that it will be useful,

 *    but WITHOUT ANY WARRANTY; without even the implied warranty of

 *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 *    GNU General Public License for more details.

 *

 *    CORTINA is a registered trademark of Cortina Systems, Inc.

 *

 */

#include <linux/module.h>

#include <linux/phy.h>



#define PHY_ID_CS4340	0x13e51002



#define VILLA_GLOBAL_CHIP_ID_LSB			0x0

#define VILLA_GLOBAL_CHIP_ID_MSB			0x1



#define VILLA_GLOBAL_GPIO_1_INTS			0x017



static int cortina_read_reg(struct phy_device *phydev, u16 regnum)

{

	return mdiobus_read(phydev->mdio.bus, phydev->mdio.addr,

			    MII_ADDR_C45 | regnum);

}



static int cortina_config_aneg(struct phy_device *phydev)

{

	phydev->supported = SUPPORTED_10000baseT_Full;

	phydev->advertising = SUPPORTED_10000baseT_Full;



	return 0;

}



static int cortina_read_status(struct phy_device *phydev)

{

	int gpio_int_status, ret = 0;



	gpio_int_status = cortina_read_reg(phydev, VILLA_GLOBAL_GPIO_1_INTS);

	if (gpio_int_status < 0) {

		ret = gpio_int_status;

		goto err;

	}



	if (gpio_int_status & 0x8) {

		/* up when edc_convergedS set */

		phydev->speed = SPEED_10000;

		phydev->duplex = DUPLEX_FULL;

		phydev->link = 1;

	} else {

		phydev->link = 0;

	}



err:

	return ret;

}



static int cortina_soft_reset(struct phy_device *phydev)

{

	return 0;

}



static int cortina_probe(struct phy_device *phydev)

{

	u32 phy_id = 0;

	int id_lsb = 0, id_msb = 0;



	/* Read device id from phy registers. */

	id_lsb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_LSB);

	if (id_lsb < 0)

		return -ENXIO;



	phy_id = id_lsb << 16;



	id_msb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_MSB);

	if (id_msb < 0)

		return -ENXIO;



	phy_id |= id_msb;



	/* Make sure the device tree binding matched the driver with the

	 * right device.

	 */

	if (phy_id != phydev->drv->phy_id) {

		phydev_err(phydev, "Error matching phy with %s driver\n",

			   phydev->drv->name);

		return -ENODEV;

	}



	return 0;

}



static struct phy_driver cortina_driver[] = {

{

	.phy_id		= PHY_ID_CS4340,

	.phy_id_mask	= 0xffffffff,

	.name		= "Cortina CS4340",

	.config_aneg	= cortina_config_aneg,

	.read_status	= cortina_read_status,

	.soft_reset	= cortina_soft_reset,

	.probe		= cortina_probe,

},

};



module_phy_driver(cortina_driver);



static struct mdio_device_id __maybe_unused cortina_tbl[] = {

	{ PHY_ID_CS4340, 0xffffffff},

	{},

};



MODULE_DEVICE_TABLE(mdio, cortina_tbl);