[mirror_ubuntu-bionic-kernel.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_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);

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
	33	static int cortina_config_aneg(struct phy_device *phydev)
	34	{
	35	phydev->supported = SUPPORTED_10000baseT_Full;
	36	phydev->advertising = SUPPORTED_10000baseT_Full;
	37
	38	return 0;
	39	}
	40
	41	static int cortina_read_status(struct phy_device *phydev)
	42	{
	43	int gpio_int_status, ret = 0;
	44
	45	gpio_int_status = cortina_read_reg(phydev, VILLA_GLOBAL_GPIO_1_INTS);
	46	if (gpio_int_status < 0) {
	47	ret = gpio_int_status;
	48	goto err;
	49	}
	50
	51	if (gpio_int_status & 0x8) {
	52	/* up when edc_convergedS set */
	53	phydev->speed = SPEED_10000;
	54	phydev->duplex = DUPLEX_FULL;
	55	phydev->link = 1;
	56	} else {
	57	phydev->link = 0;
	58	}
	59
	60	err:
	61	return ret;
	62	}
	63
	64	static int cortina_soft_reset(struct phy_device *phydev)
65	{
66	return 0;
67	}
68
69	static int cortina_probe(struct phy_device *phydev)
70	{
71	u32 phy_id = 0;
72	int id_lsb = 0, id_msb = 0;
73
74	/* Read device id from phy registers. */
75	id_lsb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_LSB);
76	if (id_lsb < 0)
77	return -ENXIO;
78
79	phy_id = id_lsb << 16;
80
81	id_msb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_MSB);
82	if (id_msb < 0)
83	return -ENXIO;
84
85	phy_id \|= id_msb;
86
87	/* Make sure the device tree binding matched the driver with the
88	* right device.
89	*/
90	if (phy_id != phydev->drv->phy_id) {
91	phydev_err(phydev, "Error matching phy with %s driver\n",
92	phydev->drv->name);
93	return -ENODEV;
94	}
95
96	return 0;
97	}
98
99	static struct phy_driver cortina_driver[] = {
100	{
101	.phy_id = PHY_ID_CS4340,
102	.phy_id_mask = 0xffffffff,
103	.name = "Cortina CS4340",
104	.config_aneg = cortina_config_aneg,
105	.read_status = cortina_read_status,
106	.soft_reset = cortina_soft_reset,
107	.probe = cortina_probe,
108	},
109	};
110
111	module_phy_driver(cortina_driver);
112
113	static struct mdio_device_id __maybe_unused cortina_tbl[] = {
114	{ PHY_ID_CS4340, 0xffffffff},
115	{},
116	};
117
118	MODULE_DEVICE_TABLE(mdio, cortina_tbl);
0cc03504 JC	119
	120	MODULE_DESCRIPTION("Cortina EDC CDR 10G Ethernet PHY driver");
	121	MODULE_AUTHOR("NXP");
	122	MODULE_LICENSE("GPL");