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