12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2955dc68cSSamuel Mendoza-Jonas /*
3955dc68cSSamuel Mendoza-Jonas * Copyright Samuel Mendoza-Jonas, IBM Corporation 2018.
4955dc68cSSamuel Mendoza-Jonas */
5955dc68cSSamuel Mendoza-Jonas
6955dc68cSSamuel Mendoza-Jonas #include <linux/module.h>
7955dc68cSSamuel Mendoza-Jonas #include <linux/kernel.h>
8955dc68cSSamuel Mendoza-Jonas #include <linux/if_arp.h>
9955dc68cSSamuel Mendoza-Jonas #include <linux/rtnetlink.h>
10955dc68cSSamuel Mendoza-Jonas #include <linux/etherdevice.h>
11955dc68cSSamuel Mendoza-Jonas #include <net/genetlink.h>
12955dc68cSSamuel Mendoza-Jonas #include <net/ncsi.h>
13955dc68cSSamuel Mendoza-Jonas #include <linux/skbuff.h>
14955dc68cSSamuel Mendoza-Jonas #include <net/sock.h>
15955dc68cSSamuel Mendoza-Jonas #include <uapi/linux/ncsi.h>
16955dc68cSSamuel Mendoza-Jonas
17955dc68cSSamuel Mendoza-Jonas #include "internal.h"
189771b8ccSJustin.Lee1@Dell.com #include "ncsi-pkt.h"
19955dc68cSSamuel Mendoza-Jonas #include "ncsi-netlink.h"
20955dc68cSSamuel Mendoza-Jonas
21955dc68cSSamuel Mendoza-Jonas static struct genl_family ncsi_genl_family;
22955dc68cSSamuel Mendoza-Jonas
23955dc68cSSamuel Mendoza-Jonas static const struct nla_policy ncsi_genl_policy[NCSI_ATTR_MAX + 1] = {
24955dc68cSSamuel Mendoza-Jonas [NCSI_ATTR_IFINDEX] = { .type = NLA_U32 },
25955dc68cSSamuel Mendoza-Jonas [NCSI_ATTR_PACKAGE_LIST] = { .type = NLA_NESTED },
26955dc68cSSamuel Mendoza-Jonas [NCSI_ATTR_PACKAGE_ID] = { .type = NLA_U32 },
27955dc68cSSamuel Mendoza-Jonas [NCSI_ATTR_CHANNEL_ID] = { .type = NLA_U32 },
289771b8ccSJustin.Lee1@Dell.com [NCSI_ATTR_DATA] = { .type = NLA_BINARY, .len = 2048 },
298d951a75SSamuel Mendoza-Jonas [NCSI_ATTR_MULTI_FLAG] = { .type = NLA_FLAG },
308d951a75SSamuel Mendoza-Jonas [NCSI_ATTR_PACKAGE_MASK] = { .type = NLA_U32 },
318d951a75SSamuel Mendoza-Jonas [NCSI_ATTR_CHANNEL_MASK] = { .type = NLA_U32 },
32955dc68cSSamuel Mendoza-Jonas };
33955dc68cSSamuel Mendoza-Jonas
ndp_from_ifindex(struct net * net,u32 ifindex)34955dc68cSSamuel Mendoza-Jonas static struct ncsi_dev_priv *ndp_from_ifindex(struct net *net, u32 ifindex)
35955dc68cSSamuel Mendoza-Jonas {
36955dc68cSSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp;
37955dc68cSSamuel Mendoza-Jonas struct net_device *dev;
38955dc68cSSamuel Mendoza-Jonas struct ncsi_dev *nd;
39955dc68cSSamuel Mendoza-Jonas struct ncsi_dev;
40955dc68cSSamuel Mendoza-Jonas
41955dc68cSSamuel Mendoza-Jonas if (!net)
42955dc68cSSamuel Mendoza-Jonas return NULL;
43955dc68cSSamuel Mendoza-Jonas
44955dc68cSSamuel Mendoza-Jonas dev = dev_get_by_index(net, ifindex);
45955dc68cSSamuel Mendoza-Jonas if (!dev) {
46955dc68cSSamuel Mendoza-Jonas pr_err("NCSI netlink: No device for ifindex %u\n", ifindex);
47955dc68cSSamuel Mendoza-Jonas return NULL;
48955dc68cSSamuel Mendoza-Jonas }
49955dc68cSSamuel Mendoza-Jonas
50955dc68cSSamuel Mendoza-Jonas nd = ncsi_find_dev(dev);
51955dc68cSSamuel Mendoza-Jonas ndp = nd ? TO_NCSI_DEV_PRIV(nd) : NULL;
52955dc68cSSamuel Mendoza-Jonas
53955dc68cSSamuel Mendoza-Jonas dev_put(dev);
54955dc68cSSamuel Mendoza-Jonas return ndp;
55955dc68cSSamuel Mendoza-Jonas }
56955dc68cSSamuel Mendoza-Jonas
ncsi_write_channel_info(struct sk_buff * skb,struct ncsi_dev_priv * ndp,struct ncsi_channel * nc)57955dc68cSSamuel Mendoza-Jonas static int ncsi_write_channel_info(struct sk_buff *skb,
58955dc68cSSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp,
59955dc68cSSamuel Mendoza-Jonas struct ncsi_channel *nc)
60955dc68cSSamuel Mendoza-Jonas {
61062b3e1bSSamuel Mendoza-Jonas struct ncsi_channel_vlan_filter *ncf;
62955dc68cSSamuel Mendoza-Jonas struct ncsi_channel_mode *m;
63062b3e1bSSamuel Mendoza-Jonas struct nlattr *vid_nest;
64955dc68cSSamuel Mendoza-Jonas int i;
65955dc68cSSamuel Mendoza-Jonas
66955dc68cSSamuel Mendoza-Jonas nla_put_u32(skb, NCSI_CHANNEL_ATTR_ID, nc->id);
67955dc68cSSamuel Mendoza-Jonas m = &nc->modes[NCSI_MODE_LINK];
68955dc68cSSamuel Mendoza-Jonas nla_put_u32(skb, NCSI_CHANNEL_ATTR_LINK_STATE, m->data[2]);
69955dc68cSSamuel Mendoza-Jonas if (nc->state == NCSI_CHANNEL_ACTIVE)
70955dc68cSSamuel Mendoza-Jonas nla_put_flag(skb, NCSI_CHANNEL_ATTR_ACTIVE);
718d951a75SSamuel Mendoza-Jonas if (nc == nc->package->preferred_channel)
72955dc68cSSamuel Mendoza-Jonas nla_put_flag(skb, NCSI_CHANNEL_ATTR_FORCED);
73955dc68cSSamuel Mendoza-Jonas
74*1c83c708SPeter Delevoryas nla_put_u32(skb, NCSI_CHANNEL_ATTR_VERSION_MAJOR, nc->version.major);
75*1c83c708SPeter Delevoryas nla_put_u32(skb, NCSI_CHANNEL_ATTR_VERSION_MINOR, nc->version.minor);
76955dc68cSSamuel Mendoza-Jonas nla_put_string(skb, NCSI_CHANNEL_ATTR_VERSION_STR, nc->version.fw_name);
77955dc68cSSamuel Mendoza-Jonas
78ae0be8deSMichal Kubecek vid_nest = nla_nest_start_noflag(skb, NCSI_CHANNEL_ATTR_VLAN_LIST);
79955dc68cSSamuel Mendoza-Jonas if (!vid_nest)
80955dc68cSSamuel Mendoza-Jonas return -ENOMEM;
81062b3e1bSSamuel Mendoza-Jonas ncf = &nc->vlan_filter;
82955dc68cSSamuel Mendoza-Jonas i = -1;
83062b3e1bSSamuel Mendoza-Jonas while ((i = find_next_bit((void *)&ncf->bitmap, ncf->n_vids,
84062b3e1bSSamuel Mendoza-Jonas i + 1)) < ncf->n_vids) {
85062b3e1bSSamuel Mendoza-Jonas if (ncf->vids[i])
86955dc68cSSamuel Mendoza-Jonas nla_put_u16(skb, NCSI_CHANNEL_ATTR_VLAN_ID,
87062b3e1bSSamuel Mendoza-Jonas ncf->vids[i]);
88955dc68cSSamuel Mendoza-Jonas }
89955dc68cSSamuel Mendoza-Jonas nla_nest_end(skb, vid_nest);
90955dc68cSSamuel Mendoza-Jonas
91955dc68cSSamuel Mendoza-Jonas return 0;
92955dc68cSSamuel Mendoza-Jonas }
93955dc68cSSamuel Mendoza-Jonas
ncsi_write_package_info(struct sk_buff * skb,struct ncsi_dev_priv * ndp,unsigned int id)94955dc68cSSamuel Mendoza-Jonas static int ncsi_write_package_info(struct sk_buff *skb,
95955dc68cSSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp, unsigned int id)
96955dc68cSSamuel Mendoza-Jonas {
97955dc68cSSamuel Mendoza-Jonas struct nlattr *pnest, *cnest, *nest;
98955dc68cSSamuel Mendoza-Jonas struct ncsi_package *np;
99955dc68cSSamuel Mendoza-Jonas struct ncsi_channel *nc;
100955dc68cSSamuel Mendoza-Jonas bool found;
101955dc68cSSamuel Mendoza-Jonas int rc;
102955dc68cSSamuel Mendoza-Jonas
1033d0371b3SSamuel Mendoza-Jonas if (id > ndp->package_num - 1) {
104955dc68cSSamuel Mendoza-Jonas netdev_info(ndp->ndev.dev, "NCSI: No package with id %u\n", id);
105955dc68cSSamuel Mendoza-Jonas return -ENODEV;
106955dc68cSSamuel Mendoza-Jonas }
107955dc68cSSamuel Mendoza-Jonas
108955dc68cSSamuel Mendoza-Jonas found = false;
109955dc68cSSamuel Mendoza-Jonas NCSI_FOR_EACH_PACKAGE(ndp, np) {
110955dc68cSSamuel Mendoza-Jonas if (np->id != id)
111955dc68cSSamuel Mendoza-Jonas continue;
112ae0be8deSMichal Kubecek pnest = nla_nest_start_noflag(skb, NCSI_PKG_ATTR);
113955dc68cSSamuel Mendoza-Jonas if (!pnest)
114955dc68cSSamuel Mendoza-Jonas return -ENOMEM;
11592a34ab1SJiasheng Jiang rc = nla_put_u32(skb, NCSI_PKG_ATTR_ID, np->id);
11692a34ab1SJiasheng Jiang if (rc) {
11792a34ab1SJiasheng Jiang nla_nest_cancel(skb, pnest);
11892a34ab1SJiasheng Jiang return rc;
11992a34ab1SJiasheng Jiang }
1208d951a75SSamuel Mendoza-Jonas if ((0x1 << np->id) == ndp->package_whitelist)
121955dc68cSSamuel Mendoza-Jonas nla_put_flag(skb, NCSI_PKG_ATTR_FORCED);
122ae0be8deSMichal Kubecek cnest = nla_nest_start_noflag(skb, NCSI_PKG_ATTR_CHANNEL_LIST);
123955dc68cSSamuel Mendoza-Jonas if (!cnest) {
124955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, pnest);
125955dc68cSSamuel Mendoza-Jonas return -ENOMEM;
126955dc68cSSamuel Mendoza-Jonas }
127955dc68cSSamuel Mendoza-Jonas NCSI_FOR_EACH_CHANNEL(np, nc) {
128ae0be8deSMichal Kubecek nest = nla_nest_start_noflag(skb, NCSI_CHANNEL_ATTR);
129955dc68cSSamuel Mendoza-Jonas if (!nest) {
130955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, cnest);
131955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, pnest);
132955dc68cSSamuel Mendoza-Jonas return -ENOMEM;
133955dc68cSSamuel Mendoza-Jonas }
134955dc68cSSamuel Mendoza-Jonas rc = ncsi_write_channel_info(skb, ndp, nc);
135955dc68cSSamuel Mendoza-Jonas if (rc) {
136955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, nest);
137955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, cnest);
138955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, pnest);
139955dc68cSSamuel Mendoza-Jonas return rc;
140955dc68cSSamuel Mendoza-Jonas }
141955dc68cSSamuel Mendoza-Jonas nla_nest_end(skb, nest);
142955dc68cSSamuel Mendoza-Jonas }
143955dc68cSSamuel Mendoza-Jonas nla_nest_end(skb, cnest);
144955dc68cSSamuel Mendoza-Jonas nla_nest_end(skb, pnest);
145955dc68cSSamuel Mendoza-Jonas found = true;
146955dc68cSSamuel Mendoza-Jonas }
147955dc68cSSamuel Mendoza-Jonas
148955dc68cSSamuel Mendoza-Jonas if (!found)
149955dc68cSSamuel Mendoza-Jonas return -ENODEV;
150955dc68cSSamuel Mendoza-Jonas
151955dc68cSSamuel Mendoza-Jonas return 0;
152955dc68cSSamuel Mendoza-Jonas }
153955dc68cSSamuel Mendoza-Jonas
ncsi_pkg_info_nl(struct sk_buff * msg,struct genl_info * info)154955dc68cSSamuel Mendoza-Jonas static int ncsi_pkg_info_nl(struct sk_buff *msg, struct genl_info *info)
155955dc68cSSamuel Mendoza-Jonas {
156955dc68cSSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp;
157955dc68cSSamuel Mendoza-Jonas unsigned int package_id;
158955dc68cSSamuel Mendoza-Jonas struct sk_buff *skb;
159955dc68cSSamuel Mendoza-Jonas struct nlattr *attr;
160955dc68cSSamuel Mendoza-Jonas void *hdr;
161955dc68cSSamuel Mendoza-Jonas int rc;
162955dc68cSSamuel Mendoza-Jonas
163955dc68cSSamuel Mendoza-Jonas if (!info || !info->attrs)
164955dc68cSSamuel Mendoza-Jonas return -EINVAL;
165955dc68cSSamuel Mendoza-Jonas
166955dc68cSSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_IFINDEX])
167955dc68cSSamuel Mendoza-Jonas return -EINVAL;
168955dc68cSSamuel Mendoza-Jonas
169955dc68cSSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_PACKAGE_ID])
170955dc68cSSamuel Mendoza-Jonas return -EINVAL;
171955dc68cSSamuel Mendoza-Jonas
172955dc68cSSamuel Mendoza-Jonas ndp = ndp_from_ifindex(genl_info_net(info),
173955dc68cSSamuel Mendoza-Jonas nla_get_u32(info->attrs[NCSI_ATTR_IFINDEX]));
174955dc68cSSamuel Mendoza-Jonas if (!ndp)
175955dc68cSSamuel Mendoza-Jonas return -ENODEV;
176955dc68cSSamuel Mendoza-Jonas
177955dc68cSSamuel Mendoza-Jonas skb = genlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
178955dc68cSSamuel Mendoza-Jonas if (!skb)
179955dc68cSSamuel Mendoza-Jonas return -ENOMEM;
180955dc68cSSamuel Mendoza-Jonas
181955dc68cSSamuel Mendoza-Jonas hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
182955dc68cSSamuel Mendoza-Jonas &ncsi_genl_family, 0, NCSI_CMD_PKG_INFO);
183955dc68cSSamuel Mendoza-Jonas if (!hdr) {
18450db64b0SDan Carpenter kfree_skb(skb);
185955dc68cSSamuel Mendoza-Jonas return -EMSGSIZE;
186955dc68cSSamuel Mendoza-Jonas }
187955dc68cSSamuel Mendoza-Jonas
188955dc68cSSamuel Mendoza-Jonas package_id = nla_get_u32(info->attrs[NCSI_ATTR_PACKAGE_ID]);
189955dc68cSSamuel Mendoza-Jonas
190ae0be8deSMichal Kubecek attr = nla_nest_start_noflag(skb, NCSI_ATTR_PACKAGE_LIST);
1918daf1a2dSColin Ian King if (!attr) {
1928daf1a2dSColin Ian King kfree_skb(skb);
1938daf1a2dSColin Ian King return -EMSGSIZE;
1948daf1a2dSColin Ian King }
195955dc68cSSamuel Mendoza-Jonas rc = ncsi_write_package_info(skb, ndp, package_id);
196955dc68cSSamuel Mendoza-Jonas
197955dc68cSSamuel Mendoza-Jonas if (rc) {
198955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, attr);
199955dc68cSSamuel Mendoza-Jonas goto err;
200955dc68cSSamuel Mendoza-Jonas }
201955dc68cSSamuel Mendoza-Jonas
202955dc68cSSamuel Mendoza-Jonas nla_nest_end(skb, attr);
203955dc68cSSamuel Mendoza-Jonas
204955dc68cSSamuel Mendoza-Jonas genlmsg_end(skb, hdr);
205955dc68cSSamuel Mendoza-Jonas return genlmsg_reply(skb, info);
206955dc68cSSamuel Mendoza-Jonas
207955dc68cSSamuel Mendoza-Jonas err:
20850db64b0SDan Carpenter kfree_skb(skb);
209955dc68cSSamuel Mendoza-Jonas return rc;
210955dc68cSSamuel Mendoza-Jonas }
211955dc68cSSamuel Mendoza-Jonas
ncsi_pkg_info_all_nl(struct sk_buff * skb,struct netlink_callback * cb)212955dc68cSSamuel Mendoza-Jonas static int ncsi_pkg_info_all_nl(struct sk_buff *skb,
213955dc68cSSamuel Mendoza-Jonas struct netlink_callback *cb)
214955dc68cSSamuel Mendoza-Jonas {
2150f51f358SSamuel Mendoza-Jonas struct nlattr *attrs[NCSI_ATTR_MAX + 1];
216955dc68cSSamuel Mendoza-Jonas struct ncsi_package *np, *package;
217955dc68cSSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp;
218955dc68cSSamuel Mendoza-Jonas unsigned int package_id;
219955dc68cSSamuel Mendoza-Jonas struct nlattr *attr;
220955dc68cSSamuel Mendoza-Jonas void *hdr;
221955dc68cSSamuel Mendoza-Jonas int rc;
222955dc68cSSamuel Mendoza-Jonas
2238cb08174SJohannes Berg rc = genlmsg_parse_deprecated(cb->nlh, &ncsi_genl_family, attrs, NCSI_ATTR_MAX,
224955dc68cSSamuel Mendoza-Jonas ncsi_genl_policy, NULL);
225955dc68cSSamuel Mendoza-Jonas if (rc)
226955dc68cSSamuel Mendoza-Jonas return rc;
227955dc68cSSamuel Mendoza-Jonas
228955dc68cSSamuel Mendoza-Jonas if (!attrs[NCSI_ATTR_IFINDEX])
229955dc68cSSamuel Mendoza-Jonas return -EINVAL;
230955dc68cSSamuel Mendoza-Jonas
231955dc68cSSamuel Mendoza-Jonas ndp = ndp_from_ifindex(get_net(sock_net(skb->sk)),
232955dc68cSSamuel Mendoza-Jonas nla_get_u32(attrs[NCSI_ATTR_IFINDEX]));
233955dc68cSSamuel Mendoza-Jonas
234955dc68cSSamuel Mendoza-Jonas if (!ndp)
235955dc68cSSamuel Mendoza-Jonas return -ENODEV;
236955dc68cSSamuel Mendoza-Jonas
237955dc68cSSamuel Mendoza-Jonas package_id = cb->args[0];
238955dc68cSSamuel Mendoza-Jonas package = NULL;
239955dc68cSSamuel Mendoza-Jonas NCSI_FOR_EACH_PACKAGE(ndp, np)
240955dc68cSSamuel Mendoza-Jonas if (np->id == package_id)
241955dc68cSSamuel Mendoza-Jonas package = np;
242955dc68cSSamuel Mendoza-Jonas
243955dc68cSSamuel Mendoza-Jonas if (!package)
244955dc68cSSamuel Mendoza-Jonas return 0; /* done */
245955dc68cSSamuel Mendoza-Jonas
246955dc68cSSamuel Mendoza-Jonas hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
2473d0371b3SSamuel Mendoza-Jonas &ncsi_genl_family, NLM_F_MULTI, NCSI_CMD_PKG_INFO);
248955dc68cSSamuel Mendoza-Jonas if (!hdr) {
249955dc68cSSamuel Mendoza-Jonas rc = -EMSGSIZE;
250955dc68cSSamuel Mendoza-Jonas goto err;
251955dc68cSSamuel Mendoza-Jonas }
252955dc68cSSamuel Mendoza-Jonas
253ae0be8deSMichal Kubecek attr = nla_nest_start_noflag(skb, NCSI_ATTR_PACKAGE_LIST);
25407660ca6SKangjie Lu if (!attr) {
25507660ca6SKangjie Lu rc = -EMSGSIZE;
25607660ca6SKangjie Lu goto err;
25707660ca6SKangjie Lu }
258955dc68cSSamuel Mendoza-Jonas rc = ncsi_write_package_info(skb, ndp, package->id);
259955dc68cSSamuel Mendoza-Jonas if (rc) {
260955dc68cSSamuel Mendoza-Jonas nla_nest_cancel(skb, attr);
261955dc68cSSamuel Mendoza-Jonas goto err;
262955dc68cSSamuel Mendoza-Jonas }
263955dc68cSSamuel Mendoza-Jonas
264955dc68cSSamuel Mendoza-Jonas nla_nest_end(skb, attr);
265955dc68cSSamuel Mendoza-Jonas genlmsg_end(skb, hdr);
266955dc68cSSamuel Mendoza-Jonas
267955dc68cSSamuel Mendoza-Jonas cb->args[0] = package_id + 1;
268955dc68cSSamuel Mendoza-Jonas
269955dc68cSSamuel Mendoza-Jonas return skb->len;
270955dc68cSSamuel Mendoza-Jonas err:
271955dc68cSSamuel Mendoza-Jonas genlmsg_cancel(skb, hdr);
272955dc68cSSamuel Mendoza-Jonas return rc;
273955dc68cSSamuel Mendoza-Jonas }
274955dc68cSSamuel Mendoza-Jonas
ncsi_set_interface_nl(struct sk_buff * msg,struct genl_info * info)275955dc68cSSamuel Mendoza-Jonas static int ncsi_set_interface_nl(struct sk_buff *msg, struct genl_info *info)
276955dc68cSSamuel Mendoza-Jonas {
277955dc68cSSamuel Mendoza-Jonas struct ncsi_package *np, *package;
278955dc68cSSamuel Mendoza-Jonas struct ncsi_channel *nc, *channel;
279955dc68cSSamuel Mendoza-Jonas u32 package_id, channel_id;
280955dc68cSSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp;
281955dc68cSSamuel Mendoza-Jonas unsigned long flags;
282955dc68cSSamuel Mendoza-Jonas
283955dc68cSSamuel Mendoza-Jonas if (!info || !info->attrs)
284955dc68cSSamuel Mendoza-Jonas return -EINVAL;
285955dc68cSSamuel Mendoza-Jonas
286955dc68cSSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_IFINDEX])
287955dc68cSSamuel Mendoza-Jonas return -EINVAL;
288955dc68cSSamuel Mendoza-Jonas
289955dc68cSSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_PACKAGE_ID])
290955dc68cSSamuel Mendoza-Jonas return -EINVAL;
291955dc68cSSamuel Mendoza-Jonas
292955dc68cSSamuel Mendoza-Jonas ndp = ndp_from_ifindex(get_net(sock_net(msg->sk)),
293955dc68cSSamuel Mendoza-Jonas nla_get_u32(info->attrs[NCSI_ATTR_IFINDEX]));
294955dc68cSSamuel Mendoza-Jonas if (!ndp)
295955dc68cSSamuel Mendoza-Jonas return -ENODEV;
296955dc68cSSamuel Mendoza-Jonas
297955dc68cSSamuel Mendoza-Jonas package_id = nla_get_u32(info->attrs[NCSI_ATTR_PACKAGE_ID]);
298955dc68cSSamuel Mendoza-Jonas package = NULL;
299955dc68cSSamuel Mendoza-Jonas
300955dc68cSSamuel Mendoza-Jonas NCSI_FOR_EACH_PACKAGE(ndp, np)
301955dc68cSSamuel Mendoza-Jonas if (np->id == package_id)
302955dc68cSSamuel Mendoza-Jonas package = np;
303955dc68cSSamuel Mendoza-Jonas if (!package) {
304955dc68cSSamuel Mendoza-Jonas /* The user has set a package that does not exist */
305955dc68cSSamuel Mendoza-Jonas return -ERANGE;
306955dc68cSSamuel Mendoza-Jonas }
307955dc68cSSamuel Mendoza-Jonas
308955dc68cSSamuel Mendoza-Jonas channel = NULL;
3098d951a75SSamuel Mendoza-Jonas if (info->attrs[NCSI_ATTR_CHANNEL_ID]) {
310955dc68cSSamuel Mendoza-Jonas channel_id = nla_get_u32(info->attrs[NCSI_ATTR_CHANNEL_ID]);
311955dc68cSSamuel Mendoza-Jonas NCSI_FOR_EACH_CHANNEL(package, nc)
3128d951a75SSamuel Mendoza-Jonas if (nc->id == channel_id) {
313955dc68cSSamuel Mendoza-Jonas channel = nc;
3148d951a75SSamuel Mendoza-Jonas break;
315955dc68cSSamuel Mendoza-Jonas }
3168d951a75SSamuel Mendoza-Jonas if (!channel) {
3178d951a75SSamuel Mendoza-Jonas netdev_info(ndp->ndev.dev,
3188d951a75SSamuel Mendoza-Jonas "NCSI: Channel %u does not exist!\n",
319955dc68cSSamuel Mendoza-Jonas channel_id);
320955dc68cSSamuel Mendoza-Jonas return -ERANGE;
321955dc68cSSamuel Mendoza-Jonas }
3228d951a75SSamuel Mendoza-Jonas }
323955dc68cSSamuel Mendoza-Jonas
3248d951a75SSamuel Mendoza-Jonas spin_lock_irqsave(&ndp->lock, flags);
3258d951a75SSamuel Mendoza-Jonas ndp->package_whitelist = 0x1 << package->id;
3268d951a75SSamuel Mendoza-Jonas ndp->multi_package = false;
327955dc68cSSamuel Mendoza-Jonas spin_unlock_irqrestore(&ndp->lock, flags);
328955dc68cSSamuel Mendoza-Jonas
3298d951a75SSamuel Mendoza-Jonas spin_lock_irqsave(&package->lock, flags);
3308d951a75SSamuel Mendoza-Jonas package->multi_channel = false;
3318d951a75SSamuel Mendoza-Jonas if (channel) {
3328d951a75SSamuel Mendoza-Jonas package->channel_whitelist = 0x1 << channel->id;
3338d951a75SSamuel Mendoza-Jonas package->preferred_channel = channel;
3348d951a75SSamuel Mendoza-Jonas } else {
3358d951a75SSamuel Mendoza-Jonas /* Allow any channel */
3368d951a75SSamuel Mendoza-Jonas package->channel_whitelist = UINT_MAX;
3378d951a75SSamuel Mendoza-Jonas package->preferred_channel = NULL;
3388d951a75SSamuel Mendoza-Jonas }
3398d951a75SSamuel Mendoza-Jonas spin_unlock_irqrestore(&package->lock, flags);
3408d951a75SSamuel Mendoza-Jonas
3418d951a75SSamuel Mendoza-Jonas if (channel)
3428d951a75SSamuel Mendoza-Jonas netdev_info(ndp->ndev.dev,
3438d951a75SSamuel Mendoza-Jonas "Set package 0x%x, channel 0x%x as preferred\n",
3448d951a75SSamuel Mendoza-Jonas package_id, channel_id);
3458d951a75SSamuel Mendoza-Jonas else
3468d951a75SSamuel Mendoza-Jonas netdev_info(ndp->ndev.dev, "Set package 0x%x as preferred\n",
3478d951a75SSamuel Mendoza-Jonas package_id);
348955dc68cSSamuel Mendoza-Jonas
3492878a2cfSSamuel Mendoza-Jonas /* Update channel configuration */
3502878a2cfSSamuel Mendoza-Jonas if (!(ndp->flags & NCSI_DEV_RESET))
3512878a2cfSSamuel Mendoza-Jonas ncsi_reset_dev(&ndp->ndev);
352955dc68cSSamuel Mendoza-Jonas
353955dc68cSSamuel Mendoza-Jonas return 0;
354955dc68cSSamuel Mendoza-Jonas }
355955dc68cSSamuel Mendoza-Jonas
ncsi_clear_interface_nl(struct sk_buff * msg,struct genl_info * info)356955dc68cSSamuel Mendoza-Jonas static int ncsi_clear_interface_nl(struct sk_buff *msg, struct genl_info *info)
357955dc68cSSamuel Mendoza-Jonas {
358955dc68cSSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp;
3598d951a75SSamuel Mendoza-Jonas struct ncsi_package *np;
360955dc68cSSamuel Mendoza-Jonas unsigned long flags;
361955dc68cSSamuel Mendoza-Jonas
362955dc68cSSamuel Mendoza-Jonas if (!info || !info->attrs)
363955dc68cSSamuel Mendoza-Jonas return -EINVAL;
364955dc68cSSamuel Mendoza-Jonas
365955dc68cSSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_IFINDEX])
366955dc68cSSamuel Mendoza-Jonas return -EINVAL;
367955dc68cSSamuel Mendoza-Jonas
368955dc68cSSamuel Mendoza-Jonas ndp = ndp_from_ifindex(get_net(sock_net(msg->sk)),
369955dc68cSSamuel Mendoza-Jonas nla_get_u32(info->attrs[NCSI_ATTR_IFINDEX]));
370955dc68cSSamuel Mendoza-Jonas if (!ndp)
371955dc68cSSamuel Mendoza-Jonas return -ENODEV;
372955dc68cSSamuel Mendoza-Jonas
3738d951a75SSamuel Mendoza-Jonas /* Reset any whitelists and disable multi mode */
374955dc68cSSamuel Mendoza-Jonas spin_lock_irqsave(&ndp->lock, flags);
3758d951a75SSamuel Mendoza-Jonas ndp->package_whitelist = UINT_MAX;
3768d951a75SSamuel Mendoza-Jonas ndp->multi_package = false;
377955dc68cSSamuel Mendoza-Jonas spin_unlock_irqrestore(&ndp->lock, flags);
3788d951a75SSamuel Mendoza-Jonas
3798d951a75SSamuel Mendoza-Jonas NCSI_FOR_EACH_PACKAGE(ndp, np) {
3808d951a75SSamuel Mendoza-Jonas spin_lock_irqsave(&np->lock, flags);
3818d951a75SSamuel Mendoza-Jonas np->multi_channel = false;
3828d951a75SSamuel Mendoza-Jonas np->channel_whitelist = UINT_MAX;
3838d951a75SSamuel Mendoza-Jonas np->preferred_channel = NULL;
3848d951a75SSamuel Mendoza-Jonas spin_unlock_irqrestore(&np->lock, flags);
3858d951a75SSamuel Mendoza-Jonas }
386955dc68cSSamuel Mendoza-Jonas netdev_info(ndp->ndev.dev, "NCSI: Cleared preferred package/channel\n");
387955dc68cSSamuel Mendoza-Jonas
3882878a2cfSSamuel Mendoza-Jonas /* Update channel configuration */
3892878a2cfSSamuel Mendoza-Jonas if (!(ndp->flags & NCSI_DEV_RESET))
3902878a2cfSSamuel Mendoza-Jonas ncsi_reset_dev(&ndp->ndev);
391955dc68cSSamuel Mendoza-Jonas
392955dc68cSSamuel Mendoza-Jonas return 0;
393955dc68cSSamuel Mendoza-Jonas }
394955dc68cSSamuel Mendoza-Jonas
ncsi_send_cmd_nl(struct sk_buff * msg,struct genl_info * info)3959771b8ccSJustin.Lee1@Dell.com static int ncsi_send_cmd_nl(struct sk_buff *msg, struct genl_info *info)
3969771b8ccSJustin.Lee1@Dell.com {
3979771b8ccSJustin.Lee1@Dell.com struct ncsi_dev_priv *ndp;
3989771b8ccSJustin.Lee1@Dell.com struct ncsi_pkt_hdr *hdr;
3999771b8ccSJustin.Lee1@Dell.com struct ncsi_cmd_arg nca;
4009771b8ccSJustin.Lee1@Dell.com unsigned char *data;
4019771b8ccSJustin.Lee1@Dell.com u32 package_id;
4029771b8ccSJustin.Lee1@Dell.com u32 channel_id;
4039771b8ccSJustin.Lee1@Dell.com int len, ret;
4049771b8ccSJustin.Lee1@Dell.com
4059771b8ccSJustin.Lee1@Dell.com if (!info || !info->attrs) {
4069771b8ccSJustin.Lee1@Dell.com ret = -EINVAL;
4079771b8ccSJustin.Lee1@Dell.com goto out;
4089771b8ccSJustin.Lee1@Dell.com }
4099771b8ccSJustin.Lee1@Dell.com
4109771b8ccSJustin.Lee1@Dell.com if (!info->attrs[NCSI_ATTR_IFINDEX]) {
4119771b8ccSJustin.Lee1@Dell.com ret = -EINVAL;
4129771b8ccSJustin.Lee1@Dell.com goto out;
4139771b8ccSJustin.Lee1@Dell.com }
4149771b8ccSJustin.Lee1@Dell.com
4159771b8ccSJustin.Lee1@Dell.com if (!info->attrs[NCSI_ATTR_PACKAGE_ID]) {
4169771b8ccSJustin.Lee1@Dell.com ret = -EINVAL;
4179771b8ccSJustin.Lee1@Dell.com goto out;
4189771b8ccSJustin.Lee1@Dell.com }
4199771b8ccSJustin.Lee1@Dell.com
4209771b8ccSJustin.Lee1@Dell.com if (!info->attrs[NCSI_ATTR_CHANNEL_ID]) {
4219771b8ccSJustin.Lee1@Dell.com ret = -EINVAL;
4229771b8ccSJustin.Lee1@Dell.com goto out;
4239771b8ccSJustin.Lee1@Dell.com }
4249771b8ccSJustin.Lee1@Dell.com
4259771b8ccSJustin.Lee1@Dell.com if (!info->attrs[NCSI_ATTR_DATA]) {
4269771b8ccSJustin.Lee1@Dell.com ret = -EINVAL;
4279771b8ccSJustin.Lee1@Dell.com goto out;
4289771b8ccSJustin.Lee1@Dell.com }
4299771b8ccSJustin.Lee1@Dell.com
4309771b8ccSJustin.Lee1@Dell.com ndp = ndp_from_ifindex(get_net(sock_net(msg->sk)),
4319771b8ccSJustin.Lee1@Dell.com nla_get_u32(info->attrs[NCSI_ATTR_IFINDEX]));
4329771b8ccSJustin.Lee1@Dell.com if (!ndp) {
4339771b8ccSJustin.Lee1@Dell.com ret = -ENODEV;
4349771b8ccSJustin.Lee1@Dell.com goto out;
4359771b8ccSJustin.Lee1@Dell.com }
4369771b8ccSJustin.Lee1@Dell.com
4379771b8ccSJustin.Lee1@Dell.com package_id = nla_get_u32(info->attrs[NCSI_ATTR_PACKAGE_ID]);
4389771b8ccSJustin.Lee1@Dell.com channel_id = nla_get_u32(info->attrs[NCSI_ATTR_CHANNEL_ID]);
4399771b8ccSJustin.Lee1@Dell.com
4409771b8ccSJustin.Lee1@Dell.com if (package_id >= NCSI_MAX_PACKAGE || channel_id >= NCSI_MAX_CHANNEL) {
4419771b8ccSJustin.Lee1@Dell.com ret = -ERANGE;
4429771b8ccSJustin.Lee1@Dell.com goto out_netlink;
4439771b8ccSJustin.Lee1@Dell.com }
4449771b8ccSJustin.Lee1@Dell.com
4459771b8ccSJustin.Lee1@Dell.com len = nla_len(info->attrs[NCSI_ATTR_DATA]);
4469771b8ccSJustin.Lee1@Dell.com if (len < sizeof(struct ncsi_pkt_hdr)) {
4479771b8ccSJustin.Lee1@Dell.com netdev_info(ndp->ndev.dev, "NCSI: no command to send %u\n",
4489771b8ccSJustin.Lee1@Dell.com package_id);
4499771b8ccSJustin.Lee1@Dell.com ret = -EINVAL;
4509771b8ccSJustin.Lee1@Dell.com goto out_netlink;
4519771b8ccSJustin.Lee1@Dell.com } else {
4529771b8ccSJustin.Lee1@Dell.com data = (unsigned char *)nla_data(info->attrs[NCSI_ATTR_DATA]);
4539771b8ccSJustin.Lee1@Dell.com }
4549771b8ccSJustin.Lee1@Dell.com
4559771b8ccSJustin.Lee1@Dell.com hdr = (struct ncsi_pkt_hdr *)data;
4569771b8ccSJustin.Lee1@Dell.com
4579771b8ccSJustin.Lee1@Dell.com nca.ndp = ndp;
4589771b8ccSJustin.Lee1@Dell.com nca.package = (unsigned char)package_id;
4599771b8ccSJustin.Lee1@Dell.com nca.channel = (unsigned char)channel_id;
4609771b8ccSJustin.Lee1@Dell.com nca.type = hdr->type;
4619771b8ccSJustin.Lee1@Dell.com nca.req_flags = NCSI_REQ_FLAG_NETLINK_DRIVEN;
4629771b8ccSJustin.Lee1@Dell.com nca.info = info;
4639771b8ccSJustin.Lee1@Dell.com nca.payload = ntohs(hdr->length);
4649771b8ccSJustin.Lee1@Dell.com nca.data = data + sizeof(*hdr);
4659771b8ccSJustin.Lee1@Dell.com
4669771b8ccSJustin.Lee1@Dell.com ret = ncsi_xmit_cmd(&nca);
4679771b8ccSJustin.Lee1@Dell.com out_netlink:
4689771b8ccSJustin.Lee1@Dell.com if (ret != 0) {
4699771b8ccSJustin.Lee1@Dell.com netdev_err(ndp->ndev.dev,
4709771b8ccSJustin.Lee1@Dell.com "NCSI: Error %d sending command\n",
4719771b8ccSJustin.Lee1@Dell.com ret);
4729771b8ccSJustin.Lee1@Dell.com ncsi_send_netlink_err(ndp->ndev.dev,
4739771b8ccSJustin.Lee1@Dell.com info->snd_seq,
4749771b8ccSJustin.Lee1@Dell.com info->snd_portid,
4759771b8ccSJustin.Lee1@Dell.com info->nlhdr,
4769771b8ccSJustin.Lee1@Dell.com ret);
4779771b8ccSJustin.Lee1@Dell.com }
4789771b8ccSJustin.Lee1@Dell.com out:
4799771b8ccSJustin.Lee1@Dell.com return ret;
4809771b8ccSJustin.Lee1@Dell.com }
4819771b8ccSJustin.Lee1@Dell.com
ncsi_send_netlink_rsp(struct ncsi_request * nr,struct ncsi_package * np,struct ncsi_channel * nc)4829771b8ccSJustin.Lee1@Dell.com int ncsi_send_netlink_rsp(struct ncsi_request *nr,
4839771b8ccSJustin.Lee1@Dell.com struct ncsi_package *np,
4849771b8ccSJustin.Lee1@Dell.com struct ncsi_channel *nc)
4859771b8ccSJustin.Lee1@Dell.com {
4869771b8ccSJustin.Lee1@Dell.com struct sk_buff *skb;
4879771b8ccSJustin.Lee1@Dell.com struct net *net;
4889771b8ccSJustin.Lee1@Dell.com void *hdr;
4899771b8ccSJustin.Lee1@Dell.com int rc;
4909771b8ccSJustin.Lee1@Dell.com
4919771b8ccSJustin.Lee1@Dell.com net = dev_net(nr->rsp->dev);
4929771b8ccSJustin.Lee1@Dell.com
4939771b8ccSJustin.Lee1@Dell.com skb = genlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
4949771b8ccSJustin.Lee1@Dell.com if (!skb)
4959771b8ccSJustin.Lee1@Dell.com return -ENOMEM;
4969771b8ccSJustin.Lee1@Dell.com
4979771b8ccSJustin.Lee1@Dell.com hdr = genlmsg_put(skb, nr->snd_portid, nr->snd_seq,
4989771b8ccSJustin.Lee1@Dell.com &ncsi_genl_family, 0, NCSI_CMD_SEND_CMD);
4999771b8ccSJustin.Lee1@Dell.com if (!hdr) {
5009771b8ccSJustin.Lee1@Dell.com kfree_skb(skb);
5019771b8ccSJustin.Lee1@Dell.com return -EMSGSIZE;
5029771b8ccSJustin.Lee1@Dell.com }
5039771b8ccSJustin.Lee1@Dell.com
5049771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_IFINDEX, nr->rsp->dev->ifindex);
5059771b8ccSJustin.Lee1@Dell.com if (np)
5069771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_PACKAGE_ID, np->id);
5079771b8ccSJustin.Lee1@Dell.com if (nc)
5089771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_CHANNEL_ID, nc->id);
5099771b8ccSJustin.Lee1@Dell.com else
5109771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_CHANNEL_ID, NCSI_RESERVED_CHANNEL);
5119771b8ccSJustin.Lee1@Dell.com
5129771b8ccSJustin.Lee1@Dell.com rc = nla_put(skb, NCSI_ATTR_DATA, nr->rsp->len, (void *)nr->rsp->data);
5139771b8ccSJustin.Lee1@Dell.com if (rc)
5149771b8ccSJustin.Lee1@Dell.com goto err;
5159771b8ccSJustin.Lee1@Dell.com
5169771b8ccSJustin.Lee1@Dell.com genlmsg_end(skb, hdr);
5179771b8ccSJustin.Lee1@Dell.com return genlmsg_unicast(net, skb, nr->snd_portid);
5189771b8ccSJustin.Lee1@Dell.com
5199771b8ccSJustin.Lee1@Dell.com err:
5209771b8ccSJustin.Lee1@Dell.com kfree_skb(skb);
5219771b8ccSJustin.Lee1@Dell.com return rc;
5229771b8ccSJustin.Lee1@Dell.com }
5239771b8ccSJustin.Lee1@Dell.com
ncsi_send_netlink_timeout(struct ncsi_request * nr,struct ncsi_package * np,struct ncsi_channel * nc)5249771b8ccSJustin.Lee1@Dell.com int ncsi_send_netlink_timeout(struct ncsi_request *nr,
5259771b8ccSJustin.Lee1@Dell.com struct ncsi_package *np,
5269771b8ccSJustin.Lee1@Dell.com struct ncsi_channel *nc)
5279771b8ccSJustin.Lee1@Dell.com {
5289771b8ccSJustin.Lee1@Dell.com struct sk_buff *skb;
5299771b8ccSJustin.Lee1@Dell.com struct net *net;
5309771b8ccSJustin.Lee1@Dell.com void *hdr;
5319771b8ccSJustin.Lee1@Dell.com
5329771b8ccSJustin.Lee1@Dell.com skb = genlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
5339771b8ccSJustin.Lee1@Dell.com if (!skb)
5349771b8ccSJustin.Lee1@Dell.com return -ENOMEM;
5359771b8ccSJustin.Lee1@Dell.com
5369771b8ccSJustin.Lee1@Dell.com hdr = genlmsg_put(skb, nr->snd_portid, nr->snd_seq,
5379771b8ccSJustin.Lee1@Dell.com &ncsi_genl_family, 0, NCSI_CMD_SEND_CMD);
5389771b8ccSJustin.Lee1@Dell.com if (!hdr) {
5399771b8ccSJustin.Lee1@Dell.com kfree_skb(skb);
5409771b8ccSJustin.Lee1@Dell.com return -EMSGSIZE;
5419771b8ccSJustin.Lee1@Dell.com }
5429771b8ccSJustin.Lee1@Dell.com
5439771b8ccSJustin.Lee1@Dell.com net = dev_net(nr->cmd->dev);
5449771b8ccSJustin.Lee1@Dell.com
5459771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_IFINDEX, nr->cmd->dev->ifindex);
5469771b8ccSJustin.Lee1@Dell.com
5479771b8ccSJustin.Lee1@Dell.com if (np)
5489771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_PACKAGE_ID, np->id);
5499771b8ccSJustin.Lee1@Dell.com else
5509771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_PACKAGE_ID,
5519771b8ccSJustin.Lee1@Dell.com NCSI_PACKAGE_INDEX((((struct ncsi_pkt_hdr *)
5529771b8ccSJustin.Lee1@Dell.com nr->cmd->data)->channel)));
5539771b8ccSJustin.Lee1@Dell.com
5549771b8ccSJustin.Lee1@Dell.com if (nc)
5559771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_CHANNEL_ID, nc->id);
5569771b8ccSJustin.Lee1@Dell.com else
5579771b8ccSJustin.Lee1@Dell.com nla_put_u32(skb, NCSI_ATTR_CHANNEL_ID, NCSI_RESERVED_CHANNEL);
5589771b8ccSJustin.Lee1@Dell.com
5599771b8ccSJustin.Lee1@Dell.com genlmsg_end(skb, hdr);
5609771b8ccSJustin.Lee1@Dell.com return genlmsg_unicast(net, skb, nr->snd_portid);
5619771b8ccSJustin.Lee1@Dell.com }
5629771b8ccSJustin.Lee1@Dell.com
ncsi_send_netlink_err(struct net_device * dev,u32 snd_seq,u32 snd_portid,const struct nlmsghdr * nlhdr,int err)5639771b8ccSJustin.Lee1@Dell.com int ncsi_send_netlink_err(struct net_device *dev,
5649771b8ccSJustin.Lee1@Dell.com u32 snd_seq,
5659771b8ccSJustin.Lee1@Dell.com u32 snd_portid,
566fde9bd4aSJakub Kicinski const struct nlmsghdr *nlhdr,
5679771b8ccSJustin.Lee1@Dell.com int err)
5689771b8ccSJustin.Lee1@Dell.com {
5699771b8ccSJustin.Lee1@Dell.com struct nlmsghdr *nlh;
5709771b8ccSJustin.Lee1@Dell.com struct nlmsgerr *nle;
5719771b8ccSJustin.Lee1@Dell.com struct sk_buff *skb;
5729771b8ccSJustin.Lee1@Dell.com struct net *net;
5739771b8ccSJustin.Lee1@Dell.com
5749771b8ccSJustin.Lee1@Dell.com skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
5759771b8ccSJustin.Lee1@Dell.com if (!skb)
5769771b8ccSJustin.Lee1@Dell.com return -ENOMEM;
5779771b8ccSJustin.Lee1@Dell.com
5789771b8ccSJustin.Lee1@Dell.com net = dev_net(dev);
5799771b8ccSJustin.Lee1@Dell.com
5809771b8ccSJustin.Lee1@Dell.com nlh = nlmsg_put(skb, snd_portid, snd_seq,
5819771b8ccSJustin.Lee1@Dell.com NLMSG_ERROR, sizeof(*nle), 0);
5829771b8ccSJustin.Lee1@Dell.com nle = (struct nlmsgerr *)nlmsg_data(nlh);
5839771b8ccSJustin.Lee1@Dell.com nle->error = err;
5849771b8ccSJustin.Lee1@Dell.com memcpy(&nle->msg, nlhdr, sizeof(*nlh));
5859771b8ccSJustin.Lee1@Dell.com
5869771b8ccSJustin.Lee1@Dell.com nlmsg_end(skb, nlh);
5879771b8ccSJustin.Lee1@Dell.com
5889771b8ccSJustin.Lee1@Dell.com return nlmsg_unicast(net->genl_sock, skb, snd_portid);
5899771b8ccSJustin.Lee1@Dell.com }
5909771b8ccSJustin.Lee1@Dell.com
ncsi_set_package_mask_nl(struct sk_buff * msg,struct genl_info * info)5918d951a75SSamuel Mendoza-Jonas static int ncsi_set_package_mask_nl(struct sk_buff *msg,
5928d951a75SSamuel Mendoza-Jonas struct genl_info *info)
5938d951a75SSamuel Mendoza-Jonas {
5948d951a75SSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp;
5958d951a75SSamuel Mendoza-Jonas unsigned long flags;
5968d951a75SSamuel Mendoza-Jonas int rc;
5978d951a75SSamuel Mendoza-Jonas
5988d951a75SSamuel Mendoza-Jonas if (!info || !info->attrs)
5998d951a75SSamuel Mendoza-Jonas return -EINVAL;
6008d951a75SSamuel Mendoza-Jonas
6018d951a75SSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_IFINDEX])
6028d951a75SSamuel Mendoza-Jonas return -EINVAL;
6038d951a75SSamuel Mendoza-Jonas
6048d951a75SSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_PACKAGE_MASK])
6058d951a75SSamuel Mendoza-Jonas return -EINVAL;
6068d951a75SSamuel Mendoza-Jonas
6078d951a75SSamuel Mendoza-Jonas ndp = ndp_from_ifindex(get_net(sock_net(msg->sk)),
6088d951a75SSamuel Mendoza-Jonas nla_get_u32(info->attrs[NCSI_ATTR_IFINDEX]));
6098d951a75SSamuel Mendoza-Jonas if (!ndp)
6108d951a75SSamuel Mendoza-Jonas return -ENODEV;
6118d951a75SSamuel Mendoza-Jonas
6128d951a75SSamuel Mendoza-Jonas spin_lock_irqsave(&ndp->lock, flags);
6138d951a75SSamuel Mendoza-Jonas if (nla_get_flag(info->attrs[NCSI_ATTR_MULTI_FLAG])) {
6148d951a75SSamuel Mendoza-Jonas if (ndp->flags & NCSI_DEV_HWA) {
6158d951a75SSamuel Mendoza-Jonas ndp->multi_package = true;
6168d951a75SSamuel Mendoza-Jonas rc = 0;
6178d951a75SSamuel Mendoza-Jonas } else {
6188d951a75SSamuel Mendoza-Jonas netdev_err(ndp->ndev.dev,
6198d951a75SSamuel Mendoza-Jonas "NCSI: Can't use multiple packages without HWA\n");
6208d951a75SSamuel Mendoza-Jonas rc = -EPERM;
6218d951a75SSamuel Mendoza-Jonas }
6228d951a75SSamuel Mendoza-Jonas } else {
6238d951a75SSamuel Mendoza-Jonas ndp->multi_package = false;
6248d951a75SSamuel Mendoza-Jonas rc = 0;
6258d951a75SSamuel Mendoza-Jonas }
6268d951a75SSamuel Mendoza-Jonas
6278d951a75SSamuel Mendoza-Jonas if (!rc)
6288d951a75SSamuel Mendoza-Jonas ndp->package_whitelist =
6298d951a75SSamuel Mendoza-Jonas nla_get_u32(info->attrs[NCSI_ATTR_PACKAGE_MASK]);
6308d951a75SSamuel Mendoza-Jonas spin_unlock_irqrestore(&ndp->lock, flags);
6318d951a75SSamuel Mendoza-Jonas
6328d951a75SSamuel Mendoza-Jonas if (!rc) {
6338d951a75SSamuel Mendoza-Jonas /* Update channel configuration */
6348d951a75SSamuel Mendoza-Jonas if (!(ndp->flags & NCSI_DEV_RESET))
6358d951a75SSamuel Mendoza-Jonas ncsi_reset_dev(&ndp->ndev);
6368d951a75SSamuel Mendoza-Jonas }
6378d951a75SSamuel Mendoza-Jonas
6388d951a75SSamuel Mendoza-Jonas return rc;
6398d951a75SSamuel Mendoza-Jonas }
6408d951a75SSamuel Mendoza-Jonas
ncsi_set_channel_mask_nl(struct sk_buff * msg,struct genl_info * info)6418d951a75SSamuel Mendoza-Jonas static int ncsi_set_channel_mask_nl(struct sk_buff *msg,
6428d951a75SSamuel Mendoza-Jonas struct genl_info *info)
6438d951a75SSamuel Mendoza-Jonas {
6448d951a75SSamuel Mendoza-Jonas struct ncsi_package *np, *package;
6458d951a75SSamuel Mendoza-Jonas struct ncsi_channel *nc, *channel;
6468d951a75SSamuel Mendoza-Jonas u32 package_id, channel_id;
6478d951a75SSamuel Mendoza-Jonas struct ncsi_dev_priv *ndp;
6488d951a75SSamuel Mendoza-Jonas unsigned long flags;
6498d951a75SSamuel Mendoza-Jonas
6508d951a75SSamuel Mendoza-Jonas if (!info || !info->attrs)
6518d951a75SSamuel Mendoza-Jonas return -EINVAL;
6528d951a75SSamuel Mendoza-Jonas
6538d951a75SSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_IFINDEX])
6548d951a75SSamuel Mendoza-Jonas return -EINVAL;
6558d951a75SSamuel Mendoza-Jonas
6568d951a75SSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_PACKAGE_ID])
6578d951a75SSamuel Mendoza-Jonas return -EINVAL;
6588d951a75SSamuel Mendoza-Jonas
6598d951a75SSamuel Mendoza-Jonas if (!info->attrs[NCSI_ATTR_CHANNEL_MASK])
6608d951a75SSamuel Mendoza-Jonas return -EINVAL;
6618d951a75SSamuel Mendoza-Jonas
6628d951a75SSamuel Mendoza-Jonas ndp = ndp_from_ifindex(get_net(sock_net(msg->sk)),
6638d951a75SSamuel Mendoza-Jonas nla_get_u32(info->attrs[NCSI_ATTR_IFINDEX]));
6648d951a75SSamuel Mendoza-Jonas if (!ndp)
6658d951a75SSamuel Mendoza-Jonas return -ENODEV;
6668d951a75SSamuel Mendoza-Jonas
6678d951a75SSamuel Mendoza-Jonas package_id = nla_get_u32(info->attrs[NCSI_ATTR_PACKAGE_ID]);
6688d951a75SSamuel Mendoza-Jonas package = NULL;
6698d951a75SSamuel Mendoza-Jonas NCSI_FOR_EACH_PACKAGE(ndp, np)
6708d951a75SSamuel Mendoza-Jonas if (np->id == package_id) {
6718d951a75SSamuel Mendoza-Jonas package = np;
6728d951a75SSamuel Mendoza-Jonas break;
6738d951a75SSamuel Mendoza-Jonas }
6748d951a75SSamuel Mendoza-Jonas if (!package)
6758d951a75SSamuel Mendoza-Jonas return -ERANGE;
6768d951a75SSamuel Mendoza-Jonas
6778d951a75SSamuel Mendoza-Jonas spin_lock_irqsave(&package->lock, flags);
6788d951a75SSamuel Mendoza-Jonas
6798d951a75SSamuel Mendoza-Jonas channel = NULL;
6808d951a75SSamuel Mendoza-Jonas if (info->attrs[NCSI_ATTR_CHANNEL_ID]) {
6818d951a75SSamuel Mendoza-Jonas channel_id = nla_get_u32(info->attrs[NCSI_ATTR_CHANNEL_ID]);
6828d951a75SSamuel Mendoza-Jonas NCSI_FOR_EACH_CHANNEL(np, nc)
6838d951a75SSamuel Mendoza-Jonas if (nc->id == channel_id) {
6848d951a75SSamuel Mendoza-Jonas channel = nc;
6858d951a75SSamuel Mendoza-Jonas break;
6868d951a75SSamuel Mendoza-Jonas }
6878d951a75SSamuel Mendoza-Jonas if (!channel) {
6888d951a75SSamuel Mendoza-Jonas spin_unlock_irqrestore(&package->lock, flags);
6898d951a75SSamuel Mendoza-Jonas return -ERANGE;
6908d951a75SSamuel Mendoza-Jonas }
6918d951a75SSamuel Mendoza-Jonas netdev_dbg(ndp->ndev.dev,
6928d951a75SSamuel Mendoza-Jonas "NCSI: Channel %u set as preferred channel\n",
6938d951a75SSamuel Mendoza-Jonas channel->id);
6948d951a75SSamuel Mendoza-Jonas }
6958d951a75SSamuel Mendoza-Jonas
6968d951a75SSamuel Mendoza-Jonas package->channel_whitelist =
6978d951a75SSamuel Mendoza-Jonas nla_get_u32(info->attrs[NCSI_ATTR_CHANNEL_MASK]);
6988d951a75SSamuel Mendoza-Jonas if (package->channel_whitelist == 0)
6998d951a75SSamuel Mendoza-Jonas netdev_dbg(ndp->ndev.dev,
7008d951a75SSamuel Mendoza-Jonas "NCSI: Package %u set to all channels disabled\n",
7018d951a75SSamuel Mendoza-Jonas package->id);
7028d951a75SSamuel Mendoza-Jonas
7038d951a75SSamuel Mendoza-Jonas package->preferred_channel = channel;
7048d951a75SSamuel Mendoza-Jonas
7058d951a75SSamuel Mendoza-Jonas if (nla_get_flag(info->attrs[NCSI_ATTR_MULTI_FLAG])) {
7068d951a75SSamuel Mendoza-Jonas package->multi_channel = true;
7078d951a75SSamuel Mendoza-Jonas netdev_info(ndp->ndev.dev,
7088d951a75SSamuel Mendoza-Jonas "NCSI: Multi-channel enabled on package %u\n",
7098d951a75SSamuel Mendoza-Jonas package_id);
7108d951a75SSamuel Mendoza-Jonas } else {
7118d951a75SSamuel Mendoza-Jonas package->multi_channel = false;
7128d951a75SSamuel Mendoza-Jonas }
7138d951a75SSamuel Mendoza-Jonas
7148d951a75SSamuel Mendoza-Jonas spin_unlock_irqrestore(&package->lock, flags);
7158d951a75SSamuel Mendoza-Jonas
7168d951a75SSamuel Mendoza-Jonas /* Update channel configuration */
7178d951a75SSamuel Mendoza-Jonas if (!(ndp->flags & NCSI_DEV_RESET))
7188d951a75SSamuel Mendoza-Jonas ncsi_reset_dev(&ndp->ndev);
7198d951a75SSamuel Mendoza-Jonas
7208d951a75SSamuel Mendoza-Jonas return 0;
7218d951a75SSamuel Mendoza-Jonas }
7228d951a75SSamuel Mendoza-Jonas
72366a9b928SJakub Kicinski static const struct genl_small_ops ncsi_ops[] = {
724955dc68cSSamuel Mendoza-Jonas {
725955dc68cSSamuel Mendoza-Jonas .cmd = NCSI_CMD_PKG_INFO,
726ef6243acSJohannes Berg .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
727955dc68cSSamuel Mendoza-Jonas .doit = ncsi_pkg_info_nl,
728955dc68cSSamuel Mendoza-Jonas .dumpit = ncsi_pkg_info_all_nl,
729955dc68cSSamuel Mendoza-Jonas .flags = 0,
730955dc68cSSamuel Mendoza-Jonas },
731955dc68cSSamuel Mendoza-Jonas {
732955dc68cSSamuel Mendoza-Jonas .cmd = NCSI_CMD_SET_INTERFACE,
733ef6243acSJohannes Berg .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
734955dc68cSSamuel Mendoza-Jonas .doit = ncsi_set_interface_nl,
735955dc68cSSamuel Mendoza-Jonas .flags = GENL_ADMIN_PERM,
736955dc68cSSamuel Mendoza-Jonas },
737955dc68cSSamuel Mendoza-Jonas {
738955dc68cSSamuel Mendoza-Jonas .cmd = NCSI_CMD_CLEAR_INTERFACE,
739ef6243acSJohannes Berg .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
740955dc68cSSamuel Mendoza-Jonas .doit = ncsi_clear_interface_nl,
741955dc68cSSamuel Mendoza-Jonas .flags = GENL_ADMIN_PERM,
742955dc68cSSamuel Mendoza-Jonas },
7439771b8ccSJustin.Lee1@Dell.com {
7449771b8ccSJustin.Lee1@Dell.com .cmd = NCSI_CMD_SEND_CMD,
745ef6243acSJohannes Berg .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
7469771b8ccSJustin.Lee1@Dell.com .doit = ncsi_send_cmd_nl,
7479771b8ccSJustin.Lee1@Dell.com .flags = GENL_ADMIN_PERM,
7489771b8ccSJustin.Lee1@Dell.com },
7498d951a75SSamuel Mendoza-Jonas {
7508d951a75SSamuel Mendoza-Jonas .cmd = NCSI_CMD_SET_PACKAGE_MASK,
751ef6243acSJohannes Berg .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
7528d951a75SSamuel Mendoza-Jonas .doit = ncsi_set_package_mask_nl,
7538d951a75SSamuel Mendoza-Jonas .flags = GENL_ADMIN_PERM,
7548d951a75SSamuel Mendoza-Jonas },
7558d951a75SSamuel Mendoza-Jonas {
7568d951a75SSamuel Mendoza-Jonas .cmd = NCSI_CMD_SET_CHANNEL_MASK,
757ef6243acSJohannes Berg .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
7588d951a75SSamuel Mendoza-Jonas .doit = ncsi_set_channel_mask_nl,
7598d951a75SSamuel Mendoza-Jonas .flags = GENL_ADMIN_PERM,
7608d951a75SSamuel Mendoza-Jonas },
761955dc68cSSamuel Mendoza-Jonas };
762955dc68cSSamuel Mendoza-Jonas
763955dc68cSSamuel Mendoza-Jonas static struct genl_family ncsi_genl_family __ro_after_init = {
764955dc68cSSamuel Mendoza-Jonas .name = "NCSI",
765955dc68cSSamuel Mendoza-Jonas .version = 0,
766955dc68cSSamuel Mendoza-Jonas .maxattr = NCSI_ATTR_MAX,
7673b0f31f2SJohannes Berg .policy = ncsi_genl_policy,
768955dc68cSSamuel Mendoza-Jonas .module = THIS_MODULE,
76966a9b928SJakub Kicinski .small_ops = ncsi_ops,
77066a9b928SJakub Kicinski .n_small_ops = ARRAY_SIZE(ncsi_ops),
7719c5d03d3SJakub Kicinski .resv_start_op = NCSI_CMD_SET_CHANNEL_MASK + 1,
772955dc68cSSamuel Mendoza-Jonas };
773955dc68cSSamuel Mendoza-Jonas
ncsi_init_netlink(void)7741922a46bSJoel Stanley static int __init ncsi_init_netlink(void)
775955dc68cSSamuel Mendoza-Jonas {
7761922a46bSJoel Stanley return genl_register_family(&ncsi_genl_family);
777955dc68cSSamuel Mendoza-Jonas }
7781922a46bSJoel Stanley subsys_initcall(ncsi_init_netlink);
779