lan966x_phylink.c

  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				  unsigned int neg_mode,
 92				  struct phylink_link_state *state)
 93{
 94	struct lan966x_port *port = lan966x_pcs_to_port(pcs);
 95
 96	lan966x_port_status_get(port, neg_mode, state);
 97}
 98
 99static int lan966x_pcs_config(struct phylink_pcs *pcs, unsigned int neg_mode,
100			      phy_interface_t interface,
101			      const unsigned long *advertising,
102			      bool permit_pause_to_mac)
103{
104	struct lan966x_port *port = lan966x_pcs_to_port(pcs);
105	struct lan966x_port_config config;
106	int ret;
107
108	config = port->config;
109	config.portmode = interface;
110	config.inband = neg_mode & PHYLINK_PCS_NEG_INBAND;
111	config.autoneg = neg_mode == PHYLINK_PCS_NEG_INBAND_ENABLED;
112	config.advertising = advertising;
113
114	ret = lan966x_port_pcs_set(port, &config);
115	if (ret)
116		netdev_err(port->dev, "port PCS config failed: %d\n", ret);
117
118	return ret;
119}
120
121static void lan966x_pcs_aneg_restart(struct phylink_pcs *pcs)
122{
123	/* Currently not used */
124}
125
126const struct phylink_mac_ops lan966x_phylink_mac_ops = {
127	.mac_select_pcs = lan966x_phylink_mac_select,
128	.mac_config = lan966x_phylink_mac_config,
129	.mac_prepare = lan966x_phylink_mac_prepare,
130	.mac_link_down = lan966x_phylink_mac_link_down,
131	.mac_link_up = lan966x_phylink_mac_link_up,
132};
133
134const struct phylink_pcs_ops lan966x_phylink_pcs_ops = {
135	.pcs_get_state = lan966x_pcs_get_state,
136	.pcs_config = lan966x_pcs_config,
137	.pcs_an_restart = lan966x_pcs_aneg_restart,
138};