1
2
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
13static 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
26int 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
56int 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
78int 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
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
131err_unreg_prev:
132 while (i--)
133 devlink_sb_unregister(devlink,
134 le32_to_cpu(pf->shared_bufs[i].id));
135 kfree(pf->shared_bufs);
136err_release_area:
137 nfp_cpp_area_release_free(sb_desc_area);
138 return err;
139}
140
141void 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
