projects / linux-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
devlink: add device information API
[linux-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]);
db7ff19e 1629 err = ops->eswitch_mode_set(devlink, mode, info->extack);
59bfde01
RD		 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]);
db7ff19e
EB		 1639 err = ops->eswitch_inline_mode_set(devlink, inline_mode,
1640 info->extack);
59bfde01
RD		 1641 if (err)
1642 return err;
1643 }
f43e9b06
RD		 1644
1645 if (info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]) {
1646 if (!ops->eswitch_encap_mode_set)
1647 return -EOPNOTSUPP;
1648 encap_mode = nla_get_u8(info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]);
db7ff19e
EB		 1649 err = ops->eswitch_encap_mode_set(devlink, encap_mode,
1650 info->extack);
f43e9b06
RD		 1651 if (err)
1652 return err;
1653 }
1654
1555d204
AS		 1655 return 0;
1656}
1657
1658int devlink_dpipe_match_put(struct sk_buff *skb,
1659 struct devlink_dpipe_match *match)
1660{
1661 struct devlink_dpipe_header *header = match->header;
1662 struct devlink_dpipe_field *field = &header->fields[match->field_id];
1663 struct nlattr *match_attr;
1664
1665 match_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_MATCH);
1666 if (!match_attr)
1667 return -EMSGSIZE;
1668
1669 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_MATCH_TYPE, match->type) ||
1670 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, match->header_index) ||
1671 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1672 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1673 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1674 goto nla_put_failure;
1675
1676 nla_nest_end(skb, match_attr);
1677 return 0;
1678
1679nla_put_failure:
1680 nla_nest_cancel(skb, match_attr);
1681 return -EMSGSIZE;
1682}
1683EXPORT_SYMBOL_GPL(devlink_dpipe_match_put);
1684
1685static int devlink_dpipe_matches_put(struct devlink_dpipe_table *table,
1686 struct sk_buff *skb)
1687{
1688 struct nlattr *matches_attr;
1689
1690 matches_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_MATCHES);
1691 if (!matches_attr)
1692 return -EMSGSIZE;
1693
1694 if (table->table_ops->matches_dump(table->priv, skb))
1695 goto nla_put_failure;
1696
1697 nla_nest_end(skb, matches_attr);
1698 return 0;
1699
1700nla_put_failure:
1701 nla_nest_cancel(skb, matches_attr);
1702 return -EMSGSIZE;
1703}
1704
1705int devlink_dpipe_action_put(struct sk_buff *skb,
1706 struct devlink_dpipe_action *action)
1707{
1708 struct devlink_dpipe_header *header = action->header;
1709 struct devlink_dpipe_field *field = &header->fields[action->field_id];
1710 struct nlattr *action_attr;
1711
1712 action_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ACTION);
1713 if (!action_attr)
1714 return -EMSGSIZE;
1715
1716 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_ACTION_TYPE, action->type) ||
1717 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, action->header_index) ||
1718 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1719 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1720 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1721 goto nla_put_failure;
1722
1723 nla_nest_end(skb, action_attr);
1724 return 0;
1725
1726nla_put_failure:
1727 nla_nest_cancel(skb, action_attr);
1728 return -EMSGSIZE;
1729}
1730EXPORT_SYMBOL_GPL(devlink_dpipe_action_put);
1731
1732static int devlink_dpipe_actions_put(struct devlink_dpipe_table *table,
1733 struct sk_buff *skb)
1734{
1735 struct nlattr *actions_attr;
1736
1737 actions_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_ACTIONS);
1738 if (!actions_attr)
1739 return -EMSGSIZE;
1740
1741 if (table->table_ops->actions_dump(table->priv, skb))
1742 goto nla_put_failure;
1743
1744 nla_nest_end(skb, actions_attr);
1745 return 0;
1746
1747nla_put_failure:
1748 nla_nest_cancel(skb, actions_attr);
1749 return -EMSGSIZE;
1750}
1751
1752static int devlink_dpipe_table_put(struct sk_buff *skb,
1753 struct devlink_dpipe_table *table)
1754{
1755 struct nlattr *table_attr;
ffd3cdcc 1756 u64 table_size;
1555d204 1757
ffd3cdcc 1758 table_size = table->table_ops->size_get(table->priv);
1555d204
AS		 1759 table_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE);
1760 if (!table_attr)
1761 return -EMSGSIZE;
1762
1763 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_TABLE_NAME, table->name) ||
ffd3cdcc 1764 nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_SIZE, table_size,
1555d204
AS		 1765 DEVLINK_ATTR_PAD))
1766 goto nla_put_failure;
1767 if (nla_put_u8(skb, DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED,
1768 table->counters_enabled))
1769 goto nla_put_failure;
1770
56dc7cd0 1771 if (table->resource_valid) {
3d18e4f1
AS		 1772 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID,
1773 table->resource_id, DEVLINK_ATTR_PAD) ||
1774 nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_UNITS,
1775 table->resource_units, DEVLINK_ATTR_PAD))
1776 goto nla_put_failure;
56dc7cd0 1777 }
1555d204
AS		 1778 if (devlink_dpipe_matches_put(table, skb))
1779 goto nla_put_failure;
1780
1781 if (devlink_dpipe_actions_put(table, skb))
1782 goto nla_put_failure;
1783
1784 nla_nest_end(skb, table_attr);
1785 return 0;
1786
1787nla_put_failure:
1788 nla_nest_cancel(skb, table_attr);
1789 return -EMSGSIZE;
1790}
1791
1792static int devlink_dpipe_send_and_alloc_skb(struct sk_buff **pskb,
1793 struct genl_info *info)
1794{
1795 int err;
1796
1797 if (*pskb) {
1798 err = genlmsg_reply(*pskb, info);
1799 if (err)
1800 return err;
1801 }
1802 *pskb = genlmsg_new(GENLMSG_DEFAULT_SIZE, GFP_KERNEL);
1803 if (!*pskb)
1804 return -ENOMEM;
1805 return 0;
1806}
1807
1808static int devlink_dpipe_tables_fill(struct genl_info *info,
1809 enum devlink_command cmd, int flags,
1810 struct list_head *dpipe_tables,
1811 const char *table_name)
1812{
1813 struct devlink *devlink = info->user_ptr[0];
1814 struct devlink_dpipe_table *table;
1815 struct nlattr *tables_attr;
1816 struct sk_buff *skb = NULL;
1817 struct nlmsghdr *nlh;
1818 bool incomplete;
1819 void *hdr;
1820 int i;
1821 int err;
1822
1823 table = list_first_entry(dpipe_tables,
1824 struct devlink_dpipe_table, list);
1825start_again:
1826 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1827 if (err)
1828 return err;
1829
1830 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
1831 &devlink_nl_family, NLM_F_MULTI, cmd);
6044bd4a
HY		 1832 if (!hdr) {
1833 nlmsg_free(skb);
1555d204 1834 return -EMSGSIZE;
6044bd4a 1835 }
1555d204
AS		 1836
1837 if (devlink_nl_put_handle(skb, devlink))
1838 goto nla_put_failure;
1839 tables_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLES);
1840 if (!tables_attr)
1841 goto nla_put_failure;
1842
1843 i = 0;
1844 incomplete = false;
1845 list_for_each_entry_from(table, dpipe_tables, list) {
1846 if (!table_name) {
1847 err = devlink_dpipe_table_put(skb, table);
1848 if (err) {
1849 if (!i)
1850 goto err_table_put;
1851 incomplete = true;
1852 break;
1853 }
1854 } else {
1855 if (!strcmp(table->name, table_name)) {
1856 err = devlink_dpipe_table_put(skb, table);
1857 if (err)
1858 break;
1859 }
1860 }
1861 i++;
1862 }
1863
1864 nla_nest_end(skb, tables_attr);
1865 genlmsg_end(skb, hdr);
1866 if (incomplete)
1867 goto start_again;
1868
1869send_done:
1870 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
1871 NLMSG_DONE, 0, flags | NLM_F_MULTI);
1872 if (!nlh) {
1873 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1874 if (err)
7fe4d6dc 1875 return err;
1555d204
AS		 1876 goto send_done;
1877 }
1878
1879 return genlmsg_reply(skb, info);
1880
1881nla_put_failure:
1882 err = -EMSGSIZE;
1883err_table_put:
1555d204
AS		 1884 nlmsg_free(skb);
1885 return err;
1886}
1887
1888static int devlink_nl_cmd_dpipe_table_get(struct sk_buff *skb,
1889 struct genl_info *info)
1890{
1891 struct devlink *devlink = info->user_ptr[0];
1892 const char *table_name = NULL;
1893
1894 if (info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
1895 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
1896
1897 return devlink_dpipe_tables_fill(info, DEVLINK_CMD_DPIPE_TABLE_GET, 0,
1898 &devlink->dpipe_table_list,
1899 table_name);
1900}
1901
1902static int devlink_dpipe_value_put(struct sk_buff *skb,
1903 struct devlink_dpipe_value *value)
1904{
1905 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE,
1906 value->value_size, value->value))
1907 return -EMSGSIZE;
1908 if (value->mask)
1909 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE_MASK,
1910 value->value_size, value->mask))
1911 return -EMSGSIZE;
1912 if (value->mapping_valid)
1913 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_VALUE_MAPPING,
1914 value->mapping_value))
1915 return -EMSGSIZE;
1916 return 0;
1917}
1918
1919static int devlink_dpipe_action_value_put(struct sk_buff *skb,
1920 struct devlink_dpipe_value *value)
1921{
1922 if (!value->action)
1923 return -EINVAL;
1924 if (devlink_dpipe_action_put(skb, value->action))
1925 return -EMSGSIZE;
1926 if (devlink_dpipe_value_put(skb, value))
1927 return -EMSGSIZE;
1928 return 0;
1929}
1930
1931static int devlink_dpipe_action_values_put(struct sk_buff *skb,
1932 struct devlink_dpipe_value *values,
1933 unsigned int values_count)
1934{
1935 struct nlattr *action_attr;
1936 int i;
1937 int err;
1938
1939 for (i = 0; i < values_count; i++) {
1940 action_attr = nla_nest_start(skb,
1941 DEVLINK_ATTR_DPIPE_ACTION_VALUE);
1942 if (!action_attr)
1943 return -EMSGSIZE;
1944 err = devlink_dpipe_action_value_put(skb, &values[i]);
1945 if (err)
1946 goto err_action_value_put;
1947 nla_nest_end(skb, action_attr);
1948 }
1949 return 0;
1950
1951err_action_value_put:
1952 nla_nest_cancel(skb, action_attr);
1953 return err;
1954}
1955
1956static int devlink_dpipe_match_value_put(struct sk_buff *skb,
1957 struct devlink_dpipe_value *value)
1958{
1959 if (!value->match)
1960 return -EINVAL;
1961 if (devlink_dpipe_match_put(skb, value->match))
1962 return -EMSGSIZE;
1963 if (devlink_dpipe_value_put(skb, value))
1964 return -EMSGSIZE;
1965 return 0;
1966}
1967
1968static int devlink_dpipe_match_values_put(struct sk_buff *skb,
1969 struct devlink_dpipe_value *values,
1970 unsigned int values_count)
1971{
1972 struct nlattr *match_attr;
1973 int i;
1974 int err;
1975
1976 for (i = 0; i < values_count; i++) {
1977 match_attr = nla_nest_start(skb,
1978 DEVLINK_ATTR_DPIPE_MATCH_VALUE);
1979 if (!match_attr)
1980 return -EMSGSIZE;
1981 err = devlink_dpipe_match_value_put(skb, &values[i]);
1982 if (err)
1983 goto err_match_value_put;
1984 nla_nest_end(skb, match_attr);
1985 }
1986 return 0;
1987
1988err_match_value_put:
1989 nla_nest_cancel(skb, match_attr);
1990 return err;
1991}
1992
1993static int devlink_dpipe_entry_put(struct sk_buff *skb,
1994 struct devlink_dpipe_entry *entry)
1995{
1996 struct nlattr *entry_attr, *matches_attr, *actions_attr;
1997 int err;
1998
1999 entry_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ENTRY);
2000 if (!entry_attr)
2001 return -EMSGSIZE;
2002
2003 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_INDEX, entry->index,
2004 DEVLINK_ATTR_PAD))
2005 goto nla_put_failure;
2006 if (entry->counter_valid)
2007 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_COUNTER,
2008 entry->counter, DEVLINK_ATTR_PAD))
2009 goto nla_put_failure;
2010
2011 matches_attr = nla_nest_start(skb,
2012 DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES);
2013 if (!matches_attr)
2014 goto nla_put_failure;
2015
2016 err = devlink_dpipe_match_values_put(skb, entry->match_values,
2017 entry->match_values_count);
2018 if (err) {
2019 nla_nest_cancel(skb, matches_attr);
2020 goto err_match_values_put;
2021 }
2022 nla_nest_end(skb, matches_attr);
2023
2024 actions_attr = nla_nest_start(skb,
2025 DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES);
2026 if (!actions_attr)
2027 goto nla_put_failure;
2028
2029 err = devlink_dpipe_action_values_put(skb, entry->action_values,
2030 entry->action_values_count);
2031 if (err) {
2032 nla_nest_cancel(skb, actions_attr);
2033 goto err_action_values_put;
2034 }
2035 nla_nest_end(skb, actions_attr);
59bfde01 2036
1555d204 2037 nla_nest_end(skb, entry_attr);
59bfde01 2038 return 0;
1555d204
AS		 2039
2040nla_put_failure:
2041 err = -EMSGSIZE;
2042err_match_values_put:
2043err_action_values_put:
2044 nla_nest_cancel(skb, entry_attr);
2045 return err;
2046}
2047
2048static struct devlink_dpipe_table *
2049devlink_dpipe_table_find(struct list_head *dpipe_tables,
2050 const char *table_name)
2051{
2052 struct devlink_dpipe_table *table;
2053
2054 list_for_each_entry_rcu(table, dpipe_tables, list) {
2055 if (!strcmp(table->name, table_name))
2056 return table;
2057 }
2058 return NULL;
2059}
2060
2061int devlink_dpipe_entry_ctx_prepare(struct devlink_dpipe_dump_ctx *dump_ctx)
2062{
2063 struct devlink *devlink;
2064 int err;
2065
2066 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx->skb,
2067 dump_ctx->info);
2068 if (err)
2069 return err;
2070
2071 dump_ctx->hdr = genlmsg_put(dump_ctx->skb,
2072 dump_ctx->info->snd_portid,
2073 dump_ctx->info->snd_seq,
2074 &devlink_nl_family, NLM_F_MULTI,
2075 dump_ctx->cmd);
2076 if (!dump_ctx->hdr)
2077 goto nla_put_failure;
2078
2079 devlink = dump_ctx->info->user_ptr[0];
2080 if (devlink_nl_put_handle(dump_ctx->skb, devlink))
2081 goto nla_put_failure;
2082 dump_ctx->nest = nla_nest_start(dump_ctx->skb,
2083 DEVLINK_ATTR_DPIPE_ENTRIES);
2084 if (!dump_ctx->nest)
2085 goto nla_put_failure;
2086 return 0;
2087
2088nla_put_failure:
1555d204
AS		 2089 nlmsg_free(dump_ctx->skb);
2090 return -EMSGSIZE;
2091}
2092EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_prepare);
2093
2094int devlink_dpipe_entry_ctx_append(struct devlink_dpipe_dump_ctx *dump_ctx,
2095 struct devlink_dpipe_entry *entry)
2096{
2097 return devlink_dpipe_entry_put(dump_ctx->skb, entry);
2098}
2099EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_append);
2100
2101int devlink_dpipe_entry_ctx_close(struct devlink_dpipe_dump_ctx *dump_ctx)
2102{
2103 nla_nest_end(dump_ctx->skb, dump_ctx->nest);
2104 genlmsg_end(dump_ctx->skb, dump_ctx->hdr);
2105 return 0;
2106}
2107EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_close);
2108
35807324
AS		 2109void devlink_dpipe_entry_clear(struct devlink_dpipe_entry *entry)
2110
2111{
2112 unsigned int value_count, value_index;
2113 struct devlink_dpipe_value *value;
2114
2115 value = entry->action_values;
2116 value_count = entry->action_values_count;
2117 for (value_index = 0; value_index < value_count; value_index++) {
2118 kfree(value[value_index].value);
2119 kfree(value[value_index].mask);
2120 }
2121
2122 value = entry->match_values;
2123 value_count = entry->match_values_count;
2124 for (value_index = 0; value_index < value_count; value_index++) {
2125 kfree(value[value_index].value);
2126 kfree(value[value_index].mask);
2127 }
2128}
2129EXPORT_SYMBOL(devlink_dpipe_entry_clear);
2130
1555d204
AS		 2131static int devlink_dpipe_entries_fill(struct genl_info *info,
2132 enum devlink_command cmd, int flags,
2133 struct devlink_dpipe_table *table)
2134{
2135 struct devlink_dpipe_dump_ctx dump_ctx;
2136 struct nlmsghdr *nlh;
2137 int err;
2138
2139 dump_ctx.skb = NULL;
2140 dump_ctx.cmd = cmd;
2141 dump_ctx.info = info;
2142
2143 err = table->table_ops->entries_dump(table->priv,
2144 table->counters_enabled,
2145 &dump_ctx);
2146 if (err)
7fe4d6dc 2147 return err;
1555d204
AS		 2148
2149send_done:
2150 nlh = nlmsg_put(dump_ctx.skb, info->snd_portid, info->snd_seq,
2151 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2152 if (!nlh) {
2153 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx.skb, info);
2154 if (err)
7fe4d6dc 2155 return err;
1555d204
AS		 2156 goto send_done;
2157 }
2158 return genlmsg_reply(dump_ctx.skb, info);
1555d204
AS		 2159}
2160
2161static int devlink_nl_cmd_dpipe_entries_get(struct sk_buff *skb,
2162 struct genl_info *info)
2163{
2164 struct devlink *devlink = info->user_ptr[0];
2165 struct devlink_dpipe_table *table;
2166 const char *table_name;
2167
2168 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
2169 return -EINVAL;
2170
2171 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2172 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2173 table_name);
2174 if (!table)
2175 return -EINVAL;
2176
2177 if (!table->table_ops->entries_dump)
2178 return -EINVAL;
2179
2180 return devlink_dpipe_entries_fill(info, DEVLINK_CMD_DPIPE_ENTRIES_GET,
2181 0, table);
2182}
2183
2184static int devlink_dpipe_fields_put(struct sk_buff *skb,
2185 const struct devlink_dpipe_header *header)
2186{
2187 struct devlink_dpipe_field *field;
2188 struct nlattr *field_attr;
2189 int i;
2190
2191 for (i = 0; i < header->fields_count; i++) {
2192 field = &header->fields[i];
2193 field_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_FIELD);
2194 if (!field_attr)
2195 return -EMSGSIZE;
2196 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_FIELD_NAME, field->name) ||
2197 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
2198 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH, field->bitwidth) ||
2199 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE, field->mapping_type))
2200 goto nla_put_failure;
2201 nla_nest_end(skb, field_attr);
2202 }
2203 return 0;
2204
2205nla_put_failure:
2206 nla_nest_cancel(skb, field_attr);
2207 return -EMSGSIZE;
2208}
2209
2210static int devlink_dpipe_header_put(struct sk_buff *skb,
2211 struct devlink_dpipe_header *header)
2212{
2213 struct nlattr *fields_attr, *header_attr;
2214 int err;
2215
2216 header_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER);
cb6bf9cf 2217 if (!header_attr)
1555d204
AS		 2218 return -EMSGSIZE;
2219
2220 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_HEADER_NAME, header->name) ||
2221 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
2222 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
2223 goto nla_put_failure;
2224
2225 fields_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER_FIELDS);
2226 if (!fields_attr)
2227 goto nla_put_failure;
2228
2229 err = devlink_dpipe_fields_put(skb, header);
2230 if (err) {
2231 nla_nest_cancel(skb, fields_attr);
2232 goto nla_put_failure;
2233 }
2234 nla_nest_end(skb, fields_attr);
2235 nla_nest_end(skb, header_attr);
2236 return 0;
2237
2238nla_put_failure:
2239 err = -EMSGSIZE;
2240 nla_nest_cancel(skb, header_attr);
2241 return err;
2242}
2243
2244static int devlink_dpipe_headers_fill(struct genl_info *info,
2245 enum devlink_command cmd, int flags,
2246 struct devlink_dpipe_headers *
2247 dpipe_headers)
2248{
2249 struct devlink *devlink = info->user_ptr[0];
2250 struct nlattr *headers_attr;
2251 struct sk_buff *skb = NULL;
2252 struct nlmsghdr *nlh;
2253 void *hdr;
2254 int i, j;
2255 int err;
2256
2257 i = 0;
2258start_again:
2259 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2260 if (err)
2261 return err;
2262
2263 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
2264 &devlink_nl_family, NLM_F_MULTI, cmd);
6044bd4a
HY		 2265 if (!hdr) {
2266 nlmsg_free(skb);
1555d204 2267 return -EMSGSIZE;
6044bd4a 2268 }
1555d204
AS		 2269
2270 if (devlink_nl_put_handle(skb, devlink))
2271 goto nla_put_failure;
2272 headers_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADERS);
2273 if (!headers_attr)
2274 goto nla_put_failure;
2275
2276 j = 0;
2277 for (; i < dpipe_headers->headers_count; i++) {
2278 err = devlink_dpipe_header_put(skb, dpipe_headers->headers[i]);
2279 if (err) {
2280 if (!j)
2281 goto err_table_put;
2282 break;
2283 }
2284 j++;
2285 }
2286 nla_nest_end(skb, headers_attr);
2287 genlmsg_end(skb, hdr);
2288 if (i != dpipe_headers->headers_count)
2289 goto start_again;
2290
2291send_done:
2292 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
2293 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2294 if (!nlh) {
2295 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2296 if (err)
7fe4d6dc 2297 return err;
1555d204
AS		 2298 goto send_done;
2299 }
2300 return genlmsg_reply(skb, info);
2301
2302nla_put_failure:
2303 err = -EMSGSIZE;
2304err_table_put:
1555d204
AS		 2305 nlmsg_free(skb);
2306 return err;
2307}
2308
2309static int devlink_nl_cmd_dpipe_headers_get(struct sk_buff *skb,
2310 struct genl_info *info)
2311{
2312 struct devlink *devlink = info->user_ptr[0];
2313
2314 if (!devlink->dpipe_headers)
2315 return -EOPNOTSUPP;
2316 return devlink_dpipe_headers_fill(info, DEVLINK_CMD_DPIPE_HEADERS_GET,
2317 0, devlink->dpipe_headers);
2318}
2319
2320static int devlink_dpipe_table_counters_set(struct devlink *devlink,
2321 const char *table_name,
2322 bool enable)
2323{
2324 struct devlink_dpipe_table *table;
2325
2326 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2327 table_name);
2328 if (!table)
2329 return -EINVAL;
2330
2331 if (table->counter_control_extern)
2332 return -EOPNOTSUPP;
2333
2334 if (!(table->counters_enabled ^ enable))
2335 return 0;
2336
2337 table->counters_enabled = enable;
2338 if (table->table_ops->counters_set_update)
2339 table->table_ops->counters_set_update(table->priv, enable);
2340 return 0;
2341}
2342
2343static int devlink_nl_cmd_dpipe_table_counters_set(struct sk_buff *skb,
2344 struct genl_info *info)
2345{
2346 struct devlink *devlink = info->user_ptr[0];
2347 const char *table_name;
2348 bool counters_enable;
2349
2350 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME] ||
2351 !info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED])
2352 return -EINVAL;
2353
2354 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2355 counters_enable = !!nla_get_u8(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]);
2356
2357 return devlink_dpipe_table_counters_set(devlink, table_name,
2358 counters_enable);
08f4b591
OG		 2359}
2360
43dd7512 2361static struct devlink_resource *
d9f9b9a4
AS		 2362devlink_resource_find(struct devlink *devlink,
2363 struct devlink_resource *resource, u64 resource_id)
2364{
2365 struct list_head *resource_list;
2366
2367 if (resource)
2368 resource_list = &resource->resource_list;
2369 else
2370 resource_list = &devlink->resource_list;
2371
2372 list_for_each_entry(resource, resource_list, list) {
2373 struct devlink_resource *child_resource;
2374
2375 if (resource->id == resource_id)
2376 return resource;
2377
2378 child_resource = devlink_resource_find(devlink, resource,
2379 resource_id);
2380 if (child_resource)
2381 return child_resource;
2382 }
2383 return NULL;
2384}
2385
43dd7512
WY		 2386static void
2387devlink_resource_validate_children(struct devlink_resource *resource)
d9f9b9a4
AS		 2388{
2389 struct devlink_resource *child_resource;
2390 bool size_valid = true;
2391 u64 parts_size = 0;
2392
2393 if (list_empty(&resource->resource_list))
2394 goto out;
2395
2396 list_for_each_entry(child_resource, &resource->resource_list, list)
2397 parts_size += child_resource->size_new;
2398
b9d17175 2399 if (parts_size > resource->size_new)
d9f9b9a4
AS		 2400 size_valid = false;
2401out:
2402 resource->size_valid = size_valid;
2403}
2404
cc944ead
AS		 2405static int
2406devlink_resource_validate_size(struct devlink_resource *resource, u64 size,
2407 struct netlink_ext_ack *extack)
2408{
2409 u64 reminder;
2410 int err = 0;
2411
0f3e9c97 2412 if (size > resource->size_params.size_max) {
cc944ead
AS		 2413 NL_SET_ERR_MSG_MOD(extack, "Size larger than maximum");
2414 err = -EINVAL;
2415 }
2416
0f3e9c97 2417 if (size < resource->size_params.size_min) {
cc944ead
AS		 2418 NL_SET_ERR_MSG_MOD(extack, "Size smaller than minimum");
2419 err = -EINVAL;
2420 }
2421
0f3e9c97 2422 div64_u64_rem(size, resource->size_params.size_granularity, &reminder);
cc944ead
AS		 2423 if (reminder) {
2424 NL_SET_ERR_MSG_MOD(extack, "Wrong granularity");
2425 err = -EINVAL;
2426 }
2427
2428 return err;
2429}
2430
d9f9b9a4
AS		 2431static int devlink_nl_cmd_resource_set(struct sk_buff *skb,
2432 struct genl_info *info)
2433{
2434 struct devlink *devlink = info->user_ptr[0];
2435 struct devlink_resource *resource;
2436 u64 resource_id;
2437 u64 size;
2438 int err;
2439
2440 if (!info->attrs[DEVLINK_ATTR_RESOURCE_ID] ||
2441 !info->attrs[DEVLINK_ATTR_RESOURCE_SIZE])
2442 return -EINVAL;
2443 resource_id = nla_get_u64(info->attrs[DEVLINK_ATTR_RESOURCE_ID]);
2444
2445 resource = devlink_resource_find(devlink, NULL, resource_id);
2446 if (!resource)
2447 return -EINVAL;
2448
d9f9b9a4 2449 size = nla_get_u64(info->attrs[DEVLINK_ATTR_RESOURCE_SIZE]);
cc944ead 2450 err = devlink_resource_validate_size(resource, size, info->extack);
d9f9b9a4
AS		 2451 if (err)
2452 return err;
2453
2454 resource->size_new = size;
2455 devlink_resource_validate_children(resource);
2456 if (resource->parent)
2457 devlink_resource_validate_children(resource->parent);
2458 return 0;
2459}
2460
3d18e4f1 2461static int
d9f9b9a4
AS		 2462devlink_resource_size_params_put(struct devlink_resource *resource,
2463 struct sk_buff *skb)
2464{
2465 struct devlink_resource_size_params *size_params;
2466
77d27096 2467 size_params = &resource->size_params;
3d18e4f1
AS		 2468 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_GRAN,
2469 size_params->size_granularity, DEVLINK_ATTR_PAD) ||
2470 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_MAX,
2471 size_params->size_max, DEVLINK_ATTR_PAD) ||
2472 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_MIN,
2473 size_params->size_min, DEVLINK_ATTR_PAD) ||
2474 nla_put_u8(skb, DEVLINK_ATTR_RESOURCE_UNIT, size_params->unit))
2475 return -EMSGSIZE;
2476 return 0;
d9f9b9a4
AS		 2477}
2478
fc56be47
JP		 2479static int devlink_resource_occ_put(struct devlink_resource *resource,
2480 struct sk_buff *skb)
2481{
2482 if (!resource->occ_get)
2483 return 0;
2484 return nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_OCC,
2485 resource->occ_get(resource->occ_get_priv),
2486 DEVLINK_ATTR_PAD);
2487}
2488
d9f9b9a4
AS		 2489static int devlink_resource_put(struct devlink *devlink, struct sk_buff *skb,
2490 struct devlink_resource *resource)
2491{
2492 struct devlink_resource *child_resource;
2493 struct nlattr *child_resource_attr;
2494 struct nlattr *resource_attr;
2495
2496 resource_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE);
2497 if (!resource_attr)
2498 return -EMSGSIZE;
2499
2500 if (nla_put_string(skb, DEVLINK_ATTR_RESOURCE_NAME, resource->name) ||
2501 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE, resource->size,
2502 DEVLINK_ATTR_PAD) ||
2503 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_ID, resource->id,
2504 DEVLINK_ATTR_PAD))
2505 goto nla_put_failure;
2506 if (resource->size != resource->size_new)
2507 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_NEW,
2508 resource->size_new, DEVLINK_ATTR_PAD);
fc56be47
JP		 2509 if (devlink_resource_occ_put(resource, skb))
2510 goto nla_put_failure;
3d18e4f1
AS		 2511 if (devlink_resource_size_params_put(resource, skb))
2512 goto nla_put_failure;
d9f9b9a4
AS		 2513 if (list_empty(&resource->resource_list))
2514 goto out;
2515
2516 if (nla_put_u8(skb, DEVLINK_ATTR_RESOURCE_SIZE_VALID,
2517 resource->size_valid))
2518 goto nla_put_failure;
2519
2520 child_resource_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE_LIST);
2521 if (!child_resource_attr)
2522 goto nla_put_failure;
2523
2524 list_for_each_entry(child_resource, &resource->resource_list, list) {
2525 if (devlink_resource_put(devlink, skb, child_resource))
2526 goto resource_put_failure;
2527 }
2528
2529 nla_nest_end(skb, child_resource_attr);
2530out:
2531 nla_nest_end(skb, resource_attr);
2532 return 0;
2533
2534resource_put_failure:
2535 nla_nest_cancel(skb, child_resource_attr);
2536nla_put_failure:
2537 nla_nest_cancel(skb, resource_attr);
2538 return -EMSGSIZE;
2539}
2540
2541static int devlink_resource_fill(struct genl_info *info,
2542 enum devlink_command cmd, int flags)
2543{
2544 struct devlink *devlink = info->user_ptr[0];
2545 struct devlink_resource *resource;
2546 struct nlattr *resources_attr;
2547 struct sk_buff *skb = NULL;
2548 struct nlmsghdr *nlh;
2549 bool incomplete;
2550 void *hdr;
2551 int i;
2552 int err;
2553
2554 resource = list_first_entry(&devlink->resource_list,
2555 struct devlink_resource, list);
2556start_again:
2557 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2558 if (err)
2559 return err;
2560
2561 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
2562 &devlink_nl_family, NLM_F_MULTI, cmd);
2563 if (!hdr) {
2564 nlmsg_free(skb);
2565 return -EMSGSIZE;
2566 }
2567
2568 if (devlink_nl_put_handle(skb, devlink))
2569 goto nla_put_failure;
2570
2571 resources_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE_LIST);
2572 if (!resources_attr)
2573 goto nla_put_failure;
2574
2575 incomplete = false;
2576 i = 0;
2577 list_for_each_entry_from(resource, &devlink->resource_list, list) {
2578 err = devlink_resource_put(devlink, skb, resource);
2579 if (err) {
2580 if (!i)
2581 goto err_resource_put;
2582 incomplete = true;
2583 break;
2584 }
2585 i++;
2586 }
2587 nla_nest_end(skb, resources_attr);
2588 genlmsg_end(skb, hdr);
2589 if (incomplete)
2590 goto start_again;
2591send_done:
2592 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
2593 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2594 if (!nlh) {
2595 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2596 if (err)
83fe9a96 2597 return err;
d9f9b9a4
AS		 2598 goto send_done;
2599 }
2600 return genlmsg_reply(skb, info);
2601
2602nla_put_failure:
2603 err = -EMSGSIZE;
2604err_resource_put:
d9f9b9a4
AS		 2605 nlmsg_free(skb);
2606 return err;
2607}
2608
2609static int devlink_nl_cmd_resource_dump(struct sk_buff *skb,
2610 struct genl_info *info)
2611{
2612 struct devlink *devlink = info->user_ptr[0];
2613
2614 if (list_empty(&devlink->resource_list))
2615 return -EOPNOTSUPP;
2616
2617 return devlink_resource_fill(info, DEVLINK_CMD_RESOURCE_DUMP, 0);
2618}
2619
2d8dc5bb
AS		 2620static int
2621devlink_resources_validate(struct devlink *devlink,
2622 struct devlink_resource *resource,
2623 struct genl_info *info)
2624{
2625 struct list_head *resource_list;
2626 int err = 0;
2627
2628 if (resource)
2629 resource_list = &resource->resource_list;
2630 else
2631 resource_list = &devlink->resource_list;
2632
2633 list_for_each_entry(resource, resource_list, list) {
2634 if (!resource->size_valid)
2635 return -EINVAL;
2636 err = devlink_resources_validate(devlink, resource, info);
2637 if (err)
2638 return err;
2639 }
2640 return err;
2641}
2642
2643static int devlink_nl_cmd_reload(struct sk_buff *skb, struct genl_info *info)
2644{
2645 struct devlink *devlink = info->user_ptr[0];
2646 int err;
2647
2648 if (!devlink->ops->reload)
2649 return -EOPNOTSUPP;
2650
2651 err = devlink_resources_validate(devlink, NULL, info);
2652 if (err) {
2653 NL_SET_ERR_MSG_MOD(info->extack, "resources size validation failed");
2654 return err;
2655 }
ac0fc8a1 2656 return devlink->ops->reload(devlink, info->extack);
2d8dc5bb
AS		 2657}
2658
036467c3
MS		 2659static const struct devlink_param devlink_param_generic[] = {
2660 {
2661 .id = DEVLINK_PARAM_GENERIC_ID_INT_ERR_RESET,
2662 .name = DEVLINK_PARAM_GENERIC_INT_ERR_RESET_NAME,
2663 .type = DEVLINK_PARAM_GENERIC_INT_ERR_RESET_TYPE,
2664 },
2665 {
2666 .id = DEVLINK_PARAM_GENERIC_ID_MAX_MACS,
2667 .name = DEVLINK_PARAM_GENERIC_MAX_MACS_NAME,
2668 .type = DEVLINK_PARAM_GENERIC_MAX_MACS_TYPE,
2669 },
f567bcda
VV		 2670 {
2671 .id = DEVLINK_PARAM_GENERIC_ID_ENABLE_SRIOV,
2672 .name = DEVLINK_PARAM_GENERIC_ENABLE_SRIOV_NAME,
2673 .type = DEVLINK_PARAM_GENERIC_ENABLE_SRIOV_TYPE,
2674 },
f6a69885
AV		 2675 {
2676 .id = DEVLINK_PARAM_GENERIC_ID_REGION_SNAPSHOT,
2677 .name = DEVLINK_PARAM_GENERIC_REGION_SNAPSHOT_NAME,
2678 .type = DEVLINK_PARAM_GENERIC_REGION_SNAPSHOT_TYPE,
2679 },
e3b51061
VV		 2680 {
2681 .id = DEVLINK_PARAM_GENERIC_ID_IGNORE_ARI,
2682 .name = DEVLINK_PARAM_GENERIC_IGNORE_ARI_NAME,
2683 .type = DEVLINK_PARAM_GENERIC_IGNORE_ARI_TYPE,
2684 },
f61cba42
VV		 2685 {
2686 .id = DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MAX,
2687 .name = DEVLINK_PARAM_GENERIC_MSIX_VEC_PER_PF_MAX_NAME,
2688 .type = DEVLINK_PARAM_GENERIC_MSIX_VEC_PER_PF_MAX_TYPE,
2689 },
16511789
VV		 2690 {
2691 .id = DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MIN,
2692 .name = DEVLINK_PARAM_GENERIC_MSIX_VEC_PER_PF_MIN_NAME,
2693 .type = DEVLINK_PARAM_GENERIC_MSIX_VEC_PER_PF_MIN_TYPE,
2694 },
846e980a
ST		 2695 {
2696 .id = DEVLINK_PARAM_GENERIC_ID_FW_LOAD_POLICY,
2697 .name = DEVLINK_PARAM_GENERIC_FW_LOAD_POLICY_NAME,
2698 .type = DEVLINK_PARAM_GENERIC_FW_LOAD_POLICY_TYPE,
2699 },
b639583f
VV		 2700 {
2701 .id = DEVLINK_PARAM_GENERIC_ID_WOL,
2702 .name = DEVLINK_PARAM_GENERIC_WOL_NAME,
2703 .type = DEVLINK_PARAM_GENERIC_WOL_TYPE,
2704 },
036467c3 2705};
eabaef18
MS		 2706
2707static int devlink_param_generic_verify(const struct devlink_param *param)
2708{
2709 /* verify it match generic parameter by id and name */
2710 if (param->id > DEVLINK_PARAM_GENERIC_ID_MAX)
2711 return -EINVAL;
2712 if (strcmp(param->name, devlink_param_generic[param->id].name))
2713 return -ENOENT;
2714
2715 WARN_ON(param->type != devlink_param_generic[param->id].type);
2716
2717 return 0;
2718}
2719
2720static int devlink_param_driver_verify(const struct devlink_param *param)
2721{
2722 int i;
2723
2724 if (param->id <= DEVLINK_PARAM_GENERIC_ID_MAX)
2725 return -EINVAL;
2726 /* verify no such name in generic params */
2727 for (i = 0; i <= DEVLINK_PARAM_GENERIC_ID_MAX; i++)
2728 if (!strcmp(param->name, devlink_param_generic[i].name))
2729 return -EEXIST;
2730
2731 return 0;
2732}
2733
2734static struct devlink_param_item *
2735devlink_param_find_by_name(struct list_head *param_list,
2736 const char *param_name)
2737{
2738 struct devlink_param_item *param_item;
2739
2740 list_for_each_entry(param_item, param_list, list)
2741 if (!strcmp(param_item->param->name, param_name))
2742 return param_item;
2743 return NULL;
2744}
2745
ec01aeb1
MS		 2746static struct devlink_param_item *
2747devlink_param_find_by_id(struct list_head *param_list, u32 param_id)
2748{
2749 struct devlink_param_item *param_item;
2750
2751 list_for_each_entry(param_item, param_list, list)
2752 if (param_item->param->id == param_id)
2753 return param_item;
2754 return NULL;
2755}
2756
45f05def
MS		 2757static bool
2758devlink_param_cmode_is_supported(const struct devlink_param *param,
2759 enum devlink_param_cmode cmode)
2760{
2761 return test_bit(cmode, &param->supported_cmodes);
2762}
2763
2764static int devlink_param_get(struct devlink *devlink,
2765 const struct devlink_param *param,
2766 struct devlink_param_gset_ctx *ctx)
2767{
2768 if (!param->get)
2769 return -EOPNOTSUPP;
2770 return param->get(devlink, param->id, ctx);
2771}
2772
e3b7ca18
MS		 2773static int devlink_param_set(struct devlink *devlink,
2774 const struct devlink_param *param,
2775 struct devlink_param_gset_ctx *ctx)
2776{
2777 if (!param->set)
2778 return -EOPNOTSUPP;
2779 return param->set(devlink, param->id, ctx);
2780}
2781
45f05def
MS		 2782static int
2783devlink_param_type_to_nla_type(enum devlink_param_type param_type)
2784{
2785 switch (param_type) {
2786 case DEVLINK_PARAM_TYPE_U8:
2787 return NLA_U8;
2788 case DEVLINK_PARAM_TYPE_U16:
2789 return NLA_U16;
2790 case DEVLINK_PARAM_TYPE_U32:
2791 return NLA_U32;
2792 case DEVLINK_PARAM_TYPE_STRING:
2793 return NLA_STRING;
2794 case DEVLINK_PARAM_TYPE_BOOL:
2795 return NLA_FLAG;
2796 default:
2797 return -EINVAL;
2798 }
2799}
2800
2801static int
2802devlink_nl_param_value_fill_one(struct sk_buff *msg,
2803 enum devlink_param_type type,
2804 enum devlink_param_cmode cmode,
2805 union devlink_param_value val)
2806{
2807 struct nlattr *param_value_attr;
2808
2809 param_value_attr = nla_nest_start(msg, DEVLINK_ATTR_PARAM_VALUE);
2810 if (!param_value_attr)
2811 goto nla_put_failure;
2812
2813 if (nla_put_u8(msg, DEVLINK_ATTR_PARAM_VALUE_CMODE, cmode))
2814 goto value_nest_cancel;
2815
2816 switch (type) {
2817 case DEVLINK_PARAM_TYPE_U8:
2818 if (nla_put_u8(msg, DEVLINK_ATTR_PARAM_VALUE_DATA, val.vu8))
2819 goto value_nest_cancel;
2820 break;
2821 case DEVLINK_PARAM_TYPE_U16:
2822 if (nla_put_u16(msg, DEVLINK_ATTR_PARAM_VALUE_DATA, val.vu16))
2823 goto value_nest_cancel;
2824 break;
2825 case DEVLINK_PARAM_TYPE_U32:
2826 if (nla_put_u32(msg, DEVLINK_ATTR_PARAM_VALUE_DATA, val.vu32))
2827 goto value_nest_cancel;
2828 break;
2829 case DEVLINK_PARAM_TYPE_STRING:
2830 if (nla_put_string(msg, DEVLINK_ATTR_PARAM_VALUE_DATA,
2831 val.vstr))
2832 goto value_nest_cancel;
2833 break;
2834 case DEVLINK_PARAM_TYPE_BOOL:
2835 if (val.vbool &&
2836 nla_put_flag(msg, DEVLINK_ATTR_PARAM_VALUE_DATA))
2837 goto value_nest_cancel;
2838 break;
2839 }
2840
2841 nla_nest_end(msg, param_value_attr);
2842 return 0;
2843
2844value_nest_cancel:
2845 nla_nest_cancel(msg, param_value_attr);
2846nla_put_failure:
2847 return -EMSGSIZE;
2848}
2849
2850static int devlink_nl_param_fill(struct sk_buff *msg, struct devlink *devlink,
f4601dee 2851 unsigned int port_index,
45f05def
MS		 2852 struct devlink_param_item *param_item,
2853 enum devlink_command cmd,
2854 u32 portid, u32 seq, int flags)
2855{
2856 union devlink_param_value param_value[DEVLINK_PARAM_CMODE_MAX + 1];
2857 const struct devlink_param *param = param_item->param;
2858 struct devlink_param_gset_ctx ctx;
2859 struct nlattr *param_values_list;
2860 struct nlattr *param_attr;
2861 int nla_type;
2862 void *hdr;
2863 int err;
2864 int i;
2865
2866 /* Get value from driver part to driverinit configuration mode */
2867 for (i = 0; i <= DEVLINK_PARAM_CMODE_MAX; i++) {
2868 if (!devlink_param_cmode_is_supported(param, i))
2869 continue;
2870 if (i == DEVLINK_PARAM_CMODE_DRIVERINIT) {
2871 if (!param_item->driverinit_value_valid)
2872 return -EOPNOTSUPP;
2873 param_value[i] = param_item->driverinit_value;
2874 } else {
2875 ctx.cmode = i;
2876 err = devlink_param_get(devlink, param, &ctx);
2877 if (err)
2878 return err;
2879 param_value[i] = ctx.val;
2880 }
2881 }
2882
2883 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
2884 if (!hdr)
2885 return -EMSGSIZE;
2886
2887 if (devlink_nl_put_handle(msg, devlink))
2888 goto genlmsg_cancel;
f4601dee 2889
c1e5786d
VV		 2890 if (cmd == DEVLINK_CMD_PORT_PARAM_GET ||
2891 cmd == DEVLINK_CMD_PORT_PARAM_NEW ||
2892 cmd == DEVLINK_CMD_PORT_PARAM_DEL)
f4601dee
VV		 2893 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, port_index))
2894 goto genlmsg_cancel;
2895
45f05def
MS		 2896 param_attr = nla_nest_start(msg, DEVLINK_ATTR_PARAM);
2897 if (!param_attr)
2898 goto genlmsg_cancel;
2899 if (nla_put_string(msg, DEVLINK_ATTR_PARAM_NAME, param->name))
2900 goto param_nest_cancel;
2901 if (param->generic && nla_put_flag(msg, DEVLINK_ATTR_PARAM_GENERIC))
2902 goto param_nest_cancel;
2903
2904 nla_type = devlink_param_type_to_nla_type(param->type);
2905 if (nla_type < 0)
2906 goto param_nest_cancel;
2907 if (nla_put_u8(msg, DEVLINK_ATTR_PARAM_TYPE, nla_type))
2908 goto param_nest_cancel;
2909
2910 param_values_list = nla_nest_start(msg, DEVLINK_ATTR_PARAM_VALUES_LIST);
2911 if (!param_values_list)
2912 goto param_nest_cancel;
2913
2914 for (i = 0; i <= DEVLINK_PARAM_CMODE_MAX; i++) {
2915 if (!devlink_param_cmode_is_supported(param, i))
2916 continue;
2917 err = devlink_nl_param_value_fill_one(msg, param->type,
2918 i, param_value[i]);
2919 if (err)
2920 goto values_list_nest_cancel;
2921 }
2922
2923 nla_nest_end(msg, param_values_list);
2924 nla_nest_end(msg, param_attr);
2925 genlmsg_end(msg, hdr);
2926 return 0;
2927
2928values_list_nest_cancel:
2929 nla_nest_end(msg, param_values_list);
2930param_nest_cancel:
2931 nla_nest_cancel(msg, param_attr);
2932genlmsg_cancel:
2933 genlmsg_cancel(msg, hdr);
2934 return -EMSGSIZE;
2935}
2936
ea601e17 2937static void devlink_param_notify(struct devlink *devlink,
c1e5786d 2938 unsigned int port_index,
ea601e17
MS		 2939 struct devlink_param_item *param_item,
2940 enum devlink_command cmd)
2941{
2942 struct sk_buff *msg;
2943 int err;
2944
c1e5786d
VV		 2945 WARN_ON(cmd != DEVLINK_CMD_PARAM_NEW && cmd != DEVLINK_CMD_PARAM_DEL &&
2946 cmd != DEVLINK_CMD_PORT_PARAM_NEW &&
2947 cmd != DEVLINK_CMD_PORT_PARAM_DEL);
ea601e17
MS		 2948
2949 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2950 if (!msg)
2951 return;
c1e5786d
VV		 2952 err = devlink_nl_param_fill(msg, devlink, port_index, param_item, cmd,
2953 0, 0, 0);
ea601e17
MS		 2954 if (err) {
2955 nlmsg_free(msg);
2956 return;
2957 }
2958
2959 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
2960 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
2961}
2962
45f05def
MS		 2963static int devlink_nl_cmd_param_get_dumpit(struct sk_buff *msg,
2964 struct netlink_callback *cb)
2965{
2966 struct devlink_param_item *param_item;
2967 struct devlink *devlink;
2968 int start = cb->args[0];
2969 int idx = 0;
2970 int err;
2971
2972 mutex_lock(&devlink_mutex);
2973 list_for_each_entry(devlink, &devlink_list, list) {
2974 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
2975 continue;
2976 mutex_lock(&devlink->lock);
2977 list_for_each_entry(param_item, &devlink->param_list, list) {
2978 if (idx < start) {
2979 idx++;
2980 continue;
2981 }
f4601dee 2982 err = devlink_nl_param_fill(msg, devlink, 0, param_item,
45f05def
MS		 2983 DEVLINK_CMD_PARAM_GET,
2984 NETLINK_CB(cb->skb).portid,
2985 cb->nlh->nlmsg_seq,
2986 NLM_F_MULTI);
2987 if (err) {
2988 mutex_unlock(&devlink->lock);
2989 goto out;
2990 }
2991 idx++;
2992 }
2993 mutex_unlock(&devlink->lock);
2994 }
2995out:
2996 mutex_unlock(&devlink_mutex);
2997
2998 cb->args[0] = idx;
2999 return msg->len;
3000}
3001
e3b7ca18
MS		 3002static int
3003devlink_param_type_get_from_info(struct genl_info *info,
3004 enum devlink_param_type *param_type)
3005{
3006 if (!info->attrs[DEVLINK_ATTR_PARAM_TYPE])
3007 return -EINVAL;
3008
3009 switch (nla_get_u8(info->attrs[DEVLINK_ATTR_PARAM_TYPE])) {
3010 case NLA_U8:
3011 *param_type = DEVLINK_PARAM_TYPE_U8;
3012 break;
3013 case NLA_U16:
3014 *param_type = DEVLINK_PARAM_TYPE_U16;
3015 break;
3016 case NLA_U32:
3017 *param_type = DEVLINK_PARAM_TYPE_U32;
3018 break;
3019 case NLA_STRING:
3020 *param_type = DEVLINK_PARAM_TYPE_STRING;
3021 break;
3022 case NLA_FLAG:
3023 *param_type = DEVLINK_PARAM_TYPE_BOOL;
3024 break;
3025 default:
3026 return -EINVAL;
3027 }
3028
3029 return 0;
3030}
3031
3032static int
3033devlink_param_value_get_from_info(const struct devlink_param *param,
3034 struct genl_info *info,
3035 union devlink_param_value *value)
3036{
f355cfcd
MS		 3037 int len;
3038
e3b7ca18
MS		 3039 if (param->type != DEVLINK_PARAM_TYPE_BOOL &&
3040 !info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA])
3041 return -EINVAL;
3042
3043 switch (param->type) {
3044 case DEVLINK_PARAM_TYPE_U8:
3045 value->vu8 = nla_get_u8(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]);
3046 break;
3047 case DEVLINK_PARAM_TYPE_U16:
3048 value->vu16 = nla_get_u16(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]);
3049 break;
3050 case DEVLINK_PARAM_TYPE_U32:
3051 value->vu32 = nla_get_u32(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]);
3052 break;
3053 case DEVLINK_PARAM_TYPE_STRING:
f355cfcd
MS		 3054 len = strnlen(nla_data(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]),
3055 nla_len(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]));
3056 if (len == nla_len(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]) ||
bde74ad1 3057 len >= __DEVLINK_PARAM_MAX_STRING_VALUE)
e3b7ca18 3058 return -EINVAL;
f355cfcd
MS		 3059 strcpy(value->vstr,
3060 nla_data(info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA]));
e3b7ca18
MS		 3061 break;
3062 case DEVLINK_PARAM_TYPE_BOOL:
3063 value->vbool = info->attrs[DEVLINK_ATTR_PARAM_VALUE_DATA] ?
3064 true : false;
3065 break;
3066 }
3067 return 0;
3068}
3069
45f05def 3070static struct devlink_param_item *
f4601dee 3071devlink_param_get_from_info(struct list_head *param_list,
45f05def
MS		 3072 struct genl_info *info)
3073{
3074 char *param_name;
3075
3076 if (!info->attrs[DEVLINK_ATTR_PARAM_NAME])
3077 return NULL;
3078
3079 param_name = nla_data(info->attrs[DEVLINK_ATTR_PARAM_NAME]);
f4601dee 3080 return devlink_param_find_by_name(param_list, param_name);
45f05def
MS		 3081}
3082
3083static int devlink_nl_cmd_param_get_doit(struct sk_buff *skb,
3084 struct genl_info *info)
3085{
3086 struct devlink *devlink = info->user_ptr[0];
3087 struct devlink_param_item *param_item;
3088 struct sk_buff *msg;
3089 int err;
3090
f4601dee 3091 param_item = devlink_param_get_from_info(&devlink->param_list, info);
45f05def
MS		 3092 if (!param_item)
3093 return -EINVAL;
3094
3095 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3096 if (!msg)
3097 return -ENOMEM;
3098
f4601dee 3099 err = devlink_nl_param_fill(msg, devlink, 0, param_item,
45f05def
MS		 3100 DEVLINK_CMD_PARAM_GET,
3101 info->snd_portid, info->snd_seq, 0);
3102 if (err) {
3103 nlmsg_free(msg);
3104 return err;
3105 }
3106
3107 return genlmsg_reply(msg, info);
3108}
3109
9c54873b 3110static int __devlink_nl_cmd_param_set_doit(struct devlink *devlink,
c1e5786d 3111 unsigned int port_index,
9c54873b
VV		 3112 struct list_head *param_list,
3113 struct genl_info *info,
3114 enum devlink_command cmd)
e3b7ca18 3115{
e3b7ca18
MS		 3116 enum devlink_param_type param_type;
3117 struct devlink_param_gset_ctx ctx;
3118 enum devlink_param_cmode cmode;
3119 struct devlink_param_item *param_item;
3120 const struct devlink_param *param;
3121 union devlink_param_value value;
3122 int err = 0;
3123
9c54873b 3124 param_item = devlink_param_get_from_info(param_list, info);
e3b7ca18
MS		 3125 if (!param_item)
3126 return -EINVAL;
3127 param = param_item->param;
3128 err = devlink_param_type_get_from_info(info, &param_type);
3129 if (err)
3130 return err;
3131 if (param_type != param->type)
3132 return -EINVAL;
3133 err = devlink_param_value_get_from_info(param, info, &value);
3134 if (err)
3135 return err;
3136 if (param->validate) {
3137 err = param->validate(devlink, param->id, value, info->extack);
3138 if (err)
3139 return err;
3140 }
3141
3142 if (!info->attrs[DEVLINK_ATTR_PARAM_VALUE_CMODE])
3143 return -EINVAL;
3144 cmode = nla_get_u8(info->attrs[DEVLINK_ATTR_PARAM_VALUE_CMODE]);
3145 if (!devlink_param_cmode_is_supported(param, cmode))
3146 return -EOPNOTSUPP;
3147
3148 if (cmode == DEVLINK_PARAM_CMODE_DRIVERINIT) {
1276534c
MS		 3149 if (param->type == DEVLINK_PARAM_TYPE_STRING)
3150 strcpy(param_item->driverinit_value.vstr, value.vstr);
3151 else
3152 param_item->driverinit_value = value;
e3b7ca18
MS		 3153 param_item->driverinit_value_valid = true;
3154 } else {
3155 if (!param->set)
3156 return -EOPNOTSUPP;
3157 ctx.val = value;
3158 ctx.cmode = cmode;
3159 err = devlink_param_set(devlink, param, &ctx);
3160 if (err)
3161 return err;
3162 }
3163
c1e5786d 3164 devlink_param_notify(devlink, port_index, param_item, cmd);
e3b7ca18
MS		 3165 return 0;
3166}
3167
9c54873b
VV		 3168static int devlink_nl_cmd_param_set_doit(struct sk_buff *skb,
3169 struct genl_info *info)
3170{
3171 struct devlink *devlink = info->user_ptr[0];
3172
c1e5786d 3173 return __devlink_nl_cmd_param_set_doit(devlink, 0, &devlink->param_list,
9c54873b
VV		 3174 info, DEVLINK_CMD_PARAM_NEW);
3175}
3176
eabaef18 3177static int devlink_param_register_one(struct devlink *devlink,
c1e5786d 3178 unsigned int port_index,
39e6160e 3179 struct list_head *param_list,
c1e5786d
VV		 3180 const struct devlink_param *param,
3181 enum devlink_command cmd)
eabaef18
MS		 3182{
3183 struct devlink_param_item *param_item;
3184
39e6160e 3185 if (devlink_param_find_by_name(param_list, param->name))
eabaef18
MS		 3186 return -EEXIST;
3187
3188 if (param->supported_cmodes == BIT(DEVLINK_PARAM_CMODE_DRIVERINIT))
3189 WARN_ON(param->get || param->set);
3190 else
3191 WARN_ON(!param->get || !param->set);
3192
3193 param_item = kzalloc(sizeof(*param_item), GFP_KERNEL);
3194 if (!param_item)
3195 return -ENOMEM;
3196 param_item->param = param;
3197
39e6160e 3198 list_add_tail(&param_item->list, param_list);
c1e5786d 3199 devlink_param_notify(devlink, port_index, param_item, cmd);
eabaef18
MS		 3200 return 0;
3201}
3202
3203static void devlink_param_unregister_one(struct devlink *devlink,
c1e5786d 3204 unsigned int port_index,
39e6160e 3205 struct list_head *param_list,
c1e5786d
VV		 3206 const struct devlink_param *param,
3207 enum devlink_command cmd)
eabaef18
MS		 3208{
3209 struct devlink_param_item *param_item;
3210
39e6160e 3211 param_item = devlink_param_find_by_name(param_list, param->name);
eabaef18 3212 WARN_ON(!param_item);
c1e5786d 3213 devlink_param_notify(devlink, port_index, param_item, cmd);
eabaef18
MS		 3214 list_del(&param_item->list);
3215 kfree(param_item);
3216}
3217
f4601dee
VV		 3218static int devlink_nl_cmd_port_param_get_dumpit(struct sk_buff *msg,
3219 struct netlink_callback *cb)
3220{
3221 struct devlink_param_item *param_item;
3222 struct devlink_port *devlink_port;
3223 struct devlink *devlink;
3224 int start = cb->args[0];
3225 int idx = 0;
3226 int err;
3227
3228 mutex_lock(&devlink_mutex);
3229 list_for_each_entry(devlink, &devlink_list, list) {
3230 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
3231 continue;
3232 mutex_lock(&devlink->lock);
3233 list_for_each_entry(devlink_port, &devlink->port_list, list) {
3234 list_for_each_entry(param_item,
3235 &devlink_port->param_list, list) {
3236 if (idx < start) {
3237 idx++;
3238 continue;
3239 }
3240 err = devlink_nl_param_fill(msg,
3241 devlink_port->devlink,
3242 devlink_port->index, param_item,
3243 DEVLINK_CMD_PORT_PARAM_GET,
3244 NETLINK_CB(cb->skb).portid,
3245 cb->nlh->nlmsg_seq,
3246 NLM_F_MULTI);
3247 if (err) {
3248 mutex_unlock(&devlink->lock);
3249 goto out;
3250 }
3251 idx++;
3252 }
3253 }
3254 mutex_unlock(&devlink->lock);
3255 }
3256out:
3257 mutex_unlock(&devlink_mutex);
3258
3259 cb->args[0] = idx;
3260 return msg->len;
3261}
3262
3263static int devlink_nl_cmd_port_param_get_doit(struct sk_buff *skb,
3264 struct genl_info *info)
3265{
3266 struct devlink_port *devlink_port = info->user_ptr[0];
3267 struct devlink_param_item *param_item;
3268 struct sk_buff *msg;
3269 int err;
3270
3271 param_item = devlink_param_get_from_info(&devlink_port->param_list,
3272 info);
3273 if (!param_item)
3274 return -EINVAL;
3275
3276 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3277 if (!msg)
3278 return -ENOMEM;
3279
3280 err = devlink_nl_param_fill(msg, devlink_port->devlink,
3281 devlink_port->index, param_item,
3282 DEVLINK_CMD_PORT_PARAM_GET,
3283 info->snd_portid, info->snd_seq, 0);
3284 if (err) {
3285 nlmsg_free(msg);
3286 return err;
3287 }
3288
3289 return genlmsg_reply(msg, info);
3290}
3291
9c54873b
VV		 3292static int devlink_nl_cmd_port_param_set_doit(struct sk_buff *skb,
3293 struct genl_info *info)
3294{
3295 struct devlink_port *devlink_port = info->user_ptr[0];
3296
3297 return __devlink_nl_cmd_param_set_doit(devlink_port->devlink,
c1e5786d
VV		 3298 devlink_port->index,
3299 &devlink_port->param_list, info,
3300 DEVLINK_CMD_PORT_PARAM_NEW);
9c54873b
VV		 3301}
3302
a006d467
AV		 3303static int devlink_nl_region_snapshot_id_put(struct sk_buff *msg,
3304 struct devlink *devlink,
3305 struct devlink_snapshot *snapshot)
3306{
3307 struct nlattr *snap_attr;
3308 int err;
3309
3310 snap_attr = nla_nest_start(msg, DEVLINK_ATTR_REGION_SNAPSHOT);
3311 if (!snap_attr)
3312 return -EINVAL;
3313
3314 err = nla_put_u32(msg, DEVLINK_ATTR_REGION_SNAPSHOT_ID, snapshot->id);
3315 if (err)
3316 goto nla_put_failure;
3317
3318 nla_nest_end(msg, snap_attr);
3319 return 0;
3320
3321nla_put_failure:
3322 nla_nest_cancel(msg, snap_attr);
3323 return err;
3324}
3325
3326static int devlink_nl_region_snapshots_id_put(struct sk_buff *msg,
3327 struct devlink *devlink,
3328 struct devlink_region *region)
3329{
3330 struct devlink_snapshot *snapshot;
3331 struct nlattr *snapshots_attr;
3332 int err;
3333
3334 snapshots_attr = nla_nest_start(msg, DEVLINK_ATTR_REGION_SNAPSHOTS);
3335 if (!snapshots_attr)
3336 return -EINVAL;
3337
3338 list_for_each_entry(snapshot, &region->snapshot_list, list) {
3339 err = devlink_nl_region_snapshot_id_put(msg, devlink, snapshot);
3340 if (err)
3341 goto nla_put_failure;
3342 }
3343
3344 nla_nest_end(msg, snapshots_attr);
3345 return 0;
3346
3347nla_put_failure:
3348 nla_nest_cancel(msg, snapshots_attr);
3349 return err;
3350}
3351
d8db7ea5
AV		 3352static int devlink_nl_region_fill(struct sk_buff *msg, struct devlink *devlink,
3353 enum devlink_command cmd, u32 portid,
3354 u32 seq, int flags,
3355 struct devlink_region *region)
3356{
3357 void *hdr;
3358 int err;
3359
3360 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
3361 if (!hdr)
3362 return -EMSGSIZE;
3363
3364 err = devlink_nl_put_handle(msg, devlink);
3365 if (err)
3366 goto nla_put_failure;
3367
3368 err = nla_put_string(msg, DEVLINK_ATTR_REGION_NAME, region->name);
3369 if (err)
3370 goto nla_put_failure;
3371
3372 err = nla_put_u64_64bit(msg, DEVLINK_ATTR_REGION_SIZE,
3373 region->size,
3374 DEVLINK_ATTR_PAD);
3375 if (err)
3376 goto nla_put_failure;
3377
a006d467
AV		 3378 err = devlink_nl_region_snapshots_id_put(msg, devlink, region);
3379 if (err)
3380 goto nla_put_failure;
3381
d8db7ea5
AV		 3382 genlmsg_end(msg, hdr);
3383 return 0;
3384
3385nla_put_failure:
3386 genlmsg_cancel(msg, hdr);
3387 return err;
3388}
3389
866319bb
AV		 3390static void devlink_nl_region_notify(struct devlink_region *region,
3391 struct devlink_snapshot *snapshot,
3392 enum devlink_command cmd)
3393{
3394 struct devlink *devlink = region->devlink;
3395 struct sk_buff *msg;
3396 void *hdr;
3397 int err;
3398
3399 WARN_ON(cmd != DEVLINK_CMD_REGION_NEW && cmd != DEVLINK_CMD_REGION_DEL);
3400
3401 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3402 if (!msg)
3403 return;
3404
3405 hdr = genlmsg_put(msg, 0, 0, &devlink_nl_family, 0, cmd);
3406 if (!hdr)
3407 goto out_free_msg;
3408
3409 err = devlink_nl_put_handle(msg, devlink);
3410 if (err)
3411 goto out_cancel_msg;
3412
3413 err = nla_put_string(msg, DEVLINK_ATTR_REGION_NAME,
3414 region->name);
3415 if (err)
3416 goto out_cancel_msg;
3417
3418 if (snapshot) {
3419 err = nla_put_u32(msg, DEVLINK_ATTR_REGION_SNAPSHOT_ID,
3420 snapshot->id);
3421 if (err)
3422 goto out_cancel_msg;
3423 } else {
3424 err = nla_put_u64_64bit(msg, DEVLINK_ATTR_REGION_SIZE,
3425 region->size, DEVLINK_ATTR_PAD);
3426 if (err)
3427 goto out_cancel_msg;
3428 }
3429 genlmsg_end(msg, hdr);
3430
3431 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
3432 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
3433
3434 return;
3435
3436out_cancel_msg:
3437 genlmsg_cancel(msg, hdr);
3438out_free_msg:
3439 nlmsg_free(msg);
3440}
3441
d8db7ea5
AV		 3442static int devlink_nl_cmd_region_get_doit(struct sk_buff *skb,
3443 struct genl_info *info)
3444{
3445 struct devlink *devlink = info->user_ptr[0];
3446 struct devlink_region *region;
3447 const char *region_name;
3448 struct sk_buff *msg;
3449 int err;
3450
3451 if (!info->attrs[DEVLINK_ATTR_REGION_NAME])
3452 return -EINVAL;
3453
3454 region_name = nla_data(info->attrs[DEVLINK_ATTR_REGION_NAME]);
3455 region = devlink_region_get_by_name(devlink, region_name);
3456 if (!region)
3457 return -EINVAL;
3458
3459 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3460 if (!msg)
3461 return -ENOMEM;
3462
3463 err = devlink_nl_region_fill(msg, devlink, DEVLINK_CMD_REGION_GET,
3464 info->snd_portid, info->snd_seq, 0,
3465 region);
3466 if (err) {
3467 nlmsg_free(msg);
3468 return err;
3469 }
3470
3471 return genlmsg_reply(msg, info);
3472}
3473
3474static int devlink_nl_cmd_region_get_dumpit(struct sk_buff *msg,
3475 struct netlink_callback *cb)
3476{
3477 struct devlink_region *region;
3478 struct devlink *devlink;
3479 int start = cb->args[0];
3480 int idx = 0;
3481 int err;
3482
3483 mutex_lock(&devlink_mutex);
3484 list_for_each_entry(devlink, &devlink_list, list) {
3485 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
3486 continue;
3487
3488 mutex_lock(&devlink->lock);
3489 list_for_each_entry(region, &devlink->region_list, list) {
3490 if (idx < start) {
3491 idx++;
3492 continue;
3493 }
3494 err = devlink_nl_region_fill(msg, devlink,
3495 DEVLINK_CMD_REGION_GET,
3496 NETLINK_CB(cb->skb).portid,
3497 cb->nlh->nlmsg_seq,
3498 NLM_F_MULTI, region);
3499 if (err) {
3500 mutex_unlock(&devlink->lock);
3501 goto out;
3502 }
3503 idx++;
3504 }
3505 mutex_unlock(&devlink->lock);
3506 }
3507out:
3508 mutex_unlock(&devlink_mutex);
3509 cb->args[0] = idx;
3510 return msg->len;
3511}
3512
866319bb
AV		 3513static int devlink_nl_cmd_region_del(struct sk_buff *skb,
3514 struct genl_info *info)
3515{
3516 struct devlink *devlink = info->user_ptr[0];
3517 struct devlink_snapshot *snapshot;
3518 struct devlink_region *region;
3519 const char *region_name;
3520 u32 snapshot_id;
3521
3522 if (!info->attrs[DEVLINK_ATTR_REGION_NAME] ||
3523 !info->attrs[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
3524 return -EINVAL;
3525
3526 region_name = nla_data(info->attrs[DEVLINK_ATTR_REGION_NAME]);
3527 snapshot_id = nla_get_u32(info->attrs[DEVLINK_ATTR_REGION_SNAPSHOT_ID]);
3528
3529 region = devlink_region_get_by_name(devlink, region_name);
3530 if (!region)
3531 return -EINVAL;
3532
3533 snapshot = devlink_region_snapshot_get_by_id(region, snapshot_id);
3534 if (!snapshot)
3535 return -EINVAL;
3536
3537 devlink_nl_region_notify(region, snapshot, DEVLINK_CMD_REGION_DEL);
3538 devlink_region_snapshot_del(snapshot);
3539 return 0;
3540}
3541
4e54795a
AV		 3542static int devlink_nl_cmd_region_read_chunk_fill(struct sk_buff *msg,
3543 struct devlink *devlink,
3544 u8 *chunk, u32 chunk_size,
3545 u64 addr)
3546{
3547 struct nlattr *chunk_attr;
3548 int err;
3549
3550 chunk_attr = nla_nest_start(msg, DEVLINK_ATTR_REGION_CHUNK);
3551 if (!chunk_attr)
3552 return -EINVAL;
3553
3554 err = nla_put(msg, DEVLINK_ATTR_REGION_CHUNK_DATA, chunk_size, chunk);
3555 if (err)
3556 goto nla_put_failure;
3557
3558 err = nla_put_u64_64bit(msg, DEVLINK_ATTR_REGION_CHUNK_ADDR, addr,
3559 DEVLINK_ATTR_PAD);
3560 if (err)
3561 goto nla_put_failure;
3562
3563 nla_nest_end(msg, chunk_attr);
3564 return 0;
3565
3566nla_put_failure:
3567 nla_nest_cancel(msg, chunk_attr);
3568 return err;
3569}
3570
3571#define DEVLINK_REGION_READ_CHUNK_SIZE 256
3572
3573static int devlink_nl_region_read_snapshot_fill(struct sk_buff *skb,
3574 struct devlink *devlink,
3575 struct devlink_region *region,
3576 struct nlattr **attrs,
3577 u64 start_offset,
3578 u64 end_offset,
3579 bool dump,
3580 u64 *new_offset)
3581{
3582 struct devlink_snapshot *snapshot;
3583 u64 curr_offset = start_offset;
3584 u32 snapshot_id;
3585 int err = 0;
3586
3587 *new_offset = start_offset;
3588
3589 snapshot_id = nla_get_u32(attrs[DEVLINK_ATTR_REGION_SNAPSHOT_ID]);
3590 snapshot = devlink_region_snapshot_get_by_id(region, snapshot_id);
3591 if (!snapshot)
3592 return -EINVAL;
3593
3594 if (end_offset > snapshot->data_len || dump)
3595 end_offset = snapshot->data_len;
3596
3597 while (curr_offset < end_offset) {
3598 u32 data_size;
3599 u8 *data;
3600
3601 if (end_offset - curr_offset < DEVLINK_REGION_READ_CHUNK_SIZE)
3602 data_size = end_offset - curr_offset;
3603 else
3604 data_size = DEVLINK_REGION_READ_CHUNK_SIZE;
3605
3606 data = &snapshot->data[curr_offset];
3607 err = devlink_nl_cmd_region_read_chunk_fill(skb, devlink,
3608 data, data_size,
3609 curr_offset);
3610 if (err)
3611 break;
3612
3613 curr_offset += data_size;
3614 }
3615 *new_offset = curr_offset;
3616
3617 return err;
3618}
3619
3620static int devlink_nl_cmd_region_read_dumpit(struct sk_buff *skb,
3621 struct netlink_callback *cb)
3622{
3623 u64 ret_offset, start_offset, end_offset = 0;
3624 struct nlattr *attrs[DEVLINK_ATTR_MAX + 1];
3625 const struct genl_ops *ops = cb->data;
3626 struct devlink_region *region;
3627 struct nlattr *chunks_attr;
3628 const char *region_name;
3629 struct devlink *devlink;
3630 bool dump = true;
3631 void *hdr;
3632 int err;
3633
3634 start_offset = *((u64 *)&cb->args[0]);
3635
3636 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + devlink_nl_family.hdrsize,
dac9c979 3637 attrs, DEVLINK_ATTR_MAX, ops->policy, cb->extack);
4e54795a
AV		 3638 if (err)
3639 goto out;
3640
3641 devlink = devlink_get_from_attrs(sock_net(cb->skb->sk), attrs);
3642 if (IS_ERR(devlink))
3643 goto out;
3644
3645 mutex_lock(&devlink_mutex);
3646 mutex_lock(&devlink->lock);
3647
3648 if (!attrs[DEVLINK_ATTR_REGION_NAME] ||
3649 !attrs[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
3650 goto out_unlock;
3651
3652 region_name = nla_data(attrs[DEVLINK_ATTR_REGION_NAME]);
3653 region = devlink_region_get_by_name(devlink, region_name);
3654 if (!region)
3655 goto out_unlock;
3656
3657 hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
3658 &devlink_nl_family, NLM_F_ACK | NLM_F_MULTI,
3659 DEVLINK_CMD_REGION_READ);
3660 if (!hdr)
3661 goto out_unlock;
3662
3663 err = devlink_nl_put_handle(skb, devlink);
3664 if (err)
3665 goto nla_put_failure;
3666
3667 err = nla_put_string(skb, DEVLINK_ATTR_REGION_NAME, region_name);
3668 if (err)
3669 goto nla_put_failure;
3670
3671 chunks_attr = nla_nest_start(skb, DEVLINK_ATTR_REGION_CHUNKS);
3672 if (!chunks_attr)
3673 goto nla_put_failure;
3674
3675 if (attrs[DEVLINK_ATTR_REGION_CHUNK_ADDR] &&
3676 attrs[DEVLINK_ATTR_REGION_CHUNK_LEN]) {
3677 if (!start_offset)
3678 start_offset =
3679 nla_get_u64(attrs[DEVLINK_ATTR_REGION_CHUNK_ADDR]);
3680
3681 end_offset = nla_get_u64(attrs[DEVLINK_ATTR_REGION_CHUNK_ADDR]);
3682 end_offset += nla_get_u64(attrs[DEVLINK_ATTR_REGION_CHUNK_LEN]);
3683 dump = false;
3684 }
3685
3686 err = devlink_nl_region_read_snapshot_fill(skb, devlink,
3687 region, attrs,
3688 start_offset,
3689 end_offset, dump,
3690 &ret_offset);
3691
3692 if (err && err != -EMSGSIZE)
3693 goto nla_put_failure;
3694
3695 /* Check if there was any progress done to prevent infinite loop */
3696 if (ret_offset == start_offset)
3697 goto nla_put_failure;
3698
3699 *((u64 *)&cb->args[0]) = ret_offset;
3700
3701 nla_nest_end(skb, chunks_attr);
3702 genlmsg_end(skb, hdr);
3703 mutex_unlock(&devlink->lock);
3704 mutex_unlock(&devlink_mutex);
3705
3706 return skb->len;
3707
3708nla_put_failure:
3709 genlmsg_cancel(skb, hdr);
3710out_unlock:
3711 mutex_unlock(&devlink->lock);
3712 mutex_unlock(&devlink_mutex);
3713out:
3714 return 0;
3715}
3716
f9cf2288
JK		 3717struct devlink_info_req {
3718 struct sk_buff *msg;
3719};
3720
3721int devlink_info_driver_name_put(struct devlink_info_req *req, const char *name)
3722{
3723 return nla_put_string(req->msg, DEVLINK_ATTR_INFO_DRIVER_NAME, name);
3724}
3725EXPORT_SYMBOL_GPL(devlink_info_driver_name_put);
3726
3727int devlink_info_serial_number_put(struct devlink_info_req *req, const char *sn)
3728{
3729 return nla_put_string(req->msg, DEVLINK_ATTR_INFO_SERIAL_NUMBER, sn);
3730}
3731EXPORT_SYMBOL_GPL(devlink_info_serial_number_put);
3732
3733static int
3734devlink_nl_info_fill(struct sk_buff *msg, struct devlink *devlink,
3735 enum devlink_command cmd, u32 portid,
3736 u32 seq, int flags, struct netlink_ext_ack *extack)
3737{
3738 struct devlink_info_req req;
3739 void *hdr;
3740 int err;
3741
3742 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
3743 if (!hdr)
3744 return -EMSGSIZE;
3745
3746 err = -EMSGSIZE;
3747 if (devlink_nl_put_handle(msg, devlink))
3748 goto err_cancel_msg;
3749
3750 req.msg = msg;
3751 err = devlink->ops->info_get(devlink, &req, extack);
3752 if (err)
3753 goto err_cancel_msg;
3754
3755 genlmsg_end(msg, hdr);
3756 return 0;
3757
3758err_cancel_msg:
3759 genlmsg_cancel(msg, hdr);
3760 return err;
3761}
3762
3763static int devlink_nl_cmd_info_get_doit(struct sk_buff *skb,
3764 struct genl_info *info)
3765{
3766 struct devlink *devlink = info->user_ptr[0];
3767 struct sk_buff *msg;
3768 int err;
3769
3770 if (!devlink->ops || !devlink->ops->info_get)
3771 return -EOPNOTSUPP;
3772
3773 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3774 if (!msg)
3775 return -ENOMEM;
3776
3777 err = devlink_nl_info_fill(msg, devlink, DEVLINK_CMD_INFO_GET,
3778 info->snd_portid, info->snd_seq, 0,
3779 info->extack);
3780 if (err) {
3781 nlmsg_free(msg);
3782 return err;
3783 }
3784
3785 return genlmsg_reply(msg, info);
3786}
3787
3788static int devlink_nl_cmd_info_get_dumpit(struct sk_buff *msg,
3789 struct netlink_callback *cb)
3790{
3791 struct devlink *devlink;
3792 int start = cb->args[0];
3793 int idx = 0;
3794 int err;
3795
3796 mutex_lock(&devlink_mutex);
3797 list_for_each_entry(devlink, &devlink_list, list) {
3798 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
3799 continue;
3800 if (idx < start) {
3801 idx++;
3802 continue;
3803 }
3804
3805 mutex_lock(&devlink->lock);
3806 err = devlink_nl_info_fill(msg, devlink, DEVLINK_CMD_INFO_GET,
3807 NETLINK_CB(cb->skb).portid,
3808 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3809 cb->extack);
3810 mutex_unlock(&devlink->lock);
3811 if (err)
3812 break;
3813 idx++;
3814 }
3815 mutex_unlock(&devlink_mutex);
3816
3817 cb->args[0] = idx;
3818 return msg->len;
3819}
3820
bfcd3a46
JP		 3821static const struct nla_policy devlink_nl_policy[DEVLINK_ATTR_MAX + 1] = {
3822 [DEVLINK_ATTR_BUS_NAME] = { .type = NLA_NUL_STRING },
3823 [DEVLINK_ATTR_DEV_NAME] = { .type = NLA_NUL_STRING },
3824 [DEVLINK_ATTR_PORT_INDEX] = { .type = NLA_U32 },
3825 [DEVLINK_ATTR_PORT_TYPE] = { .type = NLA_U16 },
3826 [DEVLINK_ATTR_PORT_SPLIT_COUNT] = { .type = NLA_U32 },
bf797471
JP		 3827 [DEVLINK_ATTR_SB_INDEX] = { .type = NLA_U32 },
3828 [DEVLINK_ATTR_SB_POOL_INDEX] = { .type = NLA_U16 },
3829 [DEVLINK_ATTR_SB_POOL_TYPE] = { .type = NLA_U8 },
3830 [DEVLINK_ATTR_SB_POOL_SIZE] = { .type = NLA_U32 },
3831 [DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE] = { .type = NLA_U8 },
3832 [DEVLINK_ATTR_SB_THRESHOLD] = { .type = NLA_U32 },
3833 [DEVLINK_ATTR_SB_TC_INDEX] = { .type = NLA_U16 },
08f4b591 3834 [DEVLINK_ATTR_ESWITCH_MODE] = { .type = NLA_U16 },
59bfde01 3835 [DEVLINK_ATTR_ESWITCH_INLINE_MODE] = { .type = NLA_U8 },
f43e9b06 3836 [DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = { .type = NLA_U8 },
1555d204
AS		 3837 [DEVLINK_ATTR_DPIPE_TABLE_NAME] = { .type = NLA_NUL_STRING },
3838 [DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED] = { .type = NLA_U8 },
d9f9b9a4
AS		 3839 [DEVLINK_ATTR_RESOURCE_ID] = { .type = NLA_U64},
3840 [DEVLINK_ATTR_RESOURCE_SIZE] = { .type = NLA_U64},
e3b7ca18
MS		 3841 [DEVLINK_ATTR_PARAM_NAME] = { .type = NLA_NUL_STRING },
3842 [DEVLINK_ATTR_PARAM_TYPE] = { .type = NLA_U8 },
3843 [DEVLINK_ATTR_PARAM_VALUE_CMODE] = { .type = NLA_U8 },
d8db7ea5 3844 [DEVLINK_ATTR_REGION_NAME] = { .type = NLA_NUL_STRING },
866319bb 3845 [DEVLINK_ATTR_REGION_SNAPSHOT_ID] = { .type = NLA_U32 },
bfcd3a46
JP		 3846};
3847
3848static const struct genl_ops devlink_nl_ops[] = {
3849 {
3850 .cmd = DEVLINK_CMD_GET,
3851 .doit = devlink_nl_cmd_get_doit,
3852 .dumpit = devlink_nl_cmd_get_dumpit,
3853 .policy = devlink_nl_policy,
1fc2257e 3854 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
bfcd3a46
JP		 3855 /* can be retrieved by unprivileged users */
3856 },
3857 {
3858 .cmd = DEVLINK_CMD_PORT_GET,
3859 .doit = devlink_nl_cmd_port_get_doit,
3860 .dumpit = devlink_nl_cmd_port_get_dumpit,
3861 .policy = devlink_nl_policy,
3862 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
3863 /* can be retrieved by unprivileged users */
3864 },
3865 {
3866 .cmd = DEVLINK_CMD_PORT_SET,
3867 .doit = devlink_nl_cmd_port_set_doit,
3868 .policy = devlink_nl_policy,
3869 .flags = GENL_ADMIN_PERM,
3870 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
3871 },
3872 {
3873 .cmd = DEVLINK_CMD_PORT_SPLIT,
3874 .doit = devlink_nl_cmd_port_split_doit,
3875 .policy = devlink_nl_policy,
3876 .flags = GENL_ADMIN_PERM,
2406e7e5
AS		 3877 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3878 DEVLINK_NL_FLAG_NO_LOCK,
bfcd3a46
JP		 3879 },
3880 {
3881 .cmd = DEVLINK_CMD_PORT_UNSPLIT,
3882 .doit = devlink_nl_cmd_port_unsplit_doit,
3883 .policy = devlink_nl_policy,
3884 .flags = GENL_ADMIN_PERM,
2406e7e5
AS		 3885 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3886 DEVLINK_NL_FLAG_NO_LOCK,
bfcd3a46 3887 },
bf797471
JP		 3888 {
3889 .cmd = DEVLINK_CMD_SB_GET,
3890 .doit = devlink_nl_cmd_sb_get_doit,
3891 .dumpit = devlink_nl_cmd_sb_get_dumpit,
3892 .policy = devlink_nl_policy,
3893 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3894 DEVLINK_NL_FLAG_NEED_SB,
3895 /* can be retrieved by unprivileged users */
3896 },
3897 {
3898 .cmd = DEVLINK_CMD_SB_POOL_GET,
3899 .doit = devlink_nl_cmd_sb_pool_get_doit,
3900 .dumpit = devlink_nl_cmd_sb_pool_get_dumpit,
3901 .policy = devlink_nl_policy,
3902 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3903 DEVLINK_NL_FLAG_NEED_SB,
3904 /* can be retrieved by unprivileged users */
3905 },
3906 {
3907 .cmd = DEVLINK_CMD_SB_POOL_SET,
3908 .doit = devlink_nl_cmd_sb_pool_set_doit,
3909 .policy = devlink_nl_policy,
3910 .flags = GENL_ADMIN_PERM,
3911 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3912 DEVLINK_NL_FLAG_NEED_SB,
3913 },
3914 {
3915 .cmd = DEVLINK_CMD_SB_PORT_POOL_GET,
3916 .doit = devlink_nl_cmd_sb_port_pool_get_doit,
3917 .dumpit = devlink_nl_cmd_sb_port_pool_get_dumpit,
3918 .policy = devlink_nl_policy,
3919 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3920 DEVLINK_NL_FLAG_NEED_SB,
3921 /* can be retrieved by unprivileged users */
3922 },
3923 {
3924 .cmd = DEVLINK_CMD_SB_PORT_POOL_SET,
3925 .doit = devlink_nl_cmd_sb_port_pool_set_doit,
3926 .policy = devlink_nl_policy,
3927 .flags = GENL_ADMIN_PERM,
3928 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3929 DEVLINK_NL_FLAG_NEED_SB,
3930 },
3931 {
3932 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_GET,
3933 .doit = devlink_nl_cmd_sb_tc_pool_bind_get_doit,
3934 .dumpit = devlink_nl_cmd_sb_tc_pool_bind_get_dumpit,
3935 .policy = devlink_nl_policy,
3936 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3937 DEVLINK_NL_FLAG_NEED_SB,
3938 /* can be retrieved by unprivileged users */
3939 },
3940 {
3941 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_SET,
3942 .doit = devlink_nl_cmd_sb_tc_pool_bind_set_doit,
3943 .policy = devlink_nl_policy,
3944 .flags = GENL_ADMIN_PERM,
3945 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
3946 DEVLINK_NL_FLAG_NEED_SB,
3947 },
df38dafd
JP		 3948 {
3949 .cmd = DEVLINK_CMD_SB_OCC_SNAPSHOT,
3950 .doit = devlink_nl_cmd_sb_occ_snapshot_doit,
3951 .policy = devlink_nl_policy,
3952 .flags = GENL_ADMIN_PERM,
3953 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2406e7e5 3954 DEVLINK_NL_FLAG_NEED_SB,
df38dafd
JP		 3955 },
3956 {
3957 .cmd = DEVLINK_CMD_SB_OCC_MAX_CLEAR,
3958 .doit = devlink_nl_cmd_sb_occ_max_clear_doit,
3959 .policy = devlink_nl_policy,
3960 .flags = GENL_ADMIN_PERM,
3961 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2406e7e5 3962 DEVLINK_NL_FLAG_NEED_SB,
df38dafd 3963 },
08f4b591 3964 {
adf200f3
JP		 3965 .cmd = DEVLINK_CMD_ESWITCH_GET,
3966 .doit = devlink_nl_cmd_eswitch_get_doit,
08f4b591
OG		 3967 .policy = devlink_nl_policy,
3968 .flags = GENL_ADMIN_PERM,
3969 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
3970 },
3971 {
adf200f3
JP		 3972 .cmd = DEVLINK_CMD_ESWITCH_SET,
3973 .doit = devlink_nl_cmd_eswitch_set_doit,
08f4b591
OG		 3974 .policy = devlink_nl_policy,
3975 .flags = GENL_ADMIN_PERM,
7ac1cc9a
JK		 3976 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
3977 DEVLINK_NL_FLAG_NO_LOCK,
08f4b591 3978 },
1555d204
AS		 3979 {
3980 .cmd = DEVLINK_CMD_DPIPE_TABLE_GET,
3981 .doit = devlink_nl_cmd_dpipe_table_get,
3982 .policy = devlink_nl_policy,
1555d204 3983 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 3984 /* can be retrieved by unprivileged users */
1555d204
AS		 3985 },
3986 {
3987 .cmd = DEVLINK_CMD_DPIPE_ENTRIES_GET,
3988 .doit = devlink_nl_cmd_dpipe_entries_get,
3989 .policy = devlink_nl_policy,
1555d204 3990 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 3991 /* can be retrieved by unprivileged users */
1555d204
AS		 3992 },
3993 {
3994 .cmd = DEVLINK_CMD_DPIPE_HEADERS_GET,
3995 .doit = devlink_nl_cmd_dpipe_headers_get,
3996 .policy = devlink_nl_policy,
1555d204 3997 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 3998 /* can be retrieved by unprivileged users */
1555d204
AS		 3999 },
4000 {
4001 .cmd = DEVLINK_CMD_DPIPE_TABLE_COUNTERS_SET,
4002 .doit = devlink_nl_cmd_dpipe_table_counters_set,
4003 .policy = devlink_nl_policy,
4004 .flags = GENL_ADMIN_PERM,
4005 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4006 },
d9f9b9a4
AS		 4007 {
4008 .cmd = DEVLINK_CMD_RESOURCE_SET,
4009 .doit = devlink_nl_cmd_resource_set,
4010 .policy = devlink_nl_policy,
4011 .flags = GENL_ADMIN_PERM,
4012 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4013 },
4014 {
4015 .cmd = DEVLINK_CMD_RESOURCE_DUMP,
4016 .doit = devlink_nl_cmd_resource_dump,
4017 .policy = devlink_nl_policy,
d9f9b9a4 4018 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
67ae686b 4019 /* can be retrieved by unprivileged users */
d9f9b9a4 4020 },
2d8dc5bb
AS		 4021 {
4022 .cmd = DEVLINK_CMD_RELOAD,
4023 .doit = devlink_nl_cmd_reload,
4024 .policy = devlink_nl_policy,
4025 .flags = GENL_ADMIN_PERM,
4026 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
4027 DEVLINK_NL_FLAG_NO_LOCK,
4028 },
45f05def
MS		 4029 {
4030 .cmd = DEVLINK_CMD_PARAM_GET,
4031 .doit = devlink_nl_cmd_param_get_doit,
4032 .dumpit = devlink_nl_cmd_param_get_dumpit,
4033 .policy = devlink_nl_policy,
4034 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4035 /* can be retrieved by unprivileged users */
4036 },
e3b7ca18
MS		 4037 {
4038 .cmd = DEVLINK_CMD_PARAM_SET,
4039 .doit = devlink_nl_cmd_param_set_doit,
4040 .policy = devlink_nl_policy,
4041 .flags = GENL_ADMIN_PERM,
4042 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4043 },
f4601dee
VV		 4044 {
4045 .cmd = DEVLINK_CMD_PORT_PARAM_GET,
4046 .doit = devlink_nl_cmd_port_param_get_doit,
4047 .dumpit = devlink_nl_cmd_port_param_get_dumpit,
4048 .policy = devlink_nl_policy,
4049 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
4050 /* can be retrieved by unprivileged users */
4051 },
9c54873b
VV		 4052 {
4053 .cmd = DEVLINK_CMD_PORT_PARAM_SET,
4054 .doit = devlink_nl_cmd_port_param_set_doit,
4055 .policy = devlink_nl_policy,
4056 .flags = GENL_ADMIN_PERM,
4057 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
4058 },
d8db7ea5
AV		 4059 {
4060 .cmd = DEVLINK_CMD_REGION_GET,
4061 .doit = devlink_nl_cmd_region_get_doit,
4062 .dumpit = devlink_nl_cmd_region_get_dumpit,
4063 .policy = devlink_nl_policy,
4064 .flags = GENL_ADMIN_PERM,
4065 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4066 },
866319bb
AV		 4067 {
4068 .cmd = DEVLINK_CMD_REGION_DEL,
4069 .doit = devlink_nl_cmd_region_del,
4070 .policy = devlink_nl_policy,
4071 .flags = GENL_ADMIN_PERM,
4072 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4073 },
4e54795a
AV		 4074 {
4075 .cmd = DEVLINK_CMD_REGION_READ,
4076 .dumpit = devlink_nl_cmd_region_read_dumpit,
4077 .policy = devlink_nl_policy,
4078 .flags = GENL_ADMIN_PERM,
4079 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4080 },
f9cf2288
JK		 4081 {
4082 .cmd = DEVLINK_CMD_INFO_GET,
4083 .doit = devlink_nl_cmd_info_get_doit,
4084 .dumpit = devlink_nl_cmd_info_get_dumpit,
4085 .policy = devlink_nl_policy,
4086 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
4087 /* can be retrieved by unprivileged users */
4088 },
bfcd3a46
JP		 4089};
4090
56989f6d 4091static struct genl_family devlink_nl_family __ro_after_init = {
489111e5
JB		 4092 .name = DEVLINK_GENL_NAME,
4093 .version = DEVLINK_GENL_VERSION,
4094 .maxattr = DEVLINK_ATTR_MAX,
4095 .netnsok = true,
4096 .pre_doit = devlink_nl_pre_doit,
4097 .post_doit = devlink_nl_post_doit,
4098 .module = THIS_MODULE,
4099 .ops = devlink_nl_ops,
4100 .n_ops = ARRAY_SIZE(devlink_nl_ops),
4101 .mcgrps = devlink_nl_mcgrps,
4102 .n_mcgrps = ARRAY_SIZE(devlink_nl_mcgrps),
4103};
4104
bfcd3a46
JP		 4105/**
4106 * devlink_alloc - Allocate new devlink instance resources
4107 *
4108 * @ops: ops
4109 * @priv_size: size of user private data
4110 *
4111 * Allocate new devlink instance resources, including devlink index
4112 * and name.
4113 */
4114struct devlink *devlink_alloc(const struct devlink_ops *ops, size_t priv_size)
4115{
4116 struct devlink *devlink;
4117
4118 devlink = kzalloc(sizeof(*devlink) + priv_size, GFP_KERNEL);
4119 if (!devlink)
4120 return NULL;
4121 devlink->ops = ops;
4122 devlink_net_set(devlink, &init_net);
4123 INIT_LIST_HEAD(&devlink->port_list);
bf797471 4124 INIT_LIST_HEAD(&devlink->sb_list);
1555d204 4125 INIT_LIST_HEAD_RCU(&devlink->dpipe_table_list);
d9f9b9a4 4126 INIT_LIST_HEAD(&devlink->resource_list);
eabaef18 4127 INIT_LIST_HEAD(&devlink->param_list);
b16ebe92 4128 INIT_LIST_HEAD(&devlink->region_list);
2406e7e5 4129 mutex_init(&devlink->lock);
bfcd3a46
JP		 4130 return devlink;
4131}
4132EXPORT_SYMBOL_GPL(devlink_alloc);
4133
4134/**
4135 * devlink_register - Register devlink instance
4136 *
4137 * @devlink: devlink
4138 */
4139int devlink_register(struct devlink *devlink, struct device *dev)
4140{
4141 mutex_lock(&devlink_mutex);
4142 devlink->dev = dev;
4143 list_add_tail(&devlink->list, &devlink_list);
4144 devlink_notify(devlink, DEVLINK_CMD_NEW);
4145 mutex_unlock(&devlink_mutex);
4146 return 0;
4147}
4148EXPORT_SYMBOL_GPL(devlink_register);
4149
4150/**
4151 * devlink_unregister - Unregister devlink instance
4152 *
4153 * @devlink: devlink
4154 */
4155void devlink_unregister(struct devlink *devlink)
4156{
4157 mutex_lock(&devlink_mutex);
4158 devlink_notify(devlink, DEVLINK_CMD_DEL);
4159 list_del(&devlink->list);
4160 mutex_unlock(&devlink_mutex);
4161}
4162EXPORT_SYMBOL_GPL(devlink_unregister);
4163
4164/**
4165 * devlink_free - Free devlink instance resources
4166 *
4167 * @devlink: devlink
4168 */
4169void devlink_free(struct devlink *devlink)
4170{
4171 kfree(devlink);
4172}
4173EXPORT_SYMBOL_GPL(devlink_free);
4174
4175/**
4176 * devlink_port_register - Register devlink port
4177 *
4178 * @devlink: devlink
4179 * @devlink_port: devlink port
4180 * @port_index
4181 *
4182 * Register devlink port with provided port index. User can use
4183 * any indexing, even hw-related one. devlink_port structure
4184 * is convenient to be embedded inside user driver private structure.
4185 * Note that the caller should take care of zeroing the devlink_port
4186 * structure.
4187 */
4188int devlink_port_register(struct devlink *devlink,
4189 struct devlink_port *devlink_port,
4190 unsigned int port_index)
4191{
2406e7e5 4192 mutex_lock(&devlink->lock);
bfcd3a46 4193 if (devlink_port_index_exists(devlink, port_index)) {
2406e7e5 4194 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 4195 return -EEXIST;
4196 }
4197 devlink_port->devlink = devlink;
4198 devlink_port->index = port_index;
bfcd3a46
JP		 4199 devlink_port->registered = true;
4200 list_add_tail(&devlink_port->list, &devlink->port_list);
39e6160e 4201 INIT_LIST_HEAD(&devlink_port->param_list);
2406e7e5 4202 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 4203 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
4204 return 0;
4205}
4206EXPORT_SYMBOL_GPL(devlink_port_register);
4207
4208/**
4209 * devlink_port_unregister - Unregister devlink port
4210 *
4211 * @devlink_port: devlink port
4212 */
4213void devlink_port_unregister(struct devlink_port *devlink_port)
4214{
2406e7e5
AS		 4215 struct devlink *devlink = devlink_port->devlink;
4216
bfcd3a46 4217 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_DEL);
2406e7e5 4218 mutex_lock(&devlink->lock);
bfcd3a46 4219 list_del(&devlink_port->list);
2406e7e5 4220 mutex_unlock(&devlink->lock);
bfcd3a46
JP		 4221}
4222EXPORT_SYMBOL_GPL(devlink_port_unregister);
4223
4224static void __devlink_port_type_set(struct devlink_port *devlink_port,
4225 enum devlink_port_type type,
4226 void *type_dev)
4227{
4228 devlink_port->type = type;
4229 devlink_port->type_dev = type_dev;
4230 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
4231}
4232
4233/**
4234 * devlink_port_type_eth_set - Set port type to Ethernet
4235 *
4236 * @devlink_port: devlink port
4237 * @netdev: related netdevice
4238 */
4239void devlink_port_type_eth_set(struct devlink_port *devlink_port,
4240 struct net_device *netdev)
4241{
4242 return __devlink_port_type_set(devlink_port,
4243 DEVLINK_PORT_TYPE_ETH, netdev);
4244}
4245EXPORT_SYMBOL_GPL(devlink_port_type_eth_set);
4246
4247/**
4248 * devlink_port_type_ib_set - Set port type to InfiniBand
4249 *
4250 * @devlink_port: devlink port
4251 * @ibdev: related IB device
4252 */
4253void devlink_port_type_ib_set(struct devlink_port *devlink_port,
4254 struct ib_device *ibdev)
4255{
4256 return __devlink_port_type_set(devlink_port,
4257 DEVLINK_PORT_TYPE_IB, ibdev);
4258}
4259EXPORT_SYMBOL_GPL(devlink_port_type_ib_set);
4260
4261/**
4262 * devlink_port_type_clear - Clear port type
4263 *
4264 * @devlink_port: devlink port
4265 */
4266void devlink_port_type_clear(struct devlink_port *devlink_port)
4267{
4268 return __devlink_port_type_set(devlink_port,
4269 DEVLINK_PORT_TYPE_NOTSET, NULL);
4270}
4271EXPORT_SYMBOL_GPL(devlink_port_type_clear);
4272
4273/**
b9ffcbaf 4274 * devlink_port_attrs_set - Set port attributes
bfcd3a46
JP		 4275 *
4276 * @devlink_port: devlink port
5ec1380a 4277 * @flavour: flavour of the port
b9ffcbaf
JP		 4278 * @port_number: number of the port that is facing user, for example
4279 * the front panel port number
4280 * @split: indicates if this is split port
4281 * @split_subport_number: if the port is split, this is the number
4282 * of subport.
bfcd3a46 4283 */
b9ffcbaf 4284void devlink_port_attrs_set(struct devlink_port *devlink_port,
5ec1380a 4285 enum devlink_port_flavour flavour,
b9ffcbaf
JP		 4286 u32 port_number, bool split,
4287 u32 split_subport_number)
bfcd3a46 4288{
b9ffcbaf
JP		 4289 struct devlink_port_attrs *attrs = &devlink_port->attrs;
4290
4291 attrs->set = true;
5ec1380a 4292 attrs->flavour = flavour;
b9ffcbaf
JP		 4293 attrs->port_number = port_number;
4294 attrs->split = split;
4295 attrs->split_subport_number = split_subport_number;
bfcd3a46
JP		 4296 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
4297}
b9ffcbaf 4298EXPORT_SYMBOL_GPL(devlink_port_attrs_set);
bfcd3a46 4299
08474c1a
JP		 4300int devlink_port_get_phys_port_name(struct devlink_port *devlink_port,
4301 char *name, size_t len)
4302{
4303 struct devlink_port_attrs *attrs = &devlink_port->attrs;
4304 int n = 0;
4305
4306 if (!attrs->set)
4307 return -EOPNOTSUPP;
4308
4309 switch (attrs->flavour) {
4310 case DEVLINK_PORT_FLAVOUR_PHYSICAL:
4311 if (!attrs->split)
4312 n = snprintf(name, len, "p%u", attrs->port_number);
4313 else
4314 n = snprintf(name, len, "p%us%u", attrs->port_number,
4315 attrs->split_subport_number);
4316 break;
4317 case DEVLINK_PORT_FLAVOUR_CPU:
4318 case DEVLINK_PORT_FLAVOUR_DSA:
4319 /* As CPU and DSA ports do not have a netdevice associated
4320 * case should not ever happen.
4321 */
4322 WARN_ON(1);
4323 return -EINVAL;
4324 }
4325
4326 if (n >= len)
4327 return -EINVAL;
4328
4329 return 0;
4330}
4331EXPORT_SYMBOL_GPL(devlink_port_get_phys_port_name);
4332
bf797471
JP		 4333int devlink_sb_register(struct devlink *devlink, unsigned int sb_index,
4334 u32 size, u16 ingress_pools_count,
4335 u16 egress_pools_count, u16 ingress_tc_count,
4336 u16 egress_tc_count)
4337{
4338 struct devlink_sb *devlink_sb;
4339 int err = 0;
4340
2406e7e5 4341 mutex_lock(&devlink->lock);
bf797471
JP		 4342 if (devlink_sb_index_exists(devlink, sb_index)) {
4343 err = -EEXIST;
4344 goto unlock;
4345 }
4346
4347 devlink_sb = kzalloc(sizeof(*devlink_sb), GFP_KERNEL);
4348 if (!devlink_sb) {
4349 err = -ENOMEM;
4350 goto unlock;
4351 }
4352 devlink_sb->index = sb_index;
4353 devlink_sb->size = size;
4354 devlink_sb->ingress_pools_count = ingress_pools_count;
4355 devlink_sb->egress_pools_count = egress_pools_count;
4356 devlink_sb->ingress_tc_count = ingress_tc_count;
4357 devlink_sb->egress_tc_count = egress_tc_count;
4358 list_add_tail(&devlink_sb->list, &devlink->sb_list);
4359unlock:
2406e7e5 4360 mutex_unlock(&devlink->lock);
bf797471
JP		 4361 return err;
4362}
4363EXPORT_SYMBOL_GPL(devlink_sb_register);
4364
4365void devlink_sb_unregister(struct devlink *devlink, unsigned int sb_index)
4366{
4367 struct devlink_sb *devlink_sb;
4368
2406e7e5 4369 mutex_lock(&devlink->lock);
bf797471
JP		 4370 devlink_sb = devlink_sb_get_by_index(devlink, sb_index);
4371 WARN_ON(!devlink_sb);
4372 list_del(&devlink_sb->list);
2406e7e5 4373 mutex_unlock(&devlink->lock);
bf797471
JP		 4374 kfree(devlink_sb);
4375}
4376EXPORT_SYMBOL_GPL(devlink_sb_unregister);
4377
1555d204
AS		 4378/**
4379 * devlink_dpipe_headers_register - register dpipe headers
4380 *
4381 * @devlink: devlink
4382 * @dpipe_headers: dpipe header array
4383 *
4384 * Register the headers supported by hardware.
4385 */
4386int devlink_dpipe_headers_register(struct devlink *devlink,
4387 struct devlink_dpipe_headers *dpipe_headers)
4388{
2406e7e5 4389 mutex_lock(&devlink->lock);
1555d204 4390 devlink->dpipe_headers = dpipe_headers;
2406e7e5 4391 mutex_unlock(&devlink->lock);
1555d204
AS		 4392 return 0;
4393}
4394EXPORT_SYMBOL_GPL(devlink_dpipe_headers_register);
4395
4396/**
4397 * devlink_dpipe_headers_unregister - unregister dpipe headers
4398 *
4399 * @devlink: devlink
4400 *
4401 * Unregister the headers supported by hardware.
4402 */
4403void devlink_dpipe_headers_unregister(struct devlink *devlink)
4404{
2406e7e5 4405 mutex_lock(&devlink->lock);
1555d204 4406 devlink->dpipe_headers = NULL;
2406e7e5 4407 mutex_unlock(&devlink->lock);
1555d204
AS		 4408}
4409EXPORT_SYMBOL_GPL(devlink_dpipe_headers_unregister);
4410
4411/**
4412 * devlink_dpipe_table_counter_enabled - check if counter allocation
4413 * required
4414 * @devlink: devlink
4415 * @table_name: tables name
4416 *
4417 * Used by driver to check if counter allocation is required.
4418 * After counter allocation is turned on the table entries
4419 * are updated to include counter statistics.
4420 *
4421 * After that point on the driver must respect the counter
4422 * state so that each entry added to the table is added
4423 * with a counter.
4424 */
4425bool devlink_dpipe_table_counter_enabled(struct devlink *devlink,
4426 const char *table_name)
4427{
4428 struct devlink_dpipe_table *table;
4429 bool enabled;
4430
4431 rcu_read_lock();
4432 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
4433 table_name);
4434 enabled = false;
4435 if (table)
4436 enabled = table->counters_enabled;
4437 rcu_read_unlock();
4438 return enabled;
4439}
4440EXPORT_SYMBOL_GPL(devlink_dpipe_table_counter_enabled);
4441
4442/**
4443 * devlink_dpipe_table_register - register dpipe table
4444 *
4445 * @devlink: devlink
4446 * @table_name: table name
4447 * @table_ops: table ops
4448 * @priv: priv
1555d204
AS		 4449 * @counter_control_extern: external control for counters
4450 */
4451int devlink_dpipe_table_register(struct devlink *devlink,
4452 const char *table_name,
4453 struct devlink_dpipe_table_ops *table_ops,
ffd3cdcc 4454 void *priv, bool counter_control_extern)
1555d204
AS		 4455{
4456 struct devlink_dpipe_table *table;
4457
4458 if (devlink_dpipe_table_find(&devlink->dpipe_table_list, table_name))
4459 return -EEXIST;
4460
ffd3cdcc
AS		 4461 if (WARN_ON(!table_ops->size_get))
4462 return -EINVAL;
4463
1555d204
AS		 4464 table = kzalloc(sizeof(*table), GFP_KERNEL);
4465 if (!table)
4466 return -ENOMEM;
4467
4468 table->name = table_name;
4469 table->table_ops = table_ops;
4470 table->priv = priv;
1555d204
AS		 4471 table->counter_control_extern = counter_control_extern;
4472
2406e7e5 4473 mutex_lock(&devlink->lock);
1555d204 4474 list_add_tail_rcu(&table->list, &devlink->dpipe_table_list);
2406e7e5 4475 mutex_unlock(&devlink->lock);
1555d204
AS		 4476 return 0;
4477}
4478EXPORT_SYMBOL_GPL(devlink_dpipe_table_register);
4479
4480/**
4481 * devlink_dpipe_table_unregister - unregister dpipe table
4482 *
4483 * @devlink: devlink
4484 * @table_name: table name
4485 */
4486void devlink_dpipe_table_unregister(struct devlink *devlink,
4487 const char *table_name)
4488{
4489 struct devlink_dpipe_table *table;
4490
2406e7e5 4491 mutex_lock(&devlink->lock);
1555d204
AS		 4492 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
4493 table_name);
4494 if (!table)
4495 goto unlock;
4496 list_del_rcu(&table->list);
2406e7e5 4497 mutex_unlock(&devlink->lock);
1555d204
AS		 4498 kfree_rcu(table, rcu);
4499 return;
4500unlock:
2406e7e5 4501 mutex_unlock(&devlink->lock);
1555d204
AS		 4502}
4503EXPORT_SYMBOL_GPL(devlink_dpipe_table_unregister);
4504
d9f9b9a4
AS		 4505/**
4506 * devlink_resource_register - devlink resource register
4507 *
4508 * @devlink: devlink
4509 * @resource_name: resource's name
4510 * @top_hierarchy: top hierarchy
4511 * @reload_required: reload is required for new configuration to
4512 * apply
4513 * @resource_size: resource's size
4514 * @resource_id: resource's id
4515 * @parent_reosurce_id: resource's parent id
4516 * @size params: size parameters
d9f9b9a4
AS		 4517 */
4518int devlink_resource_register(struct devlink *devlink,
4519 const char *resource_name,
d9f9b9a4
AS		 4520 u64 resource_size,
4521 u64 resource_id,
4522 u64 parent_resource_id,
fc56be47 4523 const struct devlink_resource_size_params *size_params)
d9f9b9a4
AS		 4524{
4525 struct devlink_resource *resource;
4526 struct list_head *resource_list;
14530746 4527 bool top_hierarchy;
d9f9b9a4
AS		 4528 int err = 0;
4529
14530746
DA		 4530 top_hierarchy = parent_resource_id == DEVLINK_RESOURCE_ID_PARENT_TOP;
4531
d9f9b9a4
AS		 4532 mutex_lock(&devlink->lock);
4533 resource = devlink_resource_find(devlink, NULL, resource_id);
4534 if (resource) {
4535 err = -EINVAL;
4536 goto out;
4537 }
4538
4539 resource = kzalloc(sizeof(*resource), GFP_KERNEL);
4540 if (!resource) {
4541 err = -ENOMEM;
4542 goto out;
4543 }
4544
4545 if (top_hierarchy) {
4546 resource_list = &devlink->resource_list;
4547 } else {
4548 struct devlink_resource *parent_resource;
4549
4550 parent_resource = devlink_resource_find(devlink, NULL,
4551 parent_resource_id);
4552 if (parent_resource) {
4553 resource_list = &parent_resource->resource_list;
4554 resource->parent = parent_resource;
4555 } else {
b75703de 4556 kfree(resource);
d9f9b9a4
AS		 4557 err = -EINVAL;
4558 goto out;
4559 }
4560 }
4561
4562 resource->name = resource_name;
4563 resource->size = resource_size;
4564 resource->size_new = resource_size;
4565 resource->id = resource_id;
d9f9b9a4 4566 resource->size_valid = true;
77d27096
JP		 4567 memcpy(&resource->size_params, size_params,
4568 sizeof(resource->size_params));
d9f9b9a4
AS		 4569 INIT_LIST_HEAD(&resource->resource_list);
4570 list_add_tail(&resource->list, resource_list);
4571out:
4572 mutex_unlock(&devlink->lock);
4573 return err;
4574}
4575EXPORT_SYMBOL_GPL(devlink_resource_register);
4576
4577/**
4578 * devlink_resources_unregister - free all resources
4579 *
4580 * @devlink: devlink
4581 * @resource: resource
4582 */
4583void devlink_resources_unregister(struct devlink *devlink,
4584 struct devlink_resource *resource)
4585{
4586 struct devlink_resource *tmp, *child_resource;
4587 struct list_head *resource_list;
4588
4589 if (resource)
4590 resource_list = &resource->resource_list;
4591 else
4592 resource_list = &devlink->resource_list;
4593
4594 if (!resource)
4595 mutex_lock(&devlink->lock);
4596
4597 list_for_each_entry_safe(child_resource, tmp, resource_list, list) {
4598 devlink_resources_unregister(devlink, child_resource);
4599 list_del(&child_resource->list);
4600 kfree(child_resource);
4601 }
4602
4603 if (!resource)
4604 mutex_unlock(&devlink->lock);
4605}
4606EXPORT_SYMBOL_GPL(devlink_resources_unregister);
4607
4608/**
4609 * devlink_resource_size_get - get and update size
4610 *
4611 * @devlink: devlink
4612 * @resource_id: the requested resource id
4613 * @p_resource_size: ptr to update
4614 */
4615int devlink_resource_size_get(struct devlink *devlink,
4616 u64 resource_id,
4617 u64 *p_resource_size)
4618{
4619 struct devlink_resource *resource;
4620 int err = 0;
4621
4622 mutex_lock(&devlink->lock);
4623 resource = devlink_resource_find(devlink, NULL, resource_id);
4624 if (!resource) {
4625 err = -EINVAL;
4626 goto out;
4627 }
4628 *p_resource_size = resource->size_new;
4629 resource->size = resource->size_new;
4630out:
4631 mutex_unlock(&devlink->lock);
4632 return err;
4633}
4634EXPORT_SYMBOL_GPL(devlink_resource_size_get);
4635
56dc7cd0
AS		 4636/**
4637 * devlink_dpipe_table_resource_set - set the resource id
4638 *
4639 * @devlink: devlink
4640 * @table_name: table name
4641 * @resource_id: resource id
4642 * @resource_units: number of resource's units consumed per table's entry
4643 */
4644int devlink_dpipe_table_resource_set(struct devlink *devlink,
4645 const char *table_name, u64 resource_id,
4646 u64 resource_units)
4647{
4648 struct devlink_dpipe_table *table;
4649 int err = 0;
4650
4651 mutex_lock(&devlink->lock);
4652 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
4653 table_name);
4654 if (!table) {
4655 err = -EINVAL;
4656 goto out;
4657 }
4658 table->resource_id = resource_id;
4659 table->resource_units = resource_units;
4660 table->resource_valid = true;
4661out:
4662 mutex_unlock(&devlink->lock);
4663 return err;
4664}
4665EXPORT_SYMBOL_GPL(devlink_dpipe_table_resource_set);
4666
fc56be47
JP		 4667/**
4668 * devlink_resource_occ_get_register - register occupancy getter
4669 *
4670 * @devlink: devlink
4671 * @resource_id: resource id
4672 * @occ_get: occupancy getter callback
4673 * @occ_get_priv: occupancy getter callback priv
4674 */
4675void devlink_resource_occ_get_register(struct devlink *devlink,
4676 u64 resource_id,
4677 devlink_resource_occ_get_t *occ_get,
4678 void *occ_get_priv)
4679{
4680 struct devlink_resource *resource;
4681
4682 mutex_lock(&devlink->lock);
4683 resource = devlink_resource_find(devlink, NULL, resource_id);
4684 if (WARN_ON(!resource))
4685 goto out;
4686 WARN_ON(resource->occ_get);
4687
4688 resource->occ_get = occ_get;
4689 resource->occ_get_priv = occ_get_priv;
4690out:
4691 mutex_unlock(&devlink->lock);
4692}
4693EXPORT_SYMBOL_GPL(devlink_resource_occ_get_register);
4694
4695/**
4696 * devlink_resource_occ_get_unregister - unregister occupancy getter
4697 *
4698 * @devlink: devlink
4699 * @resource_id: resource id
4700 */
4701void devlink_resource_occ_get_unregister(struct devlink *devlink,
4702 u64 resource_id)
4703{
4704 struct devlink_resource *resource;
4705
4706 mutex_lock(&devlink->lock);
4707 resource = devlink_resource_find(devlink, NULL, resource_id);
4708 if (WARN_ON(!resource))
4709 goto out;
4710 WARN_ON(!resource->occ_get);
4711
4712 resource->occ_get = NULL;
4713 resource->occ_get_priv = NULL;
4714out:
4715 mutex_unlock(&devlink->lock);
4716}
4717EXPORT_SYMBOL_GPL(devlink_resource_occ_get_unregister);
4718
39e6160e
VV		 4719static int devlink_param_verify(const struct devlink_param *param)
4720{
4721 if (!param || !param->name || !param->supported_cmodes)
4722 return -EINVAL;
4723 if (param->generic)
4724 return devlink_param_generic_verify(param);
4725 else
4726 return devlink_param_driver_verify(param);
4727}
4728
4729static int __devlink_params_register(struct devlink *devlink,
c1e5786d 4730 unsigned int port_index,
39e6160e
VV		 4731 struct list_head *param_list,
4732 const struct devlink_param *params,
c1e5786d
VV		 4733 size_t params_count,
4734 enum devlink_command reg_cmd,
4735 enum devlink_command unreg_cmd)
eabaef18
MS		 4736{
4737 const struct devlink_param *param = params;
4738 int i;
4739 int err;
4740
4741 mutex_lock(&devlink->lock);
4742 for (i = 0; i < params_count; i++, param++) {
39e6160e
VV		 4743 err = devlink_param_verify(param);
4744 if (err)
eabaef18 4745 goto rollback;
39e6160e 4746
c1e5786d
VV		 4747 err = devlink_param_register_one(devlink, port_index,
4748 param_list, param, reg_cmd);
eabaef18
MS		 4749 if (err)
4750 goto rollback;
4751 }
4752
4753 mutex_unlock(&devlink->lock);
4754 return 0;
4755
4756rollback:
4757 if (!i)
4758 goto unlock;
4759 for (param--; i > 0; i--, param--)
c1e5786d
VV		 4760 devlink_param_unregister_one(devlink, port_index, param_list,
4761 param, unreg_cmd);
eabaef18
MS		 4762unlock:
4763 mutex_unlock(&devlink->lock);
4764 return err;
4765}
39e6160e
VV		 4766
4767static void __devlink_params_unregister(struct devlink *devlink,
c1e5786d 4768 unsigned int port_index,
39e6160e
VV		 4769 struct list_head *param_list,
4770 const struct devlink_param *params,
c1e5786d
VV		 4771 size_t params_count,
4772 enum devlink_command cmd)
39e6160e
VV		 4773{
4774 const struct devlink_param *param = params;
4775 int i;
4776
4777 mutex_lock(&devlink->lock);
4778 for (i = 0; i < params_count; i++, param++)
c1e5786d
VV		 4779 devlink_param_unregister_one(devlink, 0, param_list, param,
4780 cmd);
39e6160e
VV		 4781 mutex_unlock(&devlink->lock);
4782}
4783
4784/**
4785 * devlink_params_register - register configuration parameters
4786 *
4787 * @devlink: devlink
4788 * @params: configuration parameters array
4789 * @params_count: number of parameters provided
4790 *
4791 * Register the configuration parameters supported by the driver.
4792 */
4793int devlink_params_register(struct devlink *devlink,
4794 const struct devlink_param *params,
4795 size_t params_count)
4796{
c1e5786d
VV		 4797 return __devlink_params_register(devlink, 0, &devlink->param_list,
4798 params, params_count,
4799 DEVLINK_CMD_PARAM_NEW,
4800 DEVLINK_CMD_PARAM_DEL);
39e6160e 4801}
eabaef18
MS		 4802EXPORT_SYMBOL_GPL(devlink_params_register);
4803
4804/**
4805 * devlink_params_unregister - unregister configuration parameters
4806 * @devlink: devlink
4807 * @params: configuration parameters to unregister
4808 * @params_count: number of parameters provided
4809 */
4810void devlink_params_unregister(struct devlink *devlink,
4811 const struct devlink_param *params,
4812 size_t params_count)
4813{
c1e5786d
VV		 4814 return __devlink_params_unregister(devlink, 0, &devlink->param_list,
4815 params, params_count,
4816 DEVLINK_CMD_PARAM_DEL);
eabaef18
MS		 4817}
4818EXPORT_SYMBOL_GPL(devlink_params_unregister);
4819
39e6160e
VV		 4820/**
4821 * devlink_port_params_register - register port configuration parameters
4822 *
4823 * @devlink_port: devlink port
4824 * @params: configuration parameters array
4825 * @params_count: number of parameters provided
4826 *
4827 * Register the configuration parameters supported by the port.
4828 */
4829int devlink_port_params_register(struct devlink_port *devlink_port,
4830 const struct devlink_param *params,
4831 size_t params_count)
4832{
4833 return __devlink_params_register(devlink_port->devlink,
c1e5786d 4834 devlink_port->index,
39e6160e 4835 &devlink_port->param_list, params,
c1e5786d
VV		 4836 params_count,
4837 DEVLINK_CMD_PORT_PARAM_NEW,
4838 DEVLINK_CMD_PORT_PARAM_DEL);
39e6160e
VV		 4839}
4840EXPORT_SYMBOL_GPL(devlink_port_params_register);
4841
4842/**
4843 * devlink_port_params_unregister - unregister port configuration
4844 * parameters
4845 *
4846 * @devlink_port: devlink port
4847 * @params: configuration parameters array
4848 * @params_count: number of parameters provided
4849 */
4850void devlink_port_params_unregister(struct devlink_port *devlink_port,
4851 const struct devlink_param *params,
4852 size_t params_count)
4853{
4854 return __devlink_params_unregister(devlink_port->devlink,
c1e5786d 4855 devlink_port->index,
39e6160e 4856 &devlink_port->param_list,
c1e5786d
VV		 4857 params, params_count,
4858 DEVLINK_CMD_PORT_PARAM_DEL);
39e6160e
VV		 4859}
4860EXPORT_SYMBOL_GPL(devlink_port_params_unregister);
4861
ffd19b9a
VV		 4862static int
4863__devlink_param_driverinit_value_get(struct list_head *param_list, u32 param_id,
4864 union devlink_param_value *init_val)
ec01aeb1
MS		 4865{
4866 struct devlink_param_item *param_item;
4867
ffd19b9a 4868 param_item = devlink_param_find_by_id(param_list, param_id);
ec01aeb1
MS		 4869 if (!param_item)
4870 return -EINVAL;
4871
4872 if (!param_item->driverinit_value_valid ||
4873 !devlink_param_cmode_is_supported(param_item->param,
4874 DEVLINK_PARAM_CMODE_DRIVERINIT))
4875 return -EOPNOTSUPP;
4876
1276534c
MS		 4877 if (param_item->param->type == DEVLINK_PARAM_TYPE_STRING)
4878 strcpy(init_val->vstr, param_item->driverinit_value.vstr);
4879 else
4880 *init_val = param_item->driverinit_value;
ec01aeb1
MS		 4881
4882 return 0;
4883}
ffd19b9a 4884
5473a7bd
VV		 4885static int
4886__devlink_param_driverinit_value_set(struct devlink *devlink,
c1e5786d 4887 unsigned int port_index,
5473a7bd
VV		 4888 struct list_head *param_list, u32 param_id,
4889 union devlink_param_value init_val,
4890 enum devlink_command cmd)
4891{
4892 struct devlink_param_item *param_item;
4893
4894 param_item = devlink_param_find_by_id(param_list, param_id);
4895 if (!param_item)
4896 return -EINVAL;
4897
4898 if (!devlink_param_cmode_is_supported(param_item->param,
4899 DEVLINK_PARAM_CMODE_DRIVERINIT))
4900 return -EOPNOTSUPP;
4901
4902 if (param_item->param->type == DEVLINK_PARAM_TYPE_STRING)
4903 strcpy(param_item->driverinit_value.vstr, init_val.vstr);
4904 else
4905 param_item->driverinit_value = init_val;
4906 param_item->driverinit_value_valid = true;
4907
c1e5786d 4908 devlink_param_notify(devlink, port_index, param_item, cmd);
5473a7bd
VV		 4909 return 0;
4910}
4911
ffd19b9a
VV		 4912/**
4913 * devlink_param_driverinit_value_get - get configuration parameter
4914 * value for driver initializing
4915 *
4916 * @devlink: devlink
4917 * @param_id: parameter ID
4918 * @init_val: value of parameter in driverinit configuration mode
4919 *
4920 * This function should be used by the driver to get driverinit
4921 * configuration for initialization after reload command.
4922 */
4923int devlink_param_driverinit_value_get(struct devlink *devlink, u32 param_id,
4924 union devlink_param_value *init_val)
4925{
4926 if (!devlink->ops || !devlink->ops->reload)
4927 return -EOPNOTSUPP;
4928
4929 return __devlink_param_driverinit_value_get(&devlink->param_list,
4930 param_id, init_val);
4931}
ec01aeb1
MS		 4932EXPORT_SYMBOL_GPL(devlink_param_driverinit_value_get);
4933
4934/**
4935 * devlink_param_driverinit_value_set - set value of configuration
4936 * parameter for driverinit
4937 * configuration mode
4938 *
4939 * @devlink: devlink
4940 * @param_id: parameter ID
4941 * @init_val: value of parameter to set for driverinit configuration mode
4942 *
4943 * This function should be used by the driver to set driverinit
4944 * configuration mode default value.
4945 */
4946int devlink_param_driverinit_value_set(struct devlink *devlink, u32 param_id,
4947 union devlink_param_value init_val)
4948{
c1e5786d 4949 return __devlink_param_driverinit_value_set(devlink, 0,
5473a7bd
VV		 4950 &devlink->param_list,
4951 param_id, init_val,
4952 DEVLINK_CMD_PARAM_NEW);
ec01aeb1
MS		 4953}
4954EXPORT_SYMBOL_GPL(devlink_param_driverinit_value_set);
4955
ffd19b9a
VV		 4956/**
4957 * devlink_port_param_driverinit_value_get - get configuration parameter
4958 * value for driver initializing
4959 *
4960 * @devlink_port: devlink_port
4961 * @param_id: parameter ID
4962 * @init_val: value of parameter in driverinit configuration mode
4963 *
4964 * This function should be used by the driver to get driverinit
4965 * configuration for initialization after reload command.
4966 */
4967int devlink_port_param_driverinit_value_get(struct devlink_port *devlink_port,
4968 u32 param_id,
4969 union devlink_param_value *init_val)
4970{
4971 struct devlink *devlink = devlink_port->devlink;
4972
4973 if (!devlink->ops || !devlink->ops->reload)
4974 return -EOPNOTSUPP;
4975
4976 return __devlink_param_driverinit_value_get(&devlink_port->param_list,
4977 param_id, init_val);
4978}
4979EXPORT_SYMBOL_GPL(devlink_port_param_driverinit_value_get);
4980
5473a7bd
VV		 4981/**
4982 * devlink_port_param_driverinit_value_set - set value of configuration
4983 * parameter for driverinit
4984 * configuration mode
4985 *
4986 * @devlink_port: devlink_port
4987 * @param_id: parameter ID
4988 * @init_val: value of parameter to set for driverinit configuration mode
4989 *
4990 * This function should be used by the driver to set driverinit
4991 * configuration mode default value.
4992 */
4993int devlink_port_param_driverinit_value_set(struct devlink_port *devlink_port,
4994 u32 param_id,
4995 union devlink_param_value init_val)
4996{
4997 return __devlink_param_driverinit_value_set(devlink_port->devlink,
c1e5786d 4998 devlink_port->index,
5473a7bd 4999 &devlink_port->param_list,
c1e5786d
VV		 5000 param_id, init_val,
5001 DEVLINK_CMD_PORT_PARAM_NEW);
5473a7bd
VV		 5002}
5003EXPORT_SYMBOL_GPL(devlink_port_param_driverinit_value_set);
5004
ea601e17
MS		 5005/**
5006 * devlink_param_value_changed - notify devlink on a parameter's value
5007 * change. Should be called by the driver
5008 * right after the change.
5009 *
5010 * @devlink: devlink
5011 * @param_id: parameter ID
5012 *
5013 * This function should be used by the driver to notify devlink on value
5014 * change, excluding driverinit configuration mode.
5015 * For driverinit configuration mode driver should use the function
ea601e17
MS		 5016 */
5017void devlink_param_value_changed(struct devlink *devlink, u32 param_id)
5018{
5019 struct devlink_param_item *param_item;
5020
5021 param_item = devlink_param_find_by_id(&devlink->param_list, param_id);
5022 WARN_ON(!param_item);
5023
c1e5786d 5024 devlink_param_notify(devlink, 0, param_item, DEVLINK_CMD_PARAM_NEW);
ea601e17
MS		 5025}
5026EXPORT_SYMBOL_GPL(devlink_param_value_changed);
5027
c1e5786d
VV		 5028/**
5029 * devlink_port_param_value_changed - notify devlink on a parameter's value
5030 * change. Should be called by the driver
5031 * right after the change.
5032 *
5033 * @devlink_port: devlink_port
5034 * @param_id: parameter ID
5035 *
5036 * This function should be used by the driver to notify devlink on value
5037 * change, excluding driverinit configuration mode.
5038 * For driverinit configuration mode driver should use the function
5039 * devlink_port_param_driverinit_value_set() instead.
5040 */
5041void devlink_port_param_value_changed(struct devlink_port *devlink_port,
5042 u32 param_id)
5043{
5044 struct devlink_param_item *param_item;
5045
5046 param_item = devlink_param_find_by_id(&devlink_port->param_list,
5047 param_id);
5048 WARN_ON(!param_item);
5049
5050 devlink_param_notify(devlink_port->devlink, devlink_port->index,
5051 param_item, DEVLINK_CMD_PORT_PARAM_NEW);
5052}
5053EXPORT_SYMBOL_GPL(devlink_port_param_value_changed);
5054
bde74ad1
MS		 5055/**
5056 * devlink_param_value_str_fill - Safely fill-up the string preventing
5057 * from overflow of the preallocated buffer
5058 *
5059 * @dst_val: destination devlink_param_value
5060 * @src: source buffer
5061 */
5062void devlink_param_value_str_fill(union devlink_param_value *dst_val,
5063 const char *src)
5064{
5065 size_t len;
5066
5067 len = strlcpy(dst_val->vstr, src, __DEVLINK_PARAM_MAX_STRING_VALUE);
5068 WARN_ON(len >= __DEVLINK_PARAM_MAX_STRING_VALUE);
5069}
5070EXPORT_SYMBOL_GPL(devlink_param_value_str_fill);
5071
b16ebe92
AV		 5072/**
5073 * devlink_region_create - create a new address region
5074 *
5075 * @devlink: devlink
5076 * @region_name: region name
5077 * @region_max_snapshots: Maximum supported number of snapshots for region
5078 * @region_size: size of region
5079 */
5080struct devlink_region *devlink_region_create(struct devlink *devlink,
5081 const char *region_name,
5082 u32 region_max_snapshots,
5083 u64 region_size)
5084{
5085 struct devlink_region *region;
5086 int err = 0;
5087
5088 mutex_lock(&devlink->lock);
5089
5090 if (devlink_region_get_by_name(devlink, region_name)) {
5091 err = -EEXIST;
5092 goto unlock;
5093 }
5094
5095 region = kzalloc(sizeof(*region), GFP_KERNEL);
5096 if (!region) {
5097 err = -ENOMEM;
5098 goto unlock;
5099 }
5100
5101 region->devlink = devlink;
5102 region->max_snapshots = region_max_snapshots;
5103 region->name = region_name;
5104 region->size = region_size;
5105 INIT_LIST_HEAD(&region->snapshot_list);
5106 list_add_tail(&region->list, &devlink->region_list);
866319bb 5107 devlink_nl_region_notify(region, NULL, DEVLINK_CMD_REGION_NEW);
b16ebe92
AV		 5108
5109 mutex_unlock(&devlink->lock);
5110 return region;
5111
5112unlock:
5113 mutex_unlock(&devlink->lock);
5114 return ERR_PTR(err);
5115}
5116EXPORT_SYMBOL_GPL(devlink_region_create);
5117
5118/**
5119 * devlink_region_destroy - destroy address region
5120 *
5121 * @region: devlink region to destroy
5122 */
5123void devlink_region_destroy(struct devlink_region *region)
5124{
5125 struct devlink *devlink = region->devlink;
d7e52722 5126 struct devlink_snapshot *snapshot, *ts;
b16ebe92
AV		 5127
5128 mutex_lock(&devlink->lock);
d7e52722
AV		 5129
5130 /* Free all snapshots of region */
5131 list_for_each_entry_safe(snapshot, ts, &region->snapshot_list, list)
5132 devlink_region_snapshot_del(snapshot);
5133
b16ebe92 5134 list_del(&region->list);
866319bb
AV		 5135
5136 devlink_nl_region_notify(region, NULL, DEVLINK_CMD_REGION_DEL);
b16ebe92
AV		 5137 mutex_unlock(&devlink->lock);
5138 kfree(region);
5139}
5140EXPORT_SYMBOL_GPL(devlink_region_destroy);
5141
ccadfa44
AV		 5142/**
5143 * devlink_region_shapshot_id_get - get snapshot ID
5144 *
5145 * This callback should be called when adding a new snapshot,
5146 * Driver should use the same id for multiple snapshots taken
5147 * on multiple regions at the same time/by the same trigger.
5148 *
5149 * @devlink: devlink
5150 */
5151u32 devlink_region_shapshot_id_get(struct devlink *devlink)
5152{
5153 u32 id;
5154
5155 mutex_lock(&devlink->lock);
5156 id = ++devlink->snapshot_id;
5157 mutex_unlock(&devlink->lock);
5158
5159 return id;
5160}
5161EXPORT_SYMBOL_GPL(devlink_region_shapshot_id_get);
5162
d7e52722
AV		 5163/**
5164 * devlink_region_snapshot_create - create a new snapshot
5165 * This will add a new snapshot of a region. The snapshot
5166 * will be stored on the region struct and can be accessed
5167 * from devlink. This is useful for future analyses of snapshots.
5168 * Multiple snapshots can be created on a region.
5169 * The @snapshot_id should be obtained using the getter function.
5170 *
5171 * @devlink_region: devlink region of the snapshot
5172 * @data_len: size of snapshot data
5173 * @data: snapshot data
5174 * @snapshot_id: snapshot id to be created
5175 * @data_destructor: pointer to destructor function to free data
5176 */
5177int devlink_region_snapshot_create(struct devlink_region *region, u64 data_len,
5178 u8 *data, u32 snapshot_id,
5179 devlink_snapshot_data_dest_t *data_destructor)
5180{
5181 struct devlink *devlink = region->devlink;
5182 struct devlink_snapshot *snapshot;
5183 int err;
5184
5185 mutex_lock(&devlink->lock);
5186
5187 /* check if region can hold one more snapshot */
5188 if (region->cur_snapshots == region->max_snapshots) {
5189 err = -ENOMEM;
5190 goto unlock;
5191 }
5192
5193 if (devlink_region_snapshot_get_by_id(region, snapshot_id)) {
5194 err = -EEXIST;
5195 goto unlock;
5196 }
5197
5198 snapshot = kzalloc(sizeof(*snapshot), GFP_KERNEL);
5199 if (!snapshot) {
5200 err = -ENOMEM;
5201 goto unlock;
5202 }
5203
5204 snapshot->id = snapshot_id;
5205 snapshot->region = region;
5206 snapshot->data = data;
5207 snapshot->data_len = data_len;
5208 snapshot->data_destructor = data_destructor;
5209
5210 list_add_tail(&snapshot->list, &region->snapshot_list);
5211
5212 region->cur_snapshots++;
5213
866319bb 5214 devlink_nl_region_notify(region, snapshot, DEVLINK_CMD_REGION_NEW);
d7e52722
AV		 5215 mutex_unlock(&devlink->lock);
5216 return 0;
5217
5218unlock:
5219 mutex_unlock(&devlink->lock);
5220 return err;
5221}
5222EXPORT_SYMBOL_GPL(devlink_region_snapshot_create);
5223
bfcd3a46
JP		 5224static int __init devlink_module_init(void)
5225{
489111e5 5226 return genl_register_family(&devlink_nl_family);
bfcd3a46
JP		 5227}
5228
5229static void __exit devlink_module_exit(void)
5230{
5231 genl_unregister_family(&devlink_nl_family);
5232}
5233
5234module_init(devlink_module_init);
5235module_exit(devlink_module_exit);
5236
5237MODULE_LICENSE("GPL v2");
5238MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
5239MODULE_DESCRIPTION("Network physical device Netlink interface");
5240MODULE_ALIAS_GENL_FAMILY(DEVLINK_GENL_NAME);
Linux 6.x block layer and io_uring tree(s)