1// SPDX-License-Identifier: GPL-2.0+
 2/*
 3 *    Copyright 2017 NXP
 4 *
 5 *    CORTINA is a registered trademark of Cortina Systems, Inc.
 6 *
 7 */
 8#include <linux/module.h>
 9#include <linux/phy.h>
10
11#define PHY_ID_CS4340	0x13e51002
12
13#define VILLA_GLOBAL_CHIP_ID_LSB			0x0
14#define VILLA_GLOBAL_CHIP_ID_MSB			0x1
15
16#define VILLA_GLOBAL_GPIO_1_INTS			0x017
17
18static int cortina_read_reg(struct phy_device *phydev, u16 regnum)
19{
20	return mdiobus_c45_read(phydev->mdio.bus, phydev->mdio.addr, 0, regnum);
 
21}
22
23static int cortina_read_status(struct phy_device *phydev)
24{
25	int gpio_int_status, ret = 0;
26
27	gpio_int_status = cortina_read_reg(phydev, VILLA_GLOBAL_GPIO_1_INTS);
28	if (gpio_int_status < 0) {
29		ret = gpio_int_status;
30		goto err;
31	}
32
33	if (gpio_int_status & 0x8) {
34		/* up when edc_convergedS set */
35		phydev->speed = SPEED_10000;
36		phydev->duplex = DUPLEX_FULL;
37		phydev->link = 1;
38	} else {
39		phydev->link = 0;
40	}
41
42err:
43	return ret;
44}
45
46static int cortina_probe(struct phy_device *phydev)
47{
48	u32 phy_id = 0;
49	int id_lsb = 0, id_msb = 0;
50
51	/* Read device id from phy registers. */
52	id_lsb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_LSB);
53	if (id_lsb < 0)
54		return -ENXIO;
55
56	phy_id = id_lsb << 16;
57
58	id_msb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_MSB);
59	if (id_msb < 0)
60		return -ENXIO;
61
62	phy_id |= id_msb;
63
64	/* Make sure the device tree binding matched the driver with the
65	 * right device.
66	 */
67	if (phy_id != phydev->drv->phy_id) {
68		phydev_err(phydev, "Error matching phy with %s driver\n",
69			   phydev->drv->name);
70		return -ENODEV;
71	}
72
73	return 0;
74}
75
76static struct phy_driver cortina_driver[] = {
77{
78	.phy_id		= PHY_ID_CS4340,
79	.phy_id_mask	= 0xffffffff,
80	.name		= "Cortina CS4340",
81	.features       = PHY_10GBIT_FEATURES,
82	.config_aneg	= gen10g_config_aneg,
83	.read_status	= cortina_read_status,
 
84	.probe		= cortina_probe,
85},
86};
87
88module_phy_driver(cortina_driver);
89
90static struct mdio_device_id __maybe_unused cortina_tbl[] = {
91	{ PHY_ID_CS4340, 0xffffffff},
92	{},
93};
94
95MODULE_DEVICE_TABLE(mdio, cortina_tbl);
96
97MODULE_DESCRIPTION("Cortina EDC CDR 10G Ethernet PHY driver");
98MODULE_AUTHOR("NXP");
99MODULE_LICENSE("GPL");

  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 *    Copyright 2017 NXP
  4 *
  5 *    CORTINA is a registered trademark of Cortina Systems, Inc.
  6 *
  7 */
  8#include <linux/module.h>
  9#include <linux/phy.h>
 10
 11#define PHY_ID_CS4340	0x13e51002
 12
 13#define VILLA_GLOBAL_CHIP_ID_LSB			0x0
 14#define VILLA_GLOBAL_CHIP_ID_MSB			0x1
 15
 16#define VILLA_GLOBAL_GPIO_1_INTS			0x017
 17
 18static int cortina_read_reg(struct phy_device *phydev, u16 regnum)
 19{
 20	return mdiobus_read(phydev->mdio.bus, phydev->mdio.addr,
 21			    MII_ADDR_C45 | regnum);
 22}
 23
 24static int cortina_read_status(struct phy_device *phydev)
 25{
 26	int gpio_int_status, ret = 0;
 27
 28	gpio_int_status = cortina_read_reg(phydev, VILLA_GLOBAL_GPIO_1_INTS);
 29	if (gpio_int_status < 0) {
 30		ret = gpio_int_status;
 31		goto err;
 32	}
 33
 34	if (gpio_int_status & 0x8) {
 35		/* up when edc_convergedS set */
 36		phydev->speed = SPEED_10000;
 37		phydev->duplex = DUPLEX_FULL;
 38		phydev->link = 1;
 39	} else {
 40		phydev->link = 0;
 41	}
 42
 43err:
 44	return ret;
 45}
 46
 47static int cortina_probe(struct phy_device *phydev)
 48{
 49	u32 phy_id = 0;
 50	int id_lsb = 0, id_msb = 0;
 51
 52	/* Read device id from phy registers. */
 53	id_lsb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_LSB);
 54	if (id_lsb < 0)
 55		return -ENXIO;
 56
 57	phy_id = id_lsb << 16;
 58
 59	id_msb = cortina_read_reg(phydev, VILLA_GLOBAL_CHIP_ID_MSB);
 60	if (id_msb < 0)
 61		return -ENXIO;
 62
 63	phy_id |= id_msb;
 64
 65	/* Make sure the device tree binding matched the driver with the
 66	 * right device.
 67	 */
 68	if (phy_id != phydev->drv->phy_id) {
 69		phydev_err(phydev, "Error matching phy with %s driver\n",
 70			   phydev->drv->name);
 71		return -ENODEV;
 72	}
 73
 74	return 0;
 75}
 76
 77static struct phy_driver cortina_driver[] = {
 78{
 79	.phy_id		= PHY_ID_CS4340,
 80	.phy_id_mask	= 0xffffffff,
 81	.name		= "Cortina CS4340",
 82	.features       = PHY_10GBIT_FEATURES,
 83	.config_aneg	= gen10g_config_aneg,
 84	.read_status	= cortina_read_status,
 85	.soft_reset	= genphy_no_soft_reset,
 86	.probe		= cortina_probe,
 87},
 88};
 89
 90module_phy_driver(cortina_driver);
 91
 92static struct mdio_device_id __maybe_unused cortina_tbl[] = {
 93	{ PHY_ID_CS4340, 0xffffffff},
 94	{},
 95};
 96
 97MODULE_DEVICE_TABLE(mdio, cortina_tbl);
 98
 99MODULE_DESCRIPTION("Cortina EDC CDR 10G Ethernet PHY driver");
100MODULE_AUTHOR("NXP");
101MODULE_LICENSE("GPL");