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
11static 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
19static void lan966x_phylink_mac_config(struct phylink_config *config,
20				       unsigned int mode,
21				       const struct phylink_link_state *state)
22{
23}
24
25static 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
46static 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
68static 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
85static struct lan966x_port *lan966x_pcs_to_port(struct phylink_pcs *pcs)
86{
87	return container_of(pcs, struct lan966x_port, phylink_pcs);
88}
89
90static 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
98static 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
120static void lan966x_pcs_aneg_restart(struct phylink_pcs *pcs)
121{
122	/* Currently not used */
123}
124
125const 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
133const 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