[linux-2.6-block.git] / drivers / net / phy / cortina.c

/*
 *    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_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_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_init	= gen10g_config_init,
	.config_aneg	= gen10g_config_aneg,
	.read_status	= cortina_read_status,
	.soft_reset	= gen10g_no_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);

MODULE_DESCRIPTION("Cortina EDC CDR 10G Ethernet PHY driver");
MODULE_AUTHOR("NXP");
MODULE_LICENSE("GPL");
Commit	Line	Data
15b9e533 BP	1	/*
	2	* Copyright 2017 NXP
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License as published by
	6	* the Free Software Foundation; either version 2 of the License, or
	7	* (at your option) any later version.
	8	*
	9	* This program is distributed in the hope that it will be useful,
	10	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	11	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	12	* GNU General Public License for more details.
	13	*
	14	* CORTINA is a registered trademark of Cortina Systems, Inc.
	15	*
	16	*/
	17	#include <linux/module.h>
	18	#include <linux/phy.h>
	19
	20	#define PHY_ID_CS4340 0x13e51002
	21
	22	#define VILLA_GLOBAL_CHIP_ID_LSB 0x0
	23	#define VILLA_GLOBAL_CHIP_ID_MSB 0x1
	24
	25	#define VILLA_GLOBAL_GPIO_1_INTS 0x017
	26
	27	static int cortina_read_reg(struct phy_device *phydev, u16 regnum)
	28	{
	29	return mdiobus_read(phydev->mdio.bus, phydev->mdio.addr,
	30	MII_ADDR_C45 \| regnum);
	31	}
	32
15b9e533 BP	33	static int cortina_read_status(struct phy_device *phydev)
	34	{
	35	int gpio_int_status, ret = 0;
	36
	37	gpio_int_status = cortina_read_reg(phydev, VILLA_GLOBAL_GPIO_1_INTS);
	38	if (gpio_int_status < 0) {
	39	ret = gpio_int_status;
	40	goto err;
	41	}
	42
	43	if (gpio_int_status & 0x8) {
	44	/* up when edc_convergedS set */
	45	phydev->speed = SPEED_10000;
	46	phydev->duplex = DUPLEX_FULL;
	47	phydev->link = 1;
	48	} else {
	49	phydev->link = 0;
	50	}
	51
	52	err:
	53	return ret;
	54	}
	55
15b9e533 BP	56	static int cortina_probe(struct phy_device *phydev)
	57	{
	58	u32 phy_id = 0;
	59	int id_lsb = 0, id_msb = 0;
	60
	61	/* Read device id from phy registers. */
	62	id_lsb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_LSB);
	63	if (id_lsb < 0)
	64	return -ENXIO;
	65
	66	phy_id = id_lsb << 16;
	67
	68	id_msb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_MSB);
	69	if (id_msb < 0)
	70	return -ENXIO;
	71
	72	phy_id \|= id_msb;
	73
	74	/* Make sure the device tree binding matched the driver with the
	75	* right device.
	76	*/
	77	if (phy_id != phydev->drv->phy_id) {
	78	phydev_err(phydev, "Error matching phy with %s driver\n",
	79	phydev->drv->name);
	80	return -ENODEV;
	81	}
	82
	83	return 0;
	84	}
	85
	86	static struct phy_driver cortina_driver[] = {
	87	{
	88	.phy_id = PHY_ID_CS4340,
	89	.phy_id_mask = 0xffffffff,
	90	.name = "Cortina CS4340",
0adfdb66 FF	91	.config_init = gen10g_config_init,
0adfdb66 FF	92	.config_aneg = gen10g_config_aneg,
15b9e533	93	.read_status = cortina_read_status,
0adfdb66	94	.soft_reset = gen10g_no_soft_reset,
15b9e533 BP	95	.probe = cortina_probe,
	96	},
	97	};
	98
	99	module_phy_driver(cortina_driver);
	100
	101	static struct mdio_device_id __maybe_unused cortina_tbl[] = {
	102	{ PHY_ID_CS4340, 0xffffffff},
	103	{},
	104	};
	105
	106	MODULE_DEVICE_TABLE(mdio, cortina_tbl);
0cc03504 JC	107
	108	MODULE_DESCRIPTION("Cortina EDC CDR 10G Ethernet PHY driver");
	109	MODULE_AUTHOR("NXP");
	110	MODULE_LICENSE("GPL");