Loading...
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
27static 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
33static 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
52err:
53 return ret;
54}
55
56static 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
86static struct phy_driver cortina_driver[] = {
87{
88 .phy_id = PHY_ID_CS4340,
89 .phy_id_mask = 0xffffffff,
90 .name = "Cortina CS4340",
91 .config_init = gen10g_config_init,
92 .config_aneg = gen10g_config_aneg,
93 .read_status = cortina_read_status,
94 .soft_reset = gen10g_no_soft_reset,
95 .probe = cortina_probe,
96},
97};
98
99module_phy_driver(cortina_driver);
100
101static struct mdio_device_id __maybe_unused cortina_tbl[] = {
102 { PHY_ID_CS4340, 0xffffffff},
103 {},
104};
105
106MODULE_DEVICE_TABLE(mdio, cortina_tbl);
107
108MODULE_DESCRIPTION("Cortina EDC CDR 10G Ethernet PHY driver");
109MODULE_AUTHOR("NXP");
110MODULE_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");