| /* | 
 |  * AMD 10Gb Ethernet driver | 
 |  * | 
 |  * This file is available to you under your choice of the following two | 
 |  * licenses: | 
 |  * | 
 |  * License 1: GPLv2 | 
 |  * | 
 |  * Copyright (c) 2014 Advanced Micro Devices, Inc. | 
 |  * | 
 |  * This file is free software; you may copy, redistribute and/or modify | 
 |  * it under the terms of the GNU General Public License as published by | 
 |  * the Free Software Foundation, either version 2 of the License, or (at | 
 |  * your option) any later version. | 
 |  * | 
 |  * This file is distributed in the hope that it will be useful, but | 
 |  * WITHOUT ANY WARRANTY; without even the implied warranty of | 
 |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | 
 |  * General Public License for more details. | 
 |  * | 
 |  * You should have received a copy of the GNU General Public License | 
 |  * along with this program.  If not, see <http://www.gnu.org/licenses/>. | 
 |  * | 
 |  * This file incorporates work covered by the following copyright and | 
 |  * permission notice: | 
 |  *     The Synopsys DWC ETHER XGMAC Software Driver and documentation | 
 |  *     (hereinafter "Software") is an unsupported proprietary work of Synopsys, | 
 |  *     Inc. unless otherwise expressly agreed to in writing between Synopsys | 
 |  *     and you. | 
 |  * | 
 |  *     The Software IS NOT an item of Licensed Software or Licensed Product | 
 |  *     under any End User Software License Agreement or Agreement for Licensed | 
 |  *     Product with Synopsys or any supplement thereto.  Permission is hereby | 
 |  *     granted, free of charge, to any person obtaining a copy of this software | 
 |  *     annotated with this license and the Software, to deal in the Software | 
 |  *     without restriction, including without limitation the rights to use, | 
 |  *     copy, modify, merge, publish, distribute, sublicense, and/or sell copies | 
 |  *     of the Software, and to permit persons to whom the Software is furnished | 
 |  *     to do so, subject to the following conditions: | 
 |  * | 
 |  *     The above copyright notice and this permission notice shall be included | 
 |  *     in all copies or substantial portions of the Software. | 
 |  * | 
 |  *     THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS" | 
 |  *     BASIS AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED | 
 |  *     TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A | 
 |  *     PARTICULAR PURPOSE ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS | 
 |  *     BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | 
 |  *     CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | 
 |  *     SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | 
 |  *     INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | 
 |  *     CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | 
 |  *     ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF | 
 |  *     THE POSSIBILITY OF SUCH DAMAGE. | 
 |  * | 
 |  * | 
 |  * License 2: Modified BSD | 
 |  * | 
 |  * Copyright (c) 2014 Advanced Micro Devices, Inc. | 
 |  * All rights reserved. | 
 |  * | 
 |  * Redistribution and use in source and binary forms, with or without | 
 |  * modification, are permitted provided that the following conditions are met: | 
 |  *     * Redistributions of source code must retain the above copyright | 
 |  *       notice, this list of conditions and the following disclaimer. | 
 |  *     * Redistributions in binary form must reproduce the above copyright | 
 |  *       notice, this list of conditions and the following disclaimer in the | 
 |  *       documentation and/or other materials provided with the distribution. | 
 |  *     * Neither the name of Advanced Micro Devices, Inc. nor the | 
 |  *       names of its contributors may be used to endorse or promote products | 
 |  *       derived from this software without specific prior written permission. | 
 |  * | 
 |  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" | 
 |  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | 
 |  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | 
 |  * ARE DISCLAIMED. IN NO EVENT SHALL <COPYRIGHT HOLDER> BE LIABLE FOR ANY | 
 |  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES | 
 |  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; | 
 |  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND | 
 |  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | 
 |  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | 
 |  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | 
 |  * | 
 |  * This file incorporates work covered by the following copyright and | 
 |  * permission notice: | 
 |  *     The Synopsys DWC ETHER XGMAC Software Driver and documentation | 
 |  *     (hereinafter "Software") is an unsupported proprietary work of Synopsys, | 
 |  *     Inc. unless otherwise expressly agreed to in writing between Synopsys | 
 |  *     and you. | 
 |  * | 
 |  *     The Software IS NOT an item of Licensed Software or Licensed Product | 
 |  *     under any End User Software License Agreement or Agreement for Licensed | 
 |  *     Product with Synopsys or any supplement thereto.  Permission is hereby | 
 |  *     granted, free of charge, to any person obtaining a copy of this software | 
 |  *     annotated with this license and the Software, to deal in the Software | 
 |  *     without restriction, including without limitation the rights to use, | 
 |  *     copy, modify, merge, publish, distribute, sublicense, and/or sell copies | 
 |  *     of the Software, and to permit persons to whom the Software is furnished | 
 |  *     to do so, subject to the following conditions: | 
 |  * | 
 |  *     The above copyright notice and this permission notice shall be included | 
 |  *     in all copies or substantial portions of the Software. | 
 |  * | 
 |  *     THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS" | 
 |  *     BASIS AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED | 
 |  *     TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A | 
 |  *     PARTICULAR PURPOSE ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS | 
 |  *     BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | 
 |  *     CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | 
 |  *     SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | 
 |  *     INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | 
 |  *     CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | 
 |  *     ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF | 
 |  *     THE POSSIBILITY OF SUCH DAMAGE. | 
 |  */ | 
 |  | 
 | #include <linux/netdevice.h> | 
 | #include <net/dcbnl.h> | 
 |  | 
 | #include "xgbe.h" | 
 | #include "xgbe-common.h" | 
 |  | 
 | static int xgbe_dcb_ieee_getets(struct net_device *netdev, | 
 | 				struct ieee_ets *ets) | 
 | { | 
 | 	struct xgbe_prv_data *pdata = netdev_priv(netdev); | 
 |  | 
 | 	/* Set number of supported traffic classes */ | 
 | 	ets->ets_cap = pdata->hw_feat.tc_cnt; | 
 |  | 
 | 	if (pdata->ets) { | 
 | 		ets->cbs = pdata->ets->cbs; | 
 | 		memcpy(ets->tc_tx_bw, pdata->ets->tc_tx_bw, | 
 | 		       sizeof(ets->tc_tx_bw)); | 
 | 		memcpy(ets->tc_tsa, pdata->ets->tc_tsa, | 
 | 		       sizeof(ets->tc_tsa)); | 
 | 		memcpy(ets->prio_tc, pdata->ets->prio_tc, | 
 | 		       sizeof(ets->prio_tc)); | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int xgbe_dcb_ieee_setets(struct net_device *netdev, | 
 | 				struct ieee_ets *ets) | 
 | { | 
 | 	struct xgbe_prv_data *pdata = netdev_priv(netdev); | 
 | 	unsigned int i, tc_ets, tc_ets_weight; | 
 |  | 
 | 	tc_ets = 0; | 
 | 	tc_ets_weight = 0; | 
 | 	for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) { | 
 | 		netif_dbg(pdata, drv, netdev, | 
 | 			  "TC%u: tx_bw=%hhu, rx_bw=%hhu, tsa=%hhu\n", i, | 
 | 			  ets->tc_tx_bw[i], ets->tc_rx_bw[i], | 
 | 			  ets->tc_tsa[i]); | 
 | 		netif_dbg(pdata, drv, netdev, "PRIO%u: TC=%hhu\n", i, | 
 | 			  ets->prio_tc[i]); | 
 |  | 
 | 		if ((ets->tc_tx_bw[i] || ets->tc_tsa[i]) && | 
 | 		    (i >= pdata->hw_feat.tc_cnt)) | 
 | 				return -EINVAL; | 
 |  | 
 | 		if (ets->prio_tc[i] >= pdata->hw_feat.tc_cnt) | 
 | 			return -EINVAL; | 
 |  | 
 | 		switch (ets->tc_tsa[i]) { | 
 | 		case IEEE_8021QAZ_TSA_STRICT: | 
 | 			break; | 
 | 		case IEEE_8021QAZ_TSA_ETS: | 
 | 			tc_ets = 1; | 
 | 			tc_ets_weight += ets->tc_tx_bw[i]; | 
 | 			break; | 
 |  | 
 | 		default: | 
 | 			return -EINVAL; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	/* Weights must add up to 100% */ | 
 | 	if (tc_ets && (tc_ets_weight != 100)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (!pdata->ets) { | 
 | 		pdata->ets = devm_kzalloc(pdata->dev, sizeof(*pdata->ets), | 
 | 					  GFP_KERNEL); | 
 | 		if (!pdata->ets) | 
 | 			return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	memcpy(pdata->ets, ets, sizeof(*pdata->ets)); | 
 |  | 
 | 	pdata->hw_if.config_dcb_tc(pdata); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int xgbe_dcb_ieee_getpfc(struct net_device *netdev, | 
 | 				struct ieee_pfc *pfc) | 
 | { | 
 | 	struct xgbe_prv_data *pdata = netdev_priv(netdev); | 
 |  | 
 | 	/* Set number of supported PFC traffic classes */ | 
 | 	pfc->pfc_cap = pdata->hw_feat.tc_cnt; | 
 |  | 
 | 	if (pdata->pfc) { | 
 | 		pfc->pfc_en = pdata->pfc->pfc_en; | 
 | 		pfc->mbc = pdata->pfc->mbc; | 
 | 		pfc->delay = pdata->pfc->delay; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int xgbe_dcb_ieee_setpfc(struct net_device *netdev, | 
 | 				struct ieee_pfc *pfc) | 
 | { | 
 | 	struct xgbe_prv_data *pdata = netdev_priv(netdev); | 
 |  | 
 | 	netif_dbg(pdata, drv, netdev, | 
 | 		  "cap=%hhu, en=%#hhx, mbc=%hhu, delay=%hhu\n", | 
 | 		  pfc->pfc_cap, pfc->pfc_en, pfc->mbc, pfc->delay); | 
 |  | 
 | 	if (!pdata->pfc) { | 
 | 		pdata->pfc = devm_kzalloc(pdata->dev, sizeof(*pdata->pfc), | 
 | 					  GFP_KERNEL); | 
 | 		if (!pdata->pfc) | 
 | 			return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	memcpy(pdata->pfc, pfc, sizeof(*pdata->pfc)); | 
 |  | 
 | 	pdata->hw_if.config_dcb_pfc(pdata); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static u8 xgbe_dcb_getdcbx(struct net_device *netdev) | 
 | { | 
 | 	return DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE; | 
 | } | 
 |  | 
 | static u8 xgbe_dcb_setdcbx(struct net_device *netdev, u8 dcbx) | 
 | { | 
 | 	struct xgbe_prv_data *pdata = netdev_priv(netdev); | 
 | 	u8 support = xgbe_dcb_getdcbx(netdev); | 
 |  | 
 | 	netif_dbg(pdata, drv, netdev, "DCBX=%#hhx\n", dcbx); | 
 |  | 
 | 	if (dcbx & ~support) | 
 | 		return 1; | 
 |  | 
 | 	if ((dcbx & support) != support) | 
 | 		return 1; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static const struct dcbnl_rtnl_ops xgbe_dcbnl_ops = { | 
 | 	/* IEEE 802.1Qaz std */ | 
 | 	.ieee_getets = xgbe_dcb_ieee_getets, | 
 | 	.ieee_setets = xgbe_dcb_ieee_setets, | 
 | 	.ieee_getpfc = xgbe_dcb_ieee_getpfc, | 
 | 	.ieee_setpfc = xgbe_dcb_ieee_setpfc, | 
 |  | 
 | 	/* DCBX configuration */ | 
 | 	.getdcbx     = xgbe_dcb_getdcbx, | 
 | 	.setdcbx     = xgbe_dcb_setdcbx, | 
 | }; | 
 |  | 
 | const struct dcbnl_rtnl_ops *xgbe_get_dcbnl_ops(void) | 
 | { | 
 | 	return &xgbe_dcbnl_ops; | 
 | } |