| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 1 | /* | 
 | 2 |  * Copyright (c) 2008, Intel Corporation. | 
 | 3 |  * | 
 | 4 |  * This program is free software; you can redistribute it and/or modify it | 
 | 5 |  * under the terms and conditions of the GNU General Public License, | 
 | 6 |  * version 2, as published by the Free Software Foundation. | 
 | 7 |  * | 
 | 8 |  * This program is distributed in the hope it will be useful, but WITHOUT | 
 | 9 |  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | 
 | 10 |  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for | 
 | 11 |  * more details. | 
 | 12 |  * | 
 | 13 |  * You should have received a copy of the GNU General Public License along with | 
 | 14 |  * this program; if not, write to the Free Software Foundation, Inc., 59 Temple | 
 | 15 |  * Place - Suite 330, Boston, MA 02111-1307 USA. | 
 | 16 |  * | 
 | 17 |  * Author: Lucy Liu <lucy.liu@intel.com> | 
 | 18 |  */ | 
 | 19 |  | 
 | 20 | #include <linux/netdevice.h> | 
 | 21 | #include <linux/netlink.h> | 
 | 22 | #include <net/netlink.h> | 
 | 23 | #include <net/rtnetlink.h> | 
 | 24 | #include <linux/dcbnl.h> | 
 | 25 | #include <linux/rtnetlink.h> | 
 | 26 | #include <net/sock.h> | 
 | 27 |  | 
 | 28 | /** | 
 | 29 |  * Data Center Bridging (DCB) is a collection of Ethernet enhancements | 
 | 30 |  * intended to allow network traffic with differing requirements | 
 | 31 |  * (highly reliable, no drops vs. best effort vs. low latency) to operate | 
 | 32 |  * and co-exist on Ethernet.  Current DCB features are: | 
 | 33 |  * | 
 | 34 |  * Enhanced Transmission Selection (aka Priority Grouping [PG]) - provides a | 
 | 35 |  *   framework for assigning bandwidth guarantees to traffic classes. | 
 | 36 |  * | 
 | 37 |  * Priority-based Flow Control (PFC) - provides a flow control mechanism which | 
 | 38 |  *   can work independently for each 802.1p priority. | 
 | 39 |  * | 
 | 40 |  * Congestion Notification - provides a mechanism for end-to-end congestion | 
 | 41 |  *   control for protocols which do not have built-in congestion management. | 
 | 42 |  * | 
 | 43 |  * More information about the emerging standards for these Ethernet features | 
 | 44 |  * can be found at: http://www.ieee802.org/1/pages/dcbridges.html | 
 | 45 |  * | 
 | 46 |  * This file implements an rtnetlink interface to allow configuration of DCB | 
 | 47 |  * features for capable devices. | 
 | 48 |  */ | 
 | 49 |  | 
 | 50 | MODULE_AUTHOR("Lucy Liu, <lucy.liu@intel.com>"); | 
| Jeff Kirsher | 7a6b6f5 | 2008-11-25 01:02:08 -0800 | [diff] [blame] | 51 | MODULE_DESCRIPTION("Data Center Bridging netlink interface"); | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 52 | MODULE_LICENSE("GPL"); | 
 | 53 |  | 
 | 54 | /**************** DCB attribute policies *************************************/ | 
 | 55 |  | 
 | 56 | /* DCB netlink attributes policy */ | 
 | 57 | static struct nla_policy dcbnl_rtnl_policy[DCB_ATTR_MAX + 1] = { | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 58 | 	[DCB_ATTR_IFNAME]      = {.type = NLA_NUL_STRING, .len = IFNAMSIZ - 1}, | 
 | 59 | 	[DCB_ATTR_STATE]       = {.type = NLA_U8}, | 
 | 60 | 	[DCB_ATTR_PFC_CFG]     = {.type = NLA_NESTED}, | 
 | 61 | 	[DCB_ATTR_PG_CFG]      = {.type = NLA_NESTED}, | 
 | 62 | 	[DCB_ATTR_SET_ALL]     = {.type = NLA_U8}, | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 63 | 	[DCB_ATTR_PERM_HWADDR] = {.type = NLA_FLAG}, | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 64 | 	[DCB_ATTR_CAP]         = {.type = NLA_NESTED}, | 
 | 65 | 	[DCB_ATTR_PFC_STATE]   = {.type = NLA_U8}, | 
 | 66 | 	[DCB_ATTR_BCN]         = {.type = NLA_NESTED}, | 
| Yi Zou | 6fa382a | 2009-08-31 12:33:20 +0000 | [diff] [blame] | 67 | 	[DCB_ATTR_APP]         = {.type = NLA_NESTED}, | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 68 | }; | 
 | 69 |  | 
 | 70 | /* DCB priority flow control to User Priority nested attributes */ | 
 | 71 | static struct nla_policy dcbnl_pfc_up_nest[DCB_PFC_UP_ATTR_MAX + 1] = { | 
 | 72 | 	[DCB_PFC_UP_ATTR_0]   = {.type = NLA_U8}, | 
 | 73 | 	[DCB_PFC_UP_ATTR_1]   = {.type = NLA_U8}, | 
 | 74 | 	[DCB_PFC_UP_ATTR_2]   = {.type = NLA_U8}, | 
 | 75 | 	[DCB_PFC_UP_ATTR_3]   = {.type = NLA_U8}, | 
 | 76 | 	[DCB_PFC_UP_ATTR_4]   = {.type = NLA_U8}, | 
 | 77 | 	[DCB_PFC_UP_ATTR_5]   = {.type = NLA_U8}, | 
 | 78 | 	[DCB_PFC_UP_ATTR_6]   = {.type = NLA_U8}, | 
 | 79 | 	[DCB_PFC_UP_ATTR_7]   = {.type = NLA_U8}, | 
 | 80 | 	[DCB_PFC_UP_ATTR_ALL] = {.type = NLA_FLAG}, | 
 | 81 | }; | 
 | 82 |  | 
 | 83 | /* DCB priority grouping nested attributes */ | 
 | 84 | static struct nla_policy dcbnl_pg_nest[DCB_PG_ATTR_MAX + 1] = { | 
 | 85 | 	[DCB_PG_ATTR_TC_0]      = {.type = NLA_NESTED}, | 
 | 86 | 	[DCB_PG_ATTR_TC_1]      = {.type = NLA_NESTED}, | 
 | 87 | 	[DCB_PG_ATTR_TC_2]      = {.type = NLA_NESTED}, | 
 | 88 | 	[DCB_PG_ATTR_TC_3]      = {.type = NLA_NESTED}, | 
 | 89 | 	[DCB_PG_ATTR_TC_4]      = {.type = NLA_NESTED}, | 
 | 90 | 	[DCB_PG_ATTR_TC_5]      = {.type = NLA_NESTED}, | 
 | 91 | 	[DCB_PG_ATTR_TC_6]      = {.type = NLA_NESTED}, | 
 | 92 | 	[DCB_PG_ATTR_TC_7]      = {.type = NLA_NESTED}, | 
 | 93 | 	[DCB_PG_ATTR_TC_ALL]    = {.type = NLA_NESTED}, | 
 | 94 | 	[DCB_PG_ATTR_BW_ID_0]   = {.type = NLA_U8}, | 
 | 95 | 	[DCB_PG_ATTR_BW_ID_1]   = {.type = NLA_U8}, | 
 | 96 | 	[DCB_PG_ATTR_BW_ID_2]   = {.type = NLA_U8}, | 
 | 97 | 	[DCB_PG_ATTR_BW_ID_3]   = {.type = NLA_U8}, | 
 | 98 | 	[DCB_PG_ATTR_BW_ID_4]   = {.type = NLA_U8}, | 
 | 99 | 	[DCB_PG_ATTR_BW_ID_5]   = {.type = NLA_U8}, | 
 | 100 | 	[DCB_PG_ATTR_BW_ID_6]   = {.type = NLA_U8}, | 
 | 101 | 	[DCB_PG_ATTR_BW_ID_7]   = {.type = NLA_U8}, | 
 | 102 | 	[DCB_PG_ATTR_BW_ID_ALL] = {.type = NLA_FLAG}, | 
 | 103 | }; | 
 | 104 |  | 
 | 105 | /* DCB traffic class nested attributes. */ | 
 | 106 | static struct nla_policy dcbnl_tc_param_nest[DCB_TC_ATTR_PARAM_MAX + 1] = { | 
 | 107 | 	[DCB_TC_ATTR_PARAM_PGID]            = {.type = NLA_U8}, | 
 | 108 | 	[DCB_TC_ATTR_PARAM_UP_MAPPING]      = {.type = NLA_U8}, | 
 | 109 | 	[DCB_TC_ATTR_PARAM_STRICT_PRIO]     = {.type = NLA_U8}, | 
 | 110 | 	[DCB_TC_ATTR_PARAM_BW_PCT]          = {.type = NLA_U8}, | 
 | 111 | 	[DCB_TC_ATTR_PARAM_ALL]             = {.type = NLA_FLAG}, | 
 | 112 | }; | 
 | 113 |  | 
| Alexander Duyck | 4613218 | 2008-11-20 21:05:08 -0800 | [diff] [blame] | 114 | /* DCB capabilities nested attributes. */ | 
 | 115 | static struct nla_policy dcbnl_cap_nest[DCB_CAP_ATTR_MAX + 1] = { | 
 | 116 | 	[DCB_CAP_ATTR_ALL]     = {.type = NLA_FLAG}, | 
 | 117 | 	[DCB_CAP_ATTR_PG]      = {.type = NLA_U8}, | 
 | 118 | 	[DCB_CAP_ATTR_PFC]     = {.type = NLA_U8}, | 
 | 119 | 	[DCB_CAP_ATTR_UP2TC]   = {.type = NLA_U8}, | 
 | 120 | 	[DCB_CAP_ATTR_PG_TCS]  = {.type = NLA_U8}, | 
 | 121 | 	[DCB_CAP_ATTR_PFC_TCS] = {.type = NLA_U8}, | 
 | 122 | 	[DCB_CAP_ATTR_GSP]     = {.type = NLA_U8}, | 
 | 123 | 	[DCB_CAP_ATTR_BCN]     = {.type = NLA_U8}, | 
 | 124 | }; | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 125 |  | 
| Alexander Duyck | 33dbabc | 2008-11-20 21:08:19 -0800 | [diff] [blame] | 126 | /* DCB capabilities nested attributes. */ | 
 | 127 | static struct nla_policy dcbnl_numtcs_nest[DCB_NUMTCS_ATTR_MAX + 1] = { | 
 | 128 | 	[DCB_NUMTCS_ATTR_ALL]     = {.type = NLA_FLAG}, | 
 | 129 | 	[DCB_NUMTCS_ATTR_PG]      = {.type = NLA_U8}, | 
 | 130 | 	[DCB_NUMTCS_ATTR_PFC]     = {.type = NLA_U8}, | 
 | 131 | }; | 
 | 132 |  | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 133 | /* DCB BCN nested attributes. */ | 
 | 134 | static struct nla_policy dcbnl_bcn_nest[DCB_BCN_ATTR_MAX + 1] = { | 
 | 135 | 	[DCB_BCN_ATTR_RP_0]         = {.type = NLA_U8}, | 
 | 136 | 	[DCB_BCN_ATTR_RP_1]         = {.type = NLA_U8}, | 
 | 137 | 	[DCB_BCN_ATTR_RP_2]         = {.type = NLA_U8}, | 
 | 138 | 	[DCB_BCN_ATTR_RP_3]         = {.type = NLA_U8}, | 
 | 139 | 	[DCB_BCN_ATTR_RP_4]         = {.type = NLA_U8}, | 
 | 140 | 	[DCB_BCN_ATTR_RP_5]         = {.type = NLA_U8}, | 
 | 141 | 	[DCB_BCN_ATTR_RP_6]         = {.type = NLA_U8}, | 
 | 142 | 	[DCB_BCN_ATTR_RP_7]         = {.type = NLA_U8}, | 
 | 143 | 	[DCB_BCN_ATTR_RP_ALL]       = {.type = NLA_FLAG}, | 
| Don Skidmore | f4314e8 | 2008-12-21 20:10:29 -0800 | [diff] [blame] | 144 | 	[DCB_BCN_ATTR_BCNA_0]       = {.type = NLA_U32}, | 
 | 145 | 	[DCB_BCN_ATTR_BCNA_1]       = {.type = NLA_U32}, | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 146 | 	[DCB_BCN_ATTR_ALPHA]        = {.type = NLA_U32}, | 
 | 147 | 	[DCB_BCN_ATTR_BETA]         = {.type = NLA_U32}, | 
 | 148 | 	[DCB_BCN_ATTR_GD]           = {.type = NLA_U32}, | 
 | 149 | 	[DCB_BCN_ATTR_GI]           = {.type = NLA_U32}, | 
 | 150 | 	[DCB_BCN_ATTR_TMAX]         = {.type = NLA_U32}, | 
 | 151 | 	[DCB_BCN_ATTR_TD]           = {.type = NLA_U32}, | 
 | 152 | 	[DCB_BCN_ATTR_RMIN]         = {.type = NLA_U32}, | 
 | 153 | 	[DCB_BCN_ATTR_W]            = {.type = NLA_U32}, | 
 | 154 | 	[DCB_BCN_ATTR_RD]           = {.type = NLA_U32}, | 
 | 155 | 	[DCB_BCN_ATTR_RU]           = {.type = NLA_U32}, | 
 | 156 | 	[DCB_BCN_ATTR_WRTT]         = {.type = NLA_U32}, | 
 | 157 | 	[DCB_BCN_ATTR_RI]           = {.type = NLA_U32}, | 
 | 158 | 	[DCB_BCN_ATTR_C]            = {.type = NLA_U32}, | 
 | 159 | 	[DCB_BCN_ATTR_ALL]          = {.type = NLA_FLAG}, | 
 | 160 | }; | 
 | 161 |  | 
| Yi Zou | 6fa382a | 2009-08-31 12:33:20 +0000 | [diff] [blame] | 162 | /* DCB APP nested attributes. */ | 
 | 163 | static struct nla_policy dcbnl_app_nest[DCB_APP_ATTR_MAX + 1] = { | 
 | 164 | 	[DCB_APP_ATTR_IDTYPE]       = {.type = NLA_U8}, | 
 | 165 | 	[DCB_APP_ATTR_ID]           = {.type = NLA_U16}, | 
 | 166 | 	[DCB_APP_ATTR_PRIORITY]     = {.type = NLA_U8}, | 
 | 167 | }; | 
 | 168 |  | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 169 | /* standard netlink reply call */ | 
 | 170 | static int dcbnl_reply(u8 value, u8 event, u8 cmd, u8 attr, u32 pid, | 
 | 171 |                        u32 seq, u16 flags) | 
 | 172 | { | 
 | 173 | 	struct sk_buff *dcbnl_skb; | 
 | 174 | 	struct dcbmsg *dcb; | 
 | 175 | 	struct nlmsghdr *nlh; | 
 | 176 | 	int ret = -EINVAL; | 
 | 177 |  | 
 | 178 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 179 | 	if (!dcbnl_skb) | 
 | 180 | 		return ret; | 
 | 181 |  | 
 | 182 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, event, sizeof(*dcb), flags); | 
 | 183 |  | 
 | 184 | 	dcb = NLMSG_DATA(nlh); | 
 | 185 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 186 | 	dcb->cmd = cmd; | 
 | 187 | 	dcb->dcb_pad = 0; | 
 | 188 |  | 
 | 189 | 	ret = nla_put_u8(dcbnl_skb, attr, value); | 
 | 190 | 	if (ret) | 
 | 191 | 		goto err; | 
 | 192 |  | 
 | 193 | 	/* end the message, assign the nlmsg_len. */ | 
 | 194 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 195 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 196 | 	if (ret) | 
| John Fastabend | 7eaf507 | 2009-09-25 13:12:03 +0000 | [diff] [blame] | 197 | 		return -EINVAL; | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 198 |  | 
 | 199 | 	return 0; | 
 | 200 | nlmsg_failure: | 
 | 201 | err: | 
| Roel Kluin | 858eb71 | 2009-01-04 17:29:21 -0800 | [diff] [blame] | 202 | 	kfree_skb(dcbnl_skb); | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 203 | 	return ret; | 
 | 204 | } | 
 | 205 |  | 
 | 206 | static int dcbnl_getstate(struct net_device *netdev, struct nlattr **tb, | 
 | 207 |                           u32 pid, u32 seq, u16 flags) | 
 | 208 | { | 
 | 209 | 	int ret = -EINVAL; | 
 | 210 |  | 
 | 211 | 	/* if (!tb[DCB_ATTR_STATE] || !netdev->dcbnl_ops->getstate) */ | 
 | 212 | 	if (!netdev->dcbnl_ops->getstate) | 
 | 213 | 		return ret; | 
 | 214 |  | 
 | 215 | 	ret = dcbnl_reply(netdev->dcbnl_ops->getstate(netdev), RTM_GETDCB, | 
 | 216 | 	                  DCB_CMD_GSTATE, DCB_ATTR_STATE, pid, seq, flags); | 
 | 217 |  | 
 | 218 | 	return ret; | 
 | 219 | } | 
 | 220 |  | 
 | 221 | static int dcbnl_getpfccfg(struct net_device *netdev, struct nlattr **tb, | 
 | 222 |                            u32 pid, u32 seq, u16 flags) | 
 | 223 | { | 
 | 224 | 	struct sk_buff *dcbnl_skb; | 
 | 225 | 	struct nlmsghdr *nlh; | 
 | 226 | 	struct dcbmsg *dcb; | 
 | 227 | 	struct nlattr *data[DCB_PFC_UP_ATTR_MAX + 1], *nest; | 
 | 228 | 	u8 value; | 
 | 229 | 	int ret = -EINVAL; | 
 | 230 | 	int i; | 
 | 231 | 	int getall = 0; | 
 | 232 |  | 
 | 233 | 	if (!tb[DCB_ATTR_PFC_CFG] || !netdev->dcbnl_ops->getpfccfg) | 
 | 234 | 		return ret; | 
 | 235 |  | 
 | 236 | 	ret = nla_parse_nested(data, DCB_PFC_UP_ATTR_MAX, | 
 | 237 | 	                       tb[DCB_ATTR_PFC_CFG], | 
 | 238 | 	                       dcbnl_pfc_up_nest); | 
 | 239 | 	if (ret) | 
 | 240 | 		goto err_out; | 
 | 241 |  | 
 | 242 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 243 | 	if (!dcbnl_skb) | 
 | 244 | 		goto err_out; | 
 | 245 |  | 
 | 246 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); | 
 | 247 |  | 
 | 248 | 	dcb = NLMSG_DATA(nlh); | 
 | 249 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 250 | 	dcb->cmd = DCB_CMD_PFC_GCFG; | 
 | 251 |  | 
 | 252 | 	nest = nla_nest_start(dcbnl_skb, DCB_ATTR_PFC_CFG); | 
 | 253 | 	if (!nest) | 
 | 254 | 		goto err; | 
 | 255 |  | 
 | 256 | 	if (data[DCB_PFC_UP_ATTR_ALL]) | 
 | 257 | 		getall = 1; | 
 | 258 |  | 
 | 259 | 	for (i = DCB_PFC_UP_ATTR_0; i <= DCB_PFC_UP_ATTR_7; i++) { | 
 | 260 | 		if (!getall && !data[i]) | 
 | 261 | 			continue; | 
 | 262 |  | 
 | 263 | 		netdev->dcbnl_ops->getpfccfg(netdev, i - DCB_PFC_UP_ATTR_0, | 
 | 264 | 		                             &value); | 
 | 265 | 		ret = nla_put_u8(dcbnl_skb, i, value); | 
 | 266 |  | 
 | 267 | 		if (ret) { | 
 | 268 | 			nla_nest_cancel(dcbnl_skb, nest); | 
 | 269 | 			goto err; | 
 | 270 | 		} | 
 | 271 | 	} | 
 | 272 | 	nla_nest_end(dcbnl_skb, nest); | 
 | 273 |  | 
 | 274 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 275 |  | 
 | 276 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 277 | 	if (ret) | 
| John Fastabend | 7eaf507 | 2009-09-25 13:12:03 +0000 | [diff] [blame] | 278 | 		goto err_out; | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 279 |  | 
 | 280 | 	return 0; | 
 | 281 | nlmsg_failure: | 
 | 282 | err: | 
| Roel Kluin | 858eb71 | 2009-01-04 17:29:21 -0800 | [diff] [blame] | 283 | 	kfree_skb(dcbnl_skb); | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 284 | err_out: | 
 | 285 | 	return -EINVAL; | 
 | 286 | } | 
 | 287 |  | 
 | 288 | static int dcbnl_getperm_hwaddr(struct net_device *netdev, struct nlattr **tb, | 
 | 289 |                                 u32 pid, u32 seq, u16 flags) | 
 | 290 | { | 
 | 291 | 	struct sk_buff *dcbnl_skb; | 
 | 292 | 	struct nlmsghdr *nlh; | 
 | 293 | 	struct dcbmsg *dcb; | 
 | 294 | 	u8 perm_addr[MAX_ADDR_LEN]; | 
 | 295 | 	int ret = -EINVAL; | 
 | 296 |  | 
 | 297 | 	if (!netdev->dcbnl_ops->getpermhwaddr) | 
 | 298 | 		return ret; | 
 | 299 |  | 
 | 300 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 301 | 	if (!dcbnl_skb) | 
 | 302 | 		goto err_out; | 
 | 303 |  | 
 | 304 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); | 
 | 305 |  | 
 | 306 | 	dcb = NLMSG_DATA(nlh); | 
 | 307 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 308 | 	dcb->cmd = DCB_CMD_GPERM_HWADDR; | 
 | 309 |  | 
 | 310 | 	netdev->dcbnl_ops->getpermhwaddr(netdev, perm_addr); | 
 | 311 |  | 
 | 312 | 	ret = nla_put(dcbnl_skb, DCB_ATTR_PERM_HWADDR, sizeof(perm_addr), | 
 | 313 | 	              perm_addr); | 
 | 314 |  | 
 | 315 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 316 |  | 
 | 317 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 318 | 	if (ret) | 
| John Fastabend | 7eaf507 | 2009-09-25 13:12:03 +0000 | [diff] [blame] | 319 | 		goto err_out; | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 320 |  | 
 | 321 | 	return 0; | 
 | 322 |  | 
 | 323 | nlmsg_failure: | 
| Roel Kluin | 858eb71 | 2009-01-04 17:29:21 -0800 | [diff] [blame] | 324 | 	kfree_skb(dcbnl_skb); | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 325 | err_out: | 
 | 326 | 	return -EINVAL; | 
 | 327 | } | 
 | 328 |  | 
| Alexander Duyck | 4613218 | 2008-11-20 21:05:08 -0800 | [diff] [blame] | 329 | static int dcbnl_getcap(struct net_device *netdev, struct nlattr **tb, | 
 | 330 |                         u32 pid, u32 seq, u16 flags) | 
 | 331 | { | 
 | 332 | 	struct sk_buff *dcbnl_skb; | 
 | 333 | 	struct nlmsghdr *nlh; | 
 | 334 | 	struct dcbmsg *dcb; | 
 | 335 | 	struct nlattr *data[DCB_CAP_ATTR_MAX + 1], *nest; | 
 | 336 | 	u8 value; | 
 | 337 | 	int ret = -EINVAL; | 
 | 338 | 	int i; | 
 | 339 | 	int getall = 0; | 
 | 340 |  | 
 | 341 | 	if (!tb[DCB_ATTR_CAP] || !netdev->dcbnl_ops->getcap) | 
 | 342 | 		return ret; | 
 | 343 |  | 
 | 344 | 	ret = nla_parse_nested(data, DCB_CAP_ATTR_MAX, tb[DCB_ATTR_CAP], | 
 | 345 | 	                       dcbnl_cap_nest); | 
 | 346 | 	if (ret) | 
 | 347 | 		goto err_out; | 
 | 348 |  | 
 | 349 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 350 | 	if (!dcbnl_skb) | 
 | 351 | 		goto err_out; | 
 | 352 |  | 
 | 353 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); | 
 | 354 |  | 
 | 355 | 	dcb = NLMSG_DATA(nlh); | 
 | 356 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 357 | 	dcb->cmd = DCB_CMD_GCAP; | 
 | 358 |  | 
 | 359 | 	nest = nla_nest_start(dcbnl_skb, DCB_ATTR_CAP); | 
 | 360 | 	if (!nest) | 
 | 361 | 		goto err; | 
 | 362 |  | 
 | 363 | 	if (data[DCB_CAP_ATTR_ALL]) | 
 | 364 | 		getall = 1; | 
 | 365 |  | 
 | 366 | 	for (i = DCB_CAP_ATTR_ALL+1; i <= DCB_CAP_ATTR_MAX; i++) { | 
 | 367 | 		if (!getall && !data[i]) | 
 | 368 | 			continue; | 
 | 369 |  | 
 | 370 | 		if (!netdev->dcbnl_ops->getcap(netdev, i, &value)) { | 
 | 371 | 			ret = nla_put_u8(dcbnl_skb, i, value); | 
 | 372 |  | 
 | 373 | 			if (ret) { | 
 | 374 | 				nla_nest_cancel(dcbnl_skb, nest); | 
 | 375 | 				goto err; | 
 | 376 | 			} | 
 | 377 | 		} | 
 | 378 | 	} | 
 | 379 | 	nla_nest_end(dcbnl_skb, nest); | 
 | 380 |  | 
 | 381 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 382 |  | 
 | 383 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 384 | 	if (ret) | 
| John Fastabend | 7eaf507 | 2009-09-25 13:12:03 +0000 | [diff] [blame] | 385 | 		goto err_out; | 
| Alexander Duyck | 4613218 | 2008-11-20 21:05:08 -0800 | [diff] [blame] | 386 |  | 
 | 387 | 	return 0; | 
 | 388 | nlmsg_failure: | 
 | 389 | err: | 
| Roel Kluin | 858eb71 | 2009-01-04 17:29:21 -0800 | [diff] [blame] | 390 | 	kfree_skb(dcbnl_skb); | 
| Alexander Duyck | 4613218 | 2008-11-20 21:05:08 -0800 | [diff] [blame] | 391 | err_out: | 
 | 392 | 	return -EINVAL; | 
 | 393 | } | 
 | 394 |  | 
| Alexander Duyck | 33dbabc | 2008-11-20 21:08:19 -0800 | [diff] [blame] | 395 | static int dcbnl_getnumtcs(struct net_device *netdev, struct nlattr **tb, | 
 | 396 |                            u32 pid, u32 seq, u16 flags) | 
 | 397 | { | 
 | 398 | 	struct sk_buff *dcbnl_skb; | 
 | 399 | 	struct nlmsghdr *nlh; | 
 | 400 | 	struct dcbmsg *dcb; | 
 | 401 | 	struct nlattr *data[DCB_NUMTCS_ATTR_MAX + 1], *nest; | 
 | 402 | 	u8 value; | 
 | 403 | 	int ret = -EINVAL; | 
 | 404 | 	int i; | 
 | 405 | 	int getall = 0; | 
 | 406 |  | 
 | 407 | 	if (!tb[DCB_ATTR_NUMTCS] || !netdev->dcbnl_ops->getnumtcs) | 
 | 408 | 		return ret; | 
 | 409 |  | 
 | 410 | 	ret = nla_parse_nested(data, DCB_NUMTCS_ATTR_MAX, tb[DCB_ATTR_NUMTCS], | 
 | 411 | 	                       dcbnl_numtcs_nest); | 
 | 412 | 	if (ret) { | 
 | 413 | 		ret = -EINVAL; | 
 | 414 | 		goto err_out; | 
 | 415 | 	} | 
 | 416 |  | 
 | 417 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 418 | 	if (!dcbnl_skb) { | 
 | 419 | 		ret = -EINVAL; | 
 | 420 | 		goto err_out; | 
 | 421 | 	} | 
 | 422 |  | 
 | 423 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); | 
 | 424 |  | 
 | 425 | 	dcb = NLMSG_DATA(nlh); | 
 | 426 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 427 | 	dcb->cmd = DCB_CMD_GNUMTCS; | 
 | 428 |  | 
 | 429 | 	nest = nla_nest_start(dcbnl_skb, DCB_ATTR_NUMTCS); | 
 | 430 | 	if (!nest) { | 
 | 431 | 		ret = -EINVAL; | 
 | 432 | 		goto err; | 
 | 433 | 	} | 
 | 434 |  | 
 | 435 | 	if (data[DCB_NUMTCS_ATTR_ALL]) | 
 | 436 | 		getall = 1; | 
 | 437 |  | 
 | 438 | 	for (i = DCB_NUMTCS_ATTR_ALL+1; i <= DCB_NUMTCS_ATTR_MAX; i++) { | 
 | 439 | 		if (!getall && !data[i]) | 
 | 440 | 			continue; | 
 | 441 |  | 
 | 442 | 		ret = netdev->dcbnl_ops->getnumtcs(netdev, i, &value); | 
 | 443 | 		if (!ret) { | 
 | 444 | 			ret = nla_put_u8(dcbnl_skb, i, value); | 
 | 445 |  | 
 | 446 | 			if (ret) { | 
 | 447 | 				nla_nest_cancel(dcbnl_skb, nest); | 
 | 448 | 				ret = -EINVAL; | 
 | 449 | 				goto err; | 
 | 450 | 			} | 
 | 451 | 		} else { | 
 | 452 | 			goto err; | 
 | 453 | 		} | 
 | 454 | 	} | 
 | 455 | 	nla_nest_end(dcbnl_skb, nest); | 
 | 456 |  | 
 | 457 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 458 |  | 
 | 459 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 460 | 	if (ret) { | 
 | 461 | 		ret = -EINVAL; | 
| John Fastabend | 7eaf507 | 2009-09-25 13:12:03 +0000 | [diff] [blame] | 462 | 		goto err_out; | 
| Alexander Duyck | 33dbabc | 2008-11-20 21:08:19 -0800 | [diff] [blame] | 463 | 	} | 
 | 464 |  | 
 | 465 | 	return 0; | 
 | 466 | nlmsg_failure: | 
 | 467 | err: | 
| Roel Kluin | 858eb71 | 2009-01-04 17:29:21 -0800 | [diff] [blame] | 468 | 	kfree_skb(dcbnl_skb); | 
| Alexander Duyck | 33dbabc | 2008-11-20 21:08:19 -0800 | [diff] [blame] | 469 | err_out: | 
 | 470 | 	return ret; | 
 | 471 | } | 
 | 472 |  | 
 | 473 | static int dcbnl_setnumtcs(struct net_device *netdev, struct nlattr **tb, | 
 | 474 |                            u32 pid, u32 seq, u16 flags) | 
 | 475 | { | 
 | 476 | 	struct nlattr *data[DCB_NUMTCS_ATTR_MAX + 1]; | 
 | 477 | 	int ret = -EINVAL; | 
 | 478 | 	u8 value; | 
 | 479 | 	int i; | 
 | 480 |  | 
| Don Skidmore | 8b124a8 | 2008-12-15 01:06:23 -0800 | [diff] [blame] | 481 | 	if (!tb[DCB_ATTR_NUMTCS] || !netdev->dcbnl_ops->setnumtcs) | 
| Alexander Duyck | 33dbabc | 2008-11-20 21:08:19 -0800 | [diff] [blame] | 482 | 		return ret; | 
 | 483 |  | 
 | 484 | 	ret = nla_parse_nested(data, DCB_NUMTCS_ATTR_MAX, tb[DCB_ATTR_NUMTCS], | 
 | 485 | 	                       dcbnl_numtcs_nest); | 
 | 486 |  | 
 | 487 | 	if (ret) { | 
 | 488 | 		ret = -EINVAL; | 
 | 489 | 		goto err; | 
 | 490 | 	} | 
 | 491 |  | 
 | 492 | 	for (i = DCB_NUMTCS_ATTR_ALL+1; i <= DCB_NUMTCS_ATTR_MAX; i++) { | 
 | 493 | 		if (data[i] == NULL) | 
 | 494 | 			continue; | 
 | 495 |  | 
 | 496 | 		value = nla_get_u8(data[i]); | 
 | 497 |  | 
 | 498 | 		ret = netdev->dcbnl_ops->setnumtcs(netdev, i, value); | 
 | 499 |  | 
 | 500 | 		if (ret) | 
 | 501 | 			goto operr; | 
 | 502 | 	} | 
 | 503 |  | 
 | 504 | operr: | 
 | 505 | 	ret = dcbnl_reply(!!ret, RTM_SETDCB, DCB_CMD_SNUMTCS, | 
 | 506 | 	                  DCB_ATTR_NUMTCS, pid, seq, flags); | 
 | 507 |  | 
 | 508 | err: | 
 | 509 | 	return ret; | 
 | 510 | } | 
 | 511 |  | 
| Alexander Duyck | 0eb3aa9 | 2008-11-20 21:09:23 -0800 | [diff] [blame] | 512 | static int dcbnl_getpfcstate(struct net_device *netdev, struct nlattr **tb, | 
 | 513 |                              u32 pid, u32 seq, u16 flags) | 
 | 514 | { | 
 | 515 | 	int ret = -EINVAL; | 
 | 516 |  | 
 | 517 | 	if (!netdev->dcbnl_ops->getpfcstate) | 
 | 518 | 		return ret; | 
 | 519 |  | 
 | 520 | 	ret = dcbnl_reply(netdev->dcbnl_ops->getpfcstate(netdev), RTM_GETDCB, | 
 | 521 | 	                  DCB_CMD_PFC_GSTATE, DCB_ATTR_PFC_STATE, | 
 | 522 | 	                  pid, seq, flags); | 
 | 523 |  | 
 | 524 | 	return ret; | 
 | 525 | } | 
 | 526 |  | 
 | 527 | static int dcbnl_setpfcstate(struct net_device *netdev, struct nlattr **tb, | 
 | 528 |                              u32 pid, u32 seq, u16 flags) | 
 | 529 | { | 
 | 530 | 	int ret = -EINVAL; | 
 | 531 | 	u8 value; | 
 | 532 |  | 
 | 533 | 	if (!tb[DCB_ATTR_PFC_STATE] || !netdev->dcbnl_ops->setpfcstate) | 
 | 534 | 		return ret; | 
 | 535 |  | 
 | 536 | 	value = nla_get_u8(tb[DCB_ATTR_PFC_STATE]); | 
 | 537 |  | 
 | 538 | 	netdev->dcbnl_ops->setpfcstate(netdev, value); | 
 | 539 |  | 
 | 540 | 	ret = dcbnl_reply(0, RTM_SETDCB, DCB_CMD_PFC_SSTATE, DCB_ATTR_PFC_STATE, | 
 | 541 | 	                  pid, seq, flags); | 
 | 542 |  | 
 | 543 | 	return ret; | 
 | 544 | } | 
 | 545 |  | 
| Yi Zou | 5794968 | 2009-08-31 12:33:40 +0000 | [diff] [blame] | 546 | static int dcbnl_getapp(struct net_device *netdev, struct nlattr **tb, | 
 | 547 |                         u32 pid, u32 seq, u16 flags) | 
 | 548 | { | 
 | 549 | 	struct sk_buff *dcbnl_skb; | 
 | 550 | 	struct nlmsghdr *nlh; | 
 | 551 | 	struct dcbmsg *dcb; | 
 | 552 | 	struct nlattr *app_nest; | 
 | 553 | 	struct nlattr *app_tb[DCB_APP_ATTR_MAX + 1]; | 
 | 554 | 	u16 id; | 
 | 555 | 	u8 up, idtype; | 
 | 556 | 	int ret = -EINVAL; | 
 | 557 |  | 
 | 558 | 	if (!tb[DCB_ATTR_APP] || !netdev->dcbnl_ops->getapp) | 
 | 559 | 		goto out; | 
 | 560 |  | 
 | 561 | 	ret = nla_parse_nested(app_tb, DCB_APP_ATTR_MAX, tb[DCB_ATTR_APP], | 
 | 562 | 	                       dcbnl_app_nest); | 
 | 563 | 	if (ret) | 
 | 564 | 		goto out; | 
 | 565 |  | 
 | 566 | 	ret = -EINVAL; | 
 | 567 | 	/* all must be non-null */ | 
 | 568 | 	if ((!app_tb[DCB_APP_ATTR_IDTYPE]) || | 
 | 569 | 	    (!app_tb[DCB_APP_ATTR_ID])) | 
 | 570 | 		goto out; | 
 | 571 |  | 
 | 572 | 	/* either by eth type or by socket number */ | 
 | 573 | 	idtype = nla_get_u8(app_tb[DCB_APP_ATTR_IDTYPE]); | 
 | 574 | 	if ((idtype != DCB_APP_IDTYPE_ETHTYPE) && | 
 | 575 | 	    (idtype != DCB_APP_IDTYPE_PORTNUM)) | 
 | 576 | 		goto out; | 
 | 577 |  | 
 | 578 | 	id = nla_get_u16(app_tb[DCB_APP_ATTR_ID]); | 
 | 579 | 	up = netdev->dcbnl_ops->getapp(netdev, idtype, id); | 
 | 580 |  | 
 | 581 | 	/* send this back */ | 
 | 582 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 583 | 	if (!dcbnl_skb) | 
 | 584 | 		goto out; | 
 | 585 |  | 
 | 586 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); | 
 | 587 | 	dcb = NLMSG_DATA(nlh); | 
 | 588 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 589 | 	dcb->cmd = DCB_CMD_GAPP; | 
 | 590 |  | 
 | 591 | 	app_nest = nla_nest_start(dcbnl_skb, DCB_ATTR_APP); | 
 | 592 | 	ret = nla_put_u8(dcbnl_skb, DCB_APP_ATTR_IDTYPE, idtype); | 
 | 593 | 	if (ret) | 
 | 594 | 		goto out_cancel; | 
 | 595 |  | 
 | 596 | 	ret = nla_put_u16(dcbnl_skb, DCB_APP_ATTR_ID, id); | 
 | 597 | 	if (ret) | 
 | 598 | 		goto out_cancel; | 
 | 599 |  | 
 | 600 | 	ret = nla_put_u8(dcbnl_skb, DCB_APP_ATTR_PRIORITY, up); | 
 | 601 | 	if (ret) | 
 | 602 | 		goto out_cancel; | 
 | 603 |  | 
 | 604 | 	nla_nest_end(dcbnl_skb, app_nest); | 
 | 605 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 606 |  | 
 | 607 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 608 | 	if (ret) | 
 | 609 | 		goto nlmsg_failure; | 
 | 610 |  | 
 | 611 | 	goto out; | 
 | 612 |  | 
 | 613 | out_cancel: | 
 | 614 | 	nla_nest_cancel(dcbnl_skb, app_nest); | 
 | 615 | nlmsg_failure: | 
 | 616 | 	kfree_skb(dcbnl_skb); | 
 | 617 | out: | 
 | 618 | 	return ret; | 
 | 619 | } | 
 | 620 |  | 
 | 621 | static int dcbnl_setapp(struct net_device *netdev, struct nlattr **tb, | 
 | 622 |                         u32 pid, u32 seq, u16 flags) | 
 | 623 | { | 
 | 624 | 	int ret = -EINVAL; | 
 | 625 | 	u16 id; | 
 | 626 | 	u8 up, idtype; | 
 | 627 | 	struct nlattr *app_tb[DCB_APP_ATTR_MAX + 1]; | 
 | 628 |  | 
 | 629 | 	if (!tb[DCB_ATTR_APP] || !netdev->dcbnl_ops->setapp) | 
 | 630 | 		goto out; | 
 | 631 |  | 
 | 632 | 	ret = nla_parse_nested(app_tb, DCB_APP_ATTR_MAX, tb[DCB_ATTR_APP], | 
 | 633 | 	                       dcbnl_app_nest); | 
 | 634 | 	if (ret) | 
 | 635 | 		goto out; | 
 | 636 |  | 
 | 637 | 	ret = -EINVAL; | 
 | 638 | 	/* all must be non-null */ | 
 | 639 | 	if ((!app_tb[DCB_APP_ATTR_IDTYPE]) || | 
 | 640 | 	    (!app_tb[DCB_APP_ATTR_ID]) || | 
 | 641 | 	    (!app_tb[DCB_APP_ATTR_PRIORITY])) | 
 | 642 | 		goto out; | 
 | 643 |  | 
 | 644 | 	/* either by eth type or by socket number */ | 
 | 645 | 	idtype = nla_get_u8(app_tb[DCB_APP_ATTR_IDTYPE]); | 
 | 646 | 	if ((idtype != DCB_APP_IDTYPE_ETHTYPE) && | 
 | 647 | 	    (idtype != DCB_APP_IDTYPE_PORTNUM)) | 
 | 648 | 		goto out; | 
 | 649 |  | 
 | 650 | 	id = nla_get_u16(app_tb[DCB_APP_ATTR_ID]); | 
 | 651 | 	up = nla_get_u8(app_tb[DCB_APP_ATTR_PRIORITY]); | 
 | 652 |  | 
 | 653 | 	ret = dcbnl_reply(netdev->dcbnl_ops->setapp(netdev, idtype, id, up), | 
 | 654 | 	                  RTM_SETDCB, DCB_CMD_SAPP, DCB_ATTR_APP, | 
 | 655 | 	                  pid, seq, flags); | 
 | 656 | out: | 
 | 657 | 	return ret; | 
 | 658 | } | 
 | 659 |  | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 660 | static int __dcbnl_pg_getcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 661 |                              u32 pid, u32 seq, u16 flags, int dir) | 
 | 662 | { | 
 | 663 | 	struct sk_buff *dcbnl_skb; | 
 | 664 | 	struct nlmsghdr *nlh; | 
 | 665 | 	struct dcbmsg *dcb; | 
 | 666 | 	struct nlattr *pg_nest, *param_nest, *data; | 
 | 667 | 	struct nlattr *pg_tb[DCB_PG_ATTR_MAX + 1]; | 
 | 668 | 	struct nlattr *param_tb[DCB_TC_ATTR_PARAM_MAX + 1]; | 
 | 669 | 	u8 prio, pgid, tc_pct, up_map; | 
 | 670 | 	int ret  = -EINVAL; | 
 | 671 | 	int getall = 0; | 
 | 672 | 	int i; | 
 | 673 |  | 
 | 674 | 	if (!tb[DCB_ATTR_PG_CFG] || | 
 | 675 | 	    !netdev->dcbnl_ops->getpgtccfgtx || | 
 | 676 | 	    !netdev->dcbnl_ops->getpgtccfgrx || | 
 | 677 | 	    !netdev->dcbnl_ops->getpgbwgcfgtx || | 
 | 678 | 	    !netdev->dcbnl_ops->getpgbwgcfgrx) | 
 | 679 | 		return ret; | 
 | 680 |  | 
 | 681 | 	ret = nla_parse_nested(pg_tb, DCB_PG_ATTR_MAX, | 
 | 682 | 	                       tb[DCB_ATTR_PG_CFG], dcbnl_pg_nest); | 
 | 683 |  | 
 | 684 | 	if (ret) | 
 | 685 | 		goto err_out; | 
 | 686 |  | 
 | 687 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 688 | 	if (!dcbnl_skb) | 
 | 689 | 		goto err_out; | 
 | 690 |  | 
 | 691 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); | 
 | 692 |  | 
 | 693 | 	dcb = NLMSG_DATA(nlh); | 
 | 694 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 695 | 	dcb->cmd = (dir) ? DCB_CMD_PGRX_GCFG : DCB_CMD_PGTX_GCFG; | 
 | 696 |  | 
 | 697 | 	pg_nest = nla_nest_start(dcbnl_skb, DCB_ATTR_PG_CFG); | 
 | 698 | 	if (!pg_nest) | 
 | 699 | 		goto err; | 
 | 700 |  | 
 | 701 | 	if (pg_tb[DCB_PG_ATTR_TC_ALL]) | 
 | 702 | 		getall = 1; | 
 | 703 |  | 
 | 704 | 	for (i = DCB_PG_ATTR_TC_0; i <= DCB_PG_ATTR_TC_7; i++) { | 
 | 705 | 		if (!getall && !pg_tb[i]) | 
 | 706 | 			continue; | 
 | 707 |  | 
 | 708 | 		if (pg_tb[DCB_PG_ATTR_TC_ALL]) | 
 | 709 | 			data = pg_tb[DCB_PG_ATTR_TC_ALL]; | 
 | 710 | 		else | 
 | 711 | 			data = pg_tb[i]; | 
 | 712 | 		ret = nla_parse_nested(param_tb, DCB_TC_ATTR_PARAM_MAX, | 
 | 713 | 				       data, dcbnl_tc_param_nest); | 
 | 714 | 		if (ret) | 
 | 715 | 			goto err_pg; | 
 | 716 |  | 
 | 717 | 		param_nest = nla_nest_start(dcbnl_skb, i); | 
 | 718 | 		if (!param_nest) | 
 | 719 | 			goto err_pg; | 
 | 720 |  | 
 | 721 | 		pgid = DCB_ATTR_VALUE_UNDEFINED; | 
 | 722 | 		prio = DCB_ATTR_VALUE_UNDEFINED; | 
 | 723 | 		tc_pct = DCB_ATTR_VALUE_UNDEFINED; | 
 | 724 | 		up_map = DCB_ATTR_VALUE_UNDEFINED; | 
 | 725 |  | 
 | 726 | 		if (dir) { | 
 | 727 | 			/* Rx */ | 
 | 728 | 			netdev->dcbnl_ops->getpgtccfgrx(netdev, | 
 | 729 | 						i - DCB_PG_ATTR_TC_0, &prio, | 
 | 730 | 						&pgid, &tc_pct, &up_map); | 
 | 731 | 		} else { | 
 | 732 | 			/* Tx */ | 
 | 733 | 			netdev->dcbnl_ops->getpgtccfgtx(netdev, | 
 | 734 | 						i - DCB_PG_ATTR_TC_0, &prio, | 
 | 735 | 						&pgid, &tc_pct, &up_map); | 
 | 736 | 		} | 
 | 737 |  | 
 | 738 | 		if (param_tb[DCB_TC_ATTR_PARAM_PGID] || | 
 | 739 | 		    param_tb[DCB_TC_ATTR_PARAM_ALL]) { | 
 | 740 | 			ret = nla_put_u8(dcbnl_skb, | 
 | 741 | 			                 DCB_TC_ATTR_PARAM_PGID, pgid); | 
 | 742 | 			if (ret) | 
 | 743 | 				goto err_param; | 
 | 744 | 		} | 
 | 745 | 		if (param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING] || | 
 | 746 | 		    param_tb[DCB_TC_ATTR_PARAM_ALL]) { | 
 | 747 | 			ret = nla_put_u8(dcbnl_skb, | 
 | 748 | 			                 DCB_TC_ATTR_PARAM_UP_MAPPING, up_map); | 
 | 749 | 			if (ret) | 
 | 750 | 				goto err_param; | 
 | 751 | 		} | 
 | 752 | 		if (param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO] || | 
 | 753 | 		    param_tb[DCB_TC_ATTR_PARAM_ALL]) { | 
 | 754 | 			ret = nla_put_u8(dcbnl_skb, | 
 | 755 | 			                 DCB_TC_ATTR_PARAM_STRICT_PRIO, prio); | 
 | 756 | 			if (ret) | 
 | 757 | 				goto err_param; | 
 | 758 | 		} | 
 | 759 | 		if (param_tb[DCB_TC_ATTR_PARAM_BW_PCT] || | 
 | 760 | 		    param_tb[DCB_TC_ATTR_PARAM_ALL]) { | 
 | 761 | 			ret = nla_put_u8(dcbnl_skb, DCB_TC_ATTR_PARAM_BW_PCT, | 
 | 762 | 			                 tc_pct); | 
 | 763 | 			if (ret) | 
 | 764 | 				goto err_param; | 
 | 765 | 		} | 
 | 766 | 		nla_nest_end(dcbnl_skb, param_nest); | 
 | 767 | 	} | 
 | 768 |  | 
 | 769 | 	if (pg_tb[DCB_PG_ATTR_BW_ID_ALL]) | 
 | 770 | 		getall = 1; | 
 | 771 | 	else | 
 | 772 | 		getall = 0; | 
 | 773 |  | 
 | 774 | 	for (i = DCB_PG_ATTR_BW_ID_0; i <= DCB_PG_ATTR_BW_ID_7; i++) { | 
 | 775 | 		if (!getall && !pg_tb[i]) | 
 | 776 | 			continue; | 
 | 777 |  | 
 | 778 | 		tc_pct = DCB_ATTR_VALUE_UNDEFINED; | 
 | 779 |  | 
 | 780 | 		if (dir) { | 
 | 781 | 			/* Rx */ | 
 | 782 | 			netdev->dcbnl_ops->getpgbwgcfgrx(netdev, | 
 | 783 | 					i - DCB_PG_ATTR_BW_ID_0, &tc_pct); | 
 | 784 | 		} else { | 
 | 785 | 			/* Tx */ | 
 | 786 | 			netdev->dcbnl_ops->getpgbwgcfgtx(netdev, | 
 | 787 | 					i - DCB_PG_ATTR_BW_ID_0, &tc_pct); | 
 | 788 | 		} | 
 | 789 | 		ret = nla_put_u8(dcbnl_skb, i, tc_pct); | 
 | 790 |  | 
 | 791 | 		if (ret) | 
 | 792 | 			goto err_pg; | 
 | 793 | 	} | 
 | 794 |  | 
 | 795 | 	nla_nest_end(dcbnl_skb, pg_nest); | 
 | 796 |  | 
 | 797 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 798 |  | 
 | 799 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 800 | 	if (ret) | 
| John Fastabend | 7eaf507 | 2009-09-25 13:12:03 +0000 | [diff] [blame] | 801 | 		goto err_out; | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 802 |  | 
 | 803 | 	return 0; | 
 | 804 |  | 
 | 805 | err_param: | 
 | 806 | 	nla_nest_cancel(dcbnl_skb, param_nest); | 
 | 807 | err_pg: | 
 | 808 | 	nla_nest_cancel(dcbnl_skb, pg_nest); | 
 | 809 | nlmsg_failure: | 
 | 810 | err: | 
| Roel Kluin | 858eb71 | 2009-01-04 17:29:21 -0800 | [diff] [blame] | 811 | 	kfree_skb(dcbnl_skb); | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 812 | err_out: | 
 | 813 | 	ret  = -EINVAL; | 
 | 814 | 	return ret; | 
 | 815 | } | 
 | 816 |  | 
 | 817 | static int dcbnl_pgtx_getcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 818 |                              u32 pid, u32 seq, u16 flags) | 
 | 819 | { | 
 | 820 | 	return __dcbnl_pg_getcfg(netdev, tb, pid, seq, flags, 0); | 
 | 821 | } | 
 | 822 |  | 
 | 823 | static int dcbnl_pgrx_getcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 824 |                              u32 pid, u32 seq, u16 flags) | 
 | 825 | { | 
 | 826 | 	return __dcbnl_pg_getcfg(netdev, tb, pid, seq, flags, 1); | 
 | 827 | } | 
 | 828 |  | 
 | 829 | static int dcbnl_setstate(struct net_device *netdev, struct nlattr **tb, | 
 | 830 |                           u32 pid, u32 seq, u16 flags) | 
 | 831 | { | 
 | 832 | 	int ret = -EINVAL; | 
 | 833 | 	u8 value; | 
 | 834 |  | 
 | 835 | 	if (!tb[DCB_ATTR_STATE] || !netdev->dcbnl_ops->setstate) | 
 | 836 | 		return ret; | 
 | 837 |  | 
 | 838 | 	value = nla_get_u8(tb[DCB_ATTR_STATE]); | 
 | 839 |  | 
| Don Skidmore | 1486a61 | 2008-12-21 20:09:50 -0800 | [diff] [blame] | 840 | 	ret = dcbnl_reply(netdev->dcbnl_ops->setstate(netdev, value), | 
 | 841 | 	                  RTM_SETDCB, DCB_CMD_SSTATE, DCB_ATTR_STATE, | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 842 | 	                  pid, seq, flags); | 
 | 843 |  | 
 | 844 | 	return ret; | 
 | 845 | } | 
 | 846 |  | 
 | 847 | static int dcbnl_setpfccfg(struct net_device *netdev, struct nlattr **tb, | 
 | 848 |                            u32 pid, u32 seq, u16 flags) | 
 | 849 | { | 
 | 850 | 	struct nlattr *data[DCB_PFC_UP_ATTR_MAX + 1]; | 
 | 851 | 	int i; | 
 | 852 | 	int ret = -EINVAL; | 
 | 853 | 	u8 value; | 
 | 854 |  | 
 | 855 | 	if (!tb[DCB_ATTR_PFC_CFG] || !netdev->dcbnl_ops->setpfccfg) | 
 | 856 | 		return ret; | 
 | 857 |  | 
 | 858 | 	ret = nla_parse_nested(data, DCB_PFC_UP_ATTR_MAX, | 
 | 859 | 	                       tb[DCB_ATTR_PFC_CFG], | 
 | 860 | 	                       dcbnl_pfc_up_nest); | 
 | 861 | 	if (ret) | 
 | 862 | 		goto err; | 
 | 863 |  | 
 | 864 | 	for (i = DCB_PFC_UP_ATTR_0; i <= DCB_PFC_UP_ATTR_7; i++) { | 
 | 865 | 		if (data[i] == NULL) | 
 | 866 | 			continue; | 
 | 867 | 		value = nla_get_u8(data[i]); | 
 | 868 | 		netdev->dcbnl_ops->setpfccfg(netdev, | 
 | 869 | 			data[i]->nla_type - DCB_PFC_UP_ATTR_0, value); | 
 | 870 | 	} | 
 | 871 |  | 
 | 872 | 	ret = dcbnl_reply(0, RTM_SETDCB, DCB_CMD_PFC_SCFG, DCB_ATTR_PFC_CFG, | 
 | 873 | 	                  pid, seq, flags); | 
 | 874 | err: | 
 | 875 | 	return ret; | 
 | 876 | } | 
 | 877 |  | 
 | 878 | static int dcbnl_setall(struct net_device *netdev, struct nlattr **tb, | 
 | 879 |                         u32 pid, u32 seq, u16 flags) | 
 | 880 | { | 
 | 881 | 	int ret = -EINVAL; | 
 | 882 |  | 
 | 883 | 	if (!tb[DCB_ATTR_SET_ALL] || !netdev->dcbnl_ops->setall) | 
 | 884 | 		return ret; | 
 | 885 |  | 
 | 886 | 	ret = dcbnl_reply(netdev->dcbnl_ops->setall(netdev), RTM_SETDCB, | 
 | 887 | 	                  DCB_CMD_SET_ALL, DCB_ATTR_SET_ALL, pid, seq, flags); | 
 | 888 |  | 
 | 889 | 	return ret; | 
 | 890 | } | 
 | 891 |  | 
 | 892 | static int __dcbnl_pg_setcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 893 |                              u32 pid, u32 seq, u16 flags, int dir) | 
 | 894 | { | 
 | 895 | 	struct nlattr *pg_tb[DCB_PG_ATTR_MAX + 1]; | 
 | 896 | 	struct nlattr *param_tb[DCB_TC_ATTR_PARAM_MAX + 1]; | 
 | 897 | 	int ret = -EINVAL; | 
 | 898 | 	int i; | 
 | 899 | 	u8 pgid; | 
 | 900 | 	u8 up_map; | 
 | 901 | 	u8 prio; | 
 | 902 | 	u8 tc_pct; | 
 | 903 |  | 
 | 904 | 	if (!tb[DCB_ATTR_PG_CFG] || | 
 | 905 | 	    !netdev->dcbnl_ops->setpgtccfgtx || | 
 | 906 | 	    !netdev->dcbnl_ops->setpgtccfgrx || | 
 | 907 | 	    !netdev->dcbnl_ops->setpgbwgcfgtx || | 
 | 908 | 	    !netdev->dcbnl_ops->setpgbwgcfgrx) | 
 | 909 | 		return ret; | 
 | 910 |  | 
 | 911 | 	ret = nla_parse_nested(pg_tb, DCB_PG_ATTR_MAX, | 
 | 912 | 	                       tb[DCB_ATTR_PG_CFG], dcbnl_pg_nest); | 
 | 913 | 	if (ret) | 
 | 914 | 		goto err; | 
 | 915 |  | 
 | 916 | 	for (i = DCB_PG_ATTR_TC_0; i <= DCB_PG_ATTR_TC_7; i++) { | 
 | 917 | 		if (!pg_tb[i]) | 
 | 918 | 			continue; | 
 | 919 |  | 
 | 920 | 		ret = nla_parse_nested(param_tb, DCB_TC_ATTR_PARAM_MAX, | 
 | 921 | 		                       pg_tb[i], dcbnl_tc_param_nest); | 
 | 922 | 		if (ret) | 
 | 923 | 			goto err; | 
 | 924 |  | 
 | 925 | 		pgid = DCB_ATTR_VALUE_UNDEFINED; | 
 | 926 | 		prio = DCB_ATTR_VALUE_UNDEFINED; | 
 | 927 | 		tc_pct = DCB_ATTR_VALUE_UNDEFINED; | 
 | 928 | 		up_map = DCB_ATTR_VALUE_UNDEFINED; | 
 | 929 |  | 
 | 930 | 		if (param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO]) | 
 | 931 | 			prio = | 
 | 932 | 			    nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_STRICT_PRIO]); | 
 | 933 |  | 
 | 934 | 		if (param_tb[DCB_TC_ATTR_PARAM_PGID]) | 
 | 935 | 			pgid = nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_PGID]); | 
 | 936 |  | 
 | 937 | 		if (param_tb[DCB_TC_ATTR_PARAM_BW_PCT]) | 
 | 938 | 			tc_pct = nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_BW_PCT]); | 
 | 939 |  | 
 | 940 | 		if (param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING]) | 
 | 941 | 			up_map = | 
 | 942 | 			     nla_get_u8(param_tb[DCB_TC_ATTR_PARAM_UP_MAPPING]); | 
 | 943 |  | 
 | 944 | 		/* dir: Tx = 0, Rx = 1 */ | 
 | 945 | 		if (dir) { | 
 | 946 | 			/* Rx */ | 
 | 947 | 			netdev->dcbnl_ops->setpgtccfgrx(netdev, | 
 | 948 | 				i - DCB_PG_ATTR_TC_0, | 
 | 949 | 				prio, pgid, tc_pct, up_map); | 
 | 950 | 		} else { | 
 | 951 | 			/* Tx */ | 
 | 952 | 			netdev->dcbnl_ops->setpgtccfgtx(netdev, | 
 | 953 | 				i - DCB_PG_ATTR_TC_0, | 
 | 954 | 				prio, pgid, tc_pct, up_map); | 
 | 955 | 		} | 
 | 956 | 	} | 
 | 957 |  | 
 | 958 | 	for (i = DCB_PG_ATTR_BW_ID_0; i <= DCB_PG_ATTR_BW_ID_7; i++) { | 
 | 959 | 		if (!pg_tb[i]) | 
 | 960 | 			continue; | 
 | 961 |  | 
 | 962 | 		tc_pct = nla_get_u8(pg_tb[i]); | 
 | 963 |  | 
 | 964 | 		/* dir: Tx = 0, Rx = 1 */ | 
 | 965 | 		if (dir) { | 
 | 966 | 			/* Rx */ | 
 | 967 | 			netdev->dcbnl_ops->setpgbwgcfgrx(netdev, | 
 | 968 | 					 i - DCB_PG_ATTR_BW_ID_0, tc_pct); | 
 | 969 | 		} else { | 
 | 970 | 			/* Tx */ | 
 | 971 | 			netdev->dcbnl_ops->setpgbwgcfgtx(netdev, | 
 | 972 | 					 i - DCB_PG_ATTR_BW_ID_0, tc_pct); | 
 | 973 | 		} | 
 | 974 | 	} | 
 | 975 |  | 
 | 976 | 	ret = dcbnl_reply(0, RTM_SETDCB, | 
 | 977 | 			  (dir ? DCB_CMD_PGRX_SCFG : DCB_CMD_PGTX_SCFG), | 
 | 978 | 			  DCB_ATTR_PG_CFG, pid, seq, flags); | 
 | 979 |  | 
 | 980 | err: | 
 | 981 | 	return ret; | 
 | 982 | } | 
 | 983 |  | 
 | 984 | static int dcbnl_pgtx_setcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 985 |                              u32 pid, u32 seq, u16 flags) | 
 | 986 | { | 
 | 987 | 	return __dcbnl_pg_setcfg(netdev, tb, pid, seq, flags, 0); | 
 | 988 | } | 
 | 989 |  | 
 | 990 | static int dcbnl_pgrx_setcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 991 |                              u32 pid, u32 seq, u16 flags) | 
 | 992 | { | 
 | 993 | 	return __dcbnl_pg_setcfg(netdev, tb, pid, seq, flags, 1); | 
 | 994 | } | 
 | 995 |  | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 996 | static int dcbnl_bcn_getcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 997 |                             u32 pid, u32 seq, u16 flags) | 
 | 998 | { | 
 | 999 | 	struct sk_buff *dcbnl_skb; | 
 | 1000 | 	struct nlmsghdr *nlh; | 
 | 1001 | 	struct dcbmsg *dcb; | 
 | 1002 | 	struct nlattr *bcn_nest; | 
 | 1003 | 	struct nlattr *bcn_tb[DCB_BCN_ATTR_MAX + 1]; | 
 | 1004 | 	u8 value_byte; | 
 | 1005 | 	u32 value_integer; | 
 | 1006 | 	int ret  = -EINVAL; | 
 | 1007 | 	bool getall = false; | 
 | 1008 | 	int i; | 
 | 1009 |  | 
 | 1010 | 	if (!tb[DCB_ATTR_BCN] || !netdev->dcbnl_ops->getbcnrp || | 
 | 1011 | 	    !netdev->dcbnl_ops->getbcncfg) | 
 | 1012 | 		return ret; | 
 | 1013 |  | 
 | 1014 | 	ret = nla_parse_nested(bcn_tb, DCB_BCN_ATTR_MAX, | 
 | 1015 | 	                       tb[DCB_ATTR_BCN], dcbnl_bcn_nest); | 
 | 1016 |  | 
 | 1017 | 	if (ret) | 
 | 1018 | 		goto err_out; | 
 | 1019 |  | 
 | 1020 | 	dcbnl_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | 
 | 1021 | 	if (!dcbnl_skb) | 
 | 1022 | 		goto err_out; | 
 | 1023 |  | 
 | 1024 | 	nlh = NLMSG_NEW(dcbnl_skb, pid, seq, RTM_GETDCB, sizeof(*dcb), flags); | 
 | 1025 |  | 
 | 1026 | 	dcb = NLMSG_DATA(nlh); | 
 | 1027 | 	dcb->dcb_family = AF_UNSPEC; | 
 | 1028 | 	dcb->cmd = DCB_CMD_BCN_GCFG; | 
 | 1029 |  | 
 | 1030 | 	bcn_nest = nla_nest_start(dcbnl_skb, DCB_ATTR_BCN); | 
 | 1031 | 	if (!bcn_nest) | 
 | 1032 | 		goto err; | 
 | 1033 |  | 
 | 1034 | 	if (bcn_tb[DCB_BCN_ATTR_ALL]) | 
 | 1035 | 		getall = true; | 
 | 1036 |  | 
 | 1037 | 	for (i = DCB_BCN_ATTR_RP_0; i <= DCB_BCN_ATTR_RP_7; i++) { | 
 | 1038 | 		if (!getall && !bcn_tb[i]) | 
 | 1039 | 			continue; | 
 | 1040 |  | 
 | 1041 | 		netdev->dcbnl_ops->getbcnrp(netdev, i - DCB_BCN_ATTR_RP_0, | 
 | 1042 | 		                            &value_byte); | 
 | 1043 | 		ret = nla_put_u8(dcbnl_skb, i, value_byte); | 
 | 1044 | 		if (ret) | 
 | 1045 | 			goto err_bcn; | 
 | 1046 | 	} | 
 | 1047 |  | 
| Don Skidmore | f4314e8 | 2008-12-21 20:10:29 -0800 | [diff] [blame] | 1048 | 	for (i = DCB_BCN_ATTR_BCNA_0; i <= DCB_BCN_ATTR_RI; i++) { | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 1049 | 		if (!getall && !bcn_tb[i]) | 
 | 1050 | 			continue; | 
 | 1051 |  | 
 | 1052 | 		netdev->dcbnl_ops->getbcncfg(netdev, i, | 
 | 1053 | 		                             &value_integer); | 
 | 1054 | 		ret = nla_put_u32(dcbnl_skb, i, value_integer); | 
 | 1055 | 		if (ret) | 
 | 1056 | 			goto err_bcn; | 
 | 1057 | 	} | 
 | 1058 |  | 
 | 1059 | 	nla_nest_end(dcbnl_skb, bcn_nest); | 
 | 1060 |  | 
 | 1061 | 	nlmsg_end(dcbnl_skb, nlh); | 
 | 1062 |  | 
 | 1063 | 	ret = rtnl_unicast(dcbnl_skb, &init_net, pid); | 
 | 1064 | 	if (ret) | 
| John Fastabend | 7eaf507 | 2009-09-25 13:12:03 +0000 | [diff] [blame] | 1065 | 		goto err_out; | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 1066 |  | 
 | 1067 | 	return 0; | 
 | 1068 |  | 
 | 1069 | err_bcn: | 
 | 1070 | 	nla_nest_cancel(dcbnl_skb, bcn_nest); | 
 | 1071 | nlmsg_failure: | 
 | 1072 | err: | 
| Roel Kluin | 858eb71 | 2009-01-04 17:29:21 -0800 | [diff] [blame] | 1073 | 	kfree_skb(dcbnl_skb); | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 1074 | err_out: | 
 | 1075 | 	ret  = -EINVAL; | 
 | 1076 | 	return ret; | 
 | 1077 | } | 
 | 1078 |  | 
 | 1079 | static int dcbnl_bcn_setcfg(struct net_device *netdev, struct nlattr **tb, | 
 | 1080 |                             u32 pid, u32 seq, u16 flags) | 
 | 1081 | { | 
 | 1082 | 	struct nlattr *data[DCB_BCN_ATTR_MAX + 1]; | 
 | 1083 | 	int i; | 
 | 1084 | 	int ret = -EINVAL; | 
 | 1085 | 	u8 value_byte; | 
 | 1086 | 	u32 value_int; | 
 | 1087 |  | 
| Joe Perches | f64f9e7 | 2009-11-29 16:55:45 -0800 | [diff] [blame] | 1088 | 	if (!tb[DCB_ATTR_BCN] || !netdev->dcbnl_ops->setbcncfg || | 
 | 1089 | 	    !netdev->dcbnl_ops->setbcnrp) | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 1090 | 		return ret; | 
 | 1091 |  | 
 | 1092 | 	ret = nla_parse_nested(data, DCB_BCN_ATTR_MAX, | 
 | 1093 | 	                       tb[DCB_ATTR_BCN], | 
 | 1094 | 	                       dcbnl_pfc_up_nest); | 
 | 1095 | 	if (ret) | 
 | 1096 | 		goto err; | 
 | 1097 |  | 
 | 1098 | 	for (i = DCB_BCN_ATTR_RP_0; i <= DCB_BCN_ATTR_RP_7; i++) { | 
 | 1099 | 		if (data[i] == NULL) | 
 | 1100 | 			continue; | 
 | 1101 | 		value_byte = nla_get_u8(data[i]); | 
 | 1102 | 		netdev->dcbnl_ops->setbcnrp(netdev, | 
 | 1103 | 			data[i]->nla_type - DCB_BCN_ATTR_RP_0, value_byte); | 
 | 1104 | 	} | 
 | 1105 |  | 
| Don Skidmore | f4314e8 | 2008-12-21 20:10:29 -0800 | [diff] [blame] | 1106 | 	for (i = DCB_BCN_ATTR_BCNA_0; i <= DCB_BCN_ATTR_RI; i++) { | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 1107 | 		if (data[i] == NULL) | 
 | 1108 | 			continue; | 
 | 1109 | 		value_int = nla_get_u32(data[i]); | 
 | 1110 | 		netdev->dcbnl_ops->setbcncfg(netdev, | 
 | 1111 | 	                                     i, value_int); | 
 | 1112 | 	} | 
 | 1113 |  | 
 | 1114 | 	ret = dcbnl_reply(0, RTM_SETDCB, DCB_CMD_BCN_SCFG, DCB_ATTR_BCN, | 
 | 1115 | 	                  pid, seq, flags); | 
 | 1116 | err: | 
 | 1117 | 	return ret; | 
 | 1118 | } | 
 | 1119 |  | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 1120 | static int dcb_doit(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) | 
 | 1121 | { | 
 | 1122 | 	struct net *net = sock_net(skb->sk); | 
 | 1123 | 	struct net_device *netdev; | 
 | 1124 | 	struct dcbmsg  *dcb = (struct dcbmsg *)NLMSG_DATA(nlh); | 
 | 1125 | 	struct nlattr *tb[DCB_ATTR_MAX + 1]; | 
 | 1126 | 	u32 pid = skb ? NETLINK_CB(skb).pid : 0; | 
 | 1127 | 	int ret = -EINVAL; | 
 | 1128 |  | 
| Octavian Purdila | 09ad9bc | 2009-11-25 15:14:13 -0800 | [diff] [blame] | 1129 | 	if (!net_eq(net, &init_net)) | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 1130 | 		return -EINVAL; | 
 | 1131 |  | 
 | 1132 | 	ret = nlmsg_parse(nlh, sizeof(*dcb), tb, DCB_ATTR_MAX, | 
 | 1133 | 			  dcbnl_rtnl_policy); | 
 | 1134 | 	if (ret < 0) | 
 | 1135 | 		return ret; | 
 | 1136 |  | 
 | 1137 | 	if (!tb[DCB_ATTR_IFNAME]) | 
 | 1138 | 		return -EINVAL; | 
 | 1139 |  | 
 | 1140 | 	netdev = dev_get_by_name(&init_net, nla_data(tb[DCB_ATTR_IFNAME])); | 
 | 1141 | 	if (!netdev) | 
 | 1142 | 		return -EINVAL; | 
 | 1143 |  | 
 | 1144 | 	if (!netdev->dcbnl_ops) | 
 | 1145 | 		goto errout; | 
 | 1146 |  | 
 | 1147 | 	switch (dcb->cmd) { | 
 | 1148 | 	case DCB_CMD_GSTATE: | 
 | 1149 | 		ret = dcbnl_getstate(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1150 | 		                     nlh->nlmsg_flags); | 
 | 1151 | 		goto out; | 
 | 1152 | 	case DCB_CMD_PFC_GCFG: | 
 | 1153 | 		ret = dcbnl_getpfccfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1154 | 		                      nlh->nlmsg_flags); | 
 | 1155 | 		goto out; | 
 | 1156 | 	case DCB_CMD_GPERM_HWADDR: | 
 | 1157 | 		ret = dcbnl_getperm_hwaddr(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1158 | 		                           nlh->nlmsg_flags); | 
 | 1159 | 		goto out; | 
 | 1160 | 	case DCB_CMD_PGTX_GCFG: | 
 | 1161 | 		ret = dcbnl_pgtx_getcfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1162 | 		                        nlh->nlmsg_flags); | 
 | 1163 | 		goto out; | 
 | 1164 | 	case DCB_CMD_PGRX_GCFG: | 
 | 1165 | 		ret = dcbnl_pgrx_getcfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1166 | 		                        nlh->nlmsg_flags); | 
 | 1167 | 		goto out; | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 1168 | 	case DCB_CMD_BCN_GCFG: | 
 | 1169 | 		ret = dcbnl_bcn_getcfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1170 | 		                       nlh->nlmsg_flags); | 
 | 1171 | 		goto out; | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 1172 | 	case DCB_CMD_SSTATE: | 
 | 1173 | 		ret = dcbnl_setstate(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1174 | 		                     nlh->nlmsg_flags); | 
 | 1175 | 		goto out; | 
 | 1176 | 	case DCB_CMD_PFC_SCFG: | 
 | 1177 | 		ret = dcbnl_setpfccfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1178 | 		                      nlh->nlmsg_flags); | 
 | 1179 | 		goto out; | 
 | 1180 |  | 
 | 1181 | 	case DCB_CMD_SET_ALL: | 
 | 1182 | 		ret = dcbnl_setall(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1183 | 		                   nlh->nlmsg_flags); | 
 | 1184 | 		goto out; | 
 | 1185 | 	case DCB_CMD_PGTX_SCFG: | 
 | 1186 | 		ret = dcbnl_pgtx_setcfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1187 | 		                        nlh->nlmsg_flags); | 
 | 1188 | 		goto out; | 
 | 1189 | 	case DCB_CMD_PGRX_SCFG: | 
 | 1190 | 		ret = dcbnl_pgrx_setcfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1191 | 		                        nlh->nlmsg_flags); | 
 | 1192 | 		goto out; | 
| Alexander Duyck | 4613218 | 2008-11-20 21:05:08 -0800 | [diff] [blame] | 1193 | 	case DCB_CMD_GCAP: | 
 | 1194 | 		ret = dcbnl_getcap(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1195 | 		                   nlh->nlmsg_flags); | 
 | 1196 | 		goto out; | 
| Alexander Duyck | 33dbabc | 2008-11-20 21:08:19 -0800 | [diff] [blame] | 1197 | 	case DCB_CMD_GNUMTCS: | 
 | 1198 | 		ret = dcbnl_getnumtcs(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1199 | 		                      nlh->nlmsg_flags); | 
 | 1200 | 		goto out; | 
 | 1201 | 	case DCB_CMD_SNUMTCS: | 
 | 1202 | 		ret = dcbnl_setnumtcs(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1203 | 		                      nlh->nlmsg_flags); | 
 | 1204 | 		goto out; | 
| Alexander Duyck | 0eb3aa9 | 2008-11-20 21:09:23 -0800 | [diff] [blame] | 1205 | 	case DCB_CMD_PFC_GSTATE: | 
 | 1206 | 		ret = dcbnl_getpfcstate(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1207 | 		                        nlh->nlmsg_flags); | 
 | 1208 | 		goto out; | 
 | 1209 | 	case DCB_CMD_PFC_SSTATE: | 
 | 1210 | 		ret = dcbnl_setpfcstate(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1211 | 		                        nlh->nlmsg_flags); | 
 | 1212 | 		goto out; | 
| Alexander Duyck | 859ee3c | 2008-11-20 21:10:23 -0800 | [diff] [blame] | 1213 | 	case DCB_CMD_BCN_SCFG: | 
 | 1214 | 		ret = dcbnl_bcn_setcfg(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1215 | 		                       nlh->nlmsg_flags); | 
 | 1216 | 		goto out; | 
| Yi Zou | 5794968 | 2009-08-31 12:33:40 +0000 | [diff] [blame] | 1217 | 	case DCB_CMD_GAPP: | 
 | 1218 | 		ret = dcbnl_getapp(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1219 | 		                   nlh->nlmsg_flags); | 
 | 1220 | 		goto out; | 
 | 1221 | 	case DCB_CMD_SAPP: | 
 | 1222 | 		ret = dcbnl_setapp(netdev, tb, pid, nlh->nlmsg_seq, | 
 | 1223 | 		                   nlh->nlmsg_flags); | 
 | 1224 | 		goto out; | 
| Alexander Duyck | 2f90b86 | 2008-11-20 20:52:10 -0800 | [diff] [blame] | 1225 | 	default: | 
 | 1226 | 		goto errout; | 
 | 1227 | 	} | 
 | 1228 | errout: | 
 | 1229 | 	ret = -EINVAL; | 
 | 1230 | out: | 
 | 1231 | 	dev_put(netdev); | 
 | 1232 | 	return ret; | 
 | 1233 | } | 
 | 1234 |  | 
 | 1235 | static int __init dcbnl_init(void) | 
 | 1236 | { | 
 | 1237 | 	rtnl_register(PF_UNSPEC, RTM_GETDCB, dcb_doit, NULL); | 
 | 1238 | 	rtnl_register(PF_UNSPEC, RTM_SETDCB, dcb_doit, NULL); | 
 | 1239 |  | 
 | 1240 | 	return 0; | 
 | 1241 | } | 
 | 1242 | module_init(dcbnl_init); | 
 | 1243 |  | 
 | 1244 | static void __exit dcbnl_exit(void) | 
 | 1245 | { | 
 | 1246 | 	rtnl_unregister(PF_UNSPEC, RTM_GETDCB); | 
 | 1247 | 	rtnl_unregister(PF_UNSPEC, RTM_SETDCB); | 
 | 1248 | } | 
 | 1249 | module_exit(dcbnl_exit); | 
 | 1250 |  | 
 | 1251 |  |