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, cmd: NFP_MBOX_POOL_GET, in_data: &id, in_length: sizeof(id), |
42 | out_data: &get_data, out_length: 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, cmd: NFP_MBOX_POOL_SET, in_data: &set_data, in_length: sizeof(set_data), |
75 | NULL, out_length: 0); |
76 | } |
77 | |
78 | int nfp_shared_buf_register(struct nfp_pf *pf) |
79 | { |
80 | struct devlink *devlink = priv_to_devlink(priv: 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, default_val: 0); |
90 | if (n <= 0) |
91 | return n; |
92 | num_entries = n; |
93 | |
94 | sb_desc = nfp_pf_map_rtsym(pf, name: "sb_tbl" , NFP_SHARED_BUF_TABLE_SYM_NAME, |
95 | min_size: num_entries * sizeof(pf->shared_bufs[0]), |
96 | area: &sb_desc_area); |
97 | if (IS_ERR(ptr: sb_desc)) |
98 | return PTR_ERR(ptr: sb_desc); |
99 | |
100 | entry_sz = nfp_cpp_area_size(area: sb_desc_area) / num_entries; |
101 | |
102 | pf->shared_bufs = kmalloc_array(n: num_entries, size: 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(area: 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(objp: pf->shared_bufs); |
136 | err_release_area: |
137 | nfp_cpp_area_release_free(area: 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(priv: 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(objp: pf->shared_bufs); |
150 | } |
151 | |