dcbnl.c revision 96b99684e365f28d49bdb1221ca022b75cb91a98
12f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* 22f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * Copyright (c) 2008, 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> 282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck#include <net/sock.h> 292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/** 312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck * 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}, 712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* DCB priority flow control to User Priority nested attributes */ 74b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_pfc_up_nest[DCB_PFC_UP_ATTR_MAX + 1] = { 752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_0] = {.type = NLA_U8}, 762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_1] = {.type = NLA_U8}, 772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_2] = {.type = NLA_U8}, 782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_3] = {.type = NLA_U8}, 792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_4] = {.type = NLA_U8}, 802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_5] = {.type = NLA_U8}, 812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_6] = {.type = NLA_U8}, 822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_7] = {.type = NLA_U8}, 832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PFC_UP_ATTR_ALL] = {.type = NLA_FLAG}, 842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* DCB priority grouping nested attributes */ 87b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_pg_nest[DCB_PG_ATTR_MAX + 1] = { 882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_0] = {.type = NLA_NESTED}, 892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_1] = {.type = NLA_NESTED}, 902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_2] = {.type = NLA_NESTED}, 912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_3] = {.type = NLA_NESTED}, 922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_4] = {.type = NLA_NESTED}, 932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_5] = {.type = NLA_NESTED}, 942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_6] = {.type = NLA_NESTED}, 952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_7] = {.type = NLA_NESTED}, 962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_TC_ALL] = {.type = NLA_NESTED}, 972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_0] = {.type = NLA_U8}, 982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_1] = {.type = NLA_U8}, 992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_2] = {.type = NLA_U8}, 1002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_3] = {.type = NLA_U8}, 1012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_4] = {.type = NLA_U8}, 1022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_5] = {.type = NLA_U8}, 1032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_6] = {.type = NLA_U8}, 1042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_7] = {.type = NLA_U8}, 1052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_PG_ATTR_BW_ID_ALL] = {.type = NLA_FLAG}, 1062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 1072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 1082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* DCB traffic class nested attributes. */ 109b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_tc_param_nest[DCB_TC_ATTR_PARAM_MAX + 1] = { 1102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_PGID] = {.type = NLA_U8}, 1112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_UP_MAPPING] = {.type = NLA_U8}, 1122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_STRICT_PRIO] = {.type = NLA_U8}, 1132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_BW_PCT] = {.type = NLA_U8}, 1142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck [DCB_TC_ATTR_PARAM_ALL] = {.type = NLA_FLAG}, 1152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck}; 1162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 11746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck/* DCB capabilities nested attributes. */ 118b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_cap_nest[DCB_CAP_ATTR_MAX + 1] = { 11946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_ALL] = {.type = NLA_FLAG}, 12046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PG] = {.type = NLA_U8}, 12146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PFC] = {.type = NLA_U8}, 12246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_UP2TC] = {.type = NLA_U8}, 12346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PG_TCS] = {.type = NLA_U8}, 12446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_PFC_TCS] = {.type = NLA_U8}, 12546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_GSP] = {.type = NLA_U8}, 12646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck [DCB_CAP_ATTR_BCN] = {.type = NLA_U8}, 12746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck}; 1282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 12933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck/* DCB capabilities nested attributes. */ 130b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_numtcs_nest[DCB_NUMTCS_ATTR_MAX + 1] = { 13133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck [DCB_NUMTCS_ATTR_ALL] = {.type = NLA_FLAG}, 13233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck [DCB_NUMTCS_ATTR_PG] = {.type = NLA_U8}, 13333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck [DCB_NUMTCS_ATTR_PFC] = {.type = NLA_U8}, 13433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck}; 13533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 136859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck/* DCB BCN nested attributes. */ 137b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_bcn_nest[DCB_BCN_ATTR_MAX + 1] = { 138859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_0] = {.type = NLA_U8}, 139859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_1] = {.type = NLA_U8}, 140859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_2] = {.type = NLA_U8}, 141859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_3] = {.type = NLA_U8}, 142859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_4] = {.type = NLA_U8}, 143859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_5] = {.type = NLA_U8}, 144859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_6] = {.type = NLA_U8}, 145859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_7] = {.type = NLA_U8}, 146859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RP_ALL] = {.type = NLA_FLAG}, 147f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore [DCB_BCN_ATTR_BCNA_0] = {.type = NLA_U32}, 148f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore [DCB_BCN_ATTR_BCNA_1] = {.type = NLA_U32}, 149859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_ALPHA] = {.type = NLA_U32}, 150859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_BETA] = {.type = NLA_U32}, 151859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_GD] = {.type = NLA_U32}, 152859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_GI] = {.type = NLA_U32}, 153859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_TMAX] = {.type = NLA_U32}, 154859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_TD] = {.type = NLA_U32}, 155859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RMIN] = {.type = NLA_U32}, 156859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_W] = {.type = NLA_U32}, 157859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RD] = {.type = NLA_U32}, 158859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RU] = {.type = NLA_U32}, 159859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_WRTT] = {.type = NLA_U32}, 160859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_RI] = {.type = NLA_U32}, 161859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_C] = {.type = NLA_U32}, 162859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck [DCB_BCN_ATTR_ALL] = {.type = NLA_FLAG}, 163859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck}; 164859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1656fa382af61338908e5713234bcee598423f661c3Yi Zou/* DCB APP nested attributes. */ 166b54452b07a7b1b8cc1385edba3ef2ef6d4679d5aAlexey Dobriyanstatic const struct nla_policy dcbnl_app_nest[DCB_APP_ATTR_MAX + 1] = { 1676fa382af61338908e5713234bcee598423f661c3Yi Zou [DCB_APP_ATTR_IDTYPE] = {.type = NLA_U8}, 1686fa382af61338908e5713234bcee598423f661c3Yi Zou [DCB_APP_ATTR_ID] = {.type = NLA_U16}, 1696fa382af61338908e5713234bcee598423f661c3Yi Zou [DCB_APP_ATTR_PRIORITY] = {.type = NLA_U8}, 1706fa382af61338908e5713234bcee598423f661c3Yi Zou}; 1716fa382af61338908e5713234bcee598423f661c3Yi Zou 1723e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend/* IEEE 802.1Qaz nested attributes. */ 1733e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendstatic const struct nla_policy dcbnl_ieee_policy[DCB_ATTR_IEEE_MAX + 1] = { 1743e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_ETS] = {.len = sizeof(struct ieee_ets)}, 1753e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_PFC] = {.len = sizeof(struct ieee_pfc)}, 1763e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_APP_TABLE] = {.type = NLA_NESTED}, 1773e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend}; 1783e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 1793e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendstatic const struct nla_policy dcbnl_ieee_app[DCB_ATTR_IEEE_APP_MAX + 1] = { 1803e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend [DCB_ATTR_IEEE_APP] = {.len = sizeof(struct dcb_app)}, 1813e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend}; 1823e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 1839ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendstatic LIST_HEAD(dcb_app_list); 1849ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendstatic DEFINE_SPINLOCK(dcb_lock); 1859ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 1862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck/* standard netlink reply call */ 1872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_reply(u8 value, u8 event, u8 cmd, u8 attr, u32 pid, 1882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 seq, u16 flags) 1892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 1902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct sk_buff *dcbnl_skb; 1912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct dcbmsg *dcb; 1922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlmsghdr *nlh; 1932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 1942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 1952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 1962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!dcbnl_skb) 1972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 1982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 1992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh = NLMSG_NEW(dcbnl_skb, pid, seq, event, sizeof(*dcb), flags); 2002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb = NLMSG_DATA(nlh); 2022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->dcb_family = AF_UNSPEC; 2032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->cmd = cmd; 2042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->dcb_pad = 0; 2052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put_u8(dcbnl_skb, attr, value); 2072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 2082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err; 2092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* end the message, assign the nlmsg_len. */ 2112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlmsg_end(dcbnl_skb, nlh); 2122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 2132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 2147eaf5077b37bb33dbd44e569ff88566d6fe286e9John Fastabend return -EINVAL; 2152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 2172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duycknlmsg_failure: 2182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr: 219858eb711ba64f8a001d7003295b8078bcab33b6dRoel Kluin kfree_skb(dcbnl_skb); 2202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 2212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 2222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2232f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_getstate(struct net_device *netdev, struct nlattr **tb, 2242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 2252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 2262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 2272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* if (!tb[DCB_ATTR_STATE] || !netdev->dcbnl_ops->getstate) */ 2292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!netdev->dcbnl_ops->getstate) 2302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 2312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_reply(netdev->dcbnl_ops->getstate(netdev), RTM_GETDCB, 2332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_CMD_GSTATE, DCB_ATTR_STATE, pid, seq, flags); 2342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 2362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 2372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_getpfccfg(struct net_device *netdev, struct nlattr **tb, 2392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 2402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 2412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct sk_buff *dcbnl_skb; 2422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlmsghdr *nlh; 2432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct dcbmsg *dcb; 2442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *data[DCB_PFC_UP_ATTR_MAX + 1], *nest; 2452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 value; 2462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 2472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 2482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int getall = 0; 2492f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_PFC_CFG] || !netdev->dcbnl_ops->getpfccfg) 2512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 2522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(data, DCB_PFC_UP_ATTR_MAX, 2542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PFC_CFG], 2552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_pfc_up_nest); 2562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 2572f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_out; 2582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 2602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!dcbnl_skb) 2612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_out; 2622f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 2642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb = NLMSG_DATA(nlh); 2662f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->dcb_family = AF_UNSPEC; 2672f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->cmd = DCB_CMD_PFC_GCFG; 2682f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2692f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nest = nla_nest_start(dcbnl_skb, DCB_ATTR_PFC_CFG); 2702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!nest) 2712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err; 2722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (data[DCB_PFC_UP_ATTR_ALL]) 2742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 1; 2752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PFC_UP_ATTR_0; i <= DCB_PFC_UP_ATTR_7; i++) { 2772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!getall && !data[i]) 2782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 2792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpfccfg(netdev, i - DCB_PFC_UP_ATTR_0, 2812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck &value); 2822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put_u8(dcbnl_skb, i, value); 2832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) { 2852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_nest_cancel(dcbnl_skb, nest); 2862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err; 2872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 2882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 2892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_nest_end(dcbnl_skb, nest); 2902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlmsg_end(dcbnl_skb, nlh); 2922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 2942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 2957eaf5077b37bb33dbd44e569ff88566d6fe286e9John Fastabend goto err_out; 2962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 2972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 2982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duycknlmsg_failure: 2992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr: 300858eb711ba64f8a001d7003295b8078bcab33b6dRoel Kluin kfree_skb(dcbnl_skb); 3012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr_out: 3022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return -EINVAL; 3032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 3042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_getperm_hwaddr(struct net_device *netdev, struct nlattr **tb, 3062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 3072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 3082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct sk_buff *dcbnl_skb; 3092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlmsghdr *nlh; 3102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct dcbmsg *dcb; 3112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 perm_addr[MAX_ADDR_LEN]; 3122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 3132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!netdev->dcbnl_ops->getpermhwaddr) 3152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 3162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 3182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!dcbnl_skb) 3192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_out; 3202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 3222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3232f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb = NLMSG_DATA(nlh); 3242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->dcb_family = AF_UNSPEC; 3252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->cmd = DCB_CMD_GPERM_HWADDR; 3262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpermhwaddr(netdev, perm_addr); 3282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put(dcbnl_skb, DCB_ATTR_PERM_HWADDR, sizeof(perm_addr), 3302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck perm_addr); 3312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlmsg_end(dcbnl_skb, nlh); 3332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 3352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 3367eaf5077b37bb33dbd44e569ff88566d6fe286e9John Fastabend goto err_out; 3372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 3392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 3402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duycknlmsg_failure: 341858eb711ba64f8a001d7003295b8078bcab33b6dRoel Kluin kfree_skb(dcbnl_skb); 3422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr_out: 3432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return -EINVAL; 3442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 3452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 34646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyckstatic int dcbnl_getcap(struct net_device *netdev, struct nlattr **tb, 34746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck u32 pid, u32 seq, u16 flags) 34846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck{ 34946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck struct sk_buff *dcbnl_skb; 35046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck struct nlmsghdr *nlh; 35146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck struct dcbmsg *dcb; 35246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck struct nlattr *data[DCB_CAP_ATTR_MAX + 1], *nest; 35346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck u8 value; 35446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck int ret = -EINVAL; 35546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck int i; 35646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck int getall = 0; 35746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 35846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!tb[DCB_ATTR_CAP] || !netdev->dcbnl_ops->getcap) 35946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck return ret; 36046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 36146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck ret = nla_parse_nested(data, DCB_CAP_ATTR_MAX, tb[DCB_ATTR_CAP], 36246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck dcbnl_cap_nest); 36346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (ret) 36446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck goto err_out; 36546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 36646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 36746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!dcbnl_skb) 36846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck goto err_out; 36946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 37046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 37146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 37246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck dcb = NLMSG_DATA(nlh); 37346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck dcb->dcb_family = AF_UNSPEC; 37446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck dcb->cmd = DCB_CMD_GCAP; 37546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 37646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck nest = nla_nest_start(dcbnl_skb, DCB_ATTR_CAP); 37746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!nest) 37846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck goto err; 37946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 38046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (data[DCB_CAP_ATTR_ALL]) 38146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck getall = 1; 38246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 38346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck for (i = DCB_CAP_ATTR_ALL+1; i <= DCB_CAP_ATTR_MAX; i++) { 38446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!getall && !data[i]) 38546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck continue; 38646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 38746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (!netdev->dcbnl_ops->getcap(netdev, i, &value)) { 38846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck ret = nla_put_u8(dcbnl_skb, i, value); 38946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 39046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (ret) { 39146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck nla_nest_cancel(dcbnl_skb, nest); 39246132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck goto err; 39346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck } 39446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck } 39546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck } 39646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck nla_nest_end(dcbnl_skb, nest); 39746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 39846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck nlmsg_end(dcbnl_skb, nlh); 39946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 40046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 40146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck if (ret) 4027eaf5077b37bb33dbd44e569ff88566d6fe286e9John Fastabend goto err_out; 40346132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 40446132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck return 0; 40546132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duycknlmsg_failure: 40646132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyckerr: 407858eb711ba64f8a001d7003295b8078bcab33b6dRoel Kluin kfree_skb(dcbnl_skb); 40846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyckerr_out: 40946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck return -EINVAL; 41046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck} 41146132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck 41233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyckstatic int dcbnl_getnumtcs(struct net_device *netdev, struct nlattr **tb, 41333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck u32 pid, u32 seq, u16 flags) 41433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck{ 41533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck struct sk_buff *dcbnl_skb; 41633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck struct nlmsghdr *nlh; 41733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck struct dcbmsg *dcb; 41833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck struct nlattr *data[DCB_NUMTCS_ATTR_MAX + 1], *nest; 41933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck u8 value; 42033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int ret = -EINVAL; 42133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int i; 42233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int getall = 0; 42333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 42433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (!tb[DCB_ATTR_NUMTCS] || !netdev->dcbnl_ops->getnumtcs) 42533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck return ret; 42633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 42733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = nla_parse_nested(data, DCB_NUMTCS_ATTR_MAX, tb[DCB_ATTR_NUMTCS], 42833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcbnl_numtcs_nest); 42933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (ret) { 43033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = -EINVAL; 43133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto err_out; 43233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 43333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 43433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 43533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (!dcbnl_skb) { 43633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = -EINVAL; 43733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto err_out; 43833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 43933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 44033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 44133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 44233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcb = NLMSG_DATA(nlh); 44333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcb->dcb_family = AF_UNSPEC; 44433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcb->cmd = DCB_CMD_GNUMTCS; 44533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 44633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck nest = nla_nest_start(dcbnl_skb, DCB_ATTR_NUMTCS); 44733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (!nest) { 44833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = -EINVAL; 44933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto err; 45033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 45133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 45233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (data[DCB_NUMTCS_ATTR_ALL]) 45333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck getall = 1; 45433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 45533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck for (i = DCB_NUMTCS_ATTR_ALL+1; i <= DCB_NUMTCS_ATTR_MAX; i++) { 45633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (!getall && !data[i]) 45733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck continue; 45833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 45933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = netdev->dcbnl_ops->getnumtcs(netdev, i, &value); 46033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (!ret) { 46133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = nla_put_u8(dcbnl_skb, i, value); 46233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 46333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (ret) { 46433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck nla_nest_cancel(dcbnl_skb, nest); 46533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = -EINVAL; 46633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto err; 46733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 46833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } else { 46933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto err; 47033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 47133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 47233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck nla_nest_end(dcbnl_skb, nest); 47333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 47433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck nlmsg_end(dcbnl_skb, nlh); 47533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 47633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 47733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (ret) { 47833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = -EINVAL; 4797eaf5077b37bb33dbd44e569ff88566d6fe286e9John Fastabend goto err_out; 48033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 48133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 48233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck return 0; 48333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duycknlmsg_failure: 48433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyckerr: 485858eb711ba64f8a001d7003295b8078bcab33b6dRoel Kluin kfree_skb(dcbnl_skb); 48633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyckerr_out: 48733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck return ret; 48833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck} 48933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 49033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyckstatic int dcbnl_setnumtcs(struct net_device *netdev, struct nlattr **tb, 49133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck u32 pid, u32 seq, u16 flags) 49233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck{ 49333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck struct nlattr *data[DCB_NUMTCS_ATTR_MAX + 1]; 49433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int ret = -EINVAL; 49533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck u8 value; 49633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck int i; 49733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 4988b124a8e14c04378466ddfe63e41fc5035f957ebDon Skidmore if (!tb[DCB_ATTR_NUMTCS] || !netdev->dcbnl_ops->setnumtcs) 49933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck return ret; 50033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 50133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = nla_parse_nested(data, DCB_NUMTCS_ATTR_MAX, tb[DCB_ATTR_NUMTCS], 50233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck dcbnl_numtcs_nest); 50333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 50433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (ret) { 50533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = -EINVAL; 50633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto err; 50733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 50833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 50933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck for (i = DCB_NUMTCS_ATTR_ALL+1; i <= DCB_NUMTCS_ATTR_MAX; i++) { 51033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (data[i] == NULL) 51133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck continue; 51233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 51333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck value = nla_get_u8(data[i]); 51433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 51533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = netdev->dcbnl_ops->setnumtcs(netdev, i, value); 51633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 51733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck if (ret) 51833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto operr; 51933dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck } 52033dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 52133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyckoperr: 52233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = dcbnl_reply(!!ret, RTM_SETDCB, DCB_CMD_SNUMTCS, 52333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck DCB_ATTR_NUMTCS, pid, seq, flags); 52433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 52533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyckerr: 52633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck return ret; 52733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck} 52833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck 5290eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyckstatic int dcbnl_getpfcstate(struct net_device *netdev, struct nlattr **tb, 5300eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck u32 pid, u32 seq, u16 flags) 5310eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck{ 5320eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck int ret = -EINVAL; 5330eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5340eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck if (!netdev->dcbnl_ops->getpfcstate) 5350eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck return ret; 5360eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5370eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck ret = dcbnl_reply(netdev->dcbnl_ops->getpfcstate(netdev), RTM_GETDCB, 5380eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck DCB_CMD_PFC_GSTATE, DCB_ATTR_PFC_STATE, 5390eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck pid, seq, flags); 5400eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5410eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck return ret; 5420eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck} 5430eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5440eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyckstatic int dcbnl_setpfcstate(struct net_device *netdev, struct nlattr **tb, 5450eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck u32 pid, u32 seq, u16 flags) 5460eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck{ 5470eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck int ret = -EINVAL; 5480eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck u8 value; 5490eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5500eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck if (!tb[DCB_ATTR_PFC_STATE] || !netdev->dcbnl_ops->setpfcstate) 5510eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck return ret; 5520eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5530eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck value = nla_get_u8(tb[DCB_ATTR_PFC_STATE]); 5540eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5550eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck netdev->dcbnl_ops->setpfcstate(netdev, value); 5560eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5570eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck ret = dcbnl_reply(0, RTM_SETDCB, DCB_CMD_PFC_SSTATE, DCB_ATTR_PFC_STATE, 5580eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck pid, seq, flags); 5590eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 5600eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck return ret; 5610eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck} 5620eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck 563579496865cf4ea429146382d62047ffdbaab0deeYi Zoustatic int dcbnl_getapp(struct net_device *netdev, struct nlattr **tb, 564579496865cf4ea429146382d62047ffdbaab0deeYi Zou u32 pid, u32 seq, u16 flags) 565579496865cf4ea429146382d62047ffdbaab0deeYi Zou{ 566579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct sk_buff *dcbnl_skb; 567579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct nlmsghdr *nlh; 568579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct dcbmsg *dcb; 569579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct nlattr *app_nest; 570579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct nlattr *app_tb[DCB_APP_ATTR_MAX + 1]; 571579496865cf4ea429146382d62047ffdbaab0deeYi Zou u16 id; 572579496865cf4ea429146382d62047ffdbaab0deeYi Zou u8 up, idtype; 573579496865cf4ea429146382d62047ffdbaab0deeYi Zou int ret = -EINVAL; 574579496865cf4ea429146382d62047ffdbaab0deeYi Zou 575579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (!tb[DCB_ATTR_APP] || !netdev->dcbnl_ops->getapp) 576579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 577579496865cf4ea429146382d62047ffdbaab0deeYi Zou 578579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = nla_parse_nested(app_tb, DCB_APP_ATTR_MAX, tb[DCB_ATTR_APP], 579579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcbnl_app_nest); 580579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 581579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 582579496865cf4ea429146382d62047ffdbaab0deeYi Zou 583579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = -EINVAL; 584579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* all must be non-null */ 585579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((!app_tb[DCB_APP_ATTR_IDTYPE]) || 586579496865cf4ea429146382d62047ffdbaab0deeYi Zou (!app_tb[DCB_APP_ATTR_ID])) 587579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 588579496865cf4ea429146382d62047ffdbaab0deeYi Zou 589579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* either by eth type or by socket number */ 590579496865cf4ea429146382d62047ffdbaab0deeYi Zou idtype = nla_get_u8(app_tb[DCB_APP_ATTR_IDTYPE]); 591579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((idtype != DCB_APP_IDTYPE_ETHTYPE) && 592579496865cf4ea429146382d62047ffdbaab0deeYi Zou (idtype != DCB_APP_IDTYPE_PORTNUM)) 593579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 594579496865cf4ea429146382d62047ffdbaab0deeYi Zou 595579496865cf4ea429146382d62047ffdbaab0deeYi Zou id = nla_get_u16(app_tb[DCB_APP_ATTR_ID]); 596579496865cf4ea429146382d62047ffdbaab0deeYi Zou up = netdev->dcbnl_ops->getapp(netdev, idtype, id); 597579496865cf4ea429146382d62047ffdbaab0deeYi Zou 598579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* send this back */ 599579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 600579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (!dcbnl_skb) 601579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 602579496865cf4ea429146382d62047ffdbaab0deeYi Zou 603579496865cf4ea429146382d62047ffdbaab0deeYi Zou nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 604579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcb = NLMSG_DATA(nlh); 605579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcb->dcb_family = AF_UNSPEC; 606579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcb->cmd = DCB_CMD_GAPP; 607579496865cf4ea429146382d62047ffdbaab0deeYi Zou 608579496865cf4ea429146382d62047ffdbaab0deeYi Zou app_nest = nla_nest_start(dcbnl_skb, DCB_ATTR_APP); 609579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = nla_put_u8(dcbnl_skb, DCB_APP_ATTR_IDTYPE, idtype); 610579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 611579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out_cancel; 612579496865cf4ea429146382d62047ffdbaab0deeYi Zou 613579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = nla_put_u16(dcbnl_skb, DCB_APP_ATTR_ID, id); 614579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 615579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out_cancel; 616579496865cf4ea429146382d62047ffdbaab0deeYi Zou 617579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = nla_put_u8(dcbnl_skb, DCB_APP_ATTR_PRIORITY, up); 618579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 619579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out_cancel; 620579496865cf4ea429146382d62047ffdbaab0deeYi Zou 621579496865cf4ea429146382d62047ffdbaab0deeYi Zou nla_nest_end(dcbnl_skb, app_nest); 622579496865cf4ea429146382d62047ffdbaab0deeYi Zou nlmsg_end(dcbnl_skb, nlh); 623579496865cf4ea429146382d62047ffdbaab0deeYi Zou 624579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 625579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 626579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto nlmsg_failure; 627579496865cf4ea429146382d62047ffdbaab0deeYi Zou 628579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 629579496865cf4ea429146382d62047ffdbaab0deeYi Zou 630579496865cf4ea429146382d62047ffdbaab0deeYi Zouout_cancel: 631579496865cf4ea429146382d62047ffdbaab0deeYi Zou nla_nest_cancel(dcbnl_skb, app_nest); 632579496865cf4ea429146382d62047ffdbaab0deeYi Zounlmsg_failure: 633579496865cf4ea429146382d62047ffdbaab0deeYi Zou kfree_skb(dcbnl_skb); 634579496865cf4ea429146382d62047ffdbaab0deeYi Zouout: 635579496865cf4ea429146382d62047ffdbaab0deeYi Zou return ret; 636579496865cf4ea429146382d62047ffdbaab0deeYi Zou} 637579496865cf4ea429146382d62047ffdbaab0deeYi Zou 638579496865cf4ea429146382d62047ffdbaab0deeYi Zoustatic int dcbnl_setapp(struct net_device *netdev, struct nlattr **tb, 639579496865cf4ea429146382d62047ffdbaab0deeYi Zou u32 pid, u32 seq, u16 flags) 640579496865cf4ea429146382d62047ffdbaab0deeYi Zou{ 6419ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend int err, ret = -EINVAL; 642579496865cf4ea429146382d62047ffdbaab0deeYi Zou u16 id; 643579496865cf4ea429146382d62047ffdbaab0deeYi Zou u8 up, idtype; 644579496865cf4ea429146382d62047ffdbaab0deeYi Zou struct nlattr *app_tb[DCB_APP_ATTR_MAX + 1]; 645579496865cf4ea429146382d62047ffdbaab0deeYi Zou 6469ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (!tb[DCB_ATTR_APP]) 647579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 648579496865cf4ea429146382d62047ffdbaab0deeYi Zou 649579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = nla_parse_nested(app_tb, DCB_APP_ATTR_MAX, tb[DCB_ATTR_APP], 650579496865cf4ea429146382d62047ffdbaab0deeYi Zou dcbnl_app_nest); 651579496865cf4ea429146382d62047ffdbaab0deeYi Zou if (ret) 652579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 653579496865cf4ea429146382d62047ffdbaab0deeYi Zou 654579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = -EINVAL; 655579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* all must be non-null */ 656579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((!app_tb[DCB_APP_ATTR_IDTYPE]) || 657579496865cf4ea429146382d62047ffdbaab0deeYi Zou (!app_tb[DCB_APP_ATTR_ID]) || 658579496865cf4ea429146382d62047ffdbaab0deeYi Zou (!app_tb[DCB_APP_ATTR_PRIORITY])) 659579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 660579496865cf4ea429146382d62047ffdbaab0deeYi Zou 661579496865cf4ea429146382d62047ffdbaab0deeYi Zou /* either by eth type or by socket number */ 662579496865cf4ea429146382d62047ffdbaab0deeYi Zou idtype = nla_get_u8(app_tb[DCB_APP_ATTR_IDTYPE]); 663579496865cf4ea429146382d62047ffdbaab0deeYi Zou if ((idtype != DCB_APP_IDTYPE_ETHTYPE) && 664579496865cf4ea429146382d62047ffdbaab0deeYi Zou (idtype != DCB_APP_IDTYPE_PORTNUM)) 665579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 666579496865cf4ea429146382d62047ffdbaab0deeYi Zou 667579496865cf4ea429146382d62047ffdbaab0deeYi Zou id = nla_get_u16(app_tb[DCB_APP_ATTR_ID]); 668579496865cf4ea429146382d62047ffdbaab0deeYi Zou up = nla_get_u8(app_tb[DCB_APP_ATTR_PRIORITY]); 669579496865cf4ea429146382d62047ffdbaab0deeYi Zou 6709ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (netdev->dcbnl_ops->setapp) { 6719ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend err = netdev->dcbnl_ops->setapp(netdev, idtype, id, up); 6729ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } else { 6739ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app app; 6749ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app.selector = idtype; 6759ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app.protocol = id; 6769ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app.priority = up; 6779ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend err = dcb_setapp(netdev, &app); 6789ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 6799ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 6809ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend ret = dcbnl_reply(err, RTM_SETDCB, DCB_CMD_SAPP, DCB_ATTR_APP, 6819ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend pid, seq, flags); 682579496865cf4ea429146382d62047ffdbaab0deeYi Zouout: 683579496865cf4ea429146382d62047ffdbaab0deeYi Zou return ret; 684579496865cf4ea429146382d62047ffdbaab0deeYi Zou} 685579496865cf4ea429146382d62047ffdbaab0deeYi Zou 6862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int __dcbnl_pg_getcfg(struct net_device *netdev, struct nlattr **tb, 6872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags, int dir) 6882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 6892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct sk_buff *dcbnl_skb; 6902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlmsghdr *nlh; 6912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct dcbmsg *dcb; 6922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *pg_nest, *param_nest, *data; 6932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *pg_tb[DCB_PG_ATTR_MAX + 1]; 6942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *param_tb[DCB_TC_ATTR_PARAM_MAX + 1]; 6952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 prio, pgid, tc_pct, up_map; 6962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 6972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int getall = 0; 6982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 6992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_PG_CFG] || 7012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->getpgtccfgtx || 7022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->getpgtccfgrx || 7032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->getpgbwgcfgtx || 7042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->getpgbwgcfgrx) 7052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 7062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(pg_tb, DCB_PG_ATTR_MAX, 7082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PG_CFG], dcbnl_pg_nest); 7092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_out; 7122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!dcbnl_skb) 7152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_out; 7162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 7182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb = NLMSG_DATA(nlh); 7202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->dcb_family = AF_UNSPEC; 7212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcb->cmd = (dir) ? DCB_CMD_PGRX_GCFG : DCB_CMD_PGTX_GCFG; 7222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7232f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pg_nest = nla_nest_start(dcbnl_skb, DCB_ATTR_PG_CFG); 7242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!pg_nest) 7252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err; 7262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (pg_tb[DCB_PG_ATTR_TC_ALL]) 7282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 1; 7292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_TC_0; i <= DCB_PG_ATTR_TC_7; i++) { 7312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!getall && !pg_tb[i]) 7322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 7332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (pg_tb[DCB_PG_ATTR_TC_ALL]) 7352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data = pg_tb[DCB_PG_ATTR_TC_ALL]; 7362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck else 7372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data = pg_tb[i]; 7382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(param_tb, DCB_TC_ATTR_PARAM_MAX, 7392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data, dcbnl_tc_param_nest); 7402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_pg; 7422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_nest = nla_nest_start(dcbnl_skb, i); 7442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!param_nest) 7452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_pg; 7462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pgid = DCB_ATTR_VALUE_UNDEFINED; 7482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio = DCB_ATTR_VALUE_UNDEFINED; 7492f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = DCB_ATTR_VALUE_UNDEFINED; 7502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck up_map = DCB_ATTR_VALUE_UNDEFINED; 7512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 7532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 7542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgtccfgrx(netdev, 7552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, &prio, 7562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck &pgid, &tc_pct, &up_map); 7572f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 7582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 7592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgtccfgtx(netdev, 7602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, &prio, 7612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck &pgid, &tc_pct, &up_map); 7622f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 7632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_PGID] || 7652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 7662f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put_u8(dcbnl_skb, 7672f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_TC_ATTR_PARAM_PGID, pgid); 7682f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7692f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 7702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 7712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING] || 7722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 7732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put_u8(dcbnl_skb, 7742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_TC_ATTR_PARAM_UP_MAPPING, up_map); 7752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 7772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 7782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO] || 7792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 7802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put_u8(dcbnl_skb, 7812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_TC_ATTR_PARAM_STRICT_PRIO, prio); 7822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 7842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 7852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_BW_PCT] || 7862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck param_tb[DCB_TC_ATTR_PARAM_ALL]) { 7872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put_u8(dcbnl_skb, DCB_TC_ATTR_PARAM_BW_PCT, 7882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct); 7892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 7902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_param; 7912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 7922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_nest_end(dcbnl_skb, param_nest); 7932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 7942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 7952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (pg_tb[DCB_PG_ATTR_BW_ID_ALL]) 7962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 1; 7972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck else 7982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck getall = 0; 7992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_BW_ID_0; i <= DCB_PG_ATTR_BW_ID_7; i++) { 8012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!getall && !pg_tb[i]) 8022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 8032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = DCB_ATTR_VALUE_UNDEFINED; 8052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 8072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 8082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgbwgcfgrx(netdev, 8092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, &tc_pct); 8102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 8112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 8122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->getpgbwgcfgtx(netdev, 8132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, &tc_pct); 8142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 8152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_put_u8(dcbnl_skb, i, tc_pct); 8162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 8182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err_pg; 8192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 8202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_nest_end(dcbnl_skb, pg_nest); 8222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8232f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlmsg_end(dcbnl_skb, nlh); 8242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 8262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 8277eaf5077b37bb33dbd44e569ff88566d6fe286e9John Fastabend goto err_out; 8282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 8302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr_param: 8322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_nest_cancel(dcbnl_skb, param_nest); 8332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr_pg: 8342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_nest_cancel(dcbnl_skb, pg_nest); 8352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duycknlmsg_failure: 8362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr: 837858eb711ba64f8a001d7003295b8078bcab33b6dRoel Kluin kfree_skb(dcbnl_skb); 8382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr_out: 8392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = -EINVAL; 8402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 8412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 8422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_pgtx_getcfg(struct net_device *netdev, struct nlattr **tb, 8442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 8452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 8462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return __dcbnl_pg_getcfg(netdev, tb, pid, seq, flags, 0); 8472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 8482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8492f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_pgrx_getcfg(struct net_device *netdev, struct nlattr **tb, 8502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 8512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 8522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return __dcbnl_pg_getcfg(netdev, tb, pid, seq, flags, 1); 8532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 8542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_setstate(struct net_device *netdev, struct nlattr **tb, 8562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 8572f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 8582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 8592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 value; 8602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_STATE] || !netdev->dcbnl_ops->setstate) 8622f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 8632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck value = nla_get_u8(tb[DCB_ATTR_STATE]); 8652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8661486a61ebcd2711532f8163d30babc40e11e7b40Don Skidmore ret = dcbnl_reply(netdev->dcbnl_ops->setstate(netdev, value), 8671486a61ebcd2711532f8163d30babc40e11e7b40Don Skidmore RTM_SETDCB, DCB_CMD_SSTATE, DCB_ATTR_STATE, 8682f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pid, seq, flags); 8692f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 8712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 8722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_setpfccfg(struct net_device *netdev, struct nlattr **tb, 8742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 8752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 8762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *data[DCB_PFC_UP_ATTR_MAX + 1]; 8772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 8782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 8792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 value; 8802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_PFC_CFG] || !netdev->dcbnl_ops->setpfccfg) 8822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 8832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(data, DCB_PFC_UP_ATTR_MAX, 8852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PFC_CFG], 8862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_pfc_up_nest); 8872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 8882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err; 8892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PFC_UP_ATTR_0; i <= DCB_PFC_UP_ATTR_7; i++) { 8912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (data[i] == NULL) 8922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 8932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck value = nla_get_u8(data[i]); 8942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpfccfg(netdev, 8952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck data[i]->nla_type - DCB_PFC_UP_ATTR_0, value); 8962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 8972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 8982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_reply(0, RTM_SETDCB, DCB_CMD_PFC_SCFG, DCB_ATTR_PFC_CFG, 8992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pid, seq, flags); 9002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr: 9012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 9022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 9032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_setall(struct net_device *netdev, struct nlattr **tb, 9052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 9062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 9072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 9082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_SET_ALL] || !netdev->dcbnl_ops->setall) 9102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 9112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_reply(netdev->dcbnl_ops->setall(netdev), RTM_SETDCB, 9132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_CMD_SET_ALL, DCB_ATTR_SET_ALL, pid, seq, flags); 9142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 9162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 9172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int __dcbnl_pg_setcfg(struct net_device *netdev, struct nlattr **tb, 9192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags, int dir) 9202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 9212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *pg_tb[DCB_PG_ATTR_MAX + 1]; 9222f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *param_tb[DCB_TC_ATTR_PARAM_MAX + 1]; 9232f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 9242f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int i; 9252f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 pgid; 9262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 up_map; 9272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 prio; 9282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u8 tc_pct; 9292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_PG_CFG] || 9312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->setpgtccfgtx || 9322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->setpgtccfgrx || 9332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->setpgbwgcfgtx || 9342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck !netdev->dcbnl_ops->setpgbwgcfgrx) 9352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 9362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(pg_tb, DCB_PG_ATTR_MAX, 9382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tb[DCB_ATTR_PG_CFG], dcbnl_pg_nest); 9392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 9402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err; 9412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_TC_0; i <= DCB_PG_ATTR_TC_7; i++) { 9432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!pg_tb[i]) 9442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 9452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nla_parse_nested(param_tb, DCB_TC_ATTR_PARAM_MAX, 9472f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pg_tb[i], dcbnl_tc_param_nest); 9482f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret) 9492f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto err; 9502f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9512f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pgid = DCB_ATTR_VALUE_UNDEFINED; 9522f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio = DCB_ATTR_VALUE_UNDEFINED; 9532f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = DCB_ATTR_VALUE_UNDEFINED; 9542f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck up_map = DCB_ATTR_VALUE_UNDEFINED; 9552f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9562f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO]) 9572f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio = 9582f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO]); 9592f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9602f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_PGID]) 9612f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck pgid = nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_PGID]); 9622f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9632f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_BW_PCT]) 9642f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_BW_PCT]); 9652f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9662f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING]) 9672f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck up_map = 9682f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING]); 9692f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9702f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* dir: Tx = 0, Rx = 1 */ 9712f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 9722f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 9732f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgtccfgrx(netdev, 9742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, 9752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio, pgid, tc_pct, up_map); 9762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 9772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 9782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgtccfgtx(netdev, 9792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_TC_0, 9802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck prio, pgid, tc_pct, up_map); 9812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 9822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 9832f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck for (i = DCB_PG_ATTR_BW_ID_0; i <= DCB_PG_ATTR_BW_ID_7; i++) { 9852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!pg_tb[i]) 9862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck continue; 9872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck tc_pct = nla_get_u8(pg_tb[i]); 9892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 9902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* dir: Tx = 0, Rx = 1 */ 9912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (dir) { 9922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Rx */ 9932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgbwgcfgrx(netdev, 9942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, tc_pct); 9952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } else { 9962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck /* Tx */ 9972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev->dcbnl_ops->setpgbwgcfgtx(netdev, 9982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck i - DCB_PG_ATTR_BW_ID_0, tc_pct); 9992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 10002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 10012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 10022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_reply(0, RTM_SETDCB, 10032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck (dir ? DCB_CMD_PGRX_SCFG : DCB_CMD_PGTX_SCFG), 10042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck DCB_ATTR_PG_CFG, pid, seq, flags); 10052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 10062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerr: 10072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 10082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 10092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 10102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_pgtx_setcfg(struct net_device *netdev, struct nlattr **tb, 10112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 10122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 10132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return __dcbnl_pg_setcfg(netdev, tb, pid, seq, flags, 0); 10142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 10152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 10162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcbnl_pgrx_setcfg(struct net_device *netdev, struct nlattr **tb, 10172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid, u32 seq, u16 flags) 10182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 10192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return __dcbnl_pg_setcfg(netdev, tb, pid, seq, flags, 1); 10202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 10212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 1022859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyckstatic int dcbnl_bcn_getcfg(struct net_device *netdev, struct nlattr **tb, 1023859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u32 pid, u32 seq, u16 flags) 1024859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck{ 1025859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct sk_buff *dcbnl_skb; 1026859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct nlmsghdr *nlh; 1027859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct dcbmsg *dcb; 1028859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct nlattr *bcn_nest; 1029859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct nlattr *bcn_tb[DCB_BCN_ATTR_MAX + 1]; 1030859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u8 value_byte; 1031859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u32 value_integer; 1032859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck int ret = -EINVAL; 1033859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck bool getall = false; 1034859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck int i; 1035859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1036859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!tb[DCB_ATTR_BCN] || !netdev->dcbnl_ops->getbcnrp || 1037859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck !netdev->dcbnl_ops->getbcncfg) 1038859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck return ret; 1039859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1040859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = nla_parse_nested(bcn_tb, DCB_BCN_ATTR_MAX, 1041859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck tb[DCB_ATTR_BCN], dcbnl_bcn_nest); 1042859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1043859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 1044859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err_out; 1045859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1046859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 1047859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!dcbnl_skb) 1048859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err_out; 1049859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1050859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 1051859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1052859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck dcb = NLMSG_DATA(nlh); 1053859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck dcb->dcb_family = AF_UNSPEC; 1054859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck dcb->cmd = DCB_CMD_BCN_GCFG; 1055859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1056859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck bcn_nest = nla_nest_start(dcbnl_skb, DCB_ATTR_BCN); 1057859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!bcn_nest) 1058859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err; 1059859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1060859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (bcn_tb[DCB_BCN_ATTR_ALL]) 1061859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck getall = true; 1062859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1063859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck for (i = DCB_BCN_ATTR_RP_0; i <= DCB_BCN_ATTR_RP_7; i++) { 1064859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!getall && !bcn_tb[i]) 1065859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 1066859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1067859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->getbcnrp(netdev, i - DCB_BCN_ATTR_RP_0, 1068859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck &value_byte); 1069859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = nla_put_u8(dcbnl_skb, i, value_byte); 1070859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 1071859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err_bcn; 1072859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 1073859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1074f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore for (i = DCB_BCN_ATTR_BCNA_0; i <= DCB_BCN_ATTR_RI; i++) { 1075859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (!getall && !bcn_tb[i]) 1076859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 1077859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1078859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->getbcncfg(netdev, i, 1079859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck &value_integer); 1080859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = nla_put_u32(dcbnl_skb, i, value_integer); 1081859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 1082859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err_bcn; 1083859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 1084859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1085859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck nla_nest_end(dcbnl_skb, bcn_nest); 1086859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1087859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck nlmsg_end(dcbnl_skb, nlh); 1088859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1089859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = rtnl_unicast(dcbnl_skb, &init_net, pid); 1090859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 10917eaf5077b37bb33dbd44e569ff88566d6fe286e9John Fastabend goto err_out; 1092859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1093859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck return 0; 1094859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1095859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyckerr_bcn: 1096859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck nla_nest_cancel(dcbnl_skb, bcn_nest); 1097859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duycknlmsg_failure: 1098859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyckerr: 1099858eb711ba64f8a001d7003295b8078bcab33b6dRoel Kluin kfree_skb(dcbnl_skb); 1100859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyckerr_out: 1101859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = -EINVAL; 1102859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck return ret; 1103859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck} 1104859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1105859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyckstatic int dcbnl_bcn_setcfg(struct net_device *netdev, struct nlattr **tb, 1106859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u32 pid, u32 seq, u16 flags) 1107859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck{ 1108859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck struct nlattr *data[DCB_BCN_ATTR_MAX + 1]; 1109859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck int i; 1110859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck int ret = -EINVAL; 1111859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u8 value_byte; 1112859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck u32 value_int; 1113859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1114f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches if (!tb[DCB_ATTR_BCN] || !netdev->dcbnl_ops->setbcncfg || 1115f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches !netdev->dcbnl_ops->setbcnrp) 1116859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck return ret; 1117859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1118859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = nla_parse_nested(data, DCB_BCN_ATTR_MAX, 1119859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck tb[DCB_ATTR_BCN], 1120859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck dcbnl_pfc_up_nest); 1121859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (ret) 1122859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto err; 1123859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1124859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck for (i = DCB_BCN_ATTR_RP_0; i <= DCB_BCN_ATTR_RP_7; i++) { 1125859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (data[i] == NULL) 1126859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 1127859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck value_byte = nla_get_u8(data[i]); 1128859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->setbcnrp(netdev, 1129859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck data[i]->nla_type - DCB_BCN_ATTR_RP_0, value_byte); 1130859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 1131859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1132f4314e815e87b4ab1c9b1115dd5853cd20ca999cDon Skidmore for (i = DCB_BCN_ATTR_BCNA_0; i <= DCB_BCN_ATTR_RI; i++) { 1133859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck if (data[i] == NULL) 1134859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck continue; 1135859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck value_int = nla_get_u32(data[i]); 1136859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck netdev->dcbnl_ops->setbcncfg(netdev, 1137859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck i, value_int); 1138859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck } 1139859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 1140859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = dcbnl_reply(0, RTM_SETDCB, DCB_CMD_BCN_SCFG, DCB_ATTR_BCN, 1141859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck pid, seq, flags); 1142859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyckerr: 1143859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck return ret; 1144859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck} 1145859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck 11463e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend/* Handle IEEE 802.1Qaz SET commands. If any requested operation can not 11473e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend * be completed the entire msg is aborted and error value is returned. 11483e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend * No attempt is made to reconcile the case where only part of the 11493e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend * cmd can be completed. 11503e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend */ 11513e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendstatic int dcbnl_ieee_set(struct net_device *netdev, struct nlattr **tb, 11523e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend u32 pid, u32 seq, u16 flags) 11533e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend{ 11543e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 11553e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct nlattr *ieee[DCB_ATTR_IEEE_MAX + 1]; 11563e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend int err = -EOPNOTSUPP; 11573e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11583e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (!ops) 11593e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto err; 11603e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11613e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend err = nla_parse_nested(ieee, DCB_ATTR_IEEE_MAX, 11623e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend tb[DCB_ATTR_IEEE], dcbnl_ieee_policy); 11633e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (err) 11643e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto err; 11653e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11663e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (ieee[DCB_ATTR_IEEE_ETS] && ops->ieee_setets) { 11673e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct ieee_ets *ets = nla_data(ieee[DCB_ATTR_IEEE_ETS]); 11683e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend err = ops->ieee_setets(netdev, ets); 11693e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (err) 11703e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto err; 11713e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 11723e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11733e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (ieee[DCB_ATTR_IEEE_PFC] && ops->ieee_setets) { 11743e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct ieee_pfc *pfc = nla_data(ieee[DCB_ATTR_IEEE_PFC]); 11753e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend err = ops->ieee_setpfc(netdev, pfc); 11763e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (err) 11773e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto err; 11783e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 11793e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11809ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (ieee[DCB_ATTR_IEEE_APP_TABLE]) { 11813e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct nlattr *attr; 11823e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend int rem; 11833e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11843e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nla_for_each_nested(attr, ieee[DCB_ATTR_IEEE_APP_TABLE], rem) { 11853e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct dcb_app *app_data; 11863e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (nla_type(attr) != DCB_ATTR_IEEE_APP) 11873e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend continue; 11883e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend app_data = nla_data(attr); 11899ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (ops->ieee_setapp) 11909ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend err = ops->ieee_setapp(netdev, app_data); 11919ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend else 11929ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend err = dcb_setapp(netdev, app_data); 11933e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (err) 11943e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto err; 11953e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 11963e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 11973e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 11983e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabenderr: 11993e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend dcbnl_reply(err, RTM_SETDCB, DCB_CMD_IEEE_SET, DCB_ATTR_IEEE, 12003e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend pid, seq, flags); 12013e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend return err; 12023e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend} 12033e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12043e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12053e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend/* Handle IEEE 802.1Qaz GET commands. */ 12063e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendstatic int dcbnl_ieee_get(struct net_device *netdev, struct nlattr **tb, 12073e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend u32 pid, u32 seq, u16 flags) 12083e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend{ 12093e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct sk_buff *skb; 12103e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct nlmsghdr *nlh; 12113e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct dcbmsg *dcb; 12129ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct nlattr *ieee, *app; 12139ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *itr; 12143e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend const struct dcbnl_rtnl_ops *ops = netdev->dcbnl_ops; 12153e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend int err; 12163e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12173e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (!ops) 12183e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend return -EOPNOTSUPP; 12193e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12203e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12213e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (!skb) 12223e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend return -ENOBUFS; 12233e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12243e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nlh = NLMSG_NEW(skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); 12253e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12263e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend dcb = NLMSG_DATA(nlh); 12273e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend dcb->dcb_family = AF_UNSPEC; 12283e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend dcb->cmd = DCB_CMD_IEEE_GET; 12293e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12303e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend NLA_PUT_STRING(skb, DCB_ATTR_IFNAME, netdev->name); 12313e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12323e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend ieee = nla_nest_start(skb, DCB_ATTR_IEEE); 12333e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (!ieee) 12343e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto nla_put_failure; 12353e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12363e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (ops->ieee_getets) { 12373e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct ieee_ets ets; 12383e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend err = ops->ieee_getets(netdev, &ets); 12393e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (!err) 12403e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend NLA_PUT(skb, DCB_ATTR_IEEE_ETS, sizeof(ets), &ets); 12413e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 12423e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12433e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (ops->ieee_getpfc) { 12443e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend struct ieee_pfc pfc; 12453e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend err = ops->ieee_getpfc(netdev, &pfc); 12463e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend if (!err) 12473e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend NLA_PUT(skb, DCB_ATTR_IEEE_PFC, sizeof(pfc), &pfc); 12483e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend } 12493e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12509ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend app = nla_nest_start(skb, DCB_ATTR_IEEE_APP_TABLE); 12519ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (!app) 12529ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend goto nla_put_failure; 12539ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 12549ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 12559ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_for_each_entry(itr, &dcb_app_list, list) { 12569ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (strncmp(itr->name, netdev->name, IFNAMSIZ) == 0) 12579ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend NLA_PUT(skb, DCB_ATTR_IEEE_APP, 12589ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend sizeof(itr->app), &itr->app); 12599ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 12609ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 12619ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend nla_nest_end(skb, app); 12629ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 12633e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nla_nest_end(skb, ieee); 12643e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nlmsg_end(skb, nlh); 12653e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12663e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend return rtnl_unicast(skb, &init_net, pid); 12673e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendnla_put_failure: 12683e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nlmsg_cancel(skb, nlh); 12693e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabendnlmsg_failure: 12703e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend kfree_skb(skb); 12713e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend return -1; 12723e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend} 12733e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend 12742f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int dcb_doit(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) 12752f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 12762f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct net *net = sock_net(skb->sk); 12772f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct net_device *netdev; 12782f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct dcbmsg *dcb = (struct dcbmsg *)NLMSG_DATA(nlh); 12792f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck struct nlattr *tb[DCB_ATTR_MAX + 1]; 12802f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck u32 pid = skb ? NETLINK_CB(skb).pid : 0; 12812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck int ret = -EINVAL; 12822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 128309ad9bc752519cc167d0a573e1acf69b5c707c67Octavian Purdila if (!net_eq(net, &init_net)) 12842f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return -EINVAL; 12852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 12862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = nlmsg_parse(nlh, sizeof(*dcb), tb, DCB_ATTR_MAX, 12872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dcbnl_rtnl_policy); 12882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (ret < 0) 12892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 12902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 12912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!tb[DCB_ATTR_IFNAME]) 12922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return -EINVAL; 12932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 12942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck netdev = dev_get_by_name(&init_net, nla_data(tb[DCB_ATTR_IFNAME])); 12952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!netdev) 12962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return -EINVAL; 12972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 12982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck if (!netdev->dcbnl_ops) 12992f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto errout; 13002f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 13012f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck switch (dcb->cmd) { 13022f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_GSTATE: 13032f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_getstate(netdev, tb, pid, nlh->nlmsg_seq, 13042f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13052f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13062f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_PFC_GCFG: 13072f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_getpfccfg(netdev, tb, pid, nlh->nlmsg_seq, 13082f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13092f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13102f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_GPERM_HWADDR: 13112f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_getperm_hwaddr(netdev, tb, pid, nlh->nlmsg_seq, 13122f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13132f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13142f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_PGTX_GCFG: 13152f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_pgtx_getcfg(netdev, tb, pid, nlh->nlmsg_seq, 13162f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13172f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13182f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_PGRX_GCFG: 13192f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_pgrx_getcfg(netdev, tb, pid, nlh->nlmsg_seq, 13202f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13212f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 1322859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck case DCB_CMD_BCN_GCFG: 1323859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = dcbnl_bcn_getcfg(netdev, tb, pid, nlh->nlmsg_seq, 1324859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck nlh->nlmsg_flags); 1325859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto out; 13262f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_SSTATE: 13272f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_setstate(netdev, tb, pid, nlh->nlmsg_seq, 13282f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13292f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13302f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_PFC_SCFG: 13312f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_setpfccfg(netdev, tb, pid, nlh->nlmsg_seq, 13322f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13332f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13342f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 13352f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_SET_ALL: 13362f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_setall(netdev, tb, pid, nlh->nlmsg_seq, 13372f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13382f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13392f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_PGTX_SCFG: 13402f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_pgtx_setcfg(netdev, tb, pid, nlh->nlmsg_seq, 13412f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13422f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 13432f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck case DCB_CMD_PGRX_SCFG: 13442f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = dcbnl_pgrx_setcfg(netdev, tb, pid, nlh->nlmsg_seq, 13452f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck nlh->nlmsg_flags); 13462f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto out; 134746132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck case DCB_CMD_GCAP: 134846132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck ret = dcbnl_getcap(netdev, tb, pid, nlh->nlmsg_seq, 134946132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck nlh->nlmsg_flags); 135046132188bf72e22ef097f16ed5c969ee8cea1e8bAlexander Duyck goto out; 135133dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck case DCB_CMD_GNUMTCS: 135233dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = dcbnl_getnumtcs(netdev, tb, pid, nlh->nlmsg_seq, 135333dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck nlh->nlmsg_flags); 135433dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto out; 135533dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck case DCB_CMD_SNUMTCS: 135633dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck ret = dcbnl_setnumtcs(netdev, tb, pid, nlh->nlmsg_seq, 135733dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck nlh->nlmsg_flags); 135833dbabc4a7f7bd72313c73a3c199f31f3900336fAlexander Duyck goto out; 13590eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck case DCB_CMD_PFC_GSTATE: 13600eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck ret = dcbnl_getpfcstate(netdev, tb, pid, nlh->nlmsg_seq, 13610eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck nlh->nlmsg_flags); 13620eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck goto out; 13630eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck case DCB_CMD_PFC_SSTATE: 13640eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck ret = dcbnl_setpfcstate(netdev, tb, pid, nlh->nlmsg_seq, 13650eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck nlh->nlmsg_flags); 13660eb3aa9bab20217fb42244ccdcb5bf8a002f504cAlexander Duyck goto out; 1367859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck case DCB_CMD_BCN_SCFG: 1368859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck ret = dcbnl_bcn_setcfg(netdev, tb, pid, nlh->nlmsg_seq, 1369859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck nlh->nlmsg_flags); 1370859ee3c43812051e21816c6d6d4cc04fb7ce9b2eAlexander Duyck goto out; 1371579496865cf4ea429146382d62047ffdbaab0deeYi Zou case DCB_CMD_GAPP: 1372579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = dcbnl_getapp(netdev, tb, pid, nlh->nlmsg_seq, 1373579496865cf4ea429146382d62047ffdbaab0deeYi Zou nlh->nlmsg_flags); 1374579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 1375579496865cf4ea429146382d62047ffdbaab0deeYi Zou case DCB_CMD_SAPP: 1376579496865cf4ea429146382d62047ffdbaab0deeYi Zou ret = dcbnl_setapp(netdev, tb, pid, nlh->nlmsg_seq, 1377579496865cf4ea429146382d62047ffdbaab0deeYi Zou nlh->nlmsg_flags); 1378579496865cf4ea429146382d62047ffdbaab0deeYi Zou goto out; 13793e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend case DCB_CMD_IEEE_SET: 13803e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend ret = dcbnl_ieee_set(netdev, tb, pid, nlh->nlmsg_seq, 13813e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nlh->nlmsg_flags); 13823e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto out; 13833e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend case DCB_CMD_IEEE_GET: 13843e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend ret = dcbnl_ieee_get(netdev, tb, pid, nlh->nlmsg_seq, 13853e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend nlh->nlmsg_flags); 13863e29027af43728c2a91fe3f735ab2822edaf54a8John Fastabend goto out; 13872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck default: 13882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck goto errout; 13892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck } 13902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckerrout: 13912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck ret = -EINVAL; 13922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckout: 13932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck dev_put(netdev); 13942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return ret; 13952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 13962f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 13979ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend/** 13989ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * dcb_getapp - retrieve the DCBX application user priority 13999ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * 14009ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * On success returns a non-zero 802.1p user priority bitmap 14019ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * otherwise returns 0 as the invalid user priority bitmap to 14029ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * indicate an error. 14039ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend */ 14049ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendu8 dcb_getapp(struct net_device *dev, struct dcb_app *app) 14059ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend{ 14069ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *itr; 14079ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend u8 prio = 0; 14089ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14099ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 14109ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_for_each_entry(itr, &dcb_app_list, list) { 14119ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (itr->app.selector == app->selector && 14129ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend itr->app.protocol == app->protocol && 14139ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend (strncmp(itr->name, dev->name, IFNAMSIZ) == 0)) { 14149ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend prio = itr->app.priority; 14159ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend break; 14169ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14179ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14189ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 14199ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14209ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend return prio; 14219ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend} 14229ab933ab2cc80f04690d6aa385b1110075c5e507John FastabendEXPORT_SYMBOL(dcb_getapp); 14239ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14249ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend/** 14259ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * ixgbe_dcbnl_setapp - add dcb application data to app list 14269ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * 14279ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * Priority 0 is the default priority this removes applications 14289ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend * from the app list if the priority is set to zero. 14299ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend */ 14309ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendu8 dcb_setapp(struct net_device *dev, struct dcb_app *new) 14319ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend{ 14329ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *itr; 14339ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14349ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 14359ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend /* Search for existing match and replace */ 14369ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_for_each_entry(itr, &dcb_app_list, list) { 14379ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (itr->app.selector == new->selector && 14389ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend itr->app.protocol == new->protocol && 14399ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend (strncmp(itr->name, dev->name, IFNAMSIZ) == 0)) { 14409ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (new->priority) 14419ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend itr->app.priority = new->priority; 14429ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend else { 14439ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_del(&itr->list); 14449ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend kfree(itr); 14459ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14469ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend goto out; 14479ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14489ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14499ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend /* App type does not exist add new application type */ 14509ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (new->priority) { 14519ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *entry; 14529ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend entry = kmalloc(sizeof(struct dcb_app_type), GFP_ATOMIC); 14539ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend if (!entry) { 14549ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 14559ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend return -ENOMEM; 14569ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14579ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14589ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend memcpy(&entry->app, new, sizeof(*new)); 14599ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend strncpy(entry->name, dev->name, IFNAMSIZ); 14609ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_add(&entry->list, &dcb_app_list); 14619ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14629ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendout: 14639ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 146496b99684e365f28d49bdb1221ca022b75cb91a98John Fastabend call_dcbevent_notifiers(DCB_APP_EVENT, new); 14659ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend return 0; 14669ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend} 14679ab933ab2cc80f04690d6aa385b1110075c5e507John FastabendEXPORT_SYMBOL(dcb_setapp); 14689ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14699ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabendvoid dcb_flushapp(void) 14709ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend{ 14719ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend struct dcb_app_type *app; 14729ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14739ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_lock(&dcb_lock); 14749ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_for_each_entry(app, &dcb_app_list, list) { 14759ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend list_del(&app->list); 14769ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend kfree(app); 14779ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend } 14789ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend spin_unlock(&dcb_lock); 14799ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend} 14809ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14812f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic int __init dcbnl_init(void) 14822f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 14839ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend INIT_LIST_HEAD(&dcb_app_list); 14849ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend 14852f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck rtnl_register(PF_UNSPEC, RTM_GETDCB, dcb_doit, NULL); 14862f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck rtnl_register(PF_UNSPEC, RTM_SETDCB, dcb_doit, NULL); 14872f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 14882f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck return 0; 14892f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 14902f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckmodule_init(dcbnl_init); 14912f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck 14922f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckstatic void __exit dcbnl_exit(void) 14932f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck{ 14942f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck rtnl_unregister(PF_UNSPEC, RTM_GETDCB); 14952f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck rtnl_unregister(PF_UNSPEC, RTM_SETDCB); 14969ab933ab2cc80f04690d6aa385b1110075c5e507John Fastabend dcb_flushapp(); 14972f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyck} 14982f90b8657ec942d1880f720e0177ee71df7c8e3cAlexander Duyckmodule_exit(dcbnl_exit); 1499