dcbnl.c revision 7c77ab24e30bad7598b5cfda93be6f32ed439c2f
12f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* 2698e1d23cfc15312be2e7665014afd98c49ae9a1Mark Rustad * Copyright (c) 2008-2011, Intel Corporation. 32f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 42f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * This program is free software; you can redistribute it and/or modify it 52f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * under the terms and conditions of the GNU General Public License, 62f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * version 2, as published by the Free Software Foundation. 72f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 82f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * This program is distributed in the hope it will be useful, but WITHOUT 92f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * more details. 122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * You should have received a copy of the GNU General Public License along with 142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * this program; if not, write to the Free Software Foundation, Inc., 59 Temple 152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * Place - Suite 330, Boston, MA 02111-1307 USA. 162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * Author: Lucy Liu <lucy.liu@intel.com> 182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck */ 192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <linux/netdevice.h> 212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <linux/netlink.h> 225a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 232f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <net/netlink.h> 242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <net/rtnetlink.h> 252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <linux/dcbnl.h> 2696b99684e365f28d49bdb1221ca022b75cb91a98John Fastabend#include <net/dcbevent.h> 272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <linux/rtnetlink.h> 283a9a231d977222eea36eae091df2c358e03ac839Paul Gortmaker#include <linux/module.h> 292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <net/sock.h> 302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 31ae86b9e3846f6fc5509dee721f2bdba1db8ab96aBen Hutchings/* Data Center Bridging (DCB) is a collection of Ethernet enhancements 322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * intended to allow network traffic with differing requirements 332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * (highly reliable, no drops vs. best effort vs. low latency) to operate 342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * and co-exist on Ethernet. Current DCB features are: 352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * Enhanced Transmission Selection (aka Priority Grouping [PG]) - provides a 372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * framework for assigning bandwidth guarantees to traffic classes. 382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * Priority-based Flow Control (PFC) - provides a flow control mechanism which 402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * can work independently for each 802.1p priority. 412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * Congestion Notification - provides a mechanism for end-to-end congestion 432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * control for protocols which do not have built-in congestion management. 442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * More information about the emerging standards for these Ethernet features 462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * can be found at: http://www.ieee802.org/1/pages/dcbridges.html 472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * This file implements an rtnetlink interface to allow configuration of DCB 492f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * features for capable devices. 502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck */ 512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander DuyckMODULE_AUTHOR("Lucy Liu, <lucy.liu@intel.com>"); 537a6b6f515f77d1c62a2f383b6dce18cb0af0cf4fJeff KirsherMODULE_DESCRIPTION("Data Center Bridging netlink interface"); 542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander DuyckMODULE_LICENSE("GPL"); 552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/**************** DCB attribute policies *************************************/ 572f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* DCB netlink attributes policy */ 59b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_rtnl_policy[DCB_ATTR_MAX + 1] = { 60859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_IFNAME] = {.type = NLA_NUL_STRING, .len = IFNAMSIZ - 1}, 61859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_STATE] = {.type = NLA_U8}, 62859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_PFC_CFG] = {.type = NLA_NESTED}, 63859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_PG_CFG] = {.type = NLA_NESTED}, 64859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_SET_ALL] = {.type = NLA_U8}, 652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_ATTR_PERM_HWADDR] = {.type = NLA_FLAG}, 66859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_CAP] = {.type = NLA_NESTED}, 67859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_PFC_STATE] = {.type = NLA_U8}, 68859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_ATTR_BCN] = {.type = NLA_NESTED}, 696fa382af61338908e5713234bcee598423f661c3Yi Zou [DCB_ATTR_APP] = {.type = NLA_NESTED}, 703e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE] = {.type = NLA_NESTED}, 716241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid [DCB_ATTR_DCBX] = {.type = NLA_U8}, 72ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid [DCB_ATTR_FEATCFG] = {.type = NLA_NESTED}, 732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* DCB priority flow control to User Priority nested attributes */ 76b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_pfc_up_nest[DCB_PFC_UP_ATTR_MAX + 1] = { 772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_0] = {.type = NLA_U8}, 782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_1] = {.type = NLA_U8}, 792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_2] = {.type = NLA_U8}, 802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_3] = {.type = NLA_U8}, 812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_4] = {.type = NLA_U8}, 822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_5] = {.type = NLA_U8}, 832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_6] = {.type = NLA_U8}, 842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_7] = {.type = NLA_U8}, 852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_ALL] = {.type = NLA_FLAG}, 862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* DCB priority grouping nested attributes */ 89b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_pg_nest[DCB_PG_ATTR_MAX + 1] = { 902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_0] = {.type = NLA_NESTED}, 912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_1] = {.type = NLA_NESTED}, 922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_2] = {.type = NLA_NESTED}, 932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_3] = {.type = NLA_NESTED}, 942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_4] = {.type = NLA_NESTED}, 952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_5] = {.type = NLA_NESTED}, 962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_6] = {.type = NLA_NESTED}, 972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_7] = {.type = NLA_NESTED}, 982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_ALL] = {.type = NLA_NESTED}, 992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_0] = {.type = NLA_U8}, 1002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_1] = {.type = NLA_U8}, 1012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_2] = {.type = NLA_U8}, 1022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_3] = {.type = NLA_U8}, 1032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_4] = {.type = NLA_U8}, 1042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_5] = {.type = NLA_U8}, 1052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_6] = {.type = NLA_U8}, 1062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_7] = {.type = NLA_U8}, 1072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_ALL] = {.type = NLA_FLAG}, 1082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 1092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 1102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* DCB traffic class nested attributes. */ 111b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_tc_param_nest[DCB_TC_ATTR_PARAM_MAX + 1] = { 1122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_PGID] = {.type = NLA_U8}, 1132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_UP_MAPPING] = {.type = NLA_U8}, 1142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_STRICT_PRIO] = {.type = NLA_U8}, 1152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_BW_PCT] = {.type = NLA_U8}, 1162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_ALL] = {.type = NLA_FLAG}, 1172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 1182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 11946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck/* DCB capabilities nested attributes. */ 120b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_cap_nest[DCB_CAP_ATTR_MAX + 1] = { 12146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_ALL] = {.type = NLA_FLAG}, 12246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PG] = {.type = NLA_U8}, 12346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PFC] = {.type = NLA_U8}, 12446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_UP2TC] = {.type = NLA_U8}, 12546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PG_TCS] = {.type = NLA_U8}, 12646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PFC_TCS] = {.type = NLA_U8}, 12746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_GSP] = {.type = NLA_U8}, 12846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_BCN] = {.type = NLA_U8}, 1296241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid [DCB_CAP_ATTR_DCBX] = {.type = NLA_U8}, 13046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck}; 1312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 13233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck/* DCB capabilities nested attributes. */ 133b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_numtcs_nest[DCB_NUMTCS_ATTR_MAX + 1] = { 13433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck [DCB_NUMTCS_ATTR_ALL] = {.type = NLA_FLAG}, 13533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck [DCB_NUMTCS_ATTR_PG] = {.type = NLA_U8}, 13633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck [DCB_NUMTCS_ATTR_PFC] = {.type = NLA_U8}, 13733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck}; 13833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 139859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck/* DCB BCN nested attributes. */ 140b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_bcn_nest[DCB_BCN_ATTR_MAX + 1] = { 141859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_0] = {.type = NLA_U8}, 142859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_1] = {.type = NLA_U8}, 143859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_2] = {.type = NLA_U8}, 144859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_3] = {.type = NLA_U8}, 145859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_4] = {.type = NLA_U8}, 146859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_5] = {.type = NLA_U8}, 147859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_6] = {.type = NLA_U8}, 148859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_7] = {.type = NLA_U8}, 149859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_ALL] = {.type = NLA_FLAG}, 150f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore [DCB_BCN_ATTR_BCNA_0] = {.type = NLA_U32}, 151f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore [DCB_BCN_ATTR_BCNA_1] = {.type = NLA_U32}, 152859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_ALPHA] = {.type = NLA_U32}, 153859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_BETA] = {.type = NLA_U32}, 154859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_GD] = {.type = NLA_U32}, 155859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_GI] = {.type = NLA_U32}, 156859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_TMAX] = {.type = NLA_U32}, 157859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_TD] = {.type = NLA_U32}, 158859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RMIN] = {.type = NLA_U32}, 159859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_W] = {.type = NLA_U32}, 160859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RD] = {.type = NLA_U32}, 161859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RU] = {.type = NLA_U32}, 162859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_WRTT] = {.type = NLA_U32}, 163859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RI] = {.type = NLA_U32}, 164859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_C] = {.type = NLA_U32}, 165859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_ALL] = {.type = NLA_FLAG}, 166859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck}; 167859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1686fa382af61338908e5713234bcee598423f661c3Yi Zou/* DCB APP nested attributes. */ 169b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_app_nest[DCB_APP_ATTR_MAX + 1] = { 1706fa382af61338908e5713234bcee598423f661c3Yi Zou [DCB_APP_ATTR_IDTYPE] = {.type = NLA_U8}, 1716fa382af61338908e5713234bcee598423f661c3Yi Zou [DCB_APP_ATTR_ID] = {.type = NLA_U16}, 1726fa382af61338908e5713234bcee598423f661c3Yi Zou [DCB_APP_ATTR_PRIORITY] = {.type = NLA_U8}, 1736fa382af61338908e5713234bcee598423f661c3Yi Zou}; 1746fa382af61338908e5713234bcee598423f661c3Yi Zou 1753e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend/* IEEE 802.1Qaz nested attributes. */ 1763e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendstatic const struct nla_policy dcbnl_ieee_policy[DCB_ATTR_IEEE_MAX + 1] = { 1773e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_ETS] = {.len = sizeof(struct ieee_ets)}, 1783e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_PFC] = {.len = sizeof(struct ieee_pfc)}, 1793e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_APP_TABLE] = {.type = NLA_NESTED}, 18008f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai [DCB_ATTR_IEEE_MAXRATE] = {.len = sizeof(struct ieee_maxrate)}, 1813e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend}; 1823e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 1833e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendstatic const struct nla_policy dcbnl_ieee_app[DCB_ATTR_IEEE_APP_MAX + 1] = { 1843e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_APP] = {.len = sizeof(struct dcb_app)}, 1853e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend}; 1863e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 187ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid/* DCB number of traffic classes nested attributes. */ 188ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravidstatic const struct nla_policy dcbnl_featcfg_nest[DCB_FEATCFG_ATTR_MAX + 1] = { 189ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid [DCB_FEATCFG_ATTR_ALL] = {.type = NLA_FLAG}, 190ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid [DCB_FEATCFG_ATTR_PG] = {.type = NLA_U8}, 191ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid [DCB_FEATCFG_ATTR_PFC] = {.type = NLA_U8}, 192ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid [DCB_FEATCFG_ATTR_APP] = {.type = NLA_U8}, 193ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid}; 194ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1959ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendstatic LIST_HEAD(dcb_app_list); 1969ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendstatic DEFINE_SPINLOCK(dcb_lock); 1979ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 19833a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Grafstatic struct sk_buff *dcbnl_newmsg(int type, u8 cmd, u32 port, u32 seq, 19933a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf u32 flags, struct nlmsghdr **nlhp) 20033a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf{ 20133a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf struct sk_buff *skb; 20233a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf struct dcbmsg *dcb; 20333a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf struct nlmsghdr *nlh; 20433a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 20533a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 20633a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf if (!skb) 20733a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf return NULL; 20833a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 20933a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf nlh = nlmsg_put(skb, port, seq, type, sizeof(*dcb), flags); 210b3908e22ad8bb6074934496ef171fd83605d7d3eThomas Graf BUG_ON(!nlh); 21133a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 21233a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf dcb = nlmsg_data(nlh); 21333a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf dcb->dcb_family = AF_UNSPEC; 21433a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf dcb->cmd = cmd; 21533a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf dcb->dcb_pad = 0; 21633a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 21733a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf if (nlhp) 21833a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf *nlhp = nlh; 21933a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 22033a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf return skb; 22133a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf} 22233a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 2237be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getstate(struct net_device *netdev, struct nlmsghdr *nlh, 2247be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 2252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 2262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* if (!tb[DCB_ATTR_STATE] || !netdev->dcbnl_ops->getstate) */ 2272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!netdev->dcbnl_ops->getstate) 2283d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 2292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2307be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_STATE, 2317be994138b188387691322921c08e19bddf6d3c5Thomas Graf netdev->dcbnl_ops->getstate(netdev)); 2322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 2332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2347be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getpfccfg(struct net_device *netdev, struct nlmsghdr *nlh, 2357be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 2362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 2372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *data[DCB_PFC_UP_ATTR_MAX + 1], *nest; 2382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 value; 2393d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 2402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 2412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int getall = 0; 2422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2433d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_PFC_CFG]) 2443d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 2453d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 2463d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->getpfccfg) 2473d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 2482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2492f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(data, DCB_PFC_UP_ATTR_MAX, 2502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PFC_CFG], 2512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_pfc_up_nest); 2522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 2533d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 2542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2557be994138b188387691322921c08e19bddf6d3c5Thomas Graf nest = nla_nest_start(skb, DCB_ATTR_PFC_CFG); 2562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!nest) 2573d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 2582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (data[DCB_PFC_UP_ATTR_ALL]) 2602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 1; 2612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2622f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PFC_UP_ATTR_0; i <= DCB_PFC_UP_ATTR_7; i++) { 2632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!getall && !data[i]) 2642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 2652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2662f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpfccfg(netdev, i - DCB_PFC_UP_ATTR_0, 2672f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck &value); 2687be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, i, value); 2692f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) { 2707be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, nest); 2713d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 2722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 2732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 2747be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, nest); 2752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 2772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 2782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2797be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getperm_hwaddr(struct net_device *netdev, struct nlmsghdr *nlh, 2807be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 2812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 2822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 perm_addr[MAX_ADDR_LEN]; 2832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!netdev->dcbnl_ops->getpermhwaddr) 2853d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 2862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpermhwaddr(netdev, perm_addr); 2882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2897be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put(skb, DCB_ATTR_PERM_HWADDR, sizeof(perm_addr), perm_addr); 2902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 2912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2927be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getcap(struct net_device *netdev, struct nlmsghdr *nlh, 2937be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 29446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck{ 29546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck struct nlattr *data[DCB_CAP_ATTR_MAX + 1], *nest; 29646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck u8 value; 2973d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 29846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck int i; 29946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck int getall = 0; 30046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 3013d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_CAP]) 3023d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 3033d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 3043d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->getcap) 3053d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 30646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 30746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck ret = nla_parse_nested(data, DCB_CAP_ATTR_MAX, tb[DCB_ATTR_CAP], 30846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck dcbnl_cap_nest); 30946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (ret) 3103d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 31146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 3127be994138b188387691322921c08e19bddf6d3c5Thomas Graf nest = nla_nest_start(skb, DCB_ATTR_CAP); 31346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!nest) 3143d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 31546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 31646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (data[DCB_CAP_ATTR_ALL]) 31746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck getall = 1; 31846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 31946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck for (i = DCB_CAP_ATTR_ALL+1; i <= DCB_CAP_ATTR_MAX; i++) { 32046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!getall && !data[i]) 32146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck continue; 32246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 32346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!netdev->dcbnl_ops->getcap(netdev, i, &value)) { 3247be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, i, value); 32546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (ret) { 3267be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, nest); 3273d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 32846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck } 32946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck } 33046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck } 3317be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, nest); 33246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 33346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck return 0; 33446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck} 33546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 3367be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getnumtcs(struct net_device *netdev, struct nlmsghdr *nlh, 3377be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 33833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck{ 33933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck struct nlattr *data[DCB_NUMTCS_ATTR_MAX + 1], *nest; 34033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck u8 value; 3413d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 34233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int i; 34333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int getall = 0; 34433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 3453d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_NUMTCS]) 3463d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 3473d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 3483d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->getnumtcs) 3493d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 35033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 35133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = nla_parse_nested(data, DCB_NUMTCS_ATTR_MAX, tb[DCB_ATTR_NUMTCS], 35233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcbnl_numtcs_nest); 3533d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (ret) 3543d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 35533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 3567be994138b188387691322921c08e19bddf6d3c5Thomas Graf nest = nla_nest_start(skb, DCB_ATTR_NUMTCS); 3573d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!nest) 3583d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 35933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 36033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (data[DCB_NUMTCS_ATTR_ALL]) 36133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck getall = 1; 36233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 36333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck for (i = DCB_NUMTCS_ATTR_ALL+1; i <= DCB_NUMTCS_ATTR_MAX; i++) { 36433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (!getall && !data[i]) 36533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck continue; 36633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 36733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = netdev->dcbnl_ops->getnumtcs(netdev, i, &value); 36833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (!ret) { 3697be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, i, value); 37033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (ret) { 3717be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, nest); 3723d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 37333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 3743d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf } else 3753d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 37633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 3777be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, nest); 37833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 37933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck return 0; 38033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck} 38133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 3827be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setnumtcs(struct net_device *netdev, struct nlmsghdr *nlh, 3837be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 38433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck{ 38533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck struct nlattr *data[DCB_NUMTCS_ATTR_MAX + 1]; 3863d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 38733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck u8 value; 38833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int i; 38933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 3903d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_NUMTCS]) 3913d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 3923d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 3933d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->setnumtcs) 3943d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 39533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 39633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = nla_parse_nested(data, DCB_NUMTCS_ATTR_MAX, tb[DCB_ATTR_NUMTCS], 39733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcbnl_numtcs_nest); 3987be994138b188387691322921c08e19bddf6d3c5Thomas Graf if (ret) 3993d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 40033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 40133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck for (i = DCB_NUMTCS_ATTR_ALL+1; i <= DCB_NUMTCS_ATTR_MAX; i++) { 40233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (data[i] == NULL) 40333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck continue; 40433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 40533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck value = nla_get_u8(data[i]); 40633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 40733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = netdev->dcbnl_ops->setnumtcs(netdev, i, value); 40833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (ret) 4097be994138b188387691322921c08e19bddf6d3c5Thomas Graf break; 41033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 41133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 4127be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_NUMTCS, !!ret); 41333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck} 41433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 4157be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getpfcstate(struct net_device *netdev, struct nlmsghdr *nlh, 4167be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 4170eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck{ 4180eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck if (!netdev->dcbnl_ops->getpfcstate) 4193d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 4200eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 4217be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_PFC_STATE, 4227be994138b188387691322921c08e19bddf6d3c5Thomas Graf netdev->dcbnl_ops->getpfcstate(netdev)); 4230eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck} 4240eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 4257be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setpfcstate(struct net_device *netdev, struct nlmsghdr *nlh, 4267be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 4270eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck{ 4280eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck u8 value; 4290eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 4303d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_PFC_STATE]) 4317be994138b188387691322921c08e19bddf6d3c5Thomas Graf return -EINVAL; 4320eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 4333d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->setpfcstate) 4343d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 4353d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 4360eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck value = nla_get_u8(tb[DCB_ATTR_PFC_STATE]); 4370eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 4380eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck netdev->dcbnl_ops->setpfcstate(netdev, value); 4390eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 4407be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_PFC_STATE, 0); 4410eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck} 4420eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 4437be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getapp(struct net_device *netdev, struct nlmsghdr *nlh, 4447be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 445579496865cf4ea429146382d62047ffdbaab0deeYi Zou{ 446579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct nlattr *app_nest; 447579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct nlattr *app_tb[DCB_APP_ATTR_MAX + 1]; 448579496865cf4ea429146382d62047ffdbaab0deeYi Zou u16 id; 449579496865cf4ea429146382d62047ffdbaab0deeYi Zou u8 up, idtype; 4503d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 451579496865cf4ea429146382d62047ffdbaab0deeYi Zou 4523dce38a02d6370dca690cd923619d4b00024b723John Fastabend if (!tb[DCB_ATTR_APP]) 4533d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 454579496865cf4ea429146382d62047ffdbaab0deeYi Zou 455579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = nla_parse_nested(app_tb, DCB_APP_ATTR_MAX, tb[DCB_ATTR_APP], 456579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcbnl_app_nest); 457579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 4583d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 459579496865cf4ea429146382d62047ffdbaab0deeYi Zou 460579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* all must be non-null */ 461579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((!app_tb[DCB_APP_ATTR_IDTYPE]) || 462579496865cf4ea429146382d62047ffdbaab0deeYi Zou (!app_tb[DCB_APP_ATTR_ID])) 4633d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 464579496865cf4ea429146382d62047ffdbaab0deeYi Zou 465579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* either by eth type or by socket number */ 466579496865cf4ea429146382d62047ffdbaab0deeYi Zou idtype = nla_get_u8(app_tb[DCB_APP_ATTR_IDTYPE]); 467579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((idtype != DCB_APP_IDTYPE_ETHTYPE) && 468579496865cf4ea429146382d62047ffdbaab0deeYi Zou (idtype != DCB_APP_IDTYPE_PORTNUM)) 4693d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 470579496865cf4ea429146382d62047ffdbaab0deeYi Zou 471579496865cf4ea429146382d62047ffdbaab0deeYi Zou id = nla_get_u16(app_tb[DCB_APP_ATTR_ID]); 4723dce38a02d6370dca690cd923619d4b00024b723John Fastabend 4733dce38a02d6370dca690cd923619d4b00024b723John Fastabend if (netdev->dcbnl_ops->getapp) { 4743dce38a02d6370dca690cd923619d4b00024b723John Fastabend up = netdev->dcbnl_ops->getapp(netdev, idtype, id); 4753dce38a02d6370dca690cd923619d4b00024b723John Fastabend } else { 4763dce38a02d6370dca690cd923619d4b00024b723John Fastabend struct dcb_app app = { 4773dce38a02d6370dca690cd923619d4b00024b723John Fastabend .selector = idtype, 4783dce38a02d6370dca690cd923619d4b00024b723John Fastabend .protocol = id, 4793dce38a02d6370dca690cd923619d4b00024b723John Fastabend }; 4803dce38a02d6370dca690cd923619d4b00024b723John Fastabend up = dcb_getapp(netdev, &app); 4813dce38a02d6370dca690cd923619d4b00024b723John Fastabend } 482579496865cf4ea429146382d62047ffdbaab0deeYi Zou 4837be994138b188387691322921c08e19bddf6d3c5Thomas Graf app_nest = nla_nest_start(skb, DCB_ATTR_APP); 484d3337de52af7fb0ebe605b02b740be4ee7dee9ebJesper Juhl if (!app_nest) 4853d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 486d3337de52af7fb0ebe605b02b740be4ee7dee9ebJesper Juhl 4877be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, DCB_APP_ATTR_IDTYPE, idtype); 488579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 489579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out_cancel; 490579496865cf4ea429146382d62047ffdbaab0deeYi Zou 4917be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u16(skb, DCB_APP_ATTR_ID, id); 492579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 493579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out_cancel; 494579496865cf4ea429146382d62047ffdbaab0deeYi Zou 4957be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, DCB_APP_ATTR_PRIORITY, up); 496579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 497579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out_cancel; 498579496865cf4ea429146382d62047ffdbaab0deeYi Zou 4997be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, app_nest); 500579496865cf4ea429146382d62047ffdbaab0deeYi Zou 5013d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return 0; 502579496865cf4ea429146382d62047ffdbaab0deeYi Zou 503579496865cf4ea429146382d62047ffdbaab0deeYi Zouout_cancel: 5047be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, app_nest); 505579496865cf4ea429146382d62047ffdbaab0deeYi Zou return ret; 506579496865cf4ea429146382d62047ffdbaab0deeYi Zou} 507579496865cf4ea429146382d62047ffdbaab0deeYi Zou 5087be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setapp(struct net_device *netdev, struct nlmsghdr *nlh, 5097be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 510579496865cf4ea429146382d62047ffdbaab0deeYi Zou{ 5113d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 512579496865cf4ea429146382d62047ffdbaab0deeYi Zou u16 id; 513579496865cf4ea429146382d62047ffdbaab0deeYi Zou u8 up, idtype; 514579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct nlattr *app_tb[DCB_APP_ATTR_MAX + 1]; 515579496865cf4ea429146382d62047ffdbaab0deeYi Zou 5169ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (!tb[DCB_ATTR_APP]) 5173d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 518579496865cf4ea429146382d62047ffdbaab0deeYi Zou 519579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = nla_parse_nested(app_tb, DCB_APP_ATTR_MAX, tb[DCB_ATTR_APP], 520579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcbnl_app_nest); 521579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 5223d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 523579496865cf4ea429146382d62047ffdbaab0deeYi Zou 524579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* all must be non-null */ 525579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((!app_tb[DCB_APP_ATTR_IDTYPE]) || 526579496865cf4ea429146382d62047ffdbaab0deeYi Zou (!app_tb[DCB_APP_ATTR_ID]) || 527579496865cf4ea429146382d62047ffdbaab0deeYi Zou (!app_tb[DCB_APP_ATTR_PRIORITY])) 5283d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 529579496865cf4ea429146382d62047ffdbaab0deeYi Zou 530579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* either by eth type or by socket number */ 531579496865cf4ea429146382d62047ffdbaab0deeYi Zou idtype = nla_get_u8(app_tb[DCB_APP_ATTR_IDTYPE]); 532579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((idtype != DCB_APP_IDTYPE_ETHTYPE) && 533579496865cf4ea429146382d62047ffdbaab0deeYi Zou (idtype != DCB_APP_IDTYPE_PORTNUM)) 5343d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 535579496865cf4ea429146382d62047ffdbaab0deeYi Zou 536579496865cf4ea429146382d62047ffdbaab0deeYi Zou id = nla_get_u16(app_tb[DCB_APP_ATTR_ID]); 537579496865cf4ea429146382d62047ffdbaab0deeYi Zou up = nla_get_u8(app_tb[DCB_APP_ATTR_PRIORITY]); 538579496865cf4ea429146382d62047ffdbaab0deeYi Zou 5399ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (netdev->dcbnl_ops->setapp) { 5403d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf ret = netdev->dcbnl_ops->setapp(netdev, idtype, id, up); 5419ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } else { 5429ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app app; 5439ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app.selector = idtype; 5449ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app.protocol = id; 5459ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app.priority = up; 5463d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf ret = dcb_setapp(netdev, &app); 5479ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 5489ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 5497be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, DCB_ATTR_APP, ret); 550081579840b4b2421e37bc67e3b089b7ca64ef040John Fastabend dcbnl_cee_notify(netdev, RTM_SETDCB, DCB_CMD_SAPP, seq, 0); 5513d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 552579496865cf4ea429146382d62047ffdbaab0deeYi Zou return ret; 553579496865cf4ea429146382d62047ffdbaab0deeYi Zou} 554579496865cf4ea429146382d62047ffdbaab0deeYi Zou 5557be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int __dcbnl_pg_getcfg(struct net_device *netdev, struct nlmsghdr *nlh, 5567be994138b188387691322921c08e19bddf6d3c5Thomas Graf struct nlattr **tb, struct sk_buff *skb, int dir) 5572f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 5582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *pg_nest, *param_nest, *data; 5592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *pg_tb[DCB_PG_ATTR_MAX + 1]; 5602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *param_tb[DCB_TC_ATTR_PARAM_MAX + 1]; 5612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 prio, pgid, tc_pct, up_map; 5623d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 5632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int getall = 0; 5642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 5652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 5663d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_PG_CFG]) 5673d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 5683d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 5693d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->getpgtccfgtx || 5702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->getpgtccfgrx || 5712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->getpgbwgcfgtx || 5722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->getpgbwgcfgrx) 5733d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 5742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 5752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(pg_tb, DCB_PG_ATTR_MAX, 5762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PG_CFG], dcbnl_pg_nest); 5772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 5783d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 5792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 5807be994138b188387691322921c08e19bddf6d3c5Thomas Graf pg_nest = nla_nest_start(skb, DCB_ATTR_PG_CFG); 5812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!pg_nest) 5823d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 5832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 5842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (pg_tb[DCB_PG_ATTR_TC_ALL]) 5852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 1; 5862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 5872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_TC_0; i <= DCB_PG_ATTR_TC_7; i++) { 5882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!getall && !pg_tb[i]) 5892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 5902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 5912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (pg_tb[DCB_PG_ATTR_TC_ALL]) 5922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data = pg_tb[DCB_PG_ATTR_TC_ALL]; 5932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck else 5942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data = pg_tb[i]; 5952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(param_tb, DCB_TC_ATTR_PARAM_MAX, 5962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data, dcbnl_tc_param_nest); 5972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 5982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_pg; 5992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6007be994138b188387691322921c08e19bddf6d3c5Thomas Graf param_nest = nla_nest_start(skb, i); 6012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!param_nest) 6022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_pg; 6032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pgid = DCB_ATTR_VALUE_UNDEFINED; 6052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio = DCB_ATTR_VALUE_UNDEFINED; 6062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = DCB_ATTR_VALUE_UNDEFINED; 6072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck up_map = DCB_ATTR_VALUE_UNDEFINED; 6082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 6102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 6112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgtccfgrx(netdev, 6122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, &prio, 6132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck &pgid, &tc_pct, &up_map); 6142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 6152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 6162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgtccfgtx(netdev, 6172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, &prio, 6182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck &pgid, &tc_pct, &up_map); 6192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_PGID] || 6222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 6237be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, 6242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_TC_ATTR_PARAM_PGID, pgid); 6252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 6262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 6272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING] || 6292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 6307be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, 6312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_TC_ATTR_PARAM_UP_MAPPING, up_map); 6322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 6332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 6342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO] || 6362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 6377be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, 6382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_TC_ATTR_PARAM_STRICT_PRIO, prio); 6392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 6402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 6412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_BW_PCT] || 6432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 6447be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, DCB_TC_ATTR_PARAM_BW_PCT, 6452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct); 6462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 6472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 6482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6497be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, param_nest); 6502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (pg_tb[DCB_PG_ATTR_BW_ID_ALL]) 6532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 1; 6542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck else 6552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 0; 6562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6572f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_BW_ID_0; i <= DCB_PG_ATTR_BW_ID_7; i++) { 6582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!getall && !pg_tb[i]) 6592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 6602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = DCB_ATTR_VALUE_UNDEFINED; 6622f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 6642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 6652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgbwgcfgrx(netdev, 6662f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, &tc_pct); 6672f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 6682f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 6692f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgbwgcfgtx(netdev, 6702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, &tc_pct); 6712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6727be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, i, tc_pct); 6732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 6742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_pg; 6752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 6762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6777be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, pg_nest); 6782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 6802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr_param: 6827be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, param_nest); 6832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr_pg: 6847be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, pg_nest); 6853d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 6863d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 6872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 6882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6897be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_pgtx_getcfg(struct net_device *netdev, struct nlmsghdr *nlh, 6907be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 6912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 6927be994138b188387691322921c08e19bddf6d3c5Thomas Graf return __dcbnl_pg_getcfg(netdev, nlh, tb, skb, 0); 6932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 6942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 6957be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_pgrx_getcfg(struct net_device *netdev, struct nlmsghdr *nlh, 6967be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 6972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 6987be994138b188387691322921c08e19bddf6d3c5Thomas Graf return __dcbnl_pg_getcfg(netdev, nlh, tb, skb, 1); 6992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 7002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7017be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setstate(struct net_device *netdev, struct nlmsghdr *nlh, 7027be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 7032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 7042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 value; 7052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7063d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_STATE]) 7077be994138b188387691322921c08e19bddf6d3c5Thomas Graf return -EINVAL; 7082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7093d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->setstate) 7103d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 7113d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 7122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck value = nla_get_u8(tb[DCB_ATTR_STATE]); 7132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7147be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_STATE, 7157be994138b188387691322921c08e19bddf6d3c5Thomas Graf netdev->dcbnl_ops->setstate(netdev, value)); 7162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 7172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7187be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setpfccfg(struct net_device *netdev, struct nlmsghdr *nlh, 7197be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 7202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 7212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *data[DCB_PFC_UP_ATTR_MAX + 1]; 7222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 7233d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 7242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 value; 7252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7263d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_PFC_CFG]) 7273d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 7283d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 7293d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->setpfccfg) 7303d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 7312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(data, DCB_PFC_UP_ATTR_MAX, 7332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PFC_CFG], 7342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_pfc_up_nest); 7352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7363d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 7372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PFC_UP_ATTR_0; i <= DCB_PFC_UP_ATTR_7; i++) { 7392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (data[i] == NULL) 7402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 7412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck value = nla_get_u8(data[i]); 7422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpfccfg(netdev, 7432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data[i]->nla_type - DCB_PFC_UP_ATTR_0, value); 7442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 7452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7467be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_PFC_CFG, 0); 7472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 7482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7497be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setall(struct net_device *netdev, struct nlmsghdr *nlh, 7507be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 7512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 7523d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 7532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7543d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_SET_ALL]) 7553d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 7563d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 7573d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->setall) 7583d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 7592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7607be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, DCB_ATTR_SET_ALL, 7617be994138b188387691322921c08e19bddf6d3c5Thomas Graf netdev->dcbnl_ops->setall(netdev)); 762081579840b4b2421e37bc67e3b089b7ca64ef040John Fastabend dcbnl_cee_notify(netdev, RTM_SETDCB, DCB_CMD_SET_ALL, seq, 0); 7632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 7652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 7662f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7677be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int __dcbnl_pg_setcfg(struct net_device *netdev, struct nlmsghdr *nlh, 7687be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb, 7697be994138b188387691322921c08e19bddf6d3c5Thomas Graf int dir) 7702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 7712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *pg_tb[DCB_PG_ATTR_MAX + 1]; 7722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *param_tb[DCB_TC_ATTR_PARAM_MAX + 1]; 7733d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 7742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 7752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 pgid; 7762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 up_map; 7772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 prio; 7782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 tc_pct; 7792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7803d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_PG_CFG]) 7813d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 7823d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 7833d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->setpgtccfgtx || 7842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->setpgtccfgrx || 7852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->setpgbwgcfgtx || 7862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->setpgbwgcfgrx) 7873d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 7882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(pg_tb, DCB_PG_ATTR_MAX, 7902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PG_CFG], dcbnl_pg_nest); 7912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7923d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 7932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_TC_0; i <= DCB_PG_ATTR_TC_7; i++) { 7952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!pg_tb[i]) 7962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 7972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(param_tb, DCB_TC_ATTR_PARAM_MAX, 7992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pg_tb[i], dcbnl_tc_param_nest); 8002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 8013d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 8022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pgid = DCB_ATTR_VALUE_UNDEFINED; 8042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio = DCB_ATTR_VALUE_UNDEFINED; 8052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = DCB_ATTR_VALUE_UNDEFINED; 8062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck up_map = DCB_ATTR_VALUE_UNDEFINED; 8072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO]) 8092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio = 8102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO]); 8112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_PGID]) 8132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pgid = nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_PGID]); 8142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_BW_PCT]) 8162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_BW_PCT]); 8172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING]) 8192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck up_map = 8202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING]); 8212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* dir: Tx = 0, Rx = 1 */ 8232f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 8242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 8252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgtccfgrx(netdev, 8262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, 8272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio, pgid, tc_pct, up_map); 8282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 8292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 8302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgtccfgtx(netdev, 8312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, 8322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio, pgid, tc_pct, up_map); 8332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 8342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 8352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_BW_ID_0; i <= DCB_PG_ATTR_BW_ID_7; i++) { 8372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!pg_tb[i]) 8382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 8392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = nla_get_u8(pg_tb[i]); 8412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* dir: Tx = 0, Rx = 1 */ 8432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 8442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 8452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgbwgcfgrx(netdev, 8462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, tc_pct); 8472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 8482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 8492f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgbwgcfgtx(netdev, 8502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, tc_pct); 8512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 8522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 8532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 854bb1dfefdc62fa68107c4c9f1374cb856743a9434John Fastabend return nla_put_u8(skb, DCB_ATTR_PG_CFG, 0); 8552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 8562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8577be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_pgtx_setcfg(struct net_device *netdev, struct nlmsghdr *nlh, 8587be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 8592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 8607be994138b188387691322921c08e19bddf6d3c5Thomas Graf return __dcbnl_pg_setcfg(netdev, nlh, seq, tb, skb, 0); 8612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 8622f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8637be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_pgrx_setcfg(struct net_device *netdev, struct nlmsghdr *nlh, 8647be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 8652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 8667be994138b188387691322921c08e19bddf6d3c5Thomas Graf return __dcbnl_pg_setcfg(netdev, nlh, seq, tb, skb, 1); 8672f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 8682f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8697be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_bcn_getcfg(struct net_device *netdev, struct nlmsghdr *nlh, 8707be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 871859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck{ 872859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct nlattr *bcn_nest; 873859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct nlattr *bcn_tb[DCB_BCN_ATTR_MAX + 1]; 874859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u8 value_byte; 875859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u32 value_integer; 8763d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 877859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck bool getall = false; 878859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck int i; 879859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 8803d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_BCN]) 8813d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 8823d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 8833d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->getbcnrp || 884859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck !netdev->dcbnl_ops->getbcncfg) 8853d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 886859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 887859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = nla_parse_nested(bcn_tb, DCB_BCN_ATTR_MAX, 888859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck tb[DCB_ATTR_BCN], dcbnl_bcn_nest); 889859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 8903d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 891859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 8927be994138b188387691322921c08e19bddf6d3c5Thomas Graf bcn_nest = nla_nest_start(skb, DCB_ATTR_BCN); 893859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!bcn_nest) 8943d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 895859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 896859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (bcn_tb[DCB_BCN_ATTR_ALL]) 897859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck getall = true; 898859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 899859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck for (i = DCB_BCN_ATTR_RP_0; i <= DCB_BCN_ATTR_RP_7; i++) { 900859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!getall && !bcn_tb[i]) 901859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 902859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 903859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->getbcnrp(netdev, i - DCB_BCN_ATTR_RP_0, 904859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck &value_byte); 9057be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, i, value_byte); 906859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 907859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err_bcn; 908859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 909859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 910f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore for (i = DCB_BCN_ATTR_BCNA_0; i <= DCB_BCN_ATTR_RI; i++) { 911859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!getall && !bcn_tb[i]) 912859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 913859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 914859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->getbcncfg(netdev, i, 915859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck &value_integer); 9167be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u32(skb, i, value_integer); 917859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 918859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err_bcn; 919859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 920859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 9217be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, bcn_nest); 922859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 923859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck return 0; 924859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 925859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyckerr_bcn: 9267be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, bcn_nest); 927859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck return ret; 928859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck} 929859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 9307be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_bcn_setcfg(struct net_device *netdev, struct nlmsghdr *nlh, 9317be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 932859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck{ 933859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct nlattr *data[DCB_BCN_ATTR_MAX + 1]; 934859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck int i; 9353d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int ret; 936859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u8 value_byte; 937859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u32 value_int; 938859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 9393d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!tb[DCB_ATTR_BCN]) 9403d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EINVAL; 9413d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 9423d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops->setbcncfg || 943f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches !netdev->dcbnl_ops->setbcnrp) 9443d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 945859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 946859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = nla_parse_nested(data, DCB_BCN_ATTR_MAX, 947859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck tb[DCB_ATTR_BCN], 948859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck dcbnl_pfc_up_nest); 949859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 9503d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return ret; 951859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 952859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck for (i = DCB_BCN_ATTR_RP_0; i <= DCB_BCN_ATTR_RP_7; i++) { 953859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (data[i] == NULL) 954859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 955859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck value_byte = nla_get_u8(data[i]); 956859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->setbcnrp(netdev, 957859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck data[i]->nla_type - DCB_BCN_ATTR_RP_0, value_byte); 958859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 959859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 960f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore for (i = DCB_BCN_ATTR_BCNA_0; i <= DCB_BCN_ATTR_RI; i++) { 961859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (data[i] == NULL) 962859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 963859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck value_int = nla_get_u32(data[i]); 964859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->setbcncfg(netdev, 965859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck i, value_int); 966859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 967859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 9683d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return nla_put_u8(skb, DCB_ATTR_BCN, 0); 969859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck} 970859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 971dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravidstatic int dcbnl_build_peer_app(struct net_device *netdev, struct sk_buff* skb, 972dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid int app_nested_type, int app_info_type, 973dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid int app_entry_type) 974eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid{ 975eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid struct dcb_peer_app_info info; 976eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid struct dcb_app *table = NULL; 977eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 978eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid u16 app_count; 979eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid int err; 980eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 981eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 982eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid /** 983eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid * retrieve the peer app configuration form the driver. If the driver 984eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid * handlers fail exit without doing anything 985eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid */ 986eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid err = ops->peer_getappinfo(netdev, &info, &app_count); 987eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (!err && app_count) { 988eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid table = kmalloc(sizeof(struct dcb_app) * app_count, GFP_KERNEL); 989eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (!table) 990eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid return -ENOMEM; 991eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 992eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid err = ops->peer_getapptable(netdev, table); 993eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid } 994eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 995eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (!err) { 996eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid u16 i; 997eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid struct nlattr *app; 998eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 999eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid /** 1000eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid * build the message, from here on the only possible failure 1001eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid * is due to the skb size 1002eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid */ 1003eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid err = -EMSGSIZE; 1004eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 1005dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid app = nla_nest_start(skb, app_nested_type); 1006eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (!app) 1007eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid goto nla_put_failure; 1008eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 10091eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (app_info_type && 10101eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put(skb, app_info_type, sizeof(info), &info)) 10111eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller goto nla_put_failure; 1012eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 10131eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller for (i = 0; i < app_count; i++) { 10141eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (nla_put(skb, app_entry_type, sizeof(struct dcb_app), 10151eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller &table[i])) 10161eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller goto nla_put_failure; 10171eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller } 1018eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid nla_nest_end(skb, app); 1019eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid } 1020eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid err = 0; 1021eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 1022eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravidnla_put_failure: 1023eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid kfree(table); 1024eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid return err; 1025eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid} 10263e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 10273e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend/* Handle IEEE 802.1Qaz GET commands. */ 1028314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabendstatic int dcbnl_ieee_fill(struct sk_buff *skb, struct net_device *netdev) 10293e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend{ 10309ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct nlattr *ieee, *app; 10319ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *itr; 10323e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 1033c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend int dcbx; 10343d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int err; 10353e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 10361eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (nla_put_string(skb, DCB_ATTR_IFNAME, netdev->name)) 10373d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 10383d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf 10393e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend ieee = nla_nest_start(skb, DCB_ATTR_IEEE); 10403e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (!ieee) 10413d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 10423e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 10433e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (ops->ieee_getets) { 10443e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct ieee_ets ets; 10453e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend err = ops->ieee_getets(netdev, &ets); 10461eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (!err && 10471eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put(skb, DCB_ATTR_IEEE_ETS, sizeof(ets), &ets)) 10483d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 10493e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 10503e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 105108f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai if (ops->ieee_getmaxrate) { 105208f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai struct ieee_maxrate maxrate; 105308f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai err = ops->ieee_getmaxrate(netdev, &maxrate); 105408f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai if (!err) { 105508f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai err = nla_put(skb, DCB_ATTR_IEEE_MAXRATE, 105608f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai sizeof(maxrate), &maxrate); 105708f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai if (err) 10583d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 105908f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai } 106008f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai } 106108f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai 10623e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (ops->ieee_getpfc) { 10633e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct ieee_pfc pfc; 10643e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend err = ops->ieee_getpfc(netdev, &pfc); 10651eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (!err && 10661eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put(skb, DCB_ATTR_IEEE_PFC, sizeof(pfc), &pfc)) 10673d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 10683e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 10693e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 10709ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app = nla_nest_start(skb, DCB_ATTR_IEEE_APP_TABLE); 10719ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (!app) 10723d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 10739ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 10749ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 10759ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_for_each_entry(itr, &dcb_app_list, list) { 1076e290ed81307ca7d92675f0d9c683add693c2f377Mark Rustad if (itr->ifindex == netdev->ifindex) { 107770bfa2d2e1bfd90ef26758b5e2749f043a940037Dan Carpenter err = nla_put(skb, DCB_ATTR_IEEE_APP, sizeof(itr->app), 107870bfa2d2e1bfd90ef26758b5e2749f043a940037Dan Carpenter &itr->app); 107970bfa2d2e1bfd90ef26758b5e2749f043a940037Dan Carpenter if (err) { 108070bfa2d2e1bfd90ef26758b5e2749f043a940037Dan Carpenter spin_unlock(&dcb_lock); 10813d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 108270bfa2d2e1bfd90ef26758b5e2749f043a940037Dan Carpenter } 108370bfa2d2e1bfd90ef26758b5e2749f043a940037Dan Carpenter } 10849ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 1085c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend 1086c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend if (netdev->dcbnl_ops->getdcbx) 1087c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend dcbx = netdev->dcbnl_ops->getdcbx(netdev); 1088c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend else 1089c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend dcbx = -EOPNOTSUPP; 1090c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend 10919ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 10929ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend nla_nest_end(skb, app); 10939ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 1094eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid /* get peer info if available */ 1095eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (ops->ieee_peer_getets) { 1096eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid struct ieee_ets ets; 1097eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid err = ops->ieee_peer_getets(netdev, &ets); 10981eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (!err && 10991eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put(skb, DCB_ATTR_IEEE_PEER_ETS, sizeof(ets), &ets)) 11003d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 1101eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid } 1102eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 1103eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (ops->ieee_peer_getpfc) { 1104eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid struct ieee_pfc pfc; 1105eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid err = ops->ieee_peer_getpfc(netdev, &pfc); 11061eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (!err && 11071eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put(skb, DCB_ATTR_IEEE_PEER_PFC, sizeof(pfc), &pfc)) 11083d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 1109eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid } 1110eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 1111eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (ops->peer_getappinfo && ops->peer_getapptable) { 1112dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid err = dcbnl_build_peer_app(netdev, skb, 1113dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid DCB_ATTR_IEEE_PEER_APP, 1114dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid DCB_ATTR_IEEE_APP_UNSPEC, 1115dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid DCB_ATTR_IEEE_APP); 1116eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid if (err) 11173d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 1118eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid } 1119eed84713bc47ce2f7d675914f297ad9b6227a587Shmulik Ravid 11203e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nla_nest_end(skb, ieee); 1121c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend if (dcbx >= 0) { 1122c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend err = nla_put_u8(skb, DCB_ATTR_DCBX, dcbx); 1123c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend if (err) 11243d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 1125c7797baf9f3900996ca800ab6298f95957bb4606John Fastabend } 11263e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 1127314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend return 0; 11283e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend} 11293e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11305b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravidstatic int dcbnl_cee_pg_fill(struct sk_buff *skb, struct net_device *dev, 11315b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid int dir) 11325b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid{ 11335b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid u8 pgid, up_map, prio, tc_pct; 11345b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid const struct dcbnl_rtnl_ops *ops = dev->dcbnl_ops; 11355b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid int i = dir ? DCB_ATTR_CEE_TX_PG : DCB_ATTR_CEE_RX_PG; 11365b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct nlattr *pg = nla_nest_start(skb, i); 11375b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11385b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!pg) 11393d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 11405b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11415b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid for (i = DCB_PG_ATTR_TC_0; i <= DCB_PG_ATTR_TC_7; i++) { 11425b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct nlattr *tc_nest = nla_nest_start(skb, i); 11435b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11445b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!tc_nest) 11453d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 11465b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11475b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid pgid = DCB_ATTR_VALUE_UNDEFINED; 11485b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid prio = DCB_ATTR_VALUE_UNDEFINED; 11495b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid tc_pct = DCB_ATTR_VALUE_UNDEFINED; 11505b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid up_map = DCB_ATTR_VALUE_UNDEFINED; 11515b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11525b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!dir) 11535b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid ops->getpgtccfgrx(dev, i - DCB_PG_ATTR_TC_0, 11545b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid &prio, &pgid, &tc_pct, &up_map); 11555b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid else 11565b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid ops->getpgtccfgtx(dev, i - DCB_PG_ATTR_TC_0, 11575b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid &prio, &pgid, &tc_pct, &up_map); 11585b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11591eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (nla_put_u8(skb, DCB_TC_ATTR_PARAM_PGID, pgid) || 11601eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put_u8(skb, DCB_TC_ATTR_PARAM_UP_MAPPING, up_map) || 11611eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put_u8(skb, DCB_TC_ATTR_PARAM_STRICT_PRIO, prio) || 11621eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put_u8(skb, DCB_TC_ATTR_PARAM_BW_PCT, tc_pct)) 11633d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 11645b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid nla_nest_end(skb, tc_nest); 11655b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 11665b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11675b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid for (i = DCB_PG_ATTR_BW_ID_0; i <= DCB_PG_ATTR_BW_ID_7; i++) { 11685b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid tc_pct = DCB_ATTR_VALUE_UNDEFINED; 11695b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11705b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!dir) 11715b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid ops->getpgbwgcfgrx(dev, i - DCB_PG_ATTR_BW_ID_0, 11725b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid &tc_pct); 11735b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid else 11745b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid ops->getpgbwgcfgtx(dev, i - DCB_PG_ATTR_BW_ID_0, 11755b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid &tc_pct); 11761eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (nla_put_u8(skb, i, tc_pct)) 11773d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EMSGSIZE; 11785b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 11795b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid nla_nest_end(skb, pg); 11805b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid return 0; 11815b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid} 11825b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11835b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravidstatic int dcbnl_cee_fill(struct sk_buff *skb, struct net_device *netdev) 11845b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid{ 11855b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct nlattr *cee, *app; 11865b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct dcb_app_type *itr; 11875b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 11885b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid int dcbx, i, err = -EMSGSIZE; 11895b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid u8 value; 11905b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11911eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (nla_put_string(skb, DCB_ATTR_IFNAME, netdev->name)) 11921eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller goto nla_put_failure; 11935b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid cee = nla_nest_start(skb, DCB_ATTR_CEE); 11945b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!cee) 11955b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto nla_put_failure; 11965b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 11975b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid /* local pg */ 11985b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (ops->getpgtccfgtx && ops->getpgbwgcfgtx) { 11995b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = dcbnl_cee_pg_fill(skb, netdev, 1); 12005b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (err) 12015b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto nla_put_failure; 12025b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12035b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12045b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (ops->getpgtccfgrx && ops->getpgbwgcfgrx) { 12055b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = dcbnl_cee_pg_fill(skb, netdev, 0); 12065b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (err) 12075b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto nla_put_failure; 12085b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12095b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12105b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid /* local pfc */ 12115b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (ops->getpfccfg) { 12125b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct nlattr *pfc_nest = nla_nest_start(skb, DCB_ATTR_CEE_PFC); 12135b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12145b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!pfc_nest) 12155b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto nla_put_failure; 12165b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12175b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid for (i = DCB_PFC_UP_ATTR_0; i <= DCB_PFC_UP_ATTR_7; i++) { 12185b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid ops->getpfccfg(netdev, i - DCB_PFC_UP_ATTR_0, &value); 12191eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (nla_put_u8(skb, i, value)) 12201eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller goto nla_put_failure; 12215b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12225b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid nla_nest_end(skb, pfc_nest); 12235b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12245b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12255b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid /* local app */ 12265b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid spin_lock(&dcb_lock); 12275b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid app = nla_nest_start(skb, DCB_ATTR_CEE_APP_TABLE); 12285b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!app) 122940f5d72a4fc098c47068e3888cfb055922f6519fDan Carpenter goto dcb_unlock; 12305b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12315b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid list_for_each_entry(itr, &dcb_app_list, list) { 1232e290ed81307ca7d92675f0d9c683add693c2f377Mark Rustad if (itr->ifindex == netdev->ifindex) { 12335b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct nlattr *app_nest = nla_nest_start(skb, 12345b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid DCB_ATTR_APP); 12355b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!app_nest) 12365b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto dcb_unlock; 12375b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12385b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = nla_put_u8(skb, DCB_APP_ATTR_IDTYPE, 12395b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid itr->app.selector); 12405b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (err) 12415b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto dcb_unlock; 12425b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12435b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = nla_put_u16(skb, DCB_APP_ATTR_ID, 12445b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid itr->app.protocol); 12455b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (err) 12465b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto dcb_unlock; 12475b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12485b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = nla_put_u8(skb, DCB_APP_ATTR_PRIORITY, 12495b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid itr->app.priority); 12505b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (err) 12515b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto dcb_unlock; 12525b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12535b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid nla_nest_end(skb, app_nest); 12545b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12555b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12565b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid nla_nest_end(skb, app); 12575b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12585b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (netdev->dcbnl_ops->getdcbx) 12595b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid dcbx = netdev->dcbnl_ops->getdcbx(netdev); 12605b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid else 12615b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid dcbx = -EOPNOTSUPP; 12625b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12635b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid spin_unlock(&dcb_lock); 12645b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12655b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid /* features flags */ 12665b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (ops->getfeatcfg) { 12675b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct nlattr *feat = nla_nest_start(skb, DCB_ATTR_CEE_FEAT); 12685b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (!feat) 12695b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto nla_put_failure; 12705b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12715b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid for (i = DCB_FEATCFG_ATTR_ALL + 1; i <= DCB_FEATCFG_ATTR_MAX; 12725b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid i++) 12731eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (!ops->getfeatcfg(netdev, i, &value) && 12741eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put_u8(skb, i, value)) 12751eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller goto nla_put_failure; 12765b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12775b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid nla_nest_end(skb, feat); 12785b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12795b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12805b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid /* peer info if available */ 12815b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (ops->cee_peer_getpg) { 12825b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct cee_pg pg; 12835b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = ops->cee_peer_getpg(netdev, &pg); 12841eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (!err && 12851eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put(skb, DCB_ATTR_CEE_PEER_PG, sizeof(pg), &pg)) 12861eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller goto nla_put_failure; 12875b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12885b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12895b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (ops->cee_peer_getpfc) { 12905b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid struct cee_pfc pfc; 12915b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = ops->cee_peer_getpfc(netdev, &pfc); 12921eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller if (!err && 12931eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller nla_put(skb, DCB_ATTR_CEE_PEER_PFC, sizeof(pfc), &pfc)) 12941eb4c977778b5ab8e8fba9022687f0a5941d681aDavid S. Miller goto nla_put_failure; 12955b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 12965b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 12975b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (ops->peer_getappinfo && ops->peer_getapptable) { 12985b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = dcbnl_build_peer_app(netdev, skb, 12995b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid DCB_ATTR_CEE_PEER_APP_TABLE, 13005b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid DCB_ATTR_CEE_PEER_APP_INFO, 13015b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid DCB_ATTR_CEE_PEER_APP); 13025b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (err) 13035b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto nla_put_failure; 13045b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 13055b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid nla_nest_end(skb, cee); 13065b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 13075b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid /* DCBX state */ 13085b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (dcbx >= 0) { 13095b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = nla_put_u8(skb, DCB_ATTR_DCBX, dcbx); 13105b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (err) 13115b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid goto nla_put_failure; 13125b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid } 13135b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid return 0; 13145b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 13155b7f7626743e0912958981343b47ac0ab2206b1cShmulik Raviddcb_unlock: 13165b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid spin_unlock(&dcb_lock); 13175b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravidnla_put_failure: 13185b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid return err; 13195b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid} 13205b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 13215b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravidstatic int dcbnl_notify(struct net_device *dev, int event, int cmd, 132215e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman u32 seq, u32 portid, int dcbx_ver) 1323314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend{ 1324314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct net *net = dev_net(dev); 1325314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct sk_buff *skb; 1326314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct nlmsghdr *nlh; 1327314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend const struct dcbnl_rtnl_ops *ops = dev->dcbnl_ops; 1328314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend int err; 1329314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1330314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (!ops) 1331314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend return -EOPNOTSUPP; 1332314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 133315e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman skb = dcbnl_newmsg(event, cmd, portid, seq, 0, &nlh); 1334314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (!skb) 1335314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend return -ENOBUFS; 1336314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 13375b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid if (dcbx_ver == DCB_CAP_DCBX_VER_IEEE) 13385b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = dcbnl_ieee_fill(skb, dev); 13395b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid else 13405b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid err = dcbnl_cee_fill(skb, dev); 13415b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 1342314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (err < 0) { 1343314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend /* Report error to broadcast listeners */ 1344ab6d470735682a6e1ba889a66f56eb1640242096Thomas Graf nlmsg_free(skb); 1345314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend rtnl_set_sk_err(net, RTNLGRP_DCB, err); 1346314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend } else { 1347314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend /* End nlmsg and notify broadcast listeners */ 1348314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend nlmsg_end(skb, nlh); 1349314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend rtnl_notify(skb, net, 0, RTNLGRP_DCB, NULL, GFP_KERNEL); 1350314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend } 1351314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1352314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend return err; 1353314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend} 13545b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 13555b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravidint dcbnl_ieee_notify(struct net_device *dev, int event, int cmd, 135615e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman u32 seq, u32 portid) 13575b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid{ 135815e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman return dcbnl_notify(dev, event, cmd, seq, portid, DCB_CAP_DCBX_VER_IEEE); 13595b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid} 13605b7f7626743e0912958981343b47ac0ab2206b1cShmulik RavidEXPORT_SYMBOL(dcbnl_ieee_notify); 13615b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid 13625b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravidint dcbnl_cee_notify(struct net_device *dev, int event, int cmd, 136315e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman u32 seq, u32 portid) 13645b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid{ 136515e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman return dcbnl_notify(dev, event, cmd, seq, portid, DCB_CAP_DCBX_VER_CEE); 13665b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid} 13675b7f7626743e0912958981343b47ac0ab2206b1cShmulik RavidEXPORT_SYMBOL(dcbnl_cee_notify); 1368314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1369314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend/* Handle IEEE 802.1Qaz SET commands. If any requested operation can not 1370314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend * be completed the entire msg is aborted and error value is returned. 1371314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend * No attempt is made to reconcile the case where only part of the 1372314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend * cmd can be completed. 1373314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend */ 13747be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_ieee_set(struct net_device *netdev, struct nlmsghdr *nlh, 13757be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 1376314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend{ 1377314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 1378314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct nlattr *ieee[DCB_ATTR_IEEE_MAX + 1]; 13793d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int err; 1380314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1381314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (!ops) 13823d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -EOPNOTSUPP; 1383314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 13844003b65871c101eb5ce8f37a325feac54aa5c681John Fastabend if (!tb[DCB_ATTR_IEEE]) 13854003b65871c101eb5ce8f37a325feac54aa5c681John Fastabend return -EINVAL; 13864003b65871c101eb5ce8f37a325feac54aa5c681John Fastabend 1387314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend err = nla_parse_nested(ieee, DCB_ATTR_IEEE_MAX, 1388314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend tb[DCB_ATTR_IEEE], dcbnl_ieee_policy); 1389314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (err) 1390314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend return err; 1391314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1392314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (ieee[DCB_ATTR_IEEE_ETS] && ops->ieee_setets) { 1393314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct ieee_ets *ets = nla_data(ieee[DCB_ATTR_IEEE_ETS]); 1394314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend err = ops->ieee_setets(netdev, ets); 1395314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (err) 1396314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend goto err; 1397314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend } 1398314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 139908f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai if (ieee[DCB_ATTR_IEEE_MAXRATE] && ops->ieee_setmaxrate) { 140008f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai struct ieee_maxrate *maxrate = 140108f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai nla_data(ieee[DCB_ATTR_IEEE_MAXRATE]); 140208f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai err = ops->ieee_setmaxrate(netdev, maxrate); 140308f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai if (err) 140408f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai goto err; 140508f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai } 140608f10affe45051e18e0d8291c0a53aecef1b8a14Amir Vadai 1407314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (ieee[DCB_ATTR_IEEE_PFC] && ops->ieee_setpfc) { 1408314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct ieee_pfc *pfc = nla_data(ieee[DCB_ATTR_IEEE_PFC]); 1409314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend err = ops->ieee_setpfc(netdev, pfc); 1410314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (err) 1411314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend goto err; 1412314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend } 1413314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1414314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (ieee[DCB_ATTR_IEEE_APP_TABLE]) { 1415314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct nlattr *attr; 1416314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend int rem; 1417314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1418314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend nla_for_each_nested(attr, ieee[DCB_ATTR_IEEE_APP_TABLE], rem) { 1419314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend struct dcb_app *app_data; 1420314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (nla_type(attr) != DCB_ATTR_IEEE_APP) 1421314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend continue; 1422314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend app_data = nla_data(attr); 1423314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (ops->ieee_setapp) 1424314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend err = ops->ieee_setapp(netdev, app_data); 1425314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend else 1426b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend err = dcb_ieee_setapp(netdev, app_data); 1427314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (err) 1428314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend goto err; 1429314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend } 1430314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend } 1431314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1432314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabenderr: 14337be994138b188387691322921c08e19bddf6d3c5Thomas Graf err = nla_put_u8(skb, DCB_ATTR_IEEE, err); 14345b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid dcbnl_ieee_notify(netdev, RTM_SETDCB, DCB_CMD_IEEE_SET, seq, 0); 1435314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend return err; 1436314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend} 1437314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 14387be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_ieee_get(struct net_device *netdev, struct nlmsghdr *nlh, 14397be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 1440314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend{ 1441314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 1442314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 1443314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend if (!ops) 1444314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend return -EOPNOTSUPP; 1445314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend 14467be994138b188387691322921c08e19bddf6d3c5Thomas Graf return dcbnl_ieee_fill(skb, netdev); 1447314b4778ed579f29b6d46ba90dbf31314c13805fJohn Fastabend} 1448f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 14497be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_ieee_del(struct net_device *netdev, struct nlmsghdr *nlh, 14507be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 1451f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend{ 1452f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 1453f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend struct nlattr *ieee[DCB_ATTR_IEEE_MAX + 1]; 14543d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf int err; 1455f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1456f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (!ops) 1457f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend return -EOPNOTSUPP; 1458f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1459f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (!tb[DCB_ATTR_IEEE]) 1460f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend return -EINVAL; 1461f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1462f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend err = nla_parse_nested(ieee, DCB_ATTR_IEEE_MAX, 1463f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend tb[DCB_ATTR_IEEE], dcbnl_ieee_policy); 1464f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (err) 1465f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend return err; 1466f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1467f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (ieee[DCB_ATTR_IEEE_APP_TABLE]) { 1468f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend struct nlattr *attr; 1469f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend int rem; 1470f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1471f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend nla_for_each_nested(attr, ieee[DCB_ATTR_IEEE_APP_TABLE], rem) { 1472f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend struct dcb_app *app_data; 1473f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1474f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (nla_type(attr) != DCB_ATTR_IEEE_APP) 1475f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend continue; 1476f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend app_data = nla_data(attr); 1477f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (ops->ieee_delapp) 1478f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend err = ops->ieee_delapp(netdev, app_data); 1479f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend else 1480f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend err = dcb_ieee_delapp(netdev, app_data); 1481f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (err) 1482f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend goto err; 1483f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend } 1484f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend } 1485f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1486f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabenderr: 14877be994138b188387691322921c08e19bddf6d3c5Thomas Graf err = nla_put_u8(skb, DCB_ATTR_IEEE, err); 14885b7f7626743e0912958981343b47ac0ab2206b1cShmulik Ravid dcbnl_ieee_notify(netdev, RTM_SETDCB, DCB_CMD_IEEE_DEL, seq, 0); 1489f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend return err; 1490f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend} 1491f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1492f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 14936241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid/* DCBX configuration */ 14947be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getdcbx(struct net_device *netdev, struct nlmsghdr *nlh, 14957be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 14966241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid{ 14976241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid if (!netdev->dcbnl_ops->getdcbx) 14987f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid return -EOPNOTSUPP; 14996241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid 15007be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_DCBX, 15017be994138b188387691322921c08e19bddf6d3c5Thomas Graf netdev->dcbnl_ops->getdcbx(netdev)); 15026241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid} 15036241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid 15047be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setdcbx(struct net_device *netdev, struct nlmsghdr *nlh, 15057be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 15066241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid{ 15076241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid u8 value; 15086241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid 15097f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (!netdev->dcbnl_ops->setdcbx) 15107f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid return -EOPNOTSUPP; 15117f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid 15127f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (!tb[DCB_ATTR_DCBX]) 15137f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid return -EINVAL; 15146241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid 15156241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid value = nla_get_u8(tb[DCB_ATTR_DCBX]); 15166241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid 15177be994138b188387691322921c08e19bddf6d3c5Thomas Graf return nla_put_u8(skb, DCB_ATTR_DCBX, 15187be994138b188387691322921c08e19bddf6d3c5Thomas Graf netdev->dcbnl_ops->setdcbx(netdev, value)); 15196241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid} 15206241b6259b16aa390ff4bf50f520685b3801200bShmulik Ravid 15217be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_getfeatcfg(struct net_device *netdev, struct nlmsghdr *nlh, 15227be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 1523ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid{ 1524ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid struct nlattr *data[DCB_FEATCFG_ATTR_MAX + 1], *nest; 1525ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid u8 value; 15267f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid int ret, i; 1527ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid int getall = 0; 1528ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 15297f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (!netdev->dcbnl_ops->getfeatcfg) 15307f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid return -EOPNOTSUPP; 15317f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid 15327f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (!tb[DCB_ATTR_FEATCFG]) 15337f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid return -EINVAL; 1534ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1535ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid ret = nla_parse_nested(data, DCB_FEATCFG_ATTR_MAX, tb[DCB_ATTR_FEATCFG], 1536ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid dcbnl_featcfg_nest); 15377f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (ret) 15387be994138b188387691322921c08e19bddf6d3c5Thomas Graf return ret; 1539ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 15407be994138b188387691322921c08e19bddf6d3c5Thomas Graf nest = nla_nest_start(skb, DCB_ATTR_FEATCFG); 15417be994138b188387691322921c08e19bddf6d3c5Thomas Graf if (!nest) 15427be994138b188387691322921c08e19bddf6d3c5Thomas Graf return -EMSGSIZE; 1543ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1544ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid if (data[DCB_FEATCFG_ATTR_ALL]) 1545ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid getall = 1; 1546ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1547ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid for (i = DCB_FEATCFG_ATTR_ALL+1; i <= DCB_FEATCFG_ATTR_MAX; i++) { 1548ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid if (!getall && !data[i]) 1549ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid continue; 1550ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1551ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid ret = netdev->dcbnl_ops->getfeatcfg(netdev, i, &value); 15527f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (!ret) 15537be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, i, value); 1554ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 15557f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (ret) { 15567be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_cancel(skb, nest); 15577f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid goto nla_put_failure; 15587f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid } 1559ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid } 15607be994138b188387691322921c08e19bddf6d3c5Thomas Graf nla_nest_end(skb, nest); 1561ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 15627f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravidnla_put_failure: 1563ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid return ret; 1564ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid} 1565ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 15667be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_setfeatcfg(struct net_device *netdev, struct nlmsghdr *nlh, 15677be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 1568ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid{ 1569ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid struct nlattr *data[DCB_FEATCFG_ATTR_MAX + 1]; 15707f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid int ret, i; 1571ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid u8 value; 1572ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 15737f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (!netdev->dcbnl_ops->setfeatcfg) 15747f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid return -ENOTSUPP; 15757f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid 15767f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (!tb[DCB_ATTR_FEATCFG]) 15777f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid return -EINVAL; 1578ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1579ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid ret = nla_parse_nested(data, DCB_FEATCFG_ATTR_MAX, tb[DCB_ATTR_FEATCFG], 1580ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid dcbnl_featcfg_nest); 1581ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 15827f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid if (ret) 1583ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid goto err; 1584ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1585ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid for (i = DCB_FEATCFG_ATTR_ALL+1; i <= DCB_FEATCFG_ATTR_MAX; i++) { 1586ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid if (data[i] == NULL) 1587ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid continue; 1588ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1589ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid value = nla_get_u8(data[i]); 1590ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1591ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid ret = netdev->dcbnl_ops->setfeatcfg(netdev, i, value); 1592ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1593ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid if (ret) 15947f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid goto err; 1595ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid } 1596ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Raviderr: 15977be994138b188387691322921c08e19bddf6d3c5Thomas Graf ret = nla_put_u8(skb, DCB_ATTR_FEATCFG, ret); 15987f891cf1fc0d5d5c5b359caec77e5383e1d55986Shmulik Ravid 1599ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid return ret; 1600ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid} 1601ea45fe4e176a42d2396878f530cfdc8265bef37bShmulik Ravid 1602dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid/* Handle CEE DCBX GET commands. */ 16037be994138b188387691322921c08e19bddf6d3c5Thomas Grafstatic int dcbnl_cee_get(struct net_device *netdev, struct nlmsghdr *nlh, 16047be994138b188387691322921c08e19bddf6d3c5Thomas Graf u32 seq, struct nlattr **tb, struct sk_buff *skb) 1605dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid{ 1606dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 1607dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid 1608dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid if (!ops) 1609dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid return -EOPNOTSUPP; 1610dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid 16117be994138b188387691322921c08e19bddf6d3c5Thomas Graf return dcbnl_cee_fill(skb, netdev); 1612dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid} 1613dc6ed1df5a5f84e45e77e2acb6fd99b995414956Shmulik Ravid 161433a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Grafstruct reply_func { 161533a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf /* reply netlink message type */ 161633a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf int type; 161733a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 161833a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf /* function to fill message contents */ 161933a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf int (*cb)(struct net_device *, struct nlmsghdr *, u32, 162033a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf struct nlattr **, struct sk_buff *); 162133a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf}; 162233a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 162333a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Grafstatic const struct reply_func reply_funcs[DCB_CMD_MAX+1] = { 16247be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_GSTATE] = { RTM_GETDCB, dcbnl_getstate }, 16257be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_SSTATE] = { RTM_SETDCB, dcbnl_setstate }, 16267be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PFC_GCFG] = { RTM_GETDCB, dcbnl_getpfccfg }, 16277be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PFC_SCFG] = { RTM_SETDCB, dcbnl_setpfccfg }, 16287be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_GPERM_HWADDR] = { RTM_GETDCB, dcbnl_getperm_hwaddr }, 16297be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_GCAP] = { RTM_GETDCB, dcbnl_getcap }, 16307be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_GNUMTCS] = { RTM_GETDCB, dcbnl_getnumtcs }, 16317be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_SNUMTCS] = { RTM_SETDCB, dcbnl_setnumtcs }, 16327be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PFC_GSTATE] = { RTM_GETDCB, dcbnl_getpfcstate }, 16337be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PFC_SSTATE] = { RTM_SETDCB, dcbnl_setpfcstate }, 16347be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_GAPP] = { RTM_GETDCB, dcbnl_getapp }, 16357be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_SAPP] = { RTM_SETDCB, dcbnl_setapp }, 16367be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PGTX_GCFG] = { RTM_GETDCB, dcbnl_pgtx_getcfg }, 16377be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PGTX_SCFG] = { RTM_SETDCB, dcbnl_pgtx_setcfg }, 16387be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PGRX_GCFG] = { RTM_GETDCB, dcbnl_pgrx_getcfg }, 16397be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_PGRX_SCFG] = { RTM_SETDCB, dcbnl_pgrx_setcfg }, 16407be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_SET_ALL] = { RTM_SETDCB, dcbnl_setall }, 16417be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_BCN_GCFG] = { RTM_GETDCB, dcbnl_bcn_getcfg }, 16427be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_BCN_SCFG] = { RTM_SETDCB, dcbnl_bcn_setcfg }, 16437be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_IEEE_GET] = { RTM_GETDCB, dcbnl_ieee_get }, 16447be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_IEEE_SET] = { RTM_SETDCB, dcbnl_ieee_set }, 16457be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_IEEE_DEL] = { RTM_SETDCB, dcbnl_ieee_del }, 16467be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_GDCBX] = { RTM_GETDCB, dcbnl_getdcbx }, 16477be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_SDCBX] = { RTM_SETDCB, dcbnl_setdcbx }, 16487be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_GFEATCFG] = { RTM_GETDCB, dcbnl_getfeatcfg }, 16497be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_SFEATCFG] = { RTM_SETDCB, dcbnl_setfeatcfg }, 16507be994138b188387691322921c08e19bddf6d3c5Thomas Graf [DCB_CMD_CEE_GET] = { RTM_GETDCB, dcbnl_cee_get }, 165133a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf}; 165233a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 16532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcb_doit(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) 16542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 16552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct net *net = sock_net(skb->sk); 16562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct net_device *netdev; 16577a282bc37f8a1e7b46907d78724177d20214b137Thomas Graf struct dcbmsg *dcb = nlmsg_data(nlh); 16582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *tb[DCB_ATTR_MAX + 1]; 165915e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman u32 portid = skb ? NETLINK_CB(skb).portid : 0; 16602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 166133a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf struct sk_buff *reply_skb; 166239912f9cf9603f0de085fb5ba916a7a88010ccd9Thomas Graf struct nlmsghdr *reply_nlh = NULL; 166333a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf const struct reply_func *fn; 16642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 1665dfc47ef8639facd77210e74be831943c2fdd9c74Eric W. Biederman if ((nlh->nlmsg_type == RTM_SETDCB) && !capable(CAP_NET_ADMIN)) 1666dfc47ef8639facd77210e74be831943c2fdd9c74Eric W. Biederman return -EPERM; 1667dfc47ef8639facd77210e74be831943c2fdd9c74Eric W. Biederman 16682f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nlmsg_parse(nlh, sizeof(*dcb), tb, DCB_ATTR_MAX, 16692f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_rtnl_policy); 16702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret < 0) 16712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 16722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 167333a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf if (dcb->cmd > DCB_CMD_MAX) 167433a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf return -EINVAL; 167533a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 167633a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf /* check if a reply function has been defined for the command */ 167733a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf fn = &reply_funcs[dcb->cmd]; 167833a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf if (!fn->cb) 167933a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf return -EOPNOTSUPP; 168033a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 16812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_IFNAME]) 16822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return -EINVAL; 16832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 16847c77ab24e30bad7598b5cfda93be6f32ed439c2fJohn Fastabend netdev = dev_get_by_name(net, nla_data(tb[DCB_ATTR_IFNAME])); 16852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!netdev) 16863d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf return -ENODEV; 16872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 16883d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf if (!netdev->dcbnl_ops) { 16893d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf ret = -EOPNOTSUPP; 16903d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf goto out; 16913d1f486952b750f1cca53cf22d4f769db5aba4f0Thomas Graf } 16922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 169315e473046cb6e5d18a4d0057e61d76315230382bEric W. Biederman reply_skb = dcbnl_newmsg(fn->type, dcb->cmd, portid, nlh->nlmsg_seq, 169433a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf nlh->nlmsg_flags, &reply_nlh); 169533a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf if (!reply_skb) { 169633a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf ret = -ENOBUFS; 169733a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf goto out; 169833a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf } 169933a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 170033a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf ret = fn->cb(netdev, nlh, nlh->nlmsg_seq, tb, reply_skb); 170133a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf if (ret < 0) { 170233a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf nlmsg_free(reply_skb); 170333a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf goto out; 170433a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf } 170533a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 170633a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf nlmsg_end(reply_skb, reply_nlh); 170733a03aadb52fa05d28aba6d8f0c03c7b3b905897Thomas Graf 17087c77ab24e30bad7598b5cfda93be6f32ed439c2fJohn Fastabend ret = rtnl_unicast(reply_skb, net, portid); 17092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckout: 17102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dev_put(netdev); 17112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 17122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 17132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 1714716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Grafstatic struct dcb_app_type *dcb_app_lookup(const struct dcb_app *app, 1715716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf int ifindex, int prio) 1716716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf{ 1717716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf struct dcb_app_type *itr; 1718716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf 1719716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf list_for_each_entry(itr, &dcb_app_list, list) { 1720716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf if (itr->app.selector == app->selector && 1721716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf itr->app.protocol == app->protocol && 1722716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf itr->ifindex == ifindex && 1723716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf (!prio || itr->app.priority == prio)) 1724716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf return itr; 1725716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf } 1726716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf 1727716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf return NULL; 1728716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf} 1729716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf 17304e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Grafstatic int dcb_app_add(const struct dcb_app *app, int ifindex) 17314e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf{ 17324e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf struct dcb_app_type *entry; 17334e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf 17344e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf entry = kmalloc(sizeof(*entry), GFP_ATOMIC); 17354e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf if (!entry) 17364e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf return -ENOMEM; 17374e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf 17384e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf memcpy(&entry->app, app, sizeof(*app)); 17394e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf entry->ifindex = ifindex; 17404e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf list_add(&entry->list, &dcb_app_list); 17414e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf 17424e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf return 0; 17434e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf} 17444e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf 17459ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend/** 17469ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * dcb_getapp - retrieve the DCBX application user priority 17479ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * 17489ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * On success returns a non-zero 802.1p user priority bitmap 17499ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * otherwise returns 0 as the invalid user priority bitmap to 17509ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * indicate an error. 17519ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend */ 17529ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendu8 dcb_getapp(struct net_device *dev, struct dcb_app *app) 17539ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend{ 17549ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *itr; 17559ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend u8 prio = 0; 17569ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 17579ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 1758716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf if ((itr = dcb_app_lookup(app, dev->ifindex, 0))) 1759716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf prio = itr->app.priority; 17609ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 17619ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 17629ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend return prio; 17639ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend} 17649ab933ab2cc80f04690d6aa385b1110075c5e507John FastabendEXPORT_SYMBOL(dcb_getapp); 17659ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 17669ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend/** 1767b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * dcb_setapp - add CEE dcb application data to app list 17689ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * 1769b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * Priority 0 is an invalid priority in CEE spec. This routine 1770b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * removes applications from the app list if the priority is 1771b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * set to zero. 17729ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend */ 1773ab6baf980b095c70a56c5eb2f58166aef8a0edc8John Fastabendint dcb_setapp(struct net_device *dev, struct dcb_app *new) 17749ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend{ 17759ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *itr; 17767ec79270d7de0c8ca602c47cb25a9652ec28f37fJohn Fastabend struct dcb_app_type event; 17774e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf int err = 0; 17787ec79270d7de0c8ca602c47cb25a9652ec28f37fJohn Fastabend 1779e290ed81307ca7d92675f0d9c683add693c2f377Mark Rustad event.ifindex = dev->ifindex; 17807ec79270d7de0c8ca602c47cb25a9652ec28f37fJohn Fastabend memcpy(&event.app, new, sizeof(event.app)); 17816bd0e1cb10b6d14dda4a8806d0a2f4f0bbf01931John Fastabend if (dev->dcbnl_ops->getdcbx) 17826bd0e1cb10b6d14dda4a8806d0a2f4f0bbf01931John Fastabend event.dcbx = dev->dcbnl_ops->getdcbx(dev); 17839ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 17849ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 17859ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend /* Search for existing match and replace */ 1786716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf if ((itr = dcb_app_lookup(new, dev->ifindex, 0))) { 1787716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf if (new->priority) 1788716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf itr->app.priority = new->priority; 1789716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf else { 1790716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf list_del(&itr->list); 1791716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf kfree(itr); 17929ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 1793716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf goto out; 17949ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 17959ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend /* App type does not exist add new application type */ 17964e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf if (new->priority) 17974e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf err = dcb_app_add(new, dev->ifindex); 17989ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendout: 17999ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 18004e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf if (!err) 18014e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf call_dcbevent_notifiers(DCB_APP_EVENT, &event); 18024e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf return err; 18039ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend} 18049ab933ab2cc80f04690d6aa385b1110075c5e507John FastabendEXPORT_SYMBOL(dcb_setapp); 18059ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 1806b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend/** 1807a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend * dcb_ieee_getapp_mask - retrieve the IEEE DCB application priority 1808a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend * 1809a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend * Helper routine which on success returns a non-zero 802.1Qaz user 1810a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend * priority bitmap otherwise returns 0 to indicate the dcb_app was 1811a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend * not found in APP list. 1812a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend */ 1813a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabendu8 dcb_ieee_getapp_mask(struct net_device *dev, struct dcb_app *app) 1814a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend{ 1815a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend struct dcb_app_type *itr; 1816a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend u8 prio = 0; 1817a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend 1818a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend spin_lock(&dcb_lock); 1819716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf if ((itr = dcb_app_lookup(app, dev->ifindex, 0))) 1820716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf prio |= 1 << itr->app.priority; 1821a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend spin_unlock(&dcb_lock); 1822a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend 1823a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend return prio; 1824a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend} 1825a364c8cf80251849bab207be8c9e66253c8ca8f8John FastabendEXPORT_SYMBOL(dcb_ieee_getapp_mask); 1826a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend 1827a364c8cf80251849bab207be8c9e66253c8ca8f8John Fastabend/** 1828b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * dcb_ieee_setapp - add IEEE dcb application data to app list 1829b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * 1830b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * This adds Application data to the list. Multiple application 1831b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * entries may exists for the same selector and protocol as long 1832b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend * as the priorities are different. 1833b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend */ 1834b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabendint dcb_ieee_setapp(struct net_device *dev, struct dcb_app *new) 1835b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend{ 1836b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend struct dcb_app_type event; 1837b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend int err = 0; 1838b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend 1839e290ed81307ca7d92675f0d9c683add693c2f377Mark Rustad event.ifindex = dev->ifindex; 1840b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend memcpy(&event.app, new, sizeof(event.app)); 18416bd0e1cb10b6d14dda4a8806d0a2f4f0bbf01931John Fastabend if (dev->dcbnl_ops->getdcbx) 18426bd0e1cb10b6d14dda4a8806d0a2f4f0bbf01931John Fastabend event.dcbx = dev->dcbnl_ops->getdcbx(dev); 1843b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend 1844b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend spin_lock(&dcb_lock); 1845b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend /* Search for existing match and abort if found */ 1846716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf if (dcb_app_lookup(new, dev->ifindex, new->priority)) { 1847716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf err = -EEXIST; 1848716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf goto out; 1849b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend } 1850b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend 18514e4f2f69704be0ae218d91fb827e5a6987fe262fThomas Graf err = dcb_app_add(new, dev->ifindex); 1852b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabendout: 1853b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend spin_unlock(&dcb_lock); 1854b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend if (!err) 1855b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend call_dcbevent_notifiers(DCB_APP_EVENT, &event); 1856b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend return err; 1857b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend} 1858b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John FastabendEXPORT_SYMBOL(dcb_ieee_setapp); 1859b6db2174c59ef1e72f7bd63e0f105b1a2d7f18d3John Fastabend 1860f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend/** 1861f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend * dcb_ieee_delapp - delete IEEE dcb application data from list 1862f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend * 1863f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend * This removes a matching APP data from the APP list 1864f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend */ 1865f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabendint dcb_ieee_delapp(struct net_device *dev, struct dcb_app *del) 1866f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend{ 1867f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend struct dcb_app_type *itr; 1868f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend struct dcb_app_type event; 1869f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend int err = -ENOENT; 1870f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1871e290ed81307ca7d92675f0d9c683add693c2f377Mark Rustad event.ifindex = dev->ifindex; 1872f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend memcpy(&event.app, del, sizeof(event.app)); 18736bd0e1cb10b6d14dda4a8806d0a2f4f0bbf01931John Fastabend if (dev->dcbnl_ops->getdcbx) 18746bd0e1cb10b6d14dda4a8806d0a2f4f0bbf01931John Fastabend event.dcbx = dev->dcbnl_ops->getdcbx(dev); 1875f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1876f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend spin_lock(&dcb_lock); 1877f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend /* Search for existing match and remove it. */ 1878716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf if ((itr = dcb_app_lookup(del, dev->ifindex, del->priority))) { 1879716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf list_del(&itr->list); 1880716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf kfree(itr); 1881716b31abbd39baab307c0a7b38dce9a20c16c62dThomas Graf err = 0; 1882f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend } 1883f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 1884f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend spin_unlock(&dcb_lock); 1885f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend if (!err) 1886f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend call_dcbevent_notifiers(DCB_APP_EVENT, &event); 1887f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend return err; 1888f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend} 1889f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John FastabendEXPORT_SYMBOL(dcb_ieee_delapp); 1890f9ae7e4b515c4d56baf6e0e84ebee2e03ae57a25John Fastabend 18917c14c3f10e6dcd7f70e49f77b6e1ae605c4861e6Shmulik Ravidstatic void dcb_flushapp(void) 18929ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend{ 18939ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *app; 18942a8fe003741aa90b6b9453e90af4bbb7bc42918cDan Carpenter struct dcb_app_type *tmp; 18959ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 18969ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 18972a8fe003741aa90b6b9453e90af4bbb7bc42918cDan Carpenter list_for_each_entry_safe(app, tmp, &dcb_app_list, list) { 18989ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_del(&app->list); 18999ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend kfree(app); 19009ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 19019ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 19029ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend} 19039ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 19042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int __init dcbnl_init(void) 19052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 19069ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend INIT_LIST_HEAD(&dcb_app_list); 19079ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 1908c7ac8679bec9397afe8918f788cbcef88c38da54Greg Rose rtnl_register(PF_UNSPEC, RTM_GETDCB, dcb_doit, NULL, NULL); 1909c7ac8679bec9397afe8918f788cbcef88c38da54Greg Rose rtnl_register(PF_UNSPEC, RTM_SETDCB, dcb_doit, NULL, NULL); 19102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 19112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 19122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 19132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckmodule_init(dcbnl_init); 19142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 19152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic void __exit dcbnl_exit(void) 19162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 19172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck rtnl_unregister(PF_UNSPEC, RTM_GETDCB); 19182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck rtnl_unregister(PF_UNSPEC, RTM_SETDCB); 19199ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend dcb_flushapp(); 19202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 19212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckmodule_exit(dcbnl_exit); 1922