projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
devlink: Extend the support querying for region snapshot IDs
[linux-2.6-block.git] / net / core / devlink.c
CommitLineData
bfcd3a46
JP		 1/*
2 * net/core/devlink.c - Network physical/parent device Netlink interface
3 *
4 * Heavily inspired by net/wireless/
5 * Copyright (c) 2016 Mellanox Technologies. All rights reserved.
6 * Copyright (c) 2016 Jiri Pirko <jiri@mellanox.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 */
13
14#include <linux/kernel.h>
15#include <linux/module.h>
16#include <linux/types.h>
17#include <linux/slab.h>
18#include <linux/gfp.h>
19#include <linux/device.h>
20#include <linux/list.h>
21#include <linux/netdevice.h>
22#include <rdma/ib_verbs.h>
23#include <net/netlink.h>
24#include <net/genetlink.h>
25#include <net/rtnetlink.h>
26#include <net/net_namespace.h>
27#include <net/sock.h>
28#include <net/devlink.h>
e5224f0f
JP		 29#define CREATE_TRACE_POINTS
30#include <trace/events/devlink.h>
31
11770091
AS		 32static struct devlink_dpipe_field devlink_dpipe_fields_ethernet[] = {
33 {
12bdc5e1 34 .name = "destination mac",
11770091
AS		 35 .id = DEVLINK_DPIPE_FIELD_ETHERNET_DST_MAC,
36 .bitwidth = 48,
37 },
38};
39
40struct devlink_dpipe_header devlink_dpipe_header_ethernet = {
41 .name = "ethernet",
42 .id = DEVLINK_DPIPE_HEADER_ETHERNET,
43 .fields = devlink_dpipe_fields_ethernet,
44 .fields_count = ARRAY_SIZE(devlink_dpipe_fields_ethernet),
45 .global = true,
46};
47EXPORT_SYMBOL(devlink_dpipe_header_ethernet);
48
3fb886ec
AS		 49static struct devlink_dpipe_field devlink_dpipe_fields_ipv4[] = {
50 {
51 .name = "destination ip",
52 .id = DEVLINK_DPIPE_FIELD_IPV4_DST_IP,
53 .bitwidth = 32,
54 },
55};
56
57struct devlink_dpipe_header devlink_dpipe_header_ipv4 = {
58 .name = "ipv4",
59 .id = DEVLINK_DPIPE_HEADER_IPV4,
60 .fields = devlink_dpipe_fields_ipv4,
61 .fields_count = ARRAY_SIZE(devlink_dpipe_fields_ipv4),
62 .global = true,
63};
64EXPORT_SYMBOL(devlink_dpipe_header_ipv4);
65
1797f5b3
AS		 66static struct devlink_dpipe_field devlink_dpipe_fields_ipv6[] = {
67 {
68 .name = "destination ip",
69 .id = DEVLINK_DPIPE_FIELD_IPV6_DST_IP,
70 .bitwidth = 128,
71 },
72};
73
74struct devlink_dpipe_header devlink_dpipe_header_ipv6 = {
75 .name = "ipv6",
76 .id = DEVLINK_DPIPE_HEADER_IPV6,
77 .fields = devlink_dpipe_fields_ipv6,
78 .fields_count = ARRAY_SIZE(devlink_dpipe_fields_ipv6),
79 .global = true,
80};
81EXPORT_SYMBOL(devlink_dpipe_header_ipv6);
82
e5224f0f 83EXPORT_TRACEPOINT_SYMBOL_GPL(devlink_hwmsg);
bfcd3a46
JP		 84
85static LIST_HEAD(devlink_list);
86
87/* devlink_mutex
88 *
89 * An overall lock guarding every operation coming from userspace.
90 * It also guards devlink devices list and it is taken when
91 * driver registers/unregisters it.
92 */
93static DEFINE_MUTEX(devlink_mutex);
94
bfcd3a46
JP		 95static struct net *devlink_net(const struct devlink *devlink)
96{
97 return read_pnet(&devlink->_net);
98}
99
100static void devlink_net_set(struct devlink *devlink, struct net *net)
101{
102 write_pnet(&devlink->_net, net);
103}
104
105static struct devlink *devlink_get_from_attrs(struct net *net,
106 struct nlattr **attrs)
107{
108 struct devlink *devlink;
109 char *busname;
110 char *devname;
111
112 if (!attrs[DEVLINK_ATTR_BUS_NAME] || !attrs[DEVLINK_ATTR_DEV_NAME])
113 return ERR_PTR(-EINVAL);
114
115 busname = nla_data(attrs[DEVLINK_ATTR_BUS_NAME]);
116 devname = nla_data(attrs[DEVLINK_ATTR_DEV_NAME]);
117
118 list_for_each_entry(devlink, &devlink_list, list) {
119 if (strcmp(devlink->dev->bus->name, busname) == 0 &&
120 strcmp(dev_name(devlink->dev), devname) == 0 &&
121 net_eq(devlink_net(devlink), net))
122 return devlink;
123 }
124
125 return ERR_PTR(-ENODEV);
126}
127
128static struct devlink *devlink_get_from_info(struct genl_info *info)
129{
130 return devlink_get_from_attrs(genl_info_net(info), info->attrs);
131}
132
133static struct devlink_port *devlink_port_get_by_index(struct devlink *devlink,
134 int port_index)
135{
136 struct devlink_port *devlink_port;
137
138 list_for_each_entry(devlink_port, &devlink->port_list, list) {
139 if (devlink_port->index == port_index)
140 return devlink_port;
141 }
142 return NULL;
143}
144
145static bool devlink_port_index_exists(struct devlink *devlink, int port_index)
146{
147 return devlink_port_get_by_index(devlink, port_index);
148}
149
150static struct devlink_port *devlink_port_get_from_attrs(struct devlink *devlink,
151 struct nlattr **attrs)
152{
153 if (attrs[DEVLINK_ATTR_PORT_INDEX]) {
154 u32 port_index = nla_get_u32(attrs[DEVLINK_ATTR_PORT_INDEX]);
155 struct devlink_port *devlink_port;
156
157 devlink_port = devlink_port_get_by_index(devlink, port_index);
158 if (!devlink_port)
159 return ERR_PTR(-ENODEV);
160 return devlink_port;
161 }
162 return ERR_PTR(-EINVAL);
163}
164
165static struct devlink_port *devlink_port_get_from_info(struct devlink *devlink,
166 struct genl_info *info)
167{
168 return devlink_port_get_from_attrs(devlink, info->attrs);
169}
170
bf797471
JP		 171struct devlink_sb {
172 struct list_head list;
173 unsigned int index;
174 u32 size;
175 u16 ingress_pools_count;
176 u16 egress_pools_count;
177 u16 ingress_tc_count;
178 u16 egress_tc_count;
179};
180
181static u16 devlink_sb_pool_count(struct devlink_sb *devlink_sb)
182{
183 return devlink_sb->ingress_pools_count + devlink_sb->egress_pools_count;
184}
185
186static struct devlink_sb *devlink_sb_get_by_index(struct devlink *devlink,
187 unsigned int sb_index)
188{
189 struct devlink_sb *devlink_sb;
190
191 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
192 if (devlink_sb->index == sb_index)
193 return devlink_sb;
194 }
195 return NULL;
196}
197
198static bool devlink_sb_index_exists(struct devlink *devlink,
199 unsigned int sb_index)
200{
201 return devlink_sb_get_by_index(devlink, sb_index);
202}
203
204static struct devlink_sb *devlink_sb_get_from_attrs(struct devlink *devlink,
205 struct nlattr **attrs)
206{
207 if (attrs[DEVLINK_ATTR_SB_INDEX]) {
208 u32 sb_index = nla_get_u32(attrs[DEVLINK_ATTR_SB_INDEX]);
209 struct devlink_sb *devlink_sb;
210
211 devlink_sb = devlink_sb_get_by_index(devlink, sb_index);
212 if (!devlink_sb)
213 return ERR_PTR(-ENODEV);
214 return devlink_sb;
215 }
216 return ERR_PTR(-EINVAL);
217}
218
219static struct devlink_sb *devlink_sb_get_from_info(struct devlink *devlink,
220 struct genl_info *info)
221{
222 return devlink_sb_get_from_attrs(devlink, info->attrs);
223}
224
225static int devlink_sb_pool_index_get_from_attrs(struct devlink_sb *devlink_sb,
226 struct nlattr **attrs,
227 u16 *p_pool_index)
228{
229 u16 val;
230
231 if (!attrs[DEVLINK_ATTR_SB_POOL_INDEX])
232 return -EINVAL;
233
234 val = nla_get_u16(attrs[DEVLINK_ATTR_SB_POOL_INDEX]);
235 if (val >= devlink_sb_pool_count(devlink_sb))
236 return -EINVAL;
237 *p_pool_index = val;
238 return 0;
239}
240
241static int devlink_sb_pool_index_get_from_info(struct devlink_sb *devlink_sb,
242 struct genl_info *info,
243 u16 *p_pool_index)
244{
245 return devlink_sb_pool_index_get_from_attrs(devlink_sb, info->attrs,
246 p_pool_index);
247}
248
249static int
250devlink_sb_pool_type_get_from_attrs(struct nlattr **attrs,
251 enum devlink_sb_pool_type *p_pool_type)
252{
253 u8 val;
254
255 if (!attrs[DEVLINK_ATTR_SB_POOL_TYPE])
256 return -EINVAL;
257
258 val = nla_get_u8(attrs[DEVLINK_ATTR_SB_POOL_TYPE]);
259 if (val != DEVLINK_SB_POOL_TYPE_INGRESS &&
260 val != DEVLINK_SB_POOL_TYPE_EGRESS)
261 return -EINVAL;
262 *p_pool_type = val;
263 return 0;
264}
265
266static int
267devlink_sb_pool_type_get_from_info(struct genl_info *info,
268 enum devlink_sb_pool_type *p_pool_type)
269{
270 return devlink_sb_pool_type_get_from_attrs(info->attrs, p_pool_type);
271}
272
273static int
274devlink_sb_th_type_get_from_attrs(struct nlattr **attrs,
275 enum devlink_sb_threshold_type *p_th_type)
276{
277 u8 val;
278
279 if (!attrs[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])
280 return -EINVAL;
281
282 val = nla_get_u8(attrs[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE]);
283 if (val != DEVLINK_SB_THRESHOLD_TYPE_STATIC &&
284 val != DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC)
285 return -EINVAL;
286 *p_th_type = val;
287 return 0;
288}
289
290static int
291devlink_sb_th_type_get_from_info(struct genl_info *info,
292 enum devlink_sb_threshold_type *p_th_type)
293{
294 return devlink_sb_th_type_get_from_attrs(info->attrs, p_th_type);
295}
296
297static int
298devlink_sb_tc_index_get_from_attrs(struct devlink_sb *devlink_sb,
299 struct nlattr **attrs,
300 enum devlink_sb_pool_type pool_type,
301 u16 *p_tc_index)
302{
303 u16 val;
304
305 if (!attrs[DEVLINK_ATTR_SB_TC_INDEX])
306 return -EINVAL;
307
308 val = nla_get_u16(attrs[DEVLINK_ATTR_SB_TC_INDEX]);
309 if (pool_type == DEVLINK_SB_POOL_TYPE_INGRESS &&
310 val >= devlink_sb->ingress_tc_count)
311 return -EINVAL;
312 if (pool_type == DEVLINK_SB_POOL_TYPE_EGRESS &&
313 val >= devlink_sb->egress_tc_count)
314 return -EINVAL;
315 *p_tc_index = val;
316 return 0;
317}
318
319static int
320devlink_sb_tc_index_get_from_info(struct devlink_sb *devlink_sb,
321 struct genl_info *info,
322 enum devlink_sb_pool_type pool_type,
323 u16 *p_tc_index)
324{
325 return devlink_sb_tc_index_get_from_attrs(devlink_sb, info->attrs,
326 pool_type, p_tc_index);
327}
328
b16ebe92
AV		 329struct devlink_region {
330 struct devlink *devlink;
331 struct list_head list;
332 const char *name;
333 struct list_head snapshot_list;
334 u32 max_snapshots;
335 u32 cur_snapshots;
336 u64 size;
337};
338
d7e52722
AV		 339struct devlink_snapshot {
340 struct list_head list;
341 struct devlink_region *region;
342 devlink_snapshot_data_dest_t *data_destructor;
343 u64 data_len;
344 u8 *data;
345 u32 id;
346};
347
b16ebe92
AV		 348static struct devlink_region *
349devlink_region_get_by_name(struct devlink *devlink, const char *region_name)
350{
351 struct devlink_region *region;
352
353 list_for_each_entry(region, &devlink->region_list, list)
354 if (!strcmp(region->name, region_name))
355 return region;
356
357 return NULL;
358}
359
d7e52722
AV		 360static struct devlink_snapshot *
361devlink_region_snapshot_get_by_id(struct devlink_region *region, u32 id)
362{
363 struct devlink_snapshot *snapshot;
364
365 list_for_each_entry(snapshot, &region->snapshot_list, list)
366 if (snapshot->id == id)
367 return snapshot;
368
369 return NULL;
370}
371
372static void devlink_region_snapshot_del(struct devlink_snapshot *snapshot)
373{
374 snapshot->region->cur_snapshots--;
375 list_del(&snapshot->list);
376 (*snapshot->data_destructor)(snapshot->data);
377 kfree(snapshot);
378}
379
1fc2257e
JP		 380#define DEVLINK_NL_FLAG_NEED_DEVLINK BIT(0)
381#define DEVLINK_NL_FLAG_NEED_PORT BIT(1)
bf797471 382#define DEVLINK_NL_FLAG_NEED_SB BIT(2)
2406e7e5
AS		 383
384/* The per devlink instance lock is taken by default in the pre-doit
385 * operation, yet several commands do not require this. The global
386 * devlink lock is taken and protects from disruption by user-calls.
387 */
388#define DEVLINK_NL_FLAG_NO_LOCK BIT(3)
bfcd3a46
JP		 389
390static int devlink_nl_pre_doit(const struct genl_ops *ops,
391 struct sk_buff *skb, struct genl_info *info)
392{
393 struct devlink *devlink;
2406e7e5 394 int err;
bfcd3a46
JP		 395
396 mutex_lock(&devlink_mutex);
397 devlink = devlink_get_from_info(info);
398 if (IS_ERR(devlink)) {
399 mutex_unlock(&devlink_mutex);
400 return PTR_ERR(devlink);
401 }
2406e7e5
AS		 402 if (~ops->internal_flags & DEVLINK_NL_FLAG_NO_LOCK)
403 mutex_lock(&devlink->lock);
1fc2257e
JP		 404 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_DEVLINK) {
405 info->user_ptr[0] = devlink;
406 } else if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_PORT) {
bfcd3a46
JP		 407 struct devlink_port *devlink_port;
408
bfcd3a46
JP		 409 devlink_port = devlink_port_get_from_info(devlink, info);
410 if (IS_ERR(devlink_port)) {
2406e7e5
AS		 411 err = PTR_ERR(devlink_port);
412 goto unlock;
bfcd3a46 413 }
1fc2257e 414 info->user_ptr[0] = devlink_port;
bfcd3a46 415 }
bf797471
JP		 416 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_SB) {
417 struct devlink_sb *devlink_sb;
418
419 devlink_sb = devlink_sb_get_from_info(devlink, info);
420 if (IS_ERR(devlink_sb)) {
2406e7e5
AS		 421 err = PTR_ERR(devlink_sb);
422 goto unlock;
bf797471
JP		 423 }
424 info->user_ptr[1] = devlink_sb;
425 }
bfcd3a46 426 return 0;
2406e7e5
AS		 427
428unlock:
429 if (~ops->internal_flags & DEVLINK_NL_FLAG_NO_LOCK)
430 mutex_unlock(&devlink->lock);
431 mutex_unlock(&devlink_mutex);
432 return err;
bfcd3a46
JP		 433}
434
435static void devlink_nl_post_doit(const struct genl_ops *ops,
436 struct sk_buff *skb, struct genl_info *info)
437{
2406e7e5
AS		 438 struct devlink *devlink;
439
440 devlink = devlink_get_from_info(info);
441 if (~ops->internal_flags & DEVLINK_NL_FLAG_NO_LOCK)
442 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 443 mutex_unlock(&devlink_mutex);
444}
445
489111e5 446static struct genl_family devlink_nl_family;
bfcd3a46
JP		 447
448enum devlink_multicast_groups {
449 DEVLINK_MCGRP_CONFIG,
450};
451
452static const struct genl_multicast_group devlink_nl_mcgrps[] = {
453 [DEVLINK_MCGRP_CONFIG] = { .name = DEVLINK_GENL_MCGRP_CONFIG_NAME },
454};
455
456static int devlink_nl_put_handle(struct sk_buff *msg, struct devlink *devlink)
457{
458 if (nla_put_string(msg, DEVLINK_ATTR_BUS_NAME, devlink->dev->bus->name))
459 return -EMSGSIZE;
460 if (nla_put_string(msg, DEVLINK_ATTR_DEV_NAME, dev_name(devlink->dev)))
461 return -EMSGSIZE;
462 return 0;
463}
464
465static int devlink_nl_fill(struct sk_buff *msg, struct devlink *devlink,
466 enum devlink_command cmd, u32 portid,
467 u32 seq, int flags)
468{
469 void *hdr;
470
471 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
472 if (!hdr)
473 return -EMSGSIZE;
474
475 if (devlink_nl_put_handle(msg, devlink))
476 goto nla_put_failure;
477
478 genlmsg_end(msg, hdr);
479 return 0;
480
481nla_put_failure:
482 genlmsg_cancel(msg, hdr);
483 return -EMSGSIZE;
484}
485
486static void devlink_notify(struct devlink *devlink, enum devlink_command cmd)
487{
488 struct sk_buff *msg;
489 int err;
490
491 WARN_ON(cmd != DEVLINK_CMD_NEW && cmd != DEVLINK_CMD_DEL);
492
493 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
494 if (!msg)
495 return;
496
497 err = devlink_nl_fill(msg, devlink, cmd, 0, 0, 0);
498 if (err) {
499 nlmsg_free(msg);
500 return;
501 }
502
503 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
504 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
505}
506
b9ffcbaf
JP		 507static int devlink_nl_port_attrs_put(struct sk_buff *msg,
508 struct devlink_port *devlink_port)
509{
510 struct devlink_port_attrs *attrs = &devlink_port->attrs;
511
512 if (!attrs->set)
513 return 0;
5ec1380a
JP		 514 if (nla_put_u16(msg, DEVLINK_ATTR_PORT_FLAVOUR, attrs->flavour))
515 return -EMSGSIZE;
b9ffcbaf
JP		 516 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_NUMBER, attrs->port_number))
517 return -EMSGSIZE;
518 if (!attrs->split)
519 return 0;
520 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_SPLIT_GROUP, attrs->port_number))
521 return -EMSGSIZE;
522 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_SPLIT_SUBPORT_NUMBER,
523 attrs->split_subport_number))
524 return -EMSGSIZE;
525 return 0;
526}
527
bfcd3a46
JP		 528static int devlink_nl_port_fill(struct sk_buff *msg, struct devlink *devlink,
529 struct devlink_port *devlink_port,
530 enum devlink_command cmd, u32 portid,
531 u32 seq, int flags)
532{
533 void *hdr;
534
535 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
536 if (!hdr)
537 return -EMSGSIZE;
538
539 if (devlink_nl_put_handle(msg, devlink))
540 goto nla_put_failure;
541 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
542 goto nla_put_failure;
543 if (nla_put_u16(msg, DEVLINK_ATTR_PORT_TYPE, devlink_port->type))
544 goto nla_put_failure;
545 if (devlink_port->desired_type != DEVLINK_PORT_TYPE_NOTSET &&
546 nla_put_u16(msg, DEVLINK_ATTR_PORT_DESIRED_TYPE,
547 devlink_port->desired_type))
548 goto nla_put_failure;
549 if (devlink_port->type == DEVLINK_PORT_TYPE_ETH) {
550 struct net_device *netdev = devlink_port->type_dev;
551
552 if (netdev &&
553 (nla_put_u32(msg, DEVLINK_ATTR_PORT_NETDEV_IFINDEX,
554 netdev->ifindex) ||
555 nla_put_string(msg, DEVLINK_ATTR_PORT_NETDEV_NAME,
556 netdev->name)))
557 goto nla_put_failure;
558 }
559 if (devlink_port->type == DEVLINK_PORT_TYPE_IB) {
560 struct ib_device *ibdev = devlink_port->type_dev;
561
562 if (ibdev &&
563 nla_put_string(msg, DEVLINK_ATTR_PORT_IBDEV_NAME,
564 ibdev->name))
565 goto nla_put_failure;
566 }
b9ffcbaf 567 if (devlink_nl_port_attrs_put(msg, devlink_port))
bfcd3a46
JP		 568 goto nla_put_failure;
569
570 genlmsg_end(msg, hdr);
571 return 0;
572
573nla_put_failure:
574 genlmsg_cancel(msg, hdr);
575 return -EMSGSIZE;
576}
577
578static void devlink_port_notify(struct devlink_port *devlink_port,
579 enum devlink_command cmd)
580{
581 struct devlink *devlink = devlink_port->devlink;
582 struct sk_buff *msg;
583 int err;
584
585 if (!devlink_port->registered)
586 return;
587
588 WARN_ON(cmd != DEVLINK_CMD_PORT_NEW && cmd != DEVLINK_CMD_PORT_DEL);
589
590 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
591 if (!msg)
592 return;
593
594 err = devlink_nl_port_fill(msg, devlink, devlink_port, cmd, 0, 0, 0);
595 if (err) {
596 nlmsg_free(msg);
597 return;
598 }
599
600 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
601 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
602}
603
604static int devlink_nl_cmd_get_doit(struct sk_buff *skb, struct genl_info *info)
605{
606 struct devlink *devlink = info->user_ptr[0];
607 struct sk_buff *msg;
608 int err;
609
610 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
611 if (!msg)
612 return -ENOMEM;
613
614 err = devlink_nl_fill(msg, devlink, DEVLINK_CMD_NEW,
615 info->snd_portid, info->snd_seq, 0);
616 if (err) {
617 nlmsg_free(msg);
618 return err;
619 }
620
621 return genlmsg_reply(msg, info);
622}
623
624static int devlink_nl_cmd_get_dumpit(struct sk_buff *msg,
625 struct netlink_callback *cb)
626{
627 struct devlink *devlink;
628 int start = cb->args[0];
629 int idx = 0;
630 int err;
631
632 mutex_lock(&devlink_mutex);
633 list_for_each_entry(devlink, &devlink_list, list) {
634 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
635 continue;
636 if (idx < start) {
637 idx++;
638 continue;
639 }
640 err = devlink_nl_fill(msg, devlink, DEVLINK_CMD_NEW,
641 NETLINK_CB(cb->skb).portid,
642 cb->nlh->nlmsg_seq, NLM_F_MULTI);
643 if (err)
644 goto out;
645 idx++;
646 }
647out:
648 mutex_unlock(&devlink_mutex);
649
650 cb->args[0] = idx;
651 return msg->len;
652}
653
654static int devlink_nl_cmd_port_get_doit(struct sk_buff *skb,
655 struct genl_info *info)
656{
1fc2257e
JP		 657 struct devlink_port *devlink_port = info->user_ptr[0];
658 struct devlink *devlink = devlink_port->devlink;
bfcd3a46
JP		 659 struct sk_buff *msg;
660 int err;
661
662 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
663 if (!msg)
664 return -ENOMEM;
665
666 err = devlink_nl_port_fill(msg, devlink, devlink_port,
667 DEVLINK_CMD_PORT_NEW,
668 info->snd_portid, info->snd_seq, 0);
669 if (err) {
670 nlmsg_free(msg);
671 return err;
672 }
673
674 return genlmsg_reply(msg, info);
675}
676
677static int devlink_nl_cmd_port_get_dumpit(struct sk_buff *msg,
678 struct netlink_callback *cb)
679{
680 struct devlink *devlink;
681 struct devlink_port *devlink_port;
682 int start = cb->args[0];
683 int idx = 0;
684 int err;
685
686 mutex_lock(&devlink_mutex);
bfcd3a46
JP		 687 list_for_each_entry(devlink, &devlink_list, list) {
688 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
689 continue;
2406e7e5 690 mutex_lock(&devlink->lock);
bfcd3a46
JP		 691 list_for_each_entry(devlink_port, &devlink->port_list, list) {
692 if (idx < start) {
693 idx++;
694 continue;
695 }
696 err = devlink_nl_port_fill(msg, devlink, devlink_port,
697 DEVLINK_CMD_NEW,
698 NETLINK_CB(cb->skb).portid,
699 cb->nlh->nlmsg_seq,
700 NLM_F_MULTI);
2406e7e5
AS		 701 if (err) {
702 mutex_unlock(&devlink->lock);
bfcd3a46 703 goto out;
2406e7e5 704 }
bfcd3a46
JP		 705 idx++;
706 }
2406e7e5 707 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 708 }
709out:
bfcd3a46
JP		 710 mutex_unlock(&devlink_mutex);
711
712 cb->args[0] = idx;
713 return msg->len;
714}
715
716static int devlink_port_type_set(struct devlink *devlink,
717 struct devlink_port *devlink_port,
718 enum devlink_port_type port_type)
719
720{
721 int err;
722
723 if (devlink->ops && devlink->ops->port_type_set) {
724 if (port_type == DEVLINK_PORT_TYPE_NOTSET)
725 return -EINVAL;
6edf1017
ER		 726 if (port_type == devlink_port->type)
727 return 0;
bfcd3a46
JP		 728 err = devlink->ops->port_type_set(devlink_port, port_type);
729 if (err)
730 return err;
731 devlink_port->desired_type = port_type;
732 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
733 return 0;
734 }
735 return -EOPNOTSUPP;
736}
737
738static int devlink_nl_cmd_port_set_doit(struct sk_buff *skb,
739 struct genl_info *info)
740{
1fc2257e
JP		 741 struct devlink_port *devlink_port = info->user_ptr[0];
742 struct devlink *devlink = devlink_port->devlink;
bfcd3a46
JP		 743 int err;
744
745 if (info->attrs[DEVLINK_ATTR_PORT_TYPE]) {
746 enum devlink_port_type port_type;
747
748 port_type = nla_get_u16(info->attrs[DEVLINK_ATTR_PORT_TYPE]);
749 err = devlink_port_type_set(devlink, devlink_port, port_type);
750 if (err)
751 return err;
752 }
753 return 0;
754}
755
ac0fc8a1
DA		 756static int devlink_port_split(struct devlink *devlink, u32 port_index,
757 u32 count, struct netlink_ext_ack *extack)
bfcd3a46
JP		 758
759{
760 if (devlink->ops && devlink->ops->port_split)
ac0fc8a1
DA		 761 return devlink->ops->port_split(devlink, port_index, count,
762 extack);
bfcd3a46
JP		 763 return -EOPNOTSUPP;
764}
765
766static int devlink_nl_cmd_port_split_doit(struct sk_buff *skb,
767 struct genl_info *info)
768{
769 struct devlink *devlink = info->user_ptr[0];
770 u32 port_index;
771 u32 count;
772
773 if (!info->attrs[DEVLINK_ATTR_PORT_INDEX] ||
774 !info->attrs[DEVLINK_ATTR_PORT_SPLIT_COUNT])
775 return -EINVAL;
776
777 port_index = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_INDEX]);
778 count = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_SPLIT_COUNT]);
ac0fc8a1 779 return devlink_port_split(devlink, port_index, count, info->extack);
bfcd3a46
JP		 780}
781
ac0fc8a1
DA		 782static int devlink_port_unsplit(struct devlink *devlink, u32 port_index,
783 struct netlink_ext_ack *extack)
bfcd3a46
JP		 784
785{
786 if (devlink->ops && devlink->ops->port_unsplit)
ac0fc8a1 787 return devlink->ops->port_unsplit(devlink, port_index, extack);
bfcd3a46
JP		 788 return -EOPNOTSUPP;
789}
790
791static int devlink_nl_cmd_port_unsplit_doit(struct sk_buff *skb,
792 struct genl_info *info)
793{
794 struct devlink *devlink = info->user_ptr[0];
795 u32 port_index;
796
797 if (!info->attrs[DEVLINK_ATTR_PORT_INDEX])
798 return -EINVAL;
799
800 port_index = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_INDEX]);
ac0fc8a1 801 return devlink_port_unsplit(devlink, port_index, info->extack);
bfcd3a46
JP		 802}
803
bf797471
JP		 804static int devlink_nl_sb_fill(struct sk_buff *msg, struct devlink *devlink,
805 struct devlink_sb *devlink_sb,
806 enum devlink_command cmd, u32 portid,
807 u32 seq, int flags)
808{
809 void *hdr;
810
811 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
812 if (!hdr)
813 return -EMSGSIZE;
814
815 if (devlink_nl_put_handle(msg, devlink))
816 goto nla_put_failure;
817 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
818 goto nla_put_failure;
819 if (nla_put_u32(msg, DEVLINK_ATTR_SB_SIZE, devlink_sb->size))
820 goto nla_put_failure;
821 if (nla_put_u16(msg, DEVLINK_ATTR_SB_INGRESS_POOL_COUNT,
822 devlink_sb->ingress_pools_count))
823 goto nla_put_failure;
824 if (nla_put_u16(msg, DEVLINK_ATTR_SB_EGRESS_POOL_COUNT,
825 devlink_sb->egress_pools_count))
826 goto nla_put_failure;
827 if (nla_put_u16(msg, DEVLINK_ATTR_SB_INGRESS_TC_COUNT,
828 devlink_sb->ingress_tc_count))
829 goto nla_put_failure;
830 if (nla_put_u16(msg, DEVLINK_ATTR_SB_EGRESS_TC_COUNT,
831 devlink_sb->egress_tc_count))
832 goto nla_put_failure;
833
834 genlmsg_end(msg, hdr);
835 return 0;
836
837nla_put_failure:
838 genlmsg_cancel(msg, hdr);
839 return -EMSGSIZE;
840}
841
842static int devlink_nl_cmd_sb_get_doit(struct sk_buff *skb,
843 struct genl_info *info)
844{
845 struct devlink *devlink = info->user_ptr[0];
846 struct devlink_sb *devlink_sb = info->user_ptr[1];
847 struct sk_buff *msg;
848 int err;
849
850 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
851 if (!msg)
852 return -ENOMEM;
853
854 err = devlink_nl_sb_fill(msg, devlink, devlink_sb,
855 DEVLINK_CMD_SB_NEW,
856 info->snd_portid, info->snd_seq, 0);
857 if (err) {
858 nlmsg_free(msg);
859 return err;
860 }
861
862 return genlmsg_reply(msg, info);
863}
864
865static int devlink_nl_cmd_sb_get_dumpit(struct sk_buff *msg,
866 struct netlink_callback *cb)
867{
868 struct devlink *devlink;
869 struct devlink_sb *devlink_sb;
870 int start = cb->args[0];
871 int idx = 0;
872 int err;
873
874 mutex_lock(&devlink_mutex);
875 list_for_each_entry(devlink, &devlink_list, list) {
876 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
877 continue;
2406e7e5 878 mutex_lock(&devlink->lock);
bf797471
JP		 879 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
880 if (idx < start) {
881 idx++;
882 continue;
883 }
884 err = devlink_nl_sb_fill(msg, devlink, devlink_sb,
885 DEVLINK_CMD_SB_NEW,
886 NETLINK_CB(cb->skb).portid,
887 cb->nlh->nlmsg_seq,
888 NLM_F_MULTI);
2406e7e5
AS		 889 if (err) {
890 mutex_unlock(&devlink->lock);
bf797471 891 goto out;
2406e7e5 892 }
bf797471
JP		 893 idx++;
894 }
2406e7e5 895 mutex_unlock(&devlink->lock);
bf797471
JP		 896 }
897out:
898 mutex_unlock(&devlink_mutex);
899
900 cb->args[0] = idx;
901 return msg->len;
902}
903
904static int devlink_nl_sb_pool_fill(struct sk_buff *msg, struct devlink *devlink,
905 struct devlink_sb *devlink_sb,
906 u16 pool_index, enum devlink_command cmd,
907 u32 portid, u32 seq, int flags)
908{
909 struct devlink_sb_pool_info pool_info;
910 void *hdr;
911 int err;
912
913 err = devlink->ops->sb_pool_get(devlink, devlink_sb->index,
914 pool_index, &pool_info);
915 if (err)
916 return err;
917
918 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
919 if (!hdr)
920 return -EMSGSIZE;
921
922 if (devlink_nl_put_handle(msg, devlink))
923 goto nla_put_failure;
924 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
925 goto nla_put_failure;
926 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
927 goto nla_put_failure;
928 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_TYPE, pool_info.pool_type))
929 goto nla_put_failure;
930 if (nla_put_u32(msg, DEVLINK_ATTR_SB_POOL_SIZE, pool_info.size))
931 goto nla_put_failure;
932 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE,
933 pool_info.threshold_type))
934 goto nla_put_failure;
935
936 genlmsg_end(msg, hdr);
937 return 0;
938
939nla_put_failure:
940 genlmsg_cancel(msg, hdr);
941 return -EMSGSIZE;
942}
943
944static int devlink_nl_cmd_sb_pool_get_doit(struct sk_buff *skb,
945 struct genl_info *info)
946{
947 struct devlink *devlink = info->user_ptr[0];
948 struct devlink_sb *devlink_sb = info->user_ptr[1];
949 struct sk_buff *msg;
950 u16 pool_index;
951 int err;
952
953 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
954 &pool_index);
955 if (err)
956 return err;
957
958 if (!devlink->ops || !devlink->ops->sb_pool_get)
959 return -EOPNOTSUPP;
960
961 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
962 if (!msg)
963 return -ENOMEM;
964
965 err = devlink_nl_sb_pool_fill(msg, devlink, devlink_sb, pool_index,
966 DEVLINK_CMD_SB_POOL_NEW,
967 info->snd_portid, info->snd_seq, 0);
968 if (err) {
969 nlmsg_free(msg);
970 return err;
971 }
972
973 return genlmsg_reply(msg, info);
974}
975
976static int __sb_pool_get_dumpit(struct sk_buff *msg, int start, int *p_idx,
977 struct devlink *devlink,
978 struct devlink_sb *devlink_sb,
979 u32 portid, u32 seq)
980{
981 u16 pool_count = devlink_sb_pool_count(devlink_sb);
982 u16 pool_index;
983 int err;
984
985 for (pool_index = 0; pool_index < pool_count; pool_index++) {
986 if (*p_idx < start) {
987 (*p_idx)++;
988 continue;
989 }
990 err = devlink_nl_sb_pool_fill(msg, devlink,
991 devlink_sb,
992 pool_index,
993 DEVLINK_CMD_SB_POOL_NEW,
994 portid, seq, NLM_F_MULTI);
995 if (err)
996 return err;
997 (*p_idx)++;
998 }
999 return 0;
1000}
1001
1002static int devlink_nl_cmd_sb_pool_get_dumpit(struct sk_buff *msg,
1003 struct netlink_callback *cb)
1004{
1005 struct devlink *devlink;
1006 struct devlink_sb *devlink_sb;
1007 int start = cb->args[0];
1008 int idx = 0;
1009 int err;
1010
1011 mutex_lock(&devlink_mutex);
1012 list_for_each_entry(devlink, &devlink_list, list) {
1013 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
1014 !devlink->ops || !devlink->ops->sb_pool_get)
1015 continue;
2406e7e5 1016 mutex_lock(&devlink->lock);
bf797471
JP		 1017 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
1018 err = __sb_pool_get_dumpit(msg, start, &idx, devlink,
1019 devlink_sb,
1020 NETLINK_CB(cb->skb).portid,
1021 cb->nlh->nlmsg_seq);
2406e7e5
AS		 1022 if (err && err != -EOPNOTSUPP) {
1023 mutex_unlock(&devlink->lock);
bf797471 1024 goto out;
2406e7e5 1025 }
bf797471 1026 }
2406e7e5 1027 mutex_unlock(&devlink->lock);
bf797471
JP		 1028 }
1029out:
1030 mutex_unlock(&devlink_mutex);
1031
1032 cb->args[0] = idx;
1033 return msg->len;
1034}
1035
1036static int devlink_sb_pool_set(struct devlink *devlink, unsigned int sb_index,
1037 u16 pool_index, u32 size,
1038 enum devlink_sb_threshold_type threshold_type)
1039
1040{
1041 const struct devlink_ops *ops = devlink->ops;
1042
1043 if (ops && ops->sb_pool_set)
1044 return ops->sb_pool_set(devlink, sb_index, pool_index,
1045 size, threshold_type);
1046 return -EOPNOTSUPP;
1047}
1048
1049static int devlink_nl_cmd_sb_pool_set_doit(struct sk_buff *skb,
1050 struct genl_info *info)
1051{
1052 struct devlink *devlink = info->user_ptr[0];
1053 struct devlink_sb *devlink_sb = info->user_ptr[1];
1054 enum devlink_sb_threshold_type threshold_type;
1055 u16 pool_index;
1056 u32 size;
1057 int err;
1058
1059 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1060 &pool_index);
1061 if (err)
1062 return err;
1063
1064 err = devlink_sb_th_type_get_from_info(info, &threshold_type);
1065 if (err)
1066 return err;
1067
1068 if (!info->attrs[DEVLINK_ATTR_SB_POOL_SIZE])
1069 return -EINVAL;
1070
1071 size = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_POOL_SIZE]);
1072 return devlink_sb_pool_set(devlink, devlink_sb->index,
1073 pool_index, size, threshold_type);
1074}
1075
1076static int devlink_nl_sb_port_pool_fill(struct sk_buff *msg,
1077 struct devlink *devlink,
1078 struct devlink_port *devlink_port,
1079 struct devlink_sb *devlink_sb,
1080 u16 pool_index,
1081 enum devlink_command cmd,
1082 u32 portid, u32 seq, int flags)
1083{
df38dafd 1084 const struct devlink_ops *ops = devlink->ops;
bf797471
JP		 1085 u32 threshold;
1086 void *hdr;
1087 int err;
1088
df38dafd
JP		 1089 err = ops->sb_port_pool_get(devlink_port, devlink_sb->index,
1090 pool_index, &threshold);
bf797471
JP		 1091 if (err)
1092 return err;
1093
1094 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1095 if (!hdr)
1096 return -EMSGSIZE;
1097
1098 if (devlink_nl_put_handle(msg, devlink))
1099 goto nla_put_failure;
1100 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
1101 goto nla_put_failure;
1102 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
1103 goto nla_put_failure;
1104 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
1105 goto nla_put_failure;
1106 if (nla_put_u32(msg, DEVLINK_ATTR_SB_THRESHOLD, threshold))
1107 goto nla_put_failure;
1108
df38dafd
JP		 1109 if (ops->sb_occ_port_pool_get) {
1110 u32 cur;
1111 u32 max;
1112
1113 err = ops->sb_occ_port_pool_get(devlink_port, devlink_sb->index,
1114 pool_index, &cur, &max);
1115 if (err && err != -EOPNOTSUPP)
1116 return err;
1117 if (!err) {
1118 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_CUR, cur))
1119 goto nla_put_failure;
1120 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_MAX, max))
1121 goto nla_put_failure;
1122 }
1123 }
1124
bf797471
JP		 1125 genlmsg_end(msg, hdr);
1126 return 0;
1127
1128nla_put_failure:
1129 genlmsg_cancel(msg, hdr);
1130 return -EMSGSIZE;
1131}
1132
1133static int devlink_nl_cmd_sb_port_pool_get_doit(struct sk_buff *skb,
1134 struct genl_info *info)
1135{
1136 struct devlink_port *devlink_port = info->user_ptr[0];
1137 struct devlink *devlink = devlink_port->devlink;
1138 struct devlink_sb *devlink_sb = info->user_ptr[1];
1139 struct sk_buff *msg;
1140 u16 pool_index;
1141 int err;
1142
1143 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1144 &pool_index);
1145 if (err)
1146 return err;
1147
1148 if (!devlink->ops || !devlink->ops->sb_port_pool_get)
1149 return -EOPNOTSUPP;
1150
1151 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1152 if (!msg)
1153 return -ENOMEM;
1154
1155 err = devlink_nl_sb_port_pool_fill(msg, devlink, devlink_port,
1156 devlink_sb, pool_index,
1157 DEVLINK_CMD_SB_PORT_POOL_NEW,
1158 info->snd_portid, info->snd_seq, 0);
1159 if (err) {
1160 nlmsg_free(msg);
1161 return err;
1162 }
1163
1164 return genlmsg_reply(msg, info);
1165}
1166
1167static int __sb_port_pool_get_dumpit(struct sk_buff *msg, int start, int *p_idx,
1168 struct devlink *devlink,
1169 struct devlink_sb *devlink_sb,
1170 u32 portid, u32 seq)
1171{
1172 struct devlink_port *devlink_port;
1173 u16 pool_count = devlink_sb_pool_count(devlink_sb);
1174 u16 pool_index;
1175 int err;
1176
1177 list_for_each_entry(devlink_port, &devlink->port_list, list) {
1178 for (pool_index = 0; pool_index < pool_count; pool_index++) {
1179 if (*p_idx < start) {
1180 (*p_idx)++;
1181 continue;
1182 }
1183 err = devlink_nl_sb_port_pool_fill(msg, devlink,
1184 devlink_port,
1185 devlink_sb,
1186 pool_index,
1187 DEVLINK_CMD_SB_PORT_POOL_NEW,
1188 portid, seq,
1189 NLM_F_MULTI);
1190 if (err)
1191 return err;
1192 (*p_idx)++;
1193 }
1194 }
1195 return 0;
1196}
1197
1198static int devlink_nl_cmd_sb_port_pool_get_dumpit(struct sk_buff *msg,
1199 struct netlink_callback *cb)
1200{
1201 struct devlink *devlink;
1202 struct devlink_sb *devlink_sb;
1203 int start = cb->args[0];
1204 int idx = 0;
1205 int err;
1206
1207 mutex_lock(&devlink_mutex);
bf797471
JP		 1208 list_for_each_entry(devlink, &devlink_list, list) {
1209 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
1210 !devlink->ops || !devlink->ops->sb_port_pool_get)
1211 continue;
2406e7e5 1212 mutex_lock(&devlink->lock);
bf797471
JP		 1213 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
1214 err = __sb_port_pool_get_dumpit(msg, start, &idx,
1215 devlink, devlink_sb,
1216 NETLINK_CB(cb->skb).portid,
1217 cb->nlh->nlmsg_seq);
2406e7e5
AS		 1218 if (err && err != -EOPNOTSUPP) {
1219 mutex_unlock(&devlink->lock);
bf797471 1220 goto out;
2406e7e5 1221 }
bf797471 1222 }
2406e7e5 1223 mutex_unlock(&devlink->lock);
bf797471
JP		 1224 }
1225out:
bf797471
JP		 1226 mutex_unlock(&devlink_mutex);
1227
1228 cb->args[0] = idx;
1229 return msg->len;
1230}
1231
1232static int devlink_sb_port_pool_set(struct devlink_port *devlink_port,
1233 unsigned int sb_index, u16 pool_index,
1234 u32 threshold)
1235
1236{
1237 const struct devlink_ops *ops = devlink_port->devlink->ops;
1238
1239 if (ops && ops->sb_port_pool_set)
1240 return ops->sb_port_pool_set(devlink_port, sb_index,
1241 pool_index, threshold);
1242 return -EOPNOTSUPP;
1243}
1244
1245static int devlink_nl_cmd_sb_port_pool_set_doit(struct sk_buff *skb,
1246 struct genl_info *info)
1247{
1248 struct devlink_port *devlink_port = info->user_ptr[0];
1249 struct devlink_sb *devlink_sb = info->user_ptr[1];
1250 u16 pool_index;
1251 u32 threshold;
1252 int err;
1253
1254 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1255 &pool_index);
1256 if (err)
1257 return err;
1258
1259 if (!info->attrs[DEVLINK_ATTR_SB_THRESHOLD])
1260 return -EINVAL;
1261
1262 threshold = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_THRESHOLD]);
1263 return devlink_sb_port_pool_set(devlink_port, devlink_sb->index,
1264 pool_index, threshold);
1265}
1266
1267static int
1268devlink_nl_sb_tc_pool_bind_fill(struct sk_buff *msg, struct devlink *devlink,
1269 struct devlink_port *devlink_port,
1270 struct devlink_sb *devlink_sb, u16 tc_index,
1271 enum devlink_sb_pool_type pool_type,
1272 enum devlink_command cmd,
1273 u32 portid, u32 seq, int flags)
1274{
df38dafd 1275 const struct devlink_ops *ops = devlink->ops;
bf797471
JP		 1276 u16 pool_index;
1277 u32 threshold;
1278 void *hdr;
1279 int err;
1280
df38dafd
JP		 1281 err = ops->sb_tc_pool_bind_get(devlink_port, devlink_sb->index,
1282 tc_index, pool_type,
1283 &pool_index, &threshold);
bf797471
JP		 1284 if (err)
1285 return err;
1286
1287 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1288 if (!hdr)
1289 return -EMSGSIZE;
1290
1291 if (devlink_nl_put_handle(msg, devlink))
1292 goto nla_put_failure;
1293 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
1294 goto nla_put_failure;
1295 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
1296 goto nla_put_failure;
1297 if (nla_put_u16(msg, DEVLINK_ATTR_SB_TC_INDEX, tc_index))
1298 goto nla_put_failure;
1299 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_TYPE, pool_type))
1300 goto nla_put_failure;
1301 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
1302 goto nla_put_failure;
1303 if (nla_put_u32(msg, DEVLINK_ATTR_SB_THRESHOLD, threshold))
1304 goto nla_put_failure;
1305
df38dafd
JP		 1306 if (ops->sb_occ_tc_port_bind_get) {
1307 u32 cur;
1308 u32 max;
1309
1310 err = ops->sb_occ_tc_port_bind_get(devlink_port,
1311 devlink_sb->index,
1312 tc_index, pool_type,
1313 &cur, &max);
1314 if (err && err != -EOPNOTSUPP)
1315 return err;
1316 if (!err) {
1317 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_CUR, cur))
1318 goto nla_put_failure;
1319 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_MAX, max))
1320 goto nla_put_failure;
1321 }
1322 }
1323
bf797471
JP		 1324 genlmsg_end(msg, hdr);
1325 return 0;
1326
1327nla_put_failure:
1328 genlmsg_cancel(msg, hdr);
1329 return -EMSGSIZE;
1330}
1331
1332static int devlink_nl_cmd_sb_tc_pool_bind_get_doit(struct sk_buff *skb,
1333 struct genl_info *info)
1334{
1335 struct devlink_port *devlink_port = info->user_ptr[0];
1336 struct devlink *devlink = devlink_port->devlink;
1337 struct devlink_sb *devlink_sb = info->user_ptr[1];
1338 struct sk_buff *msg;
1339 enum devlink_sb_pool_type pool_type;
1340 u16 tc_index;
1341 int err;
1342
1343 err = devlink_sb_pool_type_get_from_info(info, &pool_type);
1344 if (err)
1345 return err;
1346
1347 err = devlink_sb_tc_index_get_from_info(devlink_sb, info,
1348 pool_type, &tc_index);
1349 if (err)
1350 return err;
1351
1352 if (!devlink->ops || !devlink->ops->sb_tc_pool_bind_get)
1353 return -EOPNOTSUPP;
1354
1355 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1356 if (!msg)
1357 return -ENOMEM;
1358
1359 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink, devlink_port,
1360 devlink_sb, tc_index, pool_type,
1361 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1362 info->snd_portid,
1363 info->snd_seq, 0);
1364 if (err) {
1365 nlmsg_free(msg);
1366 return err;
1367 }
1368
1369 return genlmsg_reply(msg, info);
1370}
1371
1372static int __sb_tc_pool_bind_get_dumpit(struct sk_buff *msg,
1373 int start, int *p_idx,
1374 struct devlink *devlink,
1375 struct devlink_sb *devlink_sb,
1376 u32 portid, u32 seq)
1377{
1378 struct devlink_port *devlink_port;
1379 u16 tc_index;
1380 int err;
1381
1382 list_for_each_entry(devlink_port, &devlink->port_list, list) {
1383 for (tc_index = 0;
1384 tc_index < devlink_sb->ingress_tc_count; tc_index++) {
1385 if (*p_idx < start) {
1386 (*p_idx)++;
1387 continue;
1388 }
1389 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink,
1390 devlink_port,
1391 devlink_sb,
1392 tc_index,
1393 DEVLINK_SB_POOL_TYPE_INGRESS,
1394 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1395 portid, seq,
1396 NLM_F_MULTI);
1397 if (err)
1398 return err;
1399 (*p_idx)++;
1400 }
1401 for (tc_index = 0;
1402 tc_index < devlink_sb->egress_tc_count; tc_index++) {
1403 if (*p_idx < start) {
1404 (*p_idx)++;
1405 continue;
1406 }
1407 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink,
1408 devlink_port,
1409 devlink_sb,
1410 tc_index,
1411 DEVLINK_SB_POOL_TYPE_EGRESS,
1412 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1413 portid, seq,
1414 NLM_F_MULTI);
1415 if (err)
1416 return err;
1417 (*p_idx)++;
1418 }
1419 }
1420 return 0;
1421}
1422
1423static int
1424devlink_nl_cmd_sb_tc_pool_bind_get_dumpit(struct sk_buff *msg,
1425 struct netlink_callback *cb)
1426{
1427 struct devlink *devlink;
1428 struct devlink_sb *devlink_sb;
1429 int start = cb->args[0];
1430 int idx = 0;
1431 int err;
1432
1433 mutex_lock(&devlink_mutex);
bf797471
JP		 1434 list_for_each_entry(devlink, &devlink_list, list) {
1435 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
1436 !devlink->ops || !devlink->ops->sb_tc_pool_bind_get)
1437 continue;
2406e7e5
AS		 1438
1439 mutex_lock(&devlink->lock);
bf797471
JP		 1440 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
1441 err = __sb_tc_pool_bind_get_dumpit(msg, start, &idx,
1442 devlink,
1443 devlink_sb,
1444 NETLINK_CB(cb->skb).portid,
1445 cb->nlh->nlmsg_seq);
2406e7e5
AS		 1446 if (err && err != -EOPNOTSUPP) {
1447 mutex_unlock(&devlink->lock);
bf797471 1448 goto out;
2406e7e5 1449 }
bf797471 1450 }
2406e7e5 1451 mutex_unlock(&devlink->lock);
bf797471
JP		 1452 }
1453out:
bf797471
JP		 1454 mutex_unlock(&devlink_mutex);
1455
1456 cb->args[0] = idx;
1457 return msg->len;
1458}
1459
1460static int devlink_sb_tc_pool_bind_set(struct devlink_port *devlink_port,
1461 unsigned int sb_index, u16 tc_index,
1462 enum devlink_sb_pool_type pool_type,
1463 u16 pool_index, u32 threshold)
1464
1465{
1466 const struct devlink_ops *ops = devlink_port->devlink->ops;
1467
1468 if (ops && ops->sb_tc_pool_bind_set)
1469 return ops->sb_tc_pool_bind_set(devlink_port, sb_index,
1470 tc_index, pool_type,
1471 pool_index, threshold);
1472 return -EOPNOTSUPP;
1473}
1474
1475static int devlink_nl_cmd_sb_tc_pool_bind_set_doit(struct sk_buff *skb,
1476 struct genl_info *info)
1477{
1478 struct devlink_port *devlink_port = info->user_ptr[0];
1479 struct devlink_sb *devlink_sb = info->user_ptr[1];
1480 enum devlink_sb_pool_type pool_type;
1481 u16 tc_index;
1482 u16 pool_index;
1483 u32 threshold;
1484 int err;
1485
1486 err = devlink_sb_pool_type_get_from_info(info, &pool_type);
1487 if (err)
1488 return err;
1489
1490 err = devlink_sb_tc_index_get_from_info(devlink_sb, info,
1491 pool_type, &tc_index);
1492 if (err)
1493 return err;
1494
1495 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1496 &pool_index);
1497 if (err)
1498 return err;
1499
1500 if (!info->attrs[DEVLINK_ATTR_SB_THRESHOLD])
1501 return -EINVAL;
1502
1503 threshold = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_THRESHOLD]);
1504 return devlink_sb_tc_pool_bind_set(devlink_port, devlink_sb->index,
1505 tc_index, pool_type,
1506 pool_index, threshold);
1507}
1508
df38dafd
JP		 1509static int devlink_nl_cmd_sb_occ_snapshot_doit(struct sk_buff *skb,
1510 struct genl_info *info)
1511{
1512 struct devlink *devlink = info->user_ptr[0];
1513 struct devlink_sb *devlink_sb = info->user_ptr[1];
1514 const struct devlink_ops *ops = devlink->ops;
1515
1516 if (ops && ops->sb_occ_snapshot)
1517 return ops->sb_occ_snapshot(devlink, devlink_sb->index);
1518 return -EOPNOTSUPP;
1519}
1520
1521static int devlink_nl_cmd_sb_occ_max_clear_doit(struct sk_buff *skb,
1522 struct genl_info *info)
1523{
1524 struct devlink *devlink = info->user_ptr[0];
1525 struct devlink_sb *devlink_sb = info->user_ptr[1];
1526 const struct devlink_ops *ops = devlink->ops;
1527
1528 if (ops && ops->sb_occ_max_clear)
1529 return ops->sb_occ_max_clear(devlink, devlink_sb->index);
1530 return -EOPNOTSUPP;
1531}
1532
21e3d2dd
JP		 1533static int devlink_nl_eswitch_fill(struct sk_buff *msg, struct devlink *devlink,
1534 enum devlink_command cmd, u32 portid,
1535 u32 seq, int flags)
08f4b591 1536{
59bfde01 1537 const struct devlink_ops *ops = devlink->ops;
f43e9b06 1538 u8 inline_mode, encap_mode;
08f4b591 1539 void *hdr;
59bfde01
RD		 1540 int err = 0;
1541 u16 mode;
08f4b591
OG		 1542
1543 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1544 if (!hdr)
1545 return -EMSGSIZE;
1546
59bfde01
RD		 1547 err = devlink_nl_put_handle(msg, devlink);
1548 if (err)
1a6aa36b 1549 goto nla_put_failure;
08f4b591 1550
4456f61c
JP		 1551 if (ops->eswitch_mode_get) {
1552 err = ops->eswitch_mode_get(devlink, &mode);
1553 if (err)
1554 goto nla_put_failure;
1555 err = nla_put_u16(msg, DEVLINK_ATTR_ESWITCH_MODE, mode);
1556 if (err)
1557 goto nla_put_failure;
1558 }
59bfde01
RD		 1559
1560 if (ops->eswitch_inline_mode_get) {
1561 err = ops->eswitch_inline_mode_get(devlink, &inline_mode);
1562 if (err)
1a6aa36b 1563 goto nla_put_failure;
59bfde01
RD		 1564 err = nla_put_u8(msg, DEVLINK_ATTR_ESWITCH_INLINE_MODE,
1565 inline_mode);
1566 if (err)
1a6aa36b 1567 goto nla_put_failure;
59bfde01 1568 }
08f4b591 1569
f43e9b06
RD		 1570 if (ops->eswitch_encap_mode_get) {
1571 err = ops->eswitch_encap_mode_get(devlink, &encap_mode);
1572 if (err)
1573 goto nla_put_failure;
1574 err = nla_put_u8(msg, DEVLINK_ATTR_ESWITCH_ENCAP_MODE, encap_mode);
1575 if (err)
1576 goto nla_put_failure;
1577 }
1578
08f4b591
OG		 1579 genlmsg_end(msg, hdr);
1580 return 0;
1581
1a6aa36b 1582nla_put_failure:
08f4b591 1583 genlmsg_cancel(msg, hdr);
59bfde01 1584 return err;
08f4b591
OG		 1585}
1586
adf200f3
JP		 1587static int devlink_nl_cmd_eswitch_get_doit(struct sk_buff *skb,
1588 struct genl_info *info)
08f4b591
OG		 1589{
1590 struct devlink *devlink = info->user_ptr[0];
1591 const struct devlink_ops *ops = devlink->ops;
1592 struct sk_buff *msg;
08f4b591
OG		 1593 int err;
1594
4456f61c 1595 if (!ops)
08f4b591
OG		 1596 return -EOPNOTSUPP;
1597
08f4b591
OG		 1598 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1599 if (!msg)
1600 return -ENOMEM;
1601
21e3d2dd
JP		 1602 err = devlink_nl_eswitch_fill(msg, devlink, DEVLINK_CMD_ESWITCH_GET,
1603 info->snd_portid, info->snd_seq, 0);
08f4b591
OG		 1604
1605 if (err) {
1606 nlmsg_free(msg);
1607 return err;
1608 }
1609
1610 return genlmsg_reply(msg, info);
1611}
1612
adf200f3
JP		 1613static int devlink_nl_cmd_eswitch_set_doit(struct sk_buff *skb,
1614 struct genl_info *info)
08f4b591
OG		 1615{
1616 struct devlink *devlink = info->user_ptr[0];
1617 const struct devlink_ops *ops = devlink->ops;
f43e9b06 1618 u8 inline_mode, encap_mode;
59bfde01 1619 int err = 0;
f43e9b06 1620 u16 mode;
08f4b591 1621
59bfde01
RD		 1622 if (!ops)
1623 return -EOPNOTSUPP;
08f4b591 1624
59bfde01
RD		 1625 if (info->attrs[DEVLINK_ATTR_ESWITCH_MODE]) {
1626 if (!ops->eswitch_mode_set)
1627 return -EOPNOTSUPP;
1628 mode = nla_get_u16(info->attrs[DEVLINK_ATTR_ESWITCH_MODE]);
1629 err = ops->eswitch_mode_set(devlink, mode);
1630 if (err)
1631 return err;
1632 }
08f4b591 1633
59bfde01
RD		 1634 if (info->attrs[DEVLINK_ATTR_ESWITCH_INLINE_MODE]) {
1635 if (!ops->eswitch_inline_mode_set)
1636 return -EOPNOTSUPP;
1637 inline_mode = nla_get_u8(
1638 info->attrs[DEVLINK_ATTR_ESWITCH_INLINE_MODE]);
1639 err = ops->eswitch_inline_mode_set(devlink, inline_mode);
1640 if (err)
1641 return err;
1642 }
f43e9b06
RD		 1643
1644 if (info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]) {
1645 if (!ops->eswitch_encap_mode_set)
1646 return -EOPNOTSUPP;
1647 encap_mode = nla_get_u8(info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]);
1648 err = ops->eswitch_encap_mode_set(devlink, encap_mode);
1649 if (err)
1650 return err;
1651 }
1652
1555d204
AS		 1653 return 0;
1654}
1655
1656int devlink_dpipe_match_put(struct sk_buff *skb,
1657 struct devlink_dpipe_match *match)
1658{
1659 struct devlink_dpipe_header *header = match->header;
1660 struct devlink_dpipe_field *field = &header->fields[match->field_id];
1661 struct nlattr *match_attr;
1662
1663 match_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_MATCH);
1664 if (!match_attr)
1665 return -EMSGSIZE;
1666
1667 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_MATCH_TYPE, match->type) ||
1668 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, match->header_index) ||
1669 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1670 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1671 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1672 goto nla_put_failure;
1673
1674 nla_nest_end(skb, match_attr);
1675 return 0;
1676
1677nla_put_failure:
1678 nla_nest_cancel(skb, match_attr);
1679 return -EMSGSIZE;
1680}
1681EXPORT_SYMBOL_GPL(devlink_dpipe_match_put);
1682
1683static int devlink_dpipe_matches_put(struct devlink_dpipe_table *table,
1684 struct sk_buff *skb)
1685{
1686 struct nlattr *matches_attr;
1687
1688 matches_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_MATCHES);
1689 if (!matches_attr)
1690 return -EMSGSIZE;
1691
1692 if (table->table_ops->matches_dump(table->priv, skb))
1693 goto nla_put_failure;
1694
1695 nla_nest_end(skb, matches_attr);
1696 return 0;
1697
1698nla_put_failure:
1699 nla_nest_cancel(skb, matches_attr);
1700 return -EMSGSIZE;
1701}
1702
1703int devlink_dpipe_action_put(struct sk_buff *skb,
1704 struct devlink_dpipe_action *action)
1705{
1706 struct devlink_dpipe_header *header = action->header;
1707 struct devlink_dpipe_field *field = &header->fields[action->field_id];
1708 struct nlattr *action_attr;
1709
1710 action_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ACTION);
1711 if (!action_attr)
1712 return -EMSGSIZE;
1713
1714 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_ACTION_TYPE, action->type) ||
1715 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, action->header_index) ||
1716 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1717 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1718 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1719 goto nla_put_failure;
1720
1721 nla_nest_end(skb, action_attr);
1722 return 0;
1723
1724nla_put_failure:
1725 nla_nest_cancel(skb, action_attr);
1726 return -EMSGSIZE;
1727}
1728EXPORT_SYMBOL_GPL(devlink_dpipe_action_put);
1729
1730static int devlink_dpipe_actions_put(struct devlink_dpipe_table *table,
1731 struct sk_buff *skb)
1732{
1733 struct nlattr *actions_attr;
1734
1735 actions_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_ACTIONS);
1736 if (!actions_attr)
1737 return -EMSGSIZE;
1738
1739 if (table->table_ops->actions_dump(table->priv, skb))
1740 goto nla_put_failure;
1741
1742 nla_nest_end(skb, actions_attr);
1743 return 0;
1744
1745nla_put_failure:
1746 nla_nest_cancel(skb, actions_attr);
1747 return -EMSGSIZE;
1748}
1749
1750static int devlink_dpipe_table_put(struct sk_buff *skb,
1751 struct devlink_dpipe_table *table)
1752{
1753 struct nlattr *table_attr;
ffd3cdcc 1754 u64 table_size;
1555d204 1755
ffd3cdcc 1756 table_size = table->table_ops->size_get(table->priv);
1555d204
AS		 1757 table_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE);
1758 if (!table_attr)
1759 return -EMSGSIZE;
1760
1761 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_TABLE_NAME, table->name) ||
ffd3cdcc 1762 nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_SIZE, table_size,
1555d204
AS		 1763 DEVLINK_ATTR_PAD))
1764 goto nla_put_failure;
1765 if (nla_put_u8(skb, DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED,
1766 table->counters_enabled))
1767 goto nla_put_failure;
1768
56dc7cd0 1769 if (table->resource_valid) {
3d18e4f1
AS		 1770 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID,
1771 table->resource_id, DEVLINK_ATTR_PAD) ||
1772 nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_UNITS,
1773 table->resource_units, DEVLINK_ATTR_PAD))
1774 goto nla_put_failure;
56dc7cd0 1775 }
1555d204
AS		 1776 if (devlink_dpipe_matches_put(table, skb))
1777 goto nla_put_failure;
1778
1779 if (devlink_dpipe_actions_put(table, skb))
1780 goto nla_put_failure;
1781
1782 nla_nest_end(skb, table_attr);
1783 return 0;
1784
1785nla_put_failure:
1786 nla_nest_cancel(skb, table_attr);
1787 return -EMSGSIZE;
1788}
1789
1790static int devlink_dpipe_send_and_alloc_skb(struct sk_buff **pskb,
1791 struct genl_info *info)
1792{
1793 int err;
1794
1795 if (*pskb) {
1796 err = genlmsg_reply(*pskb, info);
1797 if (err)
1798 return err;
1799 }
1800 *pskb = genlmsg_new(GENLMSG_DEFAULT_SIZE, GFP_KERNEL);
1801 if (!*pskb)
1802 return -ENOMEM;
1803 return 0;
1804}
1805
1806static int devlink_dpipe_tables_fill(struct genl_info *info,
1807 enum devlink_command cmd, int flags,
1808 struct list_head *dpipe_tables,
1809 const char *table_name)
1810{
1811 struct devlink *devlink = info->user_ptr[0];
1812 struct devlink_dpipe_table *table;
1813 struct nlattr *tables_attr;
1814 struct sk_buff *skb = NULL;
1815 struct nlmsghdr *nlh;
1816 bool incomplete;
1817 void *hdr;
1818 int i;
1819 int err;
1820
1821 table = list_first_entry(dpipe_tables,
1822 struct devlink_dpipe_table, list);
1823start_again:
1824 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1825 if (err)
1826 return err;
1827
1828 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
1829 &devlink_nl_family, NLM_F_MULTI, cmd);
6044bd4a
HY		 1830 if (!hdr) {
1831 nlmsg_free(skb);
1555d204 1832 return -EMSGSIZE;
6044bd4a 1833 }
1555d204
AS		 1834
1835 if (devlink_nl_put_handle(skb, devlink))
1836 goto nla_put_failure;
1837 tables_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLES);
1838 if (!tables_attr)
1839 goto nla_put_failure;
1840
1841 i = 0;
1842 incomplete = false;
1843 list_for_each_entry_from(table, dpipe_tables, list) {
1844 if (!table_name) {
1845 err = devlink_dpipe_table_put(skb, table);
1846 if (err) {
1847 if (!i)
1848 goto err_table_put;
1849 incomplete = true;
1850 break;
1851 }
1852 } else {
1853 if (!strcmp(table->name, table_name)) {
1854 err = devlink_dpipe_table_put(skb, table);
1855 if (err)
1856 break;
1857 }
1858 }
1859 i++;
1860 }
1861
1862 nla_nest_end(skb, tables_attr);
1863 genlmsg_end(skb, hdr);
1864 if (incomplete)
1865 goto start_again;
1866
1867send_done:
1868 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
1869 NLMSG_DONE, 0, flags | NLM_F_MULTI);
1870 if (!nlh) {
1871 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1872 if (err)
7fe4d6dc 1873 return err;
1555d204
AS		 1874 goto send_done;
1875 }
1876
1877 return genlmsg_reply(skb, info);
1878
1879nla_put_failure:
1880 err = -EMSGSIZE;
1881err_table_put:
1555d204
AS		 1882 nlmsg_free(skb);
1883 return err;
1884}
1885
1886static int devlink_nl_cmd_dpipe_table_get(struct sk_buff *skb,
1887 struct genl_info *info)
1888{
1889 struct devlink *devlink = info->user_ptr[0];
1890 const char *table_name = NULL;
1891
1892 if (info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
1893 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
1894
1895 return devlink_dpipe_tables_fill(info, DEVLINK_CMD_DPIPE_TABLE_GET, 0,
1896 &devlink->dpipe_table_list,
1897 table_name);
1898}
1899
1900static int devlink_dpipe_value_put(struct sk_buff *skb,
1901 struct devlink_dpipe_value *value)
1902{
1903 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE,
1904 value->value_size, value->value))
1905 return -EMSGSIZE;
1906 if (value->mask)
1907 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE_MASK,
1908 value->value_size, value->mask))
1909 return -EMSGSIZE;
1910 if (value->mapping_valid)
1911 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_VALUE_MAPPING,
1912 value->mapping_value))
1913 return -EMSGSIZE;
1914 return 0;
1915}
1916
1917static int devlink_dpipe_action_value_put(struct sk_buff *skb,
1918 struct devlink_dpipe_value *value)
1919{
1920 if (!value->action)
1921 return -EINVAL;
1922 if (devlink_dpipe_action_put(skb, value->action))
1923 return -EMSGSIZE;
1924 if (devlink_dpipe_value_put(skb, value))
1925 return -EMSGSIZE;
1926 return 0;
1927}
1928
1929static int devlink_dpipe_action_values_put(struct sk_buff *skb,
1930 struct devlink_dpipe_value *values,
1931 unsigned int values_count)
1932{
1933 struct nlattr *action_attr;
1934 int i;
1935 int err;
1936
1937 for (i = 0; i < values_count; i++) {
1938 action_attr = nla_nest_start(skb,
1939 DEVLINK_ATTR_DPIPE_ACTION_VALUE);
1940 if (!action_attr)
1941 return -EMSGSIZE;
1942 err = devlink_dpipe_action_value_put(skb, &values[i]);
1943 if (err)
1944 goto err_action_value_put;
1945 nla_nest_end(skb, action_attr);
1946 }
1947 return 0;
1948
1949err_action_value_put:
1950 nla_nest_cancel(skb, action_attr);
1951 return err;
1952}
1953
1954static int devlink_dpipe_match_value_put(struct sk_buff *skb,
1955 struct devlink_dpipe_value *value)
1956{
1957 if (!value->match)
1958 return -EINVAL;
1959 if (devlink_dpipe_match_put(skb, value->match))
1960 return -EMSGSIZE;
1961 if (devlink_dpipe_value_put(skb, value))
1962 return -EMSGSIZE;
1963 return 0;
1964}
1965
1966static int devlink_dpipe_match_values_put(struct sk_buff *skb,
1967 struct devlink_dpipe_value *values,
1968 unsigned int values_count)
1969{
1970 struct nlattr *match_attr;
1971 int i;
1972 int err;
1973
1974 for (i = 0; i < values_count; i++) {
1975 match_attr = nla_nest_start(skb,
1976 DEVLINK_ATTR_DPIPE_MATCH_VALUE);
1977 if (!match_attr)
1978 return -EMSGSIZE;
1979 err = devlink_dpipe_match_value_put(skb, &values[i]);
1980 if (err)
1981 goto err_match_value_put;
1982 nla_nest_end(skb, match_attr);
1983 }
1984 return 0;
1985
1986err_match_value_put:
1987 nla_nest_cancel(skb, match_attr);
1988 return err;
1989}
1990
1991static int devlink_dpipe_entry_put(struct sk_buff *skb,
1992 struct devlink_dpipe_entry *entry)
1993{
1994 struct nlattr *entry_attr, *matches_attr, *actions_attr;
1995 int err;
1996
1997 entry_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ENTRY);
1998 if (!entry_attr)
1999 return -EMSGSIZE;
2000
2001 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_INDEX, entry->index,
2002 DEVLINK_ATTR_PAD))
2003 goto nla_put_failure;
2004 if (entry->counter_valid)
2005 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_COUNTER,
2006 entry->counter, DEVLINK_ATTR_PAD))
2007 goto nla_put_failure;
2008
2009 matches_attr = nla_nest_start(skb,
2010 DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES);
2011 if (!matches_attr)
2012 goto nla_put_failure;
2013
2014 err = devlink_dpipe_match_values_put(skb, entry->match_values,
2015 entry->match_values_count);
2016 if (err) {
2017 nla_nest_cancel(skb, matches_attr);
2018 goto err_match_values_put;
2019 }
2020 nla_nest_end(skb, matches_attr);
2021
2022 actions_attr = nla_nest_start(skb,
2023 DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES);
2024 if (!actions_attr)
2025 goto nla_put_failure;
2026
2027 err = devlink_dpipe_action_values_put(skb, entry->action_values,
2028 entry->action_values_count);
2029 if (err) {
2030 nla_nest_cancel(skb, actions_attr);
2031 goto err_action_values_put;
2032 }
2033 nla_nest_end(skb, actions_attr);
59bfde01 2034
1555d204 2035 nla_nest_end(skb, entry_attr);
59bfde01 2036 return 0;
1555d204
AS		 2037
2038nla_put_failure:
2039 err = -EMSGSIZE;
2040err_match_values_put:
2041err_action_values_put:
2042 nla_nest_cancel(skb, entry_attr);
2043 return err;
2044}
2045
2046static struct devlink_dpipe_table *
2047devlink_dpipe_table_find(struct list_head *dpipe_tables,
2048 const char *table_name)
2049{
2050 struct devlink_dpipe_table *table;
2051
2052 list_for_each_entry_rcu(table, dpipe_tables, list) {
2053 if (!strcmp(table->name, table_name))
2054 return table;
2055 }
2056 return NULL;
2057}
2058
2059int devlink_dpipe_entry_ctx_prepare(struct devlink_dpipe_dump_ctx *dump_ctx)
2060{
2061 struct devlink *devlink;
2062 int err;
2063
2064 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx->skb,
2065 dump_ctx->info);
2066 if (err)
2067 return err;
2068
2069 dump_ctx->hdr = genlmsg_put(dump_ctx->skb,
2070 dump_ctx->info->snd_portid,
2071 dump_ctx->info->snd_seq,
2072 &devlink_nl_family, NLM_F_MULTI,
2073 dump_ctx->cmd);
2074 if (!dump_ctx->hdr)
2075 goto nla_put_failure;
2076
2077 devlink = dump_ctx->info->user_ptr[0];
2078 if (devlink_nl_put_handle(dump_ctx->skb, devlink))
2079 goto nla_put_failure;
2080 dump_ctx->nest = nla_nest_start(dump_ctx->skb,
2081 DEVLINK_ATTR_DPIPE_ENTRIES);
2082 if (!dump_ctx->nest)
2083 goto nla_put_failure;
2084 return 0;
2085
2086nla_put_failure:
1555d204
AS		 2087 nlmsg_free(dump_ctx->skb);
2088 return -EMSGSIZE;
2089}
2090EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_prepare);
2091
2092int devlink_dpipe_entry_ctx_append(struct devlink_dpipe_dump_ctx *dump_ctx,
2093 struct devlink_dpipe_entry *entry)
2094{
2095 return devlink_dpipe_entry_put(dump_ctx->skb, entry);
2096}
2097EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_append);
2098
2099int devlink_dpipe_entry_ctx_close(struct devlink_dpipe_dump_ctx *dump_ctx)
2100{
2101 nla_nest_end(dump_ctx->skb, dump_ctx->nest);
2102 genlmsg_end(dump_ctx->skb, dump_ctx->hdr);
2103 return 0;
2104}
2105EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_close);
2106
35807324
AS		 2107void devlink_dpipe_entry_clear(struct devlink_dpipe_entry *entry)
2108
2109{
2110 unsigned int value_count, value_index;
2111 struct devlink_dpipe_value *value;
2112
2113 value = entry->action_values;
2114 value_count = entry->action_values_count;
2115 for (value_index = 0; value_index < value_count; value_index++) {
2116 kfree(value[value_index].value);
2117 kfree(value[value_index].mask);
2118 }
2119
2120 value = entry->match_values;
2121 value_count = entry->match_values_count;
2122 for (value_index = 0; value_index < value_count; value_index++) {
2123 kfree(value[value_index].value);
2124 kfree(value[value_index].mask);
2125 }
2126}
2127EXPORT_SYMBOL(devlink_dpipe_entry_clear);
2128
1555d204
AS		 2129static int devlink_dpipe_entries_fill(struct genl_info *info,
2130 enum devlink_command cmd, int flags,
2131 struct devlink_dpipe_table *table)
2132{
2133 struct devlink_dpipe_dump_ctx dump_ctx;
2134 struct nlmsghdr *nlh;
2135 int err;
2136
2137 dump_ctx.skb = NULL;
2138 dump_ctx.cmd = cmd;
2139 dump_ctx.info = info;
2140
2141 err = table->table_ops->entries_dump(table->priv,
2142 table->counters_enabled,
2143 &dump_ctx);
2144 if (err)
7fe4d6dc 2145 return err;
1555d204
AS		 2146
2147send_done:
2148 nlh = nlmsg_put(dump_ctx.skb, info->snd_portid, info->snd_seq,
2149 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2150 if (!nlh) {
2151 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx.skb, info);
2152 if (err)
7fe4d6dc 2153 return err;
1555d204
AS		 2154 goto send_done;
2155 }
2156 return genlmsg_reply(dump_ctx.skb, info);
1555d204
AS		 2157}
2158
2159static int devlink_nl_cmd_dpipe_entries_get(struct sk_buff *skb,
2160 struct genl_info *info)
2161{
2162 struct devlink *devlink = info->user_ptr[0];
2163 struct devlink_dpipe_table *table;
2164 const char *table_name;
2165
2166 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
2167 return -EINVAL;
2168
2169 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2170 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2171 table_name);
2172 if (!table)
2173 return -EINVAL;
2174
2175 if (!table->table_ops->entries_dump)
2176 return -EINVAL;
2177
2178 return devlink_dpipe_entries_fill(info, DEVLINK_CMD_DPIPE_ENTRIES_GET,
2179 0, table);
2180}
2181
2182static int devlink_dpipe_fields_put(struct sk_buff *skb,
2183 const struct devlink_dpipe_header *header)
2184{
2185 struct devlink_dpipe_field *field;
2186 struct nlattr *field_attr;
2187 int i;
2188
2189 for (i = 0; i < header->fields_count; i++) {
2190 field = &header->fields[i];
2191 field_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_FIELD);
2192 if (!field_attr)
2193 return -EMSGSIZE;
2194 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_FIELD_NAME, field->name) ||
2195 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
2196 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH, field->bitwidth) ||
2197 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE, field->mapping_type))
2198 goto nla_put_failure;
2199 nla_nest_end(skb, field_attr);
2200 }
2201 return 0;
2202
2203nla_put_failure:
2204 nla_nest_cancel(skb, field_attr);
2205 return -EMSGSIZE;
2206}
2207
2208static int devlink_dpipe_header_put(struct sk_buff *skb,
2209 struct devlink_dpipe_header *header)
2210{
2211 struct nlattr *fields_attr, *header_attr;
2212 int err;
2213
2214 header_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER);
cb6bf9cf 2215 if (!header_attr)
1555d204
AS		 2216 return -EMSGSIZE;
2217
2218 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_HEADER_NAME, header->name) ||
2219 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
2220 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
2221 goto nla_put_failure;
2222
2223 fields_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER_FIELDS);
2224 if (!fields_attr)
2225 goto nla_put_failure;
2226
2227 err = devlink_dpipe_fields_put(skb, header);
2228 if (err) {
2229 nla_nest_cancel(skb, fields_attr);
2230 goto nla_put_failure;
2231 }
2232 nla_nest_end(skb, fields_attr);
2233 nla_nest_end(skb, header_attr);
2234 return 0;
2235
2236nla_put_failure:
2237 err = -EMSGSIZE;
2238 nla_nest_cancel(skb, header_attr);
2239 return err;
2240}
2241
2242static int devlink_dpipe_headers_fill(struct genl_info *info,
2243 enum devlink_command cmd, int flags,
2244 struct devlink_dpipe_headers *
2245 dpipe_headers)
2246{
2247 struct devlink *devlink = info->user_ptr[0];
2248 struct nlattr *headers_attr;
2249 struct sk_buff *skb = NULL;
2250 struct nlmsghdr *nlh;
2251 void *hdr;
2252 int i, j;
2253 int err;
2254
2255 i = 0;
2256start_again:
2257 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2258 if (err)
2259 return err;
2260
2261 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
2262 &devlink_nl_family, NLM_F_MULTI, cmd);
6044bd4a
HY		 2263 if (!hdr) {
2264 nlmsg_free(skb);
1555d204 2265 return -EMSGSIZE;
6044bd4a 2266 }
1555d204
AS		 2267
2268 if (devlink_nl_put_handle(skb, devlink))
2269 goto nla_put_failure;
2270 headers_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADERS);
2271 if (!headers_attr)
2272 goto nla_put_failure;
2273
2274 j = 0;
2275 for (; i < dpipe_headers->headers_count; i++) {
2276 err = devlink_dpipe_header_put(skb, dpipe_headers->headers[i]);
2277 if (err) {
2278 if (!j)
2279 goto err_table_put;
2280 break;
2281 }
2282 j++;
2283 }
2284 nla_nest_end(skb, headers_attr);
2285 genlmsg_end(skb, hdr);
2286 if (i != dpipe_headers->headers_count)
2287 goto start_again;
2288
2289send_done:
2290 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
2291 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2292 if (!nlh) {
2293 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2294 if (err)
7fe4d6dc 2295 return err;
1555d204
AS		 2296 goto send_done;
2297 }
2298 return genlmsg_reply(skb, info);
2299
2300nla_put_failure:
2301 err = -EMSGSIZE;
2302err_table_put:
1555d204
AS		 2303 nlmsg_free(skb);
2304 return err;
2305}
2306
2307static int devlink_nl_cmd_dpipe_headers_get(struct sk_buff *skb,
2308 struct genl_info *info)
2309{
2310 struct devlink *devlink = info->user_ptr[0];
2311
2312 if (!devlink->dpipe_headers)
2313 return -EOPNOTSUPP;
2314 return devlink_dpipe_headers_fill(info, DEVLINK_CMD_DPIPE_HEADERS_GET,
2315 0, devlink->dpipe_headers);
2316}
2317
2318static int devlink_dpipe_table_counters_set(struct devlink *devlink,
2319 const char *table_name,
2320 bool enable)
2321{
2322 struct devlink_dpipe_table *table;
2323
2324 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2325 table_name);
2326 if (!table)
2327 return -EINVAL;
2328
2329 if (table->counter_control_extern)
2330 return -EOPNOTSUPP;
2331
2332 if (!(table->counters_enabled ^ enable))
2333 return 0;
2334
2335 table->counters_enabled = enable;
2336 if (table->table_ops->counters_set_update)
2337 table->table_ops->counters_set_update(table->priv, enable);
2338 return 0;
2339}
2340
2341static int devlink_nl_cmd_dpipe_table_counters_set(struct sk_buff *skb,
2342 struct genl_info *info)
2343{
2344 struct devlink *devlink = info->user_ptr[0];
2345 const char *table_name;
2346 bool counters_enable;
2347
2348 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME] ||
2349 !info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED])
2350 return -EINVAL;
2351
2352 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2353 counters_enable = !!nla_get_u8(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]);
2354
2355 return devlink_dpipe_table_counters_set(devlink, table_name,
2356 counters_enable);
08f4b591
OG		 2357}
2358
43dd7512 2359static struct devlink_resource *
d9f9b9a4
AS		 2360devlink_resource_find(struct devlink *devlink,
2361 struct devlink_resource *resource, u64 resource_id)
2362{
2363 struct list_head *resource_list;
2364
2365 if (resource)
2366 resource_list = &resource->resource_list;
2367 else
2368 resource_list = &devlink->resource_list;
2369
2370 list_for_each_entry(resource, resource_list, list) {
2371 struct devlink_resource *child_resource;
2372
2373 if (resource->id == resource_id)
2374 return resource;
2375
2376 child_resource = devlink_resource_find(devlink, resource,
2377 resource_id);
2378 if (child_resource)
2379 return child_resource;
2380 }
2381 return NULL;
2382}
2383
43dd7512
WY		 2384static void
2385devlink_resource_validate_children(struct devlink_resource *resource)
d9f9b9a4
AS		 2386{
2387 struct devlink_resource *child_resource;
2388 bool size_valid = true;
2389 u64 parts_size = 0;
2390
2391 if (list_empty(&resource->resource_list))
2392 goto out;
2393
2394 list_for_each_entry(child_resource, &resource->resource_list, list)
2395 parts_size += child_resource->size_new;
2396
b9d17175 2397 if (parts_size > resource->size_new)
d9f9b9a4
AS		 2398 size_valid = false;
2399out:
2400 resource->size_valid = size_valid;
2401}
2402
cc944ead
AS		 2403static int
2404devlink_resource_validate_size(struct devlink_resource *resource, u64 size,
2405 struct netlink_ext_ack *extack)
2406{
2407 u64 reminder;
2408 int err = 0;
2409
0f3e9c97 2410 if (size > resource->size_params.size_max) {
cc944ead
AS		 2411 NL_SET_ERR_MSG_MOD(extack, "Size larger than maximum");
2412 err = -EINVAL;
2413 }
2414
0f3e9c97 2415 if (size < resource->size_params.size_min) {
cc944ead
AS		 2416 NL_SET_ERR_MSG_MOD(extack, "Size smaller than minimum");
2417 err = -EINVAL;
2418 }
2419
0f3e9c97 2420 div64_u64_rem(size, resource->size_params.size_granularity, &reminder);
cc944ead
AS		 2421 if (reminder) {
2422 NL_SET_ERR_MSG_MOD(extack, "Wrong granularity");
2423 err = -EINVAL;
2424 }
2425
2426 return err;
2427}
2428
d9f9b9a4
AS		 2429static int devlink_nl_cmd_resource_set(struct sk_buff *skb,
2430 struct genl_info *info)
2431{
2432 struct devlink *devlink = info->user_ptr[0];
2433 struct devlink_resource *resource;
2434 u64 resource_id;
2435 u64 size;
2436 int err;
2437
2438 if (!info->attrs[DEVLINK_ATTR_RESOURCE_ID] ||
2439 !info->attrs[DEVLINK_ATTR_RESOURCE_SIZE])
2440 return -EINVAL;
2441 resource_id = nla_get_u64(info->attrs[DEVLINK_ATTR_RESOURCE_ID]);
2442
2443 resource = devlink_resource_find(devlink, NULL, resource_id);
2444 if (!resource)
2445 return -EINVAL;
2446
d9f9b9a4 2447 size = nla_get_u64(info->attrs[DEVLINK_ATTR_RESOURCE_SIZE]);
cc944ead 2448 err = devlink_resource_validate_size(resource, size, info->extack);
d9f9b9a4
AS		 2449 if (err)
2450 return err;
2451
2452 resource->size_new = size;
2453 devlink_resource_validate_children(resource);
2454 if (resource->parent)
2455 devlink_resource_validate_children(resource->parent);
2456 return 0;
2457}
2458
3d18e4f1 2459static int
d9f9b9a4
AS		 2460devlink_resource_size_params_put(struct devlink_resource *resource,
2461 struct sk_buff *skb)
2462{
2463 struct devlink_resource_size_params *size_params;
2464
77d27096 2465 size_params = &resource->size_params;
3d18e4f1
AS		 2466 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_GRAN,
2467 size_params->size_granularity, DEVLINK_ATTR_PAD) ||
2468 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_MAX,
2469 size_params->size_max, DEVLINK_ATTR_PAD) ||
2470 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_MIN,
2471 size_params->size_min, DEVLINK_ATTR_PAD) ||
2472 nla_put_u8(skb, DEVLINK_ATTR_RESOURCE_UNIT, size_params->unit))
2473 return -EMSGSIZE;
2474 return 0;
d9f9b9a4
AS		 2475}
2476
fc56be47
JP		 2477static int devlink_resource_occ_put(struct devlink_resource *resource,
2478 struct sk_buff *skb)
2479{
2480 if (!resource->occ_get)
2481 return 0;
2482 return nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_OCC,
2483 resource->occ_get(resource->occ_get_priv),
2484 DEVLINK_ATTR_PAD);
2485}
2486
d9f9b9a4
AS		 2487static int devlink_resource_put(struct devlink *devlink, struct sk_buff *skb,
2488 struct devlink_resource *resource)
2489{
2490 struct devlink_resource *child_resource;
2491 struct nlattr *child_resource_attr;
2492 struct nlattr *resource_attr;
2493
2494 resource_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE);
2495 if (!resource_attr)
2496 return -EMSGSIZE;
2497
2498 if (nla_put_string(skb, DEVLINK_ATTR_RESOURCE_NAME, resource->name) ||
2499 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE, resource->size,
2500 DEVLINK_ATTR_PAD) ||
2501 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_ID, resource->id,
2502 DEVLINK_ATTR_PAD))
2503 goto nla_put_failure;
2504 if (resource->size != resource->size_new)
2505 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_NEW,
2506 resource->size_new, DEVLINK_ATTR_PAD);
fc56be47
JP		 2507 if (devlink_resource_occ_put(resource, skb))
2508 goto nla_put_failure;
3d18e4f1
AS		 2509 if (devlink_resource_size_params_put(resource, skb))
2510 goto nla_put_failure;
d9f9b9a4
AS		 2511 if (list_empty(&resource->resource_list))
2512 goto out;
2513
2514 if (nla_put_u8(skb, DEVLINK_ATTR_RESOURCE_SIZE_VALID,
2515 resource->size_valid))
2516 goto nla_put_failure;
2517
2518 child_resource_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE_LIST);
2519 if (!child_resource_attr)
2520 goto nla_put_failure;
2521
2522 list_for_each_entry(child_resource, &resource->resource_list, list) {
2523 if (devlink_resource_put(devlink, skb, child_resource))
2524 goto resource_put_failure;
2525 }
2526
2527 nla_nest_end(skb, child_resource_attr);
2528out:
2529 nla_nest_end(skb, resource_attr);
2530 return 0;
2531
2532resource_put_failure:
2533 nla_nest_cancel(skb, child_resource_attr);
2534nla_put_failure:
2535 nla_nest_cancel(skb, resource_attr);
2536 return -EMSGSIZE;
2537}
2538
2539static int devlink_resource_fill(struct genl_info *info,
2540 enum devlink_command cmd, int flags)
2541{
2542 struct devlink *devlink = info->user_ptr[0];
2543 struct devlink_resource *resource;
2544 struct nlattr *resources_attr;
2545 struct sk_buff *skb = NULL;
2546 struct nlmsghdr *nlh;
2547 bool incomplete;
2548 void *hdr;
2549 int i;
2550 int err;
2551
2552 resource = list_first_entry(&devlink->resource_list,
2553 struct devlink_resource, list);
2554start_again:
2555 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2556 if (err)
2557 return err;
2558
2559 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
2560 &devlink_nl_family, NLM_F_MULTI, cmd);
2561 if (!hdr) {
2562 nlmsg_free(skb);
2563 return -EMSGSIZE;
2564 }
2565
2566 if (devlink_nl_put_handle(skb, devlink))
2567 goto nla_put_failure;
2568
2569 resources_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE_LIST);
2570 if (!resources_attr)
2571 goto nla_put_failure;
2572
2573 incomplete = false;
2574 i = 0;
2575 list_for_each_entry_from(resource, &devlink->resource_list, list) {
2576 err = devlink_resource_put(devlink, skb, resource);
2577 if (err) {
2578 if (!i)
2579 goto err_resource_put;
2580 incomplete = true;
2581 break;
2582 }
2583 i++;
2584 }
2585 nla_nest_end(skb, resources_attr);
2586 genlmsg_end(skb, hdr);
2587 if (incomplete)
2588 goto start_again;
2589send_done:
2590 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
2591 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2592 if (!nlh) {
2593 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2594 if (err)
2595 goto err_skb_send_alloc;
2596 goto send_done;
2597 }
2598 return genlmsg_reply(skb, info);
2599
2600nla_put_failure:
2601 err = -EMSGSIZE;
2602err_resource_put:
2603err_skb_send_alloc:
d9f9b9a4
AS		 2604 nlmsg_free(skb);
2605 return err;
2606}
2607
2608static int devlink_nl_cmd_resource_dump(struct sk_buff *skb,
2609 struct genl_info *info)
2610{
2611 struct devlink *devlink = info->user_ptr[0];
2612
2613 if (list_empty(&devlink->resource_list))
2614 return -EOPNOTSUPP;
2615
2616 return devlink_resource_fill(info, DEVLINK_CMD_RESOURCE_DUMP, 0);
2617}
2618
2d8dc5bb
AS		 2619static int
2620devlink_resources_validate(struct devlink *devlink,
2621 struct devlink_resource *resource,
2622 struct genl_info *info)
2623{
2624 struct list_head *resource_list;
2625 int err = 0;
2626
2627 if (resource)
2628 resource_list = &resource->resource_list;
2629 else
2630 resource_list = &devlink->resource_list;
2631
2632 list_for_each_entry(resource, resource_list, list) {
2633 if (!resource->size_valid)
2634 return -EINVAL;
2635 err = devlink_resources_validate(devlink, resource, info);
2636 if (err)
2637 return err;
2638 }
2639 return err;
2640}
2641
2642static int devlink_nl_cmd_reload(struct sk_buff *skb, struct genl_info *info)
2643{
2644 struct devlink *devlink = info->user_ptr[0];
2645 int err;
2646
2647 if (!devlink->ops->reload)
2648 return -EOPNOTSUPP;
2649
2650 err = devlink_resources_validate(devlink, NULL, info);
2651 if (err) {
2652 NL_SET_ERR_MSG_MOD(info->extack, "resources size validation failed");
2653 return err;
2654 }
ac0fc8a1 2655 return devlink->ops->reload(devlink, info->extack);
2d8dc5bb
AS		 2656}
2657
036467c3
MS		 2658static const struct devlink_param devlink_param_generic[] = {
2659 {
2660 .id = DEVLINK_PARAM_GENERIC_ID_INT_ERR_RESET,
2661 .name = DEVLINK_PARAM_GENERIC_INT_ERR_RESET_NAME,
2662 .type = DEVLINK_PARAM_GENERIC_INT_ERR_RESET_TYPE,
2663 },
2664 {
2665 .id = DEVLINK_PARAM_GENERIC_ID_MAX_MACS,
2666 .name = DEVLINK_PARAM_GENERIC_MAX_MACS_NAME,
2667 .type = DEVLINK_PARAM_GENERIC_MAX_MACS_TYPE,
2668 },
f567bcda
VV		 2669 {
2670 .id = DEVLINK_PARAM_GENERIC_ID_ENABLE_SRIOV,
2671 .name = DEVLINK_PARAM_GENERIC_ENABLE_SRIOV_NAME,
2672 .type = DEVLINK_PARAM_GENERIC_ENABLE_SRIOV_TYPE,
2673 },
036467c3 2674};
eabaef18
MS		 2675
2676static int devlink_param_generic_verify(const struct devlink_param *param)
2677{
2678 /* verify it match generic parameter by id and name */
2679 if (param->id > DEVLINK_PARAM_GENERIC_ID_MAX)
2680 return -EINVAL;
2681 if (strcmp(param->name, devlink_param_generic[param->id].name))
2682 return -ENOENT;
2683
2684 WARN_ON(param->type != devlink_param_generic[param->id].type);
2685
2686 return 0;
2687}
2688
2689static int devlink_param_driver_verify(const struct devlink_param *param)
2690{
2691 int i;
2692
2693 if (param->id <= DEVLINK_PARAM_GENERIC_ID_MAX)
2694 return -EINVAL;
2695 /* verify no such name in generic params */
2696 for (i = 0; i <= DEVLINK_PARAM_GENERIC_ID_MAX; i++)
2697 if (!strcmp(param->name, devlink_param_generic[i].name))
2698 return -EEXIST;
2699
2700 return 0;
2701}
2702
2703static struct devlink_param_item *
2704devlink_param_find_by_name(struct list_head *param_list,
2705 const char *param_name)
2706{
2707 struct devlink_param_item *param_item;
2708
2709 list_for_each_entry(param_item, param_list, list)
2710 if (!strcmp(param_item->param->name, param_name))
2711 return param_item;
2712 return NULL;
2713}
2714
ec01aeb1
MS		 2715static struct devlink_param_item *
2716devlink_param_find_by_id(struct list_head *param_list, u32 param_id)
2717{
2718 struct devlink_param_item *param_item;
2719
2720 list_for_each_entry(param_item, param_list, list)
2721 if (param_item->param->id == param_id)
2722 return param_item;
2723 return NULL;
2724}
2725
45f05def
MS		 2726static bool
2727devlink_param_cmode_is_supported(const struct devlink_param *param,
2728 enum devlink_param_cmode cmode)
2729{
2730 return test_bit(cmode, &param->supported_cmodes);
2731}
2732
2733static int devlink_param_get(struct devlink *devlink,
2734 const struct devlink_param *param,
2735 struct devlink_param_gset_ctx *ctx)
2736{
2737 if (!param->get)
2738 return -EOPNOTSUPP;
2739 return param->get(devlink, param->id, ctx);
2740}
2741
e3b7ca18
MS		 2742static int devlink_param_set(struct devlink *devlink,
2743 const struct devlink_param *param,
2744 struct devlink_param_gset_ctx *ctx)
2745{
2746 if (!param->set)
2747 return -EOPNOTSUPP;
2748 return param->set(devlink, param->id, ctx);
2749}
2750
45f05def
MS		 2751static int
2752devlink_param_type_to_nla_type(enum devlink_param_type param_type)
2753{
2754 switch (param_type) {
2755 case DEVLINK_PARAM_TYPE_U8:
2756 return NLA_U8;
2757 case DEVLINK_PARAM_TYPE_U16:
2758 return NLA_U16;
2759 case DEVLINK_PARAM_TYPE_U32:
2760 return NLA_U32;
2761 case DEVLINK_PARAM_TYPE_STRING:
2762 return NLA_STRING;
2763 case DEVLINK_PARAM_TYPE_BOOL:
2764 return NLA_FLAG;
2765 default:
2766 return -EINVAL;
2767 }
2768}
2769
2770static int
2771devlink_nl_param_value_fill_one(struct sk_buff *msg,
2772 enum devlink_param_type type,
2773 enum devlink_param_cmode cmode,
2774 union devlink_param_value val)
2775{
2776 struct nlattr *param_value_attr;
2777
2778 param_value_attr = nla_nest_start(msg, DEVLINK_ATTR_PARAM_VALUE);
2779 if (!param_value_attr)
2780 goto nla_put_failure;
2781
2782 if (nla_put_u8(msg, DEVLINK_ATTR_PARAM_VALUE_CMODE, cmode))
2783 goto value_nest_cancel;
2784
2785 switch (type) {
2786 case DEVLINK_PARAM_TYPE_U8:
2787 if (nla_put_u8(msg, DEVLINK_ATTR_PARAM_VALUE_DATA, val.vu8))
2788 goto value_nest_cancel;
2789 break;
2790 case DEVLINK_PARAM_TYPE_U16:
2791 if (nla_put_u16(msg, DEVLINK_ATTR_PARAM_VALUE_DATA, val.vu16))
2792 goto value_nest_cancel;
2793 break;
2794 case DEVLINK_PARAM_TYPE_U32:
2795 if (nla_put_u32(msg, DEVLINK_ATTR_PARAM_VALUE_DATA, val.vu32))
2796 goto value_nest_cancel;
2797 break;
2798 case DEVLINK_PARAM_TYPE_STRING:
2799 if (nla_put_string(msg, DEVLINK_ATTR_PARAM_VALUE_DATA,
2800 val.vstr))
2801 goto value_nest_cancel;
2802 break;
2803 case DEVLINK_PARAM_TYPE_BOOL:
2804 if (val.vbool &&
2805 nla_put_flag(msg, DEVLINK_ATTR_PARAM_VALUE_DATA))
2806 goto value_nest_cancel;
2807 break;
2808 }
2809
2810 nla_nest_end(msg, param_value_attr);
2811 return 0;
2812
2813value_nest_cancel:
2814 nla_nest_cancel(msg, param_value_attr);
2815nla_put_failure:
2816 return -EMSGSIZE;
2817}
2818
2819static int devlink_nl_param_fill(struct sk_buff *msg, struct devlink *devlink,
2820 struct devlink_param_item *param_item,
2821 enum devlink_command cmd,
2822 u32 portid, u32 seq, int flags)
2823{
2824 union devlink_param_value param_value[DEVLINK_PARAM_CMODE_MAX + 1];
2825 const struct devlink_param *param = param_item->param;
2826 struct devlink_param_gset_ctx ctx;
2827 struct nlattr *param_values_list;
2828 struct nlattr *param_attr;
2829 int nla_type;
2830 void *hdr;
2831 int err;
2832 int i;
2833
2834 /* Get value from driver part to driverinit configuration mode */
2835 for (i = 0; i <= DEVLINK_PARAM_CMODE_MAX; i++) {
2836 if (!devlink_param_cmode_is_supported(param, i))
2837 continue;
2838 if (i == DEVLINK_PARAM_CMODE_DRIVERINIT) {
2839 if (!param_item->driverinit_value_valid)
2840 return -EOPNOTSUPP;
2841 param_value[i] = param_item->driverinit_value;
2842 } else {
2843 ctx.cmode = i;
2844 err = devlink_param_get(devlink, param, &ctx);
2845 if (err)
2846 return err;
2847 param_value[i] = ctx.val;
2848 }
2849 }
2850
2851 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
2852 if (!hdr)
2853 return -EMSGSIZE;
2854
2855 if (devlink_nl_put_handle(msg, devlink))
2856 goto genlmsg_cancel;
2857 param_attr = nla_nest_start(msg, DEVLINK_ATTR_PARAM);
2858 if (!param_attr)
2859 goto genlmsg_cancel;
2860 if (nla_put_string(msg, DEVLINK_ATTR_PARAM_NAME, param->name))
2861 goto param_nest_cancel;
2862 if (param->generic && nla_put_flag(msg, DEVLINK_ATTR_PARAM_GENERIC))
2863 goto param_nest_cancel;
2864
2865 nla_type = devlink_param_type_to_nla_type(param->type);
2866 if (nla_type < 0)
2867 goto param_nest_cancel;
2868 if (nla_put_u8(msg, DEVLINK_ATTR_PARAM_TYPE, nla_type))
2869 goto param_nest_cancel;
2870
2871 param_values_list = nla_nest_start(msg, DEVLINK_ATTR_PARAM_VALUES_LIST);
2872 if (!param_values_list)
2873 goto param_nest_cancel;
2874
2875 for (i = 0; i <= DEVLINK_PARAM_CMODE_MAX; i++) {
2876 if (!devlink_param_cmode_is_supported(param, i))
2877 continue;
2878 err = devlink_nl_param_value_fill_one(msg, param->type,
2879 i, param_value[i]);
2880 if (err)
2881 goto values_list_nest_cancel;
2882 }
2883
2884 nla_nest_end(msg, param_values_list);
2885 nla_nest_end(msg, param_attr);
2886 genlmsg_end(msg, hdr);
2887 return 0;
2888
2889values_list_nest_cancel:
2890 nla_nest_end(msg, param_values_list);
2891param_nest_cancel:
2892 nla_nest_cancel(msg, param_attr);
2893genlmsg_cancel:
2894 genlmsg_cancel(msg, hdr);
2895 return -EMSGSIZE;
2896}
2897
ea601e17
MS		 2898static void devlink_param_notify(struct devlink *devlink,
2899 struct devlink_param_item *param_item,
2900 enum devlink_command cmd)
2901{
2902 struct sk_buff *msg;
2903 int err;
2904
2905 WARN_ON(cmd != DEVLINK_CMD_PARAM_NEW && cmd != DEVLINK_CMD_PARAM_DEL);
2906
2907 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2908 if (!msg)
2909 return;
2910 err = devlink_nl_param_fill(msg, devlink, param_item, cmd, 0, 0, 0);
2911 if (err) {
2912 nlmsg_free(msg);
2913 return;
2914 }
2915
2916 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
2917 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
2918}
2919
45f05def
MS		 2920static int devlink_nl_cmd_param_get_dumpit(struct sk_buff *msg,
2921 struct netlink_callback *cb)
2922{
2923 struct devlink_param_item *param_item;
2924 struct devlink *devlink;
2925 int start = cb->args[0];
2926 int idx = 0;
2927 int err;
2928
2929 mutex_lock(&devlink_mutex);
2930 list_for_each_entry(devlink, &devlink_list, list) {
2931 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
2932 continue;
2933 mutex_lock(&devlink->lock);
2934 list_for_each_entry(param_item, &devlink->param_list, list) {
2935 if (idx < start) {
2936 idx++;
2937 continue;
2938 }
2939 err = devlink_nl_param_fill(msg, devlink, param_item,
2940 DEVLINK_CMD_PARAM_GET,
2941 NETLINK_CB(cb->skb).portid,
2942 cb->nlh->nlmsg_seq,
2943 NLM_F_MULTI);
2944 if (err) {
2945 mutex_unlock(&devlink->lock);
2946 goto out;
2947 }
2948 idx++;
2949 }
2950 mutex_unlock(&devlink->lock);
2951 }
2952out:
2953 mutex_unlock(&devlink_mutex);
2954
2955 cb->args[0] = idx;
2956 return msg->len;
2957}
2958
e3b7ca18
MS		 2959static int
2960devlink_param_type_get_from_info(struct genl_info *info,
2961 enum devlink_param_type *param_type)
2962{
2963 if (!info->attrs[DEVLINK_ATTR_PARAM_TYPE])
2964 return -EINVAL;
2965
2966 switch (nla_get_u8(info->attrs[DEVLINK_ATTR_PARAM_TYPE])) {
2967 case NLA_U8:
2968 *param_type = DEVLINK_PARAM_TYPE_U8;
2969 break;
2970 case NLA_U16:
2971 *param_type = DEVLINK_PARAM_TYPE_U16;
2972 break;
2973 case NLA_U32:
2974 *param_type = DEVLINK_PARAM_TYPE_U32;
2975 break;
2976 case NLA_STRING:
2977 *param_type = DEVLINK_PARAM_TYPE_STRING;
2978 break;
2979 case NLA_FLAG:
2980 *param_type = DEVLINK_PARAM_TYPE_BOOL;
2981 break;
2982 default:
2983 return -EINVAL;
2984 }
2985
2986 return 0;
2987}
2988
2989static int
2990devlink_param_value_get_from_info(const struct devlink_param *param,
2991 struct genl_info *info,
2992 union devlink_param_value *value)
2993{
2994 if (param->type != DEVLINK_PARAM_TYPE_BOOL &&
2995 !info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA])
2996 return -EINVAL;
2997
2998 switch (param->type) {
2999 case DEVLINK_PARAM_TYPE_U8:
3000 value->vu8 = nla_get_u8(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]);
3001 break;
3002 case DEVLINK_PARAM_TYPE_U16:
3003 value->vu16 = nla_get_u16(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]);
3004 break;
3005 case DEVLINK_PARAM_TYPE_U32:
3006 value->vu32 = nla_get_u32(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]);
3007 break;
3008 case DEVLINK_PARAM_TYPE_STRING:
3009 if (nla_len(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]) >
3010 DEVLINK_PARAM_MAX_STRING_VALUE)
3011 return -EINVAL;
3012 value->vstr = nla_data(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]);
3013 break;
3014 case DEVLINK_PARAM_TYPE_BOOL:
3015 value->vbool = info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA] ?
3016 true : false;
3017 break;
3018 }
3019 return 0;
3020}
3021
45f05def
MS		 3022static struct devlink_param_item *
3023devlink_param_get_from_info(struct devlink *devlink,
3024 struct genl_info *info)
3025{
3026 char *param_name;
3027
3028 if (!info->attrs[DEVLINK_ATTR_PARAM_NAME])
3029 return NULL;
3030
3031 param_name = nla_data(info->attrs[DEVLINK_ATTR_PARAM_NAME]);
3032 return devlink_param_find_by_name(&devlink->param_list, param_name);
3033}
3034
3035static int devlink_nl_cmd_param_get_doit(struct sk_buff *skb,
3036 struct genl_info *info)
3037{
3038 struct devlink *devlink = info->user_ptr[0];
3039 struct devlink_param_item *param_item;
3040 struct sk_buff *msg;
3041 int err;
3042
3043 param_item = devlink_param_get_from_info(devlink, info);
3044 if (!param_item)
3045 return -EINVAL;
3046
3047 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3048 if (!msg)
3049 return -ENOMEM;
3050
3051 err = devlink_nl_param_fill(msg, devlink, param_item,
3052 DEVLINK_CMD_PARAM_GET,
3053 info->snd_portid, info->snd_seq, 0);
3054 if (err) {
3055 nlmsg_free(msg);
3056 return err;
3057 }
3058
3059 return genlmsg_reply(msg, info);
3060}
3061
e3b7ca18
MS		 3062static int devlink_nl_cmd_param_set_doit(struct sk_buff *skb,
3063 struct genl_info *info)
3064{
3065 struct devlink *devlink = info->user_ptr[0];
3066 enum devlink_param_type param_type;
3067 struct devlink_param_gset_ctx ctx;
3068 enum devlink_param_cmode cmode;
3069 struct devlink_param_item *param_item;
3070 const struct devlink_param *param;
3071 union devlink_param_value value;
3072 int err = 0;
3073
3074 param_item = devlink_param_get_from_info(devlink, info);
3075 if (!param_item)
3076 return -EINVAL;
3077 param = param_item->param;
3078 err = devlink_param_type_get_from_info(info, &param_type);
3079 if (err)
3080 return err;
3081 if (param_type != param->type)
3082 return -EINVAL;
3083 err = devlink_param_value_get_from_info(param, info, &value);
3084 if (err)
3085 return err;
3086 if (param->validate) {
3087 err = param->validate(devlink, param->id, value, info->extack);
3088 if (err)
3089 return err;
3090 }
3091
3092 if (!info->attrs[DEVLINK_ATTR_PARAM_VALUE_CMODE])
3093 return -EINVAL;
3094 cmode = nla_get_u8(info->attrs[DEVLINK_ATTR_PARAM_VALUE_CMODE]);
3095 if (!devlink_param_cmode_is_supported(param, cmode))
3096 return -EOPNOTSUPP;
3097
3098 if (cmode == DEVLINK_PARAM_CMODE_DRIVERINIT) {
3099 param_item->driverinit_value = value;
3100 param_item->driverinit_value_valid = true;
3101 } else {
3102 if (!param->set)
3103 return -EOPNOTSUPP;
3104 ctx.val = value;
3105 ctx.cmode = cmode;
3106 err = devlink_param_set(devlink, param, &ctx);
3107 if (err)
3108 return err;
3109 }
3110
ea601e17 3111 devlink_param_notify(devlink, param_item, DEVLINK_CMD_PARAM_NEW);
e3b7ca18
MS		 3112 return 0;
3113}
3114
eabaef18
MS		 3115static int devlink_param_register_one(struct devlink *devlink,
3116 const struct devlink_param *param)
3117{
3118 struct devlink_param_item *param_item;
3119
3120 if (devlink_param_find_by_name(&devlink->param_list,
3121 param->name))
3122 return -EEXIST;
3123
3124 if (param->supported_cmodes == BIT(DEVLINK_PARAM_CMODE_DRIVERINIT))
3125 WARN_ON(param->get || param->set);
3126 else
3127 WARN_ON(!param->get || !param->set);
3128
3129 param_item = kzalloc(sizeof(*param_item), GFP_KERNEL);
3130 if (!param_item)
3131 return -ENOMEM;
3132 param_item->param = param;
3133
3134 list_add_tail(&param_item->list, &devlink->param_list);
ea601e17 3135 devlink_param_notify(devlink, param_item, DEVLINK_CMD_PARAM_NEW);
eabaef18
MS		 3136 return 0;
3137}
3138
3139static void devlink_param_unregister_one(struct devlink *devlink,
3140 const struct devlink_param *param)
3141{
3142 struct devlink_param_item *param_item;
3143
3144 param_item = devlink_param_find_by_name(&devlink->param_list,
3145 param->name);
3146 WARN_ON(!param_item);
ea601e17 3147 devlink_param_notify(devlink, param_item, DEVLINK_CMD_PARAM_DEL);
eabaef18
MS		 3148 list_del(&param_item->list);
3149 kfree(param_item);
3150}
3151
a006d467
AV		 3152static int devlink_nl_region_snapshot_id_put(struct sk_buff *msg,
3153 struct devlink *devlink,
3154 struct devlink_snapshot *snapshot)
3155{
3156 struct nlattr *snap_attr;
3157 int err;
3158
3159 snap_attr = nla_nest_start(msg, DEVLINK_ATTR_REGION_SNAPSHOT);
3160 if (!snap_attr)
3161 return -EINVAL;
3162
3163 err = nla_put_u32(msg, DEVLINK_ATTR_REGION_SNAPSHOT_ID, snapshot->id);
3164 if (err)
3165 goto nla_put_failure;
3166
3167 nla_nest_end(msg, snap_attr);
3168 return 0;
3169
3170nla_put_failure:
3171 nla_nest_cancel(msg, snap_attr);
3172 return err;
3173}
3174
3175static int devlink_nl_region_snapshots_id_put(struct sk_buff *msg,
3176 struct devlink *devlink,
3177 struct devlink_region *region)
3178{
3179 struct devlink_snapshot *snapshot;
3180 struct nlattr *snapshots_attr;
3181 int err;
3182
3183 snapshots_attr = nla_nest_start(msg, DEVLINK_ATTR_REGION_SNAPSHOTS);
3184 if (!snapshots_attr)
3185 return -EINVAL;
3186
3187 list_for_each_entry(snapshot, &region->snapshot_list, list) {
3188 err = devlink_nl_region_snapshot_id_put(msg, devlink, snapshot);
3189 if (err)
3190 goto nla_put_failure;
3191 }
3192
3193 nla_nest_end(msg, snapshots_attr);
3194 return 0;
3195
3196nla_put_failure:
3197 nla_nest_cancel(msg, snapshots_attr);
3198 return err;
3199}
3200
d8db7ea5
AV		 3201static int devlink_nl_region_fill(struct sk_buff *msg, struct devlink *devlink,
3202 enum devlink_command cmd, u32 portid,
3203 u32 seq, int flags,
3204 struct devlink_region *region)
3205{
3206 void *hdr;
3207 int err;
3208
3209 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
3210 if (!hdr)
3211 return -EMSGSIZE;
3212
3213 err = devlink_nl_put_handle(msg, devlink);
3214 if (err)
3215 goto nla_put_failure;
3216
3217 err = nla_put_string(msg, DEVLINK_ATTR_REGION_NAME, region->name);
3218 if (err)
3219 goto nla_put_failure;
3220
3221 err = nla_put_u64_64bit(msg, DEVLINK_ATTR_REGION_SIZE,
3222 region->size,
3223 DEVLINK_ATTR_PAD);
3224 if (err)
3225 goto nla_put_failure;
3226
a006d467
AV		 3227 err = devlink_nl_region_snapshots_id_put(msg, devlink, region);
3228 if (err)
3229 goto nla_put_failure;
3230
d8db7ea5
AV		 3231 genlmsg_end(msg, hdr);
3232 return 0;
3233
3234nla_put_failure:
3235 genlmsg_cancel(msg, hdr);
3236 return err;
3237}
3238
3239static int devlink_nl_cmd_region_get_doit(struct sk_buff *skb,
3240 struct genl_info *info)
3241{
3242 struct devlink *devlink = info->user_ptr[0];
3243 struct devlink_region *region;
3244 const char *region_name;
3245 struct sk_buff *msg;
3246 int err;
3247
3248 if (!info->attrs[DEVLINK_ATTR_REGION_NAME])
3249 return -EINVAL;
3250
3251 region_name = nla_data(info->attrs[DEVLINK_ATTR_REGION_NAME]);
3252 region = devlink_region_get_by_name(devlink, region_name);
3253 if (!region)
3254 return -EINVAL;
3255
3256 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3257 if (!msg)
3258 return -ENOMEM;
3259
3260 err = devlink_nl_region_fill(msg, devlink, DEVLINK_CMD_REGION_GET,
3261 info->snd_portid, info->snd_seq, 0,
3262 region);
3263 if (err) {
3264 nlmsg_free(msg);
3265 return err;
3266 }
3267
3268 return genlmsg_reply(msg, info);
3269}
3270
3271static int devlink_nl_cmd_region_get_dumpit(struct sk_buff *msg,
3272 struct netlink_callback *cb)
3273{
3274 struct devlink_region *region;
3275 struct devlink *devlink;
3276 int start = cb->args[0];
3277 int idx = 0;
3278 int err;
3279
3280 mutex_lock(&devlink_mutex);
3281 list_for_each_entry(devlink, &devlink_list, list) {
3282 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
3283 continue;
3284
3285 mutex_lock(&devlink->lock);
3286 list_for_each_entry(region, &devlink->region_list, list) {
3287 if (idx < start) {
3288 idx++;
3289 continue;
3290 }
3291 err = devlink_nl_region_fill(msg, devlink,
3292 DEVLINK_CMD_REGION_GET,
3293 NETLINK_CB(cb->skb).portid,
3294 cb->nlh->nlmsg_seq,
3295 NLM_F_MULTI, region);
3296 if (err) {
3297 mutex_unlock(&devlink->lock);
3298 goto out;
3299 }
3300 idx++;
3301 }
3302 mutex_unlock(&devlink->lock);
3303 }
3304out:
3305 mutex_unlock(&devlink_mutex);
3306 cb->args[0] = idx;
3307 return msg->len;
3308}
3309
bfcd3a46
JP		 3310static const struct nla_policy devlink_nl_policy[DEVLINK_ATTR_MAX + 1] = {
3311 [DEVLINK_ATTR_BUS_NAME] = { .type = NLA_NUL_STRING },
3312 [DEVLINK_ATTR_DEV_NAME] = { .type = NLA_NUL_STRING },
3313 [DEVLINK_ATTR_PORT_INDEX] = { .type = NLA_U32 },
3314 [DEVLINK_ATTR_PORT_TYPE] = { .type = NLA_U16 },
3315 [DEVLINK_ATTR_PORT_SPLIT_COUNT] = { .type = NLA_U32 },
bf797471
JP		 3316 [DEVLINK_ATTR_SB_INDEX] = { .type = NLA_U32 },
3317 [DEVLINK_ATTR_SB_POOL_INDEX] = { .type = NLA_U16 },
3318 [DEVLINK_ATTR_SB_POOL_TYPE] = { .type = NLA_U8 },
3319 [DEVLINK_ATTR_SB_POOL_SIZE] = { .type = NLA_U32 },
3320 [DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE] = { .type = NLA_U8 },
3321 [DEVLINK_ATTR_SB_THRESHOLD] = { .type = NLA_U32 },
3322 [DEVLINK_ATTR_SB_TC_INDEX] = { .type = NLA_U16 },
08f4b591 3323 [DEVLINK_ATTR_ESWITCH_MODE] = { .type = NLA_U16 },
59bfde01 3324 [DEVLINK_ATTR_ESWITCH_INLINE_MODE] = { .type = NLA_U8 },
f43e9b06 3325 [DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = { .type = NLA_U8 },
1555d204
AS		 3326 [DEVLINK_ATTR_DPIPE_TABLE_NAME] = { .type = NLA_NUL_STRING },
3327 [DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED] = { .type = NLA_U8 },
d9f9b9a4
AS		 3328 [DEVLINK_ATTR_RESOURCE_ID] = { .type = NLA_U64},
3329 [DEVLINK_ATTR_RESOURCE_SIZE] = { .type = NLA_U64},
e3b7ca18
MS		 3330 [DEVLINK_ATTR_PARAM_NAME] = { .type = NLA_NUL_STRING },
3331 [DEVLINK_ATTR_PARAM_TYPE] = { .type = NLA_U8 },
3332 [DEVLINK_ATTR_PARAM_VALUE_CMODE] = { .type = NLA_U8 },
d8db7ea5 3333 [DEVLINK_ATTR_REGION_NAME] = { .type = NLA_NUL_STRING },
bfcd3a46
JP		 3334};
3335
3336static const struct genl_ops devlink_nl_ops[] = {
3337 {
3338 .cmd = DEVLINK_CMD_GET,
3339 .doit = devlink_nl_cmd_get_doit,
3340 .dumpit = devlink_nl_cmd_get_dumpit,
3341 .policy = devlink_nl_policy,
1fc2257e 3342 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
bfcd3a46
JP		 3343 /* can be retrieved by unprivileged users */
3344 },
3345 {
3346 .cmd = DEVLINK_CMD_PORT_GET,
3347 .doit = devlink_nl_cmd_port_get_doit,
3348 .dumpit = devlink_nl_cmd_port_get_dumpit,
3349 .policy = devlink_nl_policy,
3350 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
3351 /* can be retrieved by unprivileged users */
3352 },
3353 {
3354 .cmd = DEVLINK_CMD_PORT_SET,
3355 .doit = devlink_nl_cmd_port_set_doit,
3356 .policy = devlink_nl_policy,
3357 .flags = GENL_ADMIN_PERM,
3358 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
3359 },
3360 {
3361 .cmd = DEVLINK_CMD_PORT_SPLIT,
3362 .doit = devlink_nl_cmd_port_split_doit,
3363 .policy = devlink_nl_policy,
3364 .flags = GENL_ADMIN_PERM,
2406e7e5
AS		 3365 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3366 DEVLINK_NL_FLAG_NO_LOCK,
bfcd3a46
JP		 3367 },
3368 {
3369 .cmd = DEVLINK_CMD_PORT_UNSPLIT,
3370 .doit = devlink_nl_cmd_port_unsplit_doit,
3371 .policy = devlink_nl_policy,
3372 .flags = GENL_ADMIN_PERM,
2406e7e5
AS		 3373 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3374 DEVLINK_NL_FLAG_NO_LOCK,
bfcd3a46 3375 },
bf797471
JP		 3376 {
3377 .cmd = DEVLINK_CMD_SB_GET,
3378 .doit = devlink_nl_cmd_sb_get_doit,
3379 .dumpit = devlink_nl_cmd_sb_get_dumpit,
3380 .policy = devlink_nl_policy,
3381 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3382 DEVLINK_NL_FLAG_NEED_SB,
3383 /* can be retrieved by unprivileged users */
3384 },
3385 {
3386 .cmd = DEVLINK_CMD_SB_POOL_GET,
3387 .doit = devlink_nl_cmd_sb_pool_get_doit,
3388 .dumpit = devlink_nl_cmd_sb_pool_get_dumpit,
3389 .policy = devlink_nl_policy,
3390 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3391 DEVLINK_NL_FLAG_NEED_SB,
3392 /* can be retrieved by unprivileged users */
3393 },
3394 {
3395 .cmd = DEVLINK_CMD_SB_POOL_SET,
3396 .doit = devlink_nl_cmd_sb_pool_set_doit,
3397 .policy = devlink_nl_policy,
3398 .flags = GENL_ADMIN_PERM,
3399 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3400 DEVLINK_NL_FLAG_NEED_SB,
3401 },
3402 {
3403 .cmd = DEVLINK_CMD_SB_PORT_POOL_GET,
3404 .doit = devlink_nl_cmd_sb_port_pool_get_doit,
3405 .dumpit = devlink_nl_cmd_sb_port_pool_get_dumpit,
3406 .policy = devlink_nl_policy,
3407 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3408 DEVLINK_NL_FLAG_NEED_SB,
3409 /* can be retrieved by unprivileged users */
3410 },
3411 {
3412 .cmd = DEVLINK_CMD_SB_PORT_POOL_SET,
3413 .doit = devlink_nl_cmd_sb_port_pool_set_doit,
3414 .policy = devlink_nl_policy,
3415 .flags = GENL_ADMIN_PERM,
3416 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3417 DEVLINK_NL_FLAG_NEED_SB,
3418 },
3419 {
3420 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_GET,
3421 .doit = devlink_nl_cmd_sb_tc_pool_bind_get_doit,
3422 .dumpit = devlink_nl_cmd_sb_tc_pool_bind_get_dumpit,
3423 .policy = devlink_nl_policy,
3424 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3425 DEVLINK_NL_FLAG_NEED_SB,
3426 /* can be retrieved by unprivileged users */
3427 },
3428 {
3429 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_SET,
3430 .doit = devlink_nl_cmd_sb_tc_pool_bind_set_doit,
3431 .policy = devlink_nl_policy,
3432 .flags = GENL_ADMIN_PERM,
3433 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3434 DEVLINK_NL_FLAG_NEED_SB,
3435 },
df38dafd
JP		 3436 {
3437 .cmd = DEVLINK_CMD_SB_OCC_SNAPSHOT,
3438 .doit = devlink_nl_cmd_sb_occ_snapshot_doit,
3439 .policy = devlink_nl_policy,
3440 .flags = GENL_ADMIN_PERM,
3441 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2406e7e5 3442 DEVLINK_NL_FLAG_NEED_SB,
df38dafd
JP		 3443 },
3444 {
3445 .cmd = DEVLINK_CMD_SB_OCC_MAX_CLEAR,
3446 .doit = devlink_nl_cmd_sb_occ_max_clear_doit,
3447 .policy = devlink_nl_policy,
3448 .flags = GENL_ADMIN_PERM,
3449 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2406e7e5 3450 DEVLINK_NL_FLAG_NEED_SB,
df38dafd 3451 },
08f4b591 3452 {
adf200f3
JP		 3453 .cmd = DEVLINK_CMD_ESWITCH_GET,
3454 .doit = devlink_nl_cmd_eswitch_get_doit,
08f4b591
OG		 3455 .policy = devlink_nl_policy,
3456 .flags = GENL_ADMIN_PERM,
3457 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
3458 },
3459 {
adf200f3
JP		 3460 .cmd = DEVLINK_CMD_ESWITCH_SET,
3461 .doit = devlink_nl_cmd_eswitch_set_doit,
08f4b591
OG		 3462 .policy = devlink_nl_policy,
3463 .flags = GENL_ADMIN_PERM,
7ac1cc9a
JK		 3464 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3465 DEVLINK_NL_FLAG_NO_LOCK,
08f4b591 3466 },
1555d204
AS		 3467 {
3468 .cmd = DEVLINK_CMD_DPIPE_TABLE_GET,
3469 .doit = devlink_nl_cmd_dpipe_table_get,
3470 .policy = devlink_nl_policy,
1555d204 3471 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 3472 /* can be retrieved by unprivileged users */
1555d204
AS		 3473 },
3474 {
3475 .cmd = DEVLINK_CMD_DPIPE_ENTRIES_GET,
3476 .doit = devlink_nl_cmd_dpipe_entries_get,
3477 .policy = devlink_nl_policy,
1555d204 3478 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 3479 /* can be retrieved by unprivileged users */
1555d204
AS		 3480 },
3481 {
3482 .cmd = DEVLINK_CMD_DPIPE_HEADERS_GET,
3483 .doit = devlink_nl_cmd_dpipe_headers_get,
3484 .policy = devlink_nl_policy,
1555d204 3485 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 3486 /* can be retrieved by unprivileged users */
1555d204
AS		 3487 },
3488 {
3489 .cmd = DEVLINK_CMD_DPIPE_TABLE_COUNTERS_SET,
3490 .doit = devlink_nl_cmd_dpipe_table_counters_set,
3491 .policy = devlink_nl_policy,
3492 .flags = GENL_ADMIN_PERM,
3493 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
3494 },
d9f9b9a4
AS		 3495 {
3496 .cmd = DEVLINK_CMD_RESOURCE_SET,
3497 .doit = devlink_nl_cmd_resource_set,
3498 .policy = devlink_nl_policy,
3499 .flags = GENL_ADMIN_PERM,
3500 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
3501 },
3502 {
3503 .cmd = DEVLINK_CMD_RESOURCE_DUMP,
3504 .doit = devlink_nl_cmd_resource_dump,
3505 .policy = devlink_nl_policy,
d9f9b9a4 3506 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 3507 /* can be retrieved by unprivileged users */
d9f9b9a4 3508 },
2d8dc5bb
AS		 3509 {
3510 .cmd = DEVLINK_CMD_RELOAD,
3511 .doit = devlink_nl_cmd_reload,
3512 .policy = devlink_nl_policy,
3513 .flags = GENL_ADMIN_PERM,
3514 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3515 DEVLINK_NL_FLAG_NO_LOCK,
3516 },
45f05def
MS		 3517 {
3518 .cmd = DEVLINK_CMD_PARAM_GET,
3519 .doit = devlink_nl_cmd_param_get_doit,
3520 .dumpit = devlink_nl_cmd_param_get_dumpit,
3521 .policy = devlink_nl_policy,
3522 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
3523 /* can be retrieved by unprivileged users */
3524 },
e3b7ca18
MS		 3525 {
3526 .cmd = DEVLINK_CMD_PARAM_SET,
3527 .doit = devlink_nl_cmd_param_set_doit,
3528 .policy = devlink_nl_policy,
3529 .flags = GENL_ADMIN_PERM,
3530 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
3531 },
d8db7ea5
AV		 3532 {
3533 .cmd = DEVLINK_CMD_REGION_GET,
3534 .doit = devlink_nl_cmd_region_get_doit,
3535 .dumpit = devlink_nl_cmd_region_get_dumpit,
3536 .policy = devlink_nl_policy,
3537 .flags = GENL_ADMIN_PERM,
3538 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
3539 },
bfcd3a46
JP		 3540};
3541
56989f6d 3542static struct genl_family devlink_nl_family __ro_after_init = {
489111e5
JB		 3543 .name = DEVLINK_GENL_NAME,
3544 .version = DEVLINK_GENL_VERSION,
3545 .maxattr = DEVLINK_ATTR_MAX,
3546 .netnsok = true,
3547 .pre_doit = devlink_nl_pre_doit,
3548 .post_doit = devlink_nl_post_doit,
3549 .module = THIS_MODULE,
3550 .ops = devlink_nl_ops,
3551 .n_ops = ARRAY_SIZE(devlink_nl_ops),
3552 .mcgrps = devlink_nl_mcgrps,
3553 .n_mcgrps = ARRAY_SIZE(devlink_nl_mcgrps),
3554};
3555
bfcd3a46
JP		 3556/**
3557 * devlink_alloc - Allocate new devlink instance resources
3558 *
3559 * @ops: ops
3560 * @priv_size: size of user private data
3561 *
3562 * Allocate new devlink instance resources, including devlink index
3563 * and name.
3564 */
3565struct devlink *devlink_alloc(const struct devlink_ops *ops, size_t priv_size)
3566{
3567 struct devlink *devlink;
3568
3569 devlink = kzalloc(sizeof(*devlink) + priv_size, GFP_KERNEL);
3570 if (!devlink)
3571 return NULL;
3572 devlink->ops = ops;
3573 devlink_net_set(devlink, &init_net);
3574 INIT_LIST_HEAD(&devlink->port_list);
bf797471 3575 INIT_LIST_HEAD(&devlink->sb_list);
1555d204 3576 INIT_LIST_HEAD_RCU(&devlink->dpipe_table_list);
d9f9b9a4 3577 INIT_LIST_HEAD(&devlink->resource_list);
eabaef18 3578 INIT_LIST_HEAD(&devlink->param_list);
b16ebe92 3579 INIT_LIST_HEAD(&devlink->region_list);
2406e7e5 3580 mutex_init(&devlink->lock);
bfcd3a46
JP		 3581 return devlink;
3582}
3583EXPORT_SYMBOL_GPL(devlink_alloc);
3584
3585/**
3586 * devlink_register - Register devlink instance
3587 *
3588 * @devlink: devlink
3589 */
3590int devlink_register(struct devlink *devlink, struct device *dev)
3591{
3592 mutex_lock(&devlink_mutex);
3593 devlink->dev = dev;
3594 list_add_tail(&devlink->list, &devlink_list);
3595 devlink_notify(devlink, DEVLINK_CMD_NEW);
3596 mutex_unlock(&devlink_mutex);
3597 return 0;
3598}
3599EXPORT_SYMBOL_GPL(devlink_register);
3600
3601/**
3602 * devlink_unregister - Unregister devlink instance
3603 *
3604 * @devlink: devlink
3605 */
3606void devlink_unregister(struct devlink *devlink)
3607{
3608 mutex_lock(&devlink_mutex);
3609 devlink_notify(devlink, DEVLINK_CMD_DEL);
3610 list_del(&devlink->list);
3611 mutex_unlock(&devlink_mutex);
3612}
3613EXPORT_SYMBOL_GPL(devlink_unregister);
3614
3615/**
3616 * devlink_free - Free devlink instance resources
3617 *
3618 * @devlink: devlink
3619 */
3620void devlink_free(struct devlink *devlink)
3621{
3622 kfree(devlink);
3623}
3624EXPORT_SYMBOL_GPL(devlink_free);
3625
3626/**
3627 * devlink_port_register - Register devlink port
3628 *
3629 * @devlink: devlink
3630 * @devlink_port: devlink port
3631 * @port_index
3632 *
3633 * Register devlink port with provided port index. User can use
3634 * any indexing, even hw-related one. devlink_port structure
3635 * is convenient to be embedded inside user driver private structure.
3636 * Note that the caller should take care of zeroing the devlink_port
3637 * structure.
3638 */
3639int devlink_port_register(struct devlink *devlink,
3640 struct devlink_port *devlink_port,
3641 unsigned int port_index)
3642{
2406e7e5 3643 mutex_lock(&devlink->lock);
bfcd3a46 3644 if (devlink_port_index_exists(devlink, port_index)) {
2406e7e5 3645 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 3646 return -EEXIST;
3647 }
3648 devlink_port->devlink = devlink;
3649 devlink_port->index = port_index;
bfcd3a46
JP		 3650 devlink_port->registered = true;
3651 list_add_tail(&devlink_port->list, &devlink->port_list);
2406e7e5 3652 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 3653 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
3654 return 0;
3655}
3656EXPORT_SYMBOL_GPL(devlink_port_register);
3657
3658/**
3659 * devlink_port_unregister - Unregister devlink port
3660 *
3661 * @devlink_port: devlink port
3662 */
3663void devlink_port_unregister(struct devlink_port *devlink_port)
3664{
2406e7e5
AS		 3665 struct devlink *devlink = devlink_port->devlink;
3666
bfcd3a46 3667 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_DEL);
2406e7e5 3668 mutex_lock(&devlink->lock);
bfcd3a46 3669 list_del(&devlink_port->list);
2406e7e5 3670 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 3671}
3672EXPORT_SYMBOL_GPL(devlink_port_unregister);
3673
3674static void __devlink_port_type_set(struct devlink_port *devlink_port,
3675 enum devlink_port_type type,
3676 void *type_dev)
3677{
3678 devlink_port->type = type;
3679 devlink_port->type_dev = type_dev;
3680 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
3681}
3682
3683/**
3684 * devlink_port_type_eth_set - Set port type to Ethernet
3685 *
3686 * @devlink_port: devlink port
3687 * @netdev: related netdevice
3688 */
3689void devlink_port_type_eth_set(struct devlink_port *devlink_port,
3690 struct net_device *netdev)
3691{
3692 return __devlink_port_type_set(devlink_port,
3693 DEVLINK_PORT_TYPE_ETH, netdev);
3694}
3695EXPORT_SYMBOL_GPL(devlink_port_type_eth_set);
3696
3697/**
3698 * devlink_port_type_ib_set - Set port type to InfiniBand
3699 *
3700 * @devlink_port: devlink port
3701 * @ibdev: related IB device
3702 */
3703void devlink_port_type_ib_set(struct devlink_port *devlink_port,
3704 struct ib_device *ibdev)
3705{
3706 return __devlink_port_type_set(devlink_port,
3707 DEVLINK_PORT_TYPE_IB, ibdev);
3708}
3709EXPORT_SYMBOL_GPL(devlink_port_type_ib_set);
3710
3711/**
3712 * devlink_port_type_clear - Clear port type
3713 *
3714 * @devlink_port: devlink port
3715 */
3716void devlink_port_type_clear(struct devlink_port *devlink_port)
3717{
3718 return __devlink_port_type_set(devlink_port,
3719 DEVLINK_PORT_TYPE_NOTSET, NULL);
3720}
3721EXPORT_SYMBOL_GPL(devlink_port_type_clear);
3722
3723/**
b9ffcbaf 3724 * devlink_port_attrs_set - Set port attributes
bfcd3a46
JP		 3725 *
3726 * @devlink_port: devlink port
5ec1380a 3727 * @flavour: flavour of the port
b9ffcbaf
JP		 3728 * @port_number: number of the port that is facing user, for example
3729 * the front panel port number
3730 * @split: indicates if this is split port
3731 * @split_subport_number: if the port is split, this is the number
3732 * of subport.
bfcd3a46 3733 */
b9ffcbaf 3734void devlink_port_attrs_set(struct devlink_port *devlink_port,
5ec1380a 3735 enum devlink_port_flavour flavour,
b9ffcbaf
JP		 3736 u32 port_number, bool split,
3737 u32 split_subport_number)
bfcd3a46 3738{
b9ffcbaf
JP		 3739 struct devlink_port_attrs *attrs = &devlink_port->attrs;
3740
3741 attrs->set = true;
5ec1380a 3742 attrs->flavour = flavour;
b9ffcbaf
JP		 3743 attrs->port_number = port_number;
3744 attrs->split = split;
3745 attrs->split_subport_number = split_subport_number;
bfcd3a46
JP		 3746 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
3747}
b9ffcbaf 3748EXPORT_SYMBOL_GPL(devlink_port_attrs_set);
bfcd3a46 3749
08474c1a
JP		 3750int devlink_port_get_phys_port_name(struct devlink_port *devlink_port,
3751 char *name, size_t len)
3752{
3753 struct devlink_port_attrs *attrs = &devlink_port->attrs;
3754 int n = 0;
3755
3756 if (!attrs->set)
3757 return -EOPNOTSUPP;
3758
3759 switch (attrs->flavour) {
3760 case DEVLINK_PORT_FLAVOUR_PHYSICAL:
3761 if (!attrs->split)
3762 n = snprintf(name, len, "p%u", attrs->port_number);
3763 else
3764 n = snprintf(name, len, "p%us%u", attrs->port_number,
3765 attrs->split_subport_number);
3766 break;
3767 case DEVLINK_PORT_FLAVOUR_CPU:
3768 case DEVLINK_PORT_FLAVOUR_DSA:
3769 /* As CPU and DSA ports do not have a netdevice associated
3770 * case should not ever happen.
3771 */
3772 WARN_ON(1);
3773 return -EINVAL;
3774 }
3775
3776 if (n >= len)
3777 return -EINVAL;
3778
3779 return 0;
3780}
3781EXPORT_SYMBOL_GPL(devlink_port_get_phys_port_name);
3782
bf797471
JP		 3783int devlink_sb_register(struct devlink *devlink, unsigned int sb_index,
3784 u32 size, u16 ingress_pools_count,
3785 u16 egress_pools_count, u16 ingress_tc_count,
3786 u16 egress_tc_count)
3787{
3788 struct devlink_sb *devlink_sb;
3789 int err = 0;
3790
2406e7e5 3791 mutex_lock(&devlink->lock);
bf797471
JP		 3792 if (devlink_sb_index_exists(devlink, sb_index)) {
3793 err = -EEXIST;
3794 goto unlock;
3795 }
3796
3797 devlink_sb = kzalloc(sizeof(*devlink_sb), GFP_KERNEL);
3798 if (!devlink_sb) {
3799 err = -ENOMEM;
3800 goto unlock;
3801 }
3802 devlink_sb->index = sb_index;
3803 devlink_sb->size = size;
3804 devlink_sb->ingress_pools_count = ingress_pools_count;
3805 devlink_sb->egress_pools_count = egress_pools_count;
3806 devlink_sb->ingress_tc_count = ingress_tc_count;
3807 devlink_sb->egress_tc_count = egress_tc_count;
3808 list_add_tail(&devlink_sb->list, &devlink->sb_list);
3809unlock:
2406e7e5 3810 mutex_unlock(&devlink->lock);
bf797471
JP		 3811 return err;
3812}
3813EXPORT_SYMBOL_GPL(devlink_sb_register);
3814
3815void devlink_sb_unregister(struct devlink *devlink, unsigned int sb_index)
3816{
3817 struct devlink_sb *devlink_sb;
3818
2406e7e5 3819 mutex_lock(&devlink->lock);
bf797471
JP		 3820 devlink_sb = devlink_sb_get_by_index(devlink, sb_index);
3821 WARN_ON(!devlink_sb);
3822 list_del(&devlink_sb->list);
2406e7e5 3823 mutex_unlock(&devlink->lock);
bf797471
JP		 3824 kfree(devlink_sb);
3825}
3826EXPORT_SYMBOL_GPL(devlink_sb_unregister);
3827
1555d204
AS		 3828/**
3829 * devlink_dpipe_headers_register - register dpipe headers
3830 *
3831 * @devlink: devlink
3832 * @dpipe_headers: dpipe header array
3833 *
3834 * Register the headers supported by hardware.
3835 */
3836int devlink_dpipe_headers_register(struct devlink *devlink,
3837 struct devlink_dpipe_headers *dpipe_headers)
3838{
2406e7e5 3839 mutex_lock(&devlink->lock);
1555d204 3840 devlink->dpipe_headers = dpipe_headers;
2406e7e5 3841 mutex_unlock(&devlink->lock);
1555d204
AS		 3842 return 0;
3843}
3844EXPORT_SYMBOL_GPL(devlink_dpipe_headers_register);
3845
3846/**
3847 * devlink_dpipe_headers_unregister - unregister dpipe headers
3848 *
3849 * @devlink: devlink
3850 *
3851 * Unregister the headers supported by hardware.
3852 */
3853void devlink_dpipe_headers_unregister(struct devlink *devlink)
3854{
2406e7e5 3855 mutex_lock(&devlink->lock);
1555d204 3856 devlink->dpipe_headers = NULL;
2406e7e5 3857 mutex_unlock(&devlink->lock);
1555d204
AS		 3858}
3859EXPORT_SYMBOL_GPL(devlink_dpipe_headers_unregister);
3860
3861/**
3862 * devlink_dpipe_table_counter_enabled - check if counter allocation
3863 * required
3864 * @devlink: devlink
3865 * @table_name: tables name
3866 *
3867 * Used by driver to check if counter allocation is required.
3868 * After counter allocation is turned on the table entries
3869 * are updated to include counter statistics.
3870 *
3871 * After that point on the driver must respect the counter
3872 * state so that each entry added to the table is added
3873 * with a counter.
3874 */
3875bool devlink_dpipe_table_counter_enabled(struct devlink *devlink,
3876 const char *table_name)
3877{
3878 struct devlink_dpipe_table *table;
3879 bool enabled;
3880
3881 rcu_read_lock();
3882 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
3883 table_name);
3884 enabled = false;
3885 if (table)
3886 enabled = table->counters_enabled;
3887 rcu_read_unlock();
3888 return enabled;
3889}
3890EXPORT_SYMBOL_GPL(devlink_dpipe_table_counter_enabled);
3891
3892/**
3893 * devlink_dpipe_table_register - register dpipe table
3894 *
3895 * @devlink: devlink
3896 * @table_name: table name
3897 * @table_ops: table ops
3898 * @priv: priv
1555d204
AS		 3899 * @counter_control_extern: external control for counters
3900 */
3901int devlink_dpipe_table_register(struct devlink *devlink,
3902 const char *table_name,
3903 struct devlink_dpipe_table_ops *table_ops,
ffd3cdcc 3904 void *priv, bool counter_control_extern)
1555d204
AS		 3905{
3906 struct devlink_dpipe_table *table;
3907
3908 if (devlink_dpipe_table_find(&devlink->dpipe_table_list, table_name))
3909 return -EEXIST;
3910
ffd3cdcc
AS		 3911 if (WARN_ON(!table_ops->size_get))
3912 return -EINVAL;
3913
1555d204
AS		 3914 table = kzalloc(sizeof(*table), GFP_KERNEL);
3915 if (!table)
3916 return -ENOMEM;
3917
3918 table->name = table_name;
3919 table->table_ops = table_ops;
3920 table->priv = priv;
1555d204
AS		 3921 table->counter_control_extern = counter_control_extern;
3922
2406e7e5 3923 mutex_lock(&devlink->lock);
1555d204 3924 list_add_tail_rcu(&table->list, &devlink->dpipe_table_list);
2406e7e5 3925 mutex_unlock(&devlink->lock);
1555d204
AS		 3926 return 0;
3927}
3928EXPORT_SYMBOL_GPL(devlink_dpipe_table_register);
3929
3930/**
3931 * devlink_dpipe_table_unregister - unregister dpipe table
3932 *
3933 * @devlink: devlink
3934 * @table_name: table name
3935 */
3936void devlink_dpipe_table_unregister(struct devlink *devlink,
3937 const char *table_name)
3938{
3939 struct devlink_dpipe_table *table;
3940
2406e7e5 3941 mutex_lock(&devlink->lock);
1555d204
AS		 3942 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
3943 table_name);
3944 if (!table)
3945 goto unlock;
3946 list_del_rcu(&table->list);
2406e7e5 3947 mutex_unlock(&devlink->lock);
1555d204
AS		 3948 kfree_rcu(table, rcu);
3949 return;
3950unlock:
2406e7e5 3951 mutex_unlock(&devlink->lock);
1555d204
AS		 3952}
3953EXPORT_SYMBOL_GPL(devlink_dpipe_table_unregister);
3954
d9f9b9a4
AS		 3955/**
3956 * devlink_resource_register - devlink resource register
3957 *
3958 * @devlink: devlink
3959 * @resource_name: resource's name
3960 * @top_hierarchy: top hierarchy
3961 * @reload_required: reload is required for new configuration to
3962 * apply
3963 * @resource_size: resource's size
3964 * @resource_id: resource's id
3965 * @parent_reosurce_id: resource's parent id
3966 * @size params: size parameters
d9f9b9a4
AS		 3967 */
3968int devlink_resource_register(struct devlink *devlink,
3969 const char *resource_name,
d9f9b9a4
AS		 3970 u64 resource_size,
3971 u64 resource_id,
3972 u64 parent_resource_id,
fc56be47 3973 const struct devlink_resource_size_params *size_params)
d9f9b9a4
AS		 3974{
3975 struct devlink_resource *resource;
3976 struct list_head *resource_list;
14530746 3977 bool top_hierarchy;
d9f9b9a4
AS		 3978 int err = 0;
3979
14530746
DA		 3980 top_hierarchy = parent_resource_id == DEVLINK_RESOURCE_ID_PARENT_TOP;
3981
d9f9b9a4
AS		 3982 mutex_lock(&devlink->lock);
3983 resource = devlink_resource_find(devlink, NULL, resource_id);
3984 if (resource) {
3985 err = -EINVAL;
3986 goto out;
3987 }
3988
3989 resource = kzalloc(sizeof(*resource), GFP_KERNEL);
3990 if (!resource) {
3991 err = -ENOMEM;
3992 goto out;
3993 }
3994
3995 if (top_hierarchy) {
3996 resource_list = &devlink->resource_list;
3997 } else {
3998 struct devlink_resource *parent_resource;
3999
4000 parent_resource = devlink_resource_find(devlink, NULL,
4001 parent_resource_id);
4002 if (parent_resource) {
4003 resource_list = &parent_resource->resource_list;
4004 resource->parent = parent_resource;
4005 } else {
b75703de 4006 kfree(resource);
d9f9b9a4
AS		 4007 err = -EINVAL;
4008 goto out;
4009 }
4010 }
4011
4012 resource->name = resource_name;
4013 resource->size = resource_size;
4014 resource->size_new = resource_size;
4015 resource->id = resource_id;
d9f9b9a4 4016 resource->size_valid = true;
77d27096
JP		 4017 memcpy(&resource->size_params, size_params,
4018 sizeof(resource->size_params));
d9f9b9a4
AS		 4019 INIT_LIST_HEAD(&resource->resource_list);
4020 list_add_tail(&resource->list, resource_list);
4021out:
4022 mutex_unlock(&devlink->lock);
4023 return err;
4024}
4025EXPORT_SYMBOL_GPL(devlink_resource_register);
4026
4027/**
4028 * devlink_resources_unregister - free all resources
4029 *
4030 * @devlink: devlink
4031 * @resource: resource
4032 */
4033void devlink_resources_unregister(struct devlink *devlink,
4034 struct devlink_resource *resource)
4035{
4036 struct devlink_resource *tmp, *child_resource;
4037 struct list_head *resource_list;
4038
4039 if (resource)
4040 resource_list = &resource->resource_list;
4041 else
4042 resource_list = &devlink->resource_list;
4043
4044 if (!resource)
4045 mutex_lock(&devlink->lock);
4046
4047 list_for_each_entry_safe(child_resource, tmp, resource_list, list) {
4048 devlink_resources_unregister(devlink, child_resource);
4049 list_del(&child_resource->list);
4050 kfree(child_resource);
4051 }
4052
4053 if (!resource)
4054 mutex_unlock(&devlink->lock);
4055}
4056EXPORT_SYMBOL_GPL(devlink_resources_unregister);
4057
4058/**
4059 * devlink_resource_size_get - get and update size
4060 *
4061 * @devlink: devlink
4062 * @resource_id: the requested resource id
4063 * @p_resource_size: ptr to update
4064 */
4065int devlink_resource_size_get(struct devlink *devlink,
4066 u64 resource_id,
4067 u64 *p_resource_size)
4068{
4069 struct devlink_resource *resource;
4070 int err = 0;
4071
4072 mutex_lock(&devlink->lock);
4073 resource = devlink_resource_find(devlink, NULL, resource_id);
4074 if (!resource) {
4075 err = -EINVAL;
4076 goto out;
4077 }
4078 *p_resource_size = resource->size_new;
4079 resource->size = resource->size_new;
4080out:
4081 mutex_unlock(&devlink->lock);
4082 return err;
4083}
4084EXPORT_SYMBOL_GPL(devlink_resource_size_get);
4085
56dc7cd0
AS		 4086/**
4087 * devlink_dpipe_table_resource_set - set the resource id
4088 *
4089 * @devlink: devlink
4090 * @table_name: table name
4091 * @resource_id: resource id
4092 * @resource_units: number of resource's units consumed per table's entry
4093 */
4094int devlink_dpipe_table_resource_set(struct devlink *devlink,
4095 const char *table_name, u64 resource_id,
4096 u64 resource_units)
4097{
4098 struct devlink_dpipe_table *table;
4099 int err = 0;
4100
4101 mutex_lock(&devlink->lock);
4102 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
4103 table_name);
4104 if (!table) {
4105 err = -EINVAL;
4106 goto out;
4107 }
4108 table->resource_id = resource_id;
4109 table->resource_units = resource_units;
4110 table->resource_valid = true;
4111out:
4112 mutex_unlock(&devlink->lock);
4113 return err;
4114}
4115EXPORT_SYMBOL_GPL(devlink_dpipe_table_resource_set);
4116
fc56be47
JP		 4117/**
4118 * devlink_resource_occ_get_register - register occupancy getter
4119 *
4120 * @devlink: devlink
4121 * @resource_id: resource id
4122 * @occ_get: occupancy getter callback
4123 * @occ_get_priv: occupancy getter callback priv
4124 */
4125void devlink_resource_occ_get_register(struct devlink *devlink,
4126 u64 resource_id,
4127 devlink_resource_occ_get_t *occ_get,
4128 void *occ_get_priv)
4129{
4130 struct devlink_resource *resource;
4131
4132 mutex_lock(&devlink->lock);
4133 resource = devlink_resource_find(devlink, NULL, resource_id);
4134 if (WARN_ON(!resource))
4135 goto out;
4136 WARN_ON(resource->occ_get);
4137
4138 resource->occ_get = occ_get;
4139 resource->occ_get_priv = occ_get_priv;
4140out:
4141 mutex_unlock(&devlink->lock);
4142}
4143EXPORT_SYMBOL_GPL(devlink_resource_occ_get_register);
4144
4145/**
4146 * devlink_resource_occ_get_unregister - unregister occupancy getter
4147 *
4148 * @devlink: devlink
4149 * @resource_id: resource id
4150 */
4151void devlink_resource_occ_get_unregister(struct devlink *devlink,
4152 u64 resource_id)
4153{
4154 struct devlink_resource *resource;
4155
4156 mutex_lock(&devlink->lock);
4157 resource = devlink_resource_find(devlink, NULL, resource_id);
4158 if (WARN_ON(!resource))
4159 goto out;
4160 WARN_ON(!resource->occ_get);
4161
4162 resource->occ_get = NULL;
4163 resource->occ_get_priv = NULL;
4164out:
4165 mutex_unlock(&devlink->lock);
4166}
4167EXPORT_SYMBOL_GPL(devlink_resource_occ_get_unregister);
4168
eabaef18
MS		 4169/**
4170 * devlink_params_register - register configuration parameters
4171 *
4172 * @devlink: devlink
4173 * @params: configuration parameters array
4174 * @params_count: number of parameters provided
4175 *
4176 * Register the configuration parameters supported by the driver.
4177 */
4178int devlink_params_register(struct devlink *devlink,
4179 const struct devlink_param *params,
4180 size_t params_count)
4181{
4182 const struct devlink_param *param = params;
4183 int i;
4184 int err;
4185
4186 mutex_lock(&devlink->lock);
4187 for (i = 0; i < params_count; i++, param++) {
4188 if (!param || !param->name || !param->supported_cmodes) {
4189 err = -EINVAL;
4190 goto rollback;
4191 }
4192 if (param->generic) {
4193 err = devlink_param_generic_verify(param);
4194 if (err)
4195 goto rollback;
4196 } else {
4197 err = devlink_param_driver_verify(param);
4198 if (err)
4199 goto rollback;
4200 }
4201 err = devlink_param_register_one(devlink, param);
4202 if (err)
4203 goto rollback;
4204 }
4205
4206 mutex_unlock(&devlink->lock);
4207 return 0;
4208
4209rollback:
4210 if (!i)
4211 goto unlock;
4212 for (param--; i > 0; i--, param--)
4213 devlink_param_unregister_one(devlink, param);
4214unlock:
4215 mutex_unlock(&devlink->lock);
4216 return err;
4217}
4218EXPORT_SYMBOL_GPL(devlink_params_register);
4219
4220/**
4221 * devlink_params_unregister - unregister configuration parameters
4222 * @devlink: devlink
4223 * @params: configuration parameters to unregister
4224 * @params_count: number of parameters provided
4225 */
4226void devlink_params_unregister(struct devlink *devlink,
4227 const struct devlink_param *params,
4228 size_t params_count)
4229{
4230 const struct devlink_param *param = params;
4231 int i;
4232
4233 mutex_lock(&devlink->lock);
4234 for (i = 0; i < params_count; i++, param++)
4235 devlink_param_unregister_one(devlink, param);
4236 mutex_unlock(&devlink->lock);
4237}
4238EXPORT_SYMBOL_GPL(devlink_params_unregister);
4239
ec01aeb1
MS		 4240/**
4241 * devlink_param_driverinit_value_get - get configuration parameter
4242 * value for driver initializing
4243 *
4244 * @devlink: devlink
4245 * @param_id: parameter ID
4246 * @init_val: value of parameter in driverinit configuration mode
4247 *
4248 * This function should be used by the driver to get driverinit
4249 * configuration for initialization after reload command.
4250 */
4251int devlink_param_driverinit_value_get(struct devlink *devlink, u32 param_id,
4252 union devlink_param_value *init_val)
4253{
4254 struct devlink_param_item *param_item;
4255
4256 if (!devlink->ops || !devlink->ops->reload)
4257 return -EOPNOTSUPP;
4258
4259 param_item = devlink_param_find_by_id(&devlink->param_list, param_id);
4260 if (!param_item)
4261 return -EINVAL;
4262
4263 if (!param_item->driverinit_value_valid ||
4264 !devlink_param_cmode_is_supported(param_item->param,
4265 DEVLINK_PARAM_CMODE_DRIVERINIT))
4266 return -EOPNOTSUPP;
4267
4268 *init_val = param_item->driverinit_value;
4269
4270 return 0;
4271}
4272EXPORT_SYMBOL_GPL(devlink_param_driverinit_value_get);
4273
4274/**
4275 * devlink_param_driverinit_value_set - set value of configuration
4276 * parameter for driverinit
4277 * configuration mode
4278 *
4279 * @devlink: devlink
4280 * @param_id: parameter ID
4281 * @init_val: value of parameter to set for driverinit configuration mode
4282 *
4283 * This function should be used by the driver to set driverinit
4284 * configuration mode default value.
4285 */
4286int devlink_param_driverinit_value_set(struct devlink *devlink, u32 param_id,
4287 union devlink_param_value init_val)
4288{
4289 struct devlink_param_item *param_item;
4290
4291 param_item = devlink_param_find_by_id(&devlink->param_list, param_id);
4292 if (!param_item)
4293 return -EINVAL;
4294
4295 if (!devlink_param_cmode_is_supported(param_item->param,
4296 DEVLINK_PARAM_CMODE_DRIVERINIT))
4297 return -EOPNOTSUPP;
4298
4299 param_item->driverinit_value = init_val;
4300 param_item->driverinit_value_valid = true;
4301
ea601e17 4302 devlink_param_notify(devlink, param_item, DEVLINK_CMD_PARAM_NEW);
ec01aeb1
MS		 4303 return 0;
4304}
4305EXPORT_SYMBOL_GPL(devlink_param_driverinit_value_set);
4306
ea601e17
MS		 4307/**
4308 * devlink_param_value_changed - notify devlink on a parameter's value
4309 * change. Should be called by the driver
4310 * right after the change.
4311 *
4312 * @devlink: devlink
4313 * @param_id: parameter ID
4314 *
4315 * This function should be used by the driver to notify devlink on value
4316 * change, excluding driverinit configuration mode.
4317 * For driverinit configuration mode driver should use the function
4318 * devlink_param_driverinit_value_set() instead.
4319 */
4320void devlink_param_value_changed(struct devlink *devlink, u32 param_id)
4321{
4322 struct devlink_param_item *param_item;
4323
4324 param_item = devlink_param_find_by_id(&devlink->param_list, param_id);
4325 WARN_ON(!param_item);
4326
4327 devlink_param_notify(devlink, param_item, DEVLINK_CMD_PARAM_NEW);
4328}
4329EXPORT_SYMBOL_GPL(devlink_param_value_changed);
4330
b16ebe92
AV		 4331/**
4332 * devlink_region_create - create a new address region
4333 *
4334 * @devlink: devlink
4335 * @region_name: region name
4336 * @region_max_snapshots: Maximum supported number of snapshots for region
4337 * @region_size: size of region
4338 */
4339struct devlink_region *devlink_region_create(struct devlink *devlink,
4340 const char *region_name,
4341 u32 region_max_snapshots,
4342 u64 region_size)
4343{
4344 struct devlink_region *region;
4345 int err = 0;
4346
4347 mutex_lock(&devlink->lock);
4348
4349 if (devlink_region_get_by_name(devlink, region_name)) {
4350 err = -EEXIST;
4351 goto unlock;
4352 }
4353
4354 region = kzalloc(sizeof(*region), GFP_KERNEL);
4355 if (!region) {
4356 err = -ENOMEM;
4357 goto unlock;
4358 }
4359
4360 region->devlink = devlink;
4361 region->max_snapshots = region_max_snapshots;
4362 region->name = region_name;
4363 region->size = region_size;
4364 INIT_LIST_HEAD(&region->snapshot_list);
4365 list_add_tail(&region->list, &devlink->region_list);
4366
4367 mutex_unlock(&devlink->lock);
4368 return region;
4369
4370unlock:
4371 mutex_unlock(&devlink->lock);
4372 return ERR_PTR(err);
4373}
4374EXPORT_SYMBOL_GPL(devlink_region_create);
4375
4376/**
4377 * devlink_region_destroy - destroy address region
4378 *
4379 * @region: devlink region to destroy
4380 */
4381void devlink_region_destroy(struct devlink_region *region)
4382{
4383 struct devlink *devlink = region->devlink;
d7e52722 4384 struct devlink_snapshot *snapshot, *ts;
b16ebe92
AV		 4385
4386 mutex_lock(&devlink->lock);
d7e52722
AV		 4387
4388 /* Free all snapshots of region */
4389 list_for_each_entry_safe(snapshot, ts, &region->snapshot_list, list)
4390 devlink_region_snapshot_del(snapshot);
4391
b16ebe92
AV		 4392 list_del(&region->list);
4393 mutex_unlock(&devlink->lock);
4394 kfree(region);
4395}
4396EXPORT_SYMBOL_GPL(devlink_region_destroy);
4397
ccadfa44
AV		 4398/**
4399 * devlink_region_shapshot_id_get - get snapshot ID
4400 *
4401 * This callback should be called when adding a new snapshot,
4402 * Driver should use the same id for multiple snapshots taken
4403 * on multiple regions at the same time/by the same trigger.
4404 *
4405 * @devlink: devlink
4406 */
4407u32 devlink_region_shapshot_id_get(struct devlink *devlink)
4408{
4409 u32 id;
4410
4411 mutex_lock(&devlink->lock);
4412 id = ++devlink->snapshot_id;
4413 mutex_unlock(&devlink->lock);
4414
4415 return id;
4416}
4417EXPORT_SYMBOL_GPL(devlink_region_shapshot_id_get);
4418
d7e52722
AV		 4419/**
4420 * devlink_region_snapshot_create - create a new snapshot
4421 * This will add a new snapshot of a region. The snapshot
4422 * will be stored on the region struct and can be accessed
4423 * from devlink. This is useful for future analyses of snapshots.
4424 * Multiple snapshots can be created on a region.
4425 * The @snapshot_id should be obtained using the getter function.
4426 *
4427 * @devlink_region: devlink region of the snapshot
4428 * @data_len: size of snapshot data
4429 * @data: snapshot data
4430 * @snapshot_id: snapshot id to be created
4431 * @data_destructor: pointer to destructor function to free data
4432 */
4433int devlink_region_snapshot_create(struct devlink_region *region, u64 data_len,
4434 u8 *data, u32 snapshot_id,
4435 devlink_snapshot_data_dest_t *data_destructor)
4436{
4437 struct devlink *devlink = region->devlink;
4438 struct devlink_snapshot *snapshot;
4439 int err;
4440
4441 mutex_lock(&devlink->lock);
4442
4443 /* check if region can hold one more snapshot */
4444 if (region->cur_snapshots == region->max_snapshots) {
4445 err = -ENOMEM;
4446 goto unlock;
4447 }
4448
4449 if (devlink_region_snapshot_get_by_id(region, snapshot_id)) {
4450 err = -EEXIST;
4451 goto unlock;
4452 }
4453
4454 snapshot = kzalloc(sizeof(*snapshot), GFP_KERNEL);
4455 if (!snapshot) {
4456 err = -ENOMEM;
4457 goto unlock;
4458 }
4459
4460 snapshot->id = snapshot_id;
4461 snapshot->region = region;
4462 snapshot->data = data;
4463 snapshot->data_len = data_len;
4464 snapshot->data_destructor = data_destructor;
4465
4466 list_add_tail(&snapshot->list, &region->snapshot_list);
4467
4468 region->cur_snapshots++;
4469
4470 mutex_unlock(&devlink->lock);
4471 return 0;
4472
4473unlock:
4474 mutex_unlock(&devlink->lock);
4475 return err;
4476}
4477EXPORT_SYMBOL_GPL(devlink_region_snapshot_create);
4478
bfcd3a46
JP		 4479static int __init devlink_module_init(void)
4480{
489111e5 4481 return genl_register_family(&devlink_nl_family);
bfcd3a46
JP		 4482}
4483
4484static void __exit devlink_module_exit(void)
4485{
4486 genl_unregister_family(&devlink_nl_family);
4487}
4488
4489module_init(devlink_module_init);
4490module_exit(devlink_module_exit);
4491
4492MODULE_LICENSE("GPL v2");
4493MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
4494MODULE_DESCRIPTION("Network physical device Netlink interface");
4495MODULE_ALIAS_GENL_FAMILY(DEVLINK_GENL_NAME);
Linux 6.x block layer and io_uring tree(s)