1 // SPDX-License-Identifier: GPL-2.0+
2
3 #include <linux/module.h>
4 #include <linux/phylink.h>
5 #include <linux/device.h>
6 #include <linux/netdevice.h>
7 #include <linux/phy/phy.h>
8
9 #include "lan966x_main.h"
10
lan966x_phylink_mac_select(struct phylink_config * config,phy_interface_t interface)11 static struct phylink_pcs *lan966x_phylink_mac_select(struct phylink_config *config,
12 phy_interface_t interface)
13 {
14 struct lan966x_port *port = netdev_priv(to_net_dev(config->dev));
15
16 return &port->phylink_pcs;
17 }
18
lan966x_phylink_mac_config(struct phylink_config * config,unsigned int mode,const struct phylink_link_state * state)19 static void lan966x_phylink_mac_config(struct phylink_config *config,
20 unsigned int mode,
21 const struct phylink_link_state *state)
22 {
23 }
24
lan966x_phylink_mac_prepare(struct phylink_config * config,unsigned int mode,phy_interface_t iface)25 static int lan966x_phylink_mac_prepare(struct phylink_config *config,
26 unsigned int mode,
27 phy_interface_t iface)
28 {
29 struct lan966x_port *port = netdev_priv(to_net_dev(config->dev));
30 phy_interface_t serdes_mode = iface;
31 int err;
32
33 if (port->serdes) {
34 err = phy_set_mode_ext(port->serdes, PHY_MODE_ETHERNET,
35 serdes_mode);
36 if (err) {
37 netdev_err(to_net_dev(config->dev),
38 "Could not set mode of SerDes\n");
39 return err;
40 }
41 }
42
43 return 0;
44 }
45
lan966x_phylink_mac_link_up(struct phylink_config * config,struct phy_device * phy,unsigned int mode,phy_interface_t interface,int speed,int duplex,bool tx_pause,bool rx_pause)46 static void lan966x_phylink_mac_link_up(struct phylink_config *config,
47 struct phy_device *phy,
48 unsigned int mode,
49 phy_interface_t interface,
50 int speed, int duplex,
51 bool tx_pause, bool rx_pause)
52 {
53 struct lan966x_port *port = netdev_priv(to_net_dev(config->dev));
54 struct lan966x_port_config *port_config = &port->config;
55
56 port_config->duplex = duplex;
57 port_config->speed = speed;
58 port_config->pause = 0;
59 port_config->pause |= tx_pause ? MLO_PAUSE_TX : 0;
60 port_config->pause |= rx_pause ? MLO_PAUSE_RX : 0;
61
62 if (phy_interface_mode_is_rgmii(interface))
63 phy_set_speed(port->serdes, speed);
64
65 lan966x_port_config_up(port);
66 }
67
lan966x_phylink_mac_link_down(struct phylink_config * config,unsigned int mode,phy_interface_t interface)68 static void lan966x_phylink_mac_link_down(struct phylink_config *config,
69 unsigned int mode,
70 phy_interface_t interface)
71 {
72 struct lan966x_port *port = netdev_priv(to_net_dev(config->dev));
73 struct lan966x *lan966x = port->lan966x;
74
75 lan966x_port_config_down(port);
76
77 /* Take PCS out of reset */
78 lan_rmw(DEV_CLOCK_CFG_PCS_RX_RST_SET(0) |
79 DEV_CLOCK_CFG_PCS_TX_RST_SET(0),
80 DEV_CLOCK_CFG_PCS_RX_RST |
81 DEV_CLOCK_CFG_PCS_TX_RST,
82 lan966x, DEV_CLOCK_CFG(port->chip_port));
83 }
84
lan966x_pcs_to_port(struct phylink_pcs * pcs)85 static struct lan966x_port *lan966x_pcs_to_port(struct phylink_pcs *pcs)
86 {
87 return container_of(pcs, struct lan966x_port, phylink_pcs);
88 }
89
lan966x_pcs_get_state(struct phylink_pcs * pcs,struct phylink_link_state * state)90 static void lan966x_pcs_get_state(struct phylink_pcs *pcs,
91 struct phylink_link_state *state)
92 {
93 struct lan966x_port *port = lan966x_pcs_to_port(pcs);
94
95 lan966x_port_status_get(port, state);
96 }
97
lan966x_pcs_config(struct phylink_pcs * pcs,unsigned int neg_mode,phy_interface_t interface,const unsigned long * advertising,bool permit_pause_to_mac)98 static int lan966x_pcs_config(struct phylink_pcs *pcs, unsigned int neg_mode,
99 phy_interface_t interface,
100 const unsigned long *advertising,
101 bool permit_pause_to_mac)
102 {
103 struct lan966x_port *port = lan966x_pcs_to_port(pcs);
104 struct lan966x_port_config config;
105 int ret;
106
107 config = port->config;
108 config.portmode = interface;
109 config.inband = neg_mode & PHYLINK_PCS_NEG_INBAND;
110 config.autoneg = neg_mode == PHYLINK_PCS_NEG_INBAND_ENABLED;
111 config.advertising = advertising;
112
113 ret = lan966x_port_pcs_set(port, &config);
114 if (ret)
115 netdev_err(port->dev, "port PCS config failed: %d\n", ret);
116
117 return ret;
118 }
119
lan966x_pcs_aneg_restart(struct phylink_pcs * pcs)120 static void lan966x_pcs_aneg_restart(struct phylink_pcs *pcs)
121 {
122 /* Currently not used */
123 }
124
125 const struct phylink_mac_ops lan966x_phylink_mac_ops = {
126 .mac_select_pcs = lan966x_phylink_mac_select,
127 .mac_config = lan966x_phylink_mac_config,
128 .mac_prepare = lan966x_phylink_mac_prepare,
129 .mac_link_down = lan966x_phylink_mac_link_down,
130 .mac_link_up = lan966x_phylink_mac_link_up,
131 };
132
133 const struct phylink_pcs_ops lan966x_phylink_pcs_ops = {
134 .pcs_get_state = lan966x_pcs_get_state,
135 .pcs_config = lan966x_pcs_config,
136 .pcs_an_restart = lan966x_pcs_aneg_restart,
137 };
138