1// SPDX-License-Identifier: GPL-2.0
  2/* Copyright(c) 2013 - 2019 Intel Corporation. */
  3
  4#include "fm10k.h"
  5
  6/**
  7 * fm10k_dcbnl_ieee_getets - get the ETS configuration for the device
  8 * @dev: netdev interface for the device
  9 * @ets: ETS structure to push configuration to
 10 **/
 11static int fm10k_dcbnl_ieee_getets(struct net_device *dev, struct ieee_ets *ets)
 12{
 13	int i;
 14
 15	/* we support 8 TCs in all modes */
 16	ets->ets_cap = IEEE_8021QAZ_MAX_TCS;
 17	ets->cbs = 0;
 18
 19	/* we only support strict priority and cannot do traffic shaping */
 20	memset(ets->tc_tx_bw, 0, sizeof(ets->tc_tx_bw));
 21	memset(ets->tc_rx_bw, 0, sizeof(ets->tc_rx_bw));
 22	memset(ets->tc_tsa, IEEE_8021QAZ_TSA_STRICT, sizeof(ets->tc_tsa));
 23
 24	/* populate the prio map based on the netdev */
 25	for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
 26		ets->prio_tc[i] = netdev_get_prio_tc_map(dev, i);
 27
 28	return 0;
 29}
 30
 31/**
 32 * fm10k_dcbnl_ieee_setets - set the ETS configuration for the device
 33 * @dev: netdev interface for the device
 34 * @ets: ETS structure to pull configuration from
 35 **/
 36static int fm10k_dcbnl_ieee_setets(struct net_device *dev, struct ieee_ets *ets)
 37{
 38	u8 num_tc = 0;
 39	int i;
 40
 41	/* verify type and determine num_tcs needed */
 42	for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) {
 43		if (ets->tc_tx_bw[i] || ets->tc_rx_bw[i])
 44			return -EINVAL;
 45		if (ets->tc_tsa[i] != IEEE_8021QAZ_TSA_STRICT)
 46			return -EINVAL;
 47		if (ets->prio_tc[i] > num_tc)
 48			num_tc = ets->prio_tc[i];
 49	}
 50
 51	/* if requested TC is greater than 0 then num_tcs is max + 1 */
 52	if (num_tc)
 53		num_tc++;
 54
 55	if (num_tc > IEEE_8021QAZ_MAX_TCS)
 56		return -EINVAL;
 57
 58	/* update TC hardware mapping if necessary */
 59	if (num_tc != netdev_get_num_tc(dev)) {
 60		int err = fm10k_setup_tc(dev, num_tc);
 61		if (err)
 62			return err;
 63	}
 64
 65	/* update priority mapping */
 66	for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
 67		netdev_set_prio_tc_map(dev, i, ets->prio_tc[i]);
 68
 69	return 0;
 70}
 71
 72/**
 73 * fm10k_dcbnl_ieee_getpfc - get the PFC configuration for the device
 74 * @dev: netdev interface for the device
 75 * @pfc: PFC structure to push configuration to
 76 **/
 77static int fm10k_dcbnl_ieee_getpfc(struct net_device *dev, struct ieee_pfc *pfc)
 78{
 79	struct fm10k_intfc *interface = netdev_priv(dev);
 80
 81	/* record flow control max count and state of TCs */
 82	pfc->pfc_cap = IEEE_8021QAZ_MAX_TCS;
 83	pfc->pfc_en = interface->pfc_en;
 84
 85	return 0;
 86}
 87
 88/**
 89 * fm10k_dcbnl_ieee_setpfc - set the PFC configuration for the device
 90 * @dev: netdev interface for the device
 91 * @pfc: PFC structure to pull configuration from
 92 **/
 93static int fm10k_dcbnl_ieee_setpfc(struct net_device *dev, struct ieee_pfc *pfc)
 94{
 95	struct fm10k_intfc *interface = netdev_priv(dev);
 96
 97	/* record PFC configuration to interface */
 98	interface->pfc_en = pfc->pfc_en;
 99
100	/* if we are running update the drop_en state for all queues */
101	if (netif_running(dev))
102		fm10k_update_rx_drop_en(interface);
103
104	return 0;
105}
106
107/**
108 * fm10k_dcbnl_getdcbx - get the DCBX configuration for the device
109 * @dev: netdev interface for the device
110 *
111 * Returns that we support only IEEE DCB for this interface
112 **/
113static u8 fm10k_dcbnl_getdcbx(struct net_device __always_unused *dev)
114{
115	return DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE;
116}
117
118/**
119 * fm10k_dcbnl_setdcbx - get the DCBX configuration for the device
120 * @dev: netdev interface for the device
121 * @mode: new mode for this device
122 *
123 * Returns error on attempt to enable anything but IEEE DCB for this interface
124 **/
125static u8 fm10k_dcbnl_setdcbx(struct net_device __always_unused *dev, u8 mode)
126{
127	return (mode != (DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE)) ? 1 : 0;
128}
129
130static const struct dcbnl_rtnl_ops fm10k_dcbnl_ops = {
131	.ieee_getets	= fm10k_dcbnl_ieee_getets,
132	.ieee_setets	= fm10k_dcbnl_ieee_setets,
133	.ieee_getpfc	= fm10k_dcbnl_ieee_getpfc,
134	.ieee_setpfc	= fm10k_dcbnl_ieee_setpfc,
135
136	.getdcbx	= fm10k_dcbnl_getdcbx,
137	.setdcbx	= fm10k_dcbnl_setdcbx,
138};
139
140/**
141 * fm10k_dcbnl_set_ops - Configures dcbnl ops pointer for netdev
142 * @dev: netdev interface for the device
143 *
144 * Enables PF for DCB by assigning DCBNL ops pointer.
145 **/
146void fm10k_dcbnl_set_ops(struct net_device *dev)
147{
148	struct fm10k_intfc *interface = netdev_priv(dev);
149	struct fm10k_hw *hw = &interface->hw;
150
151	if (hw->mac.type == fm10k_mac_pf)
152		dev->dcbnl_ops = &fm10k_dcbnl_ops;
153}