1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
2 /* Copyright (C) 2018 Netronome Systems, Inc. */
3 
4 #include <linux/kernel.h>
5 #include <net/devlink.h>
6 
7 #include "nfpcore/nfp_cpp.h"
8 #include "nfpcore/nfp_nffw.h"
9 #include "nfp_abi.h"
10 #include "nfp_app.h"
11 #include "nfp_main.h"
12 
13 static u32 nfp_shared_buf_pool_unit(struct nfp_pf *pf, unsigned int sb)
14 {
15 	__le32 sb_id = cpu_to_le32(sb);
16 	unsigned int i;
17 
18 	for (i = 0; i < pf->num_shared_bufs; i++)
19 		if (pf->shared_bufs[i].id == sb_id)
20 			return le32_to_cpu(pf->shared_bufs[i].pool_size_unit);
21 
22 	WARN_ON_ONCE(1);
23 	return 0;
24 }
25 
26 int nfp_shared_buf_pool_get(struct nfp_pf *pf, unsigned int sb, u16 pool_index,
27 			    struct devlink_sb_pool_info *pool_info)
28 {
29 	struct nfp_shared_buf_pool_info_get get_data;
30 	struct nfp_shared_buf_pool_id id = {
31 		.shared_buf	= cpu_to_le32(sb),
32 		.pool		= cpu_to_le32(pool_index),
33 	};
34 	unsigned int unit_size;
35 	int n;
36 
37 	unit_size = nfp_shared_buf_pool_unit(pf, sb);
38 	if (!unit_size)
39 		return -EINVAL;
40 
41 	n = nfp_mbox_cmd(pf, NFP_MBOX_POOL_GET, &id, sizeof(id),
42 			 &get_data, sizeof(get_data));
43 	if (n < 0)
44 		return n;
45 	if (n < sizeof(get_data))
46 		return -EIO;
47 
48 	pool_info->pool_type = le32_to_cpu(get_data.pool_type);
49 	pool_info->threshold_type = le32_to_cpu(get_data.threshold_type);
50 	pool_info->size = le32_to_cpu(get_data.size) * unit_size;
51 	pool_info->cell_size = unit_size;
52 
53 	return 0;
54 }
55 
56 int nfp_shared_buf_pool_set(struct nfp_pf *pf, unsigned int sb,
57 			    u16 pool_index, u32 size,
58 			    enum devlink_sb_threshold_type threshold_type)
59 {
60 	struct nfp_shared_buf_pool_info_set set_data = {
61 		.id = {
62 			.shared_buf	= cpu_to_le32(sb),
63 			.pool		= cpu_to_le32(pool_index),
64 		},
65 		.threshold_type	= cpu_to_le32(threshold_type),
66 	};
67 	unsigned int unit_size;
68 
69 	unit_size = nfp_shared_buf_pool_unit(pf, sb);
70 	if (!unit_size || size % unit_size)
71 		return -EINVAL;
72 	set_data.size = cpu_to_le32(size / unit_size);
73 
74 	return nfp_mbox_cmd(pf, NFP_MBOX_POOL_SET, &set_data, sizeof(set_data),
75 			    NULL, 0);
76 }
77 
78 int nfp_shared_buf_register(struct nfp_pf *pf)
79 {
80 	struct devlink *devlink = priv_to_devlink(pf);
81 	unsigned int i, num_entries, entry_sz;
82 	struct nfp_cpp_area *sb_desc_area;
83 	u8 __iomem *sb_desc;
84 	int n, err;
85 
86 	if (!pf->mbox)
87 		return 0;
88 
89 	n = nfp_pf_rtsym_read_optional(pf, NFP_SHARED_BUF_COUNT_SYM_NAME, 0);
90 	if (n <= 0)
91 		return n;
92 	num_entries = n;
93 
94 	sb_desc = nfp_pf_map_rtsym(pf, "sb_tbl", NFP_SHARED_BUF_TABLE_SYM_NAME,
95 				   num_entries * sizeof(pf->shared_bufs[0]),
96 				   &sb_desc_area);
97 	if (IS_ERR(sb_desc))
98 		return PTR_ERR(sb_desc);
99 
100 	entry_sz = nfp_cpp_area_size(sb_desc_area) / num_entries;
101 
102 	pf->shared_bufs = kmalloc_array(num_entries, sizeof(pf->shared_bufs[0]),
103 					GFP_KERNEL);
104 	if (!pf->shared_bufs) {
105 		err = -ENOMEM;
106 		goto err_release_area;
107 	}
108 
109 	for (i = 0; i < num_entries; i++) {
110 		struct nfp_shared_buf *sb = &pf->shared_bufs[i];
111 
112 		/* Entries may be larger in future FW */
113 		memcpy_fromio(sb, sb_desc + i * entry_sz, sizeof(*sb));
114 
115 		err = devlink_sb_register(devlink,
116 					  le32_to_cpu(sb->id),
117 					  le32_to_cpu(sb->size),
118 					  le16_to_cpu(sb->ingress_pools_count),
119 					  le16_to_cpu(sb->egress_pools_count),
120 					  le16_to_cpu(sb->ingress_tc_count),
121 					  le16_to_cpu(sb->egress_tc_count));
122 		if (err)
123 			goto err_unreg_prev;
124 	}
125 	pf->num_shared_bufs = num_entries;
126 
127 	nfp_cpp_area_release_free(sb_desc_area);
128 
129 	return 0;
130 
131 err_unreg_prev:
132 	while (i--)
133 		devlink_sb_unregister(devlink,
134 				      le32_to_cpu(pf->shared_bufs[i].id));
135 	kfree(pf->shared_bufs);
136 err_release_area:
137 	nfp_cpp_area_release_free(sb_desc_area);
138 	return err;
139 }
140 
141 void nfp_shared_buf_unregister(struct nfp_pf *pf)
142 {
143 	struct devlink *devlink = priv_to_devlink(pf);
144 	unsigned int i;
145 
146 	for (i = 0; i < pf->num_shared_bufs; i++)
147 		devlink_sb_unregister(devlink,
148 				      le32_to_cpu(pf->shared_bufs[i].id));
149 	kfree(pf->shared_bufs);
150 }
151