1 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
2 /* Copyright (c) 2017-2018 Mellanox Technologies. All rights reserved */
3 
4 #include <linux/kernel.h>
5 #include <linux/errno.h>
6 #include <linux/parman.h>
7 
8 #include "reg.h"
9 #include "core.h"
10 #include "spectrum.h"
11 #include "spectrum_acl_tcam.h"
12 
13 static int
14 mlxsw_sp_acl_ctcam_region_resize(struct mlxsw_sp *mlxsw_sp,
15 				 struct mlxsw_sp_acl_tcam_region *region,
16 				 u16 new_size)
17 {
18 	char ptar_pl[MLXSW_REG_PTAR_LEN];
19 
20 	mlxsw_reg_ptar_pack(ptar_pl, MLXSW_REG_PTAR_OP_RESIZE,
21 			    region->key_type, new_size, region->id,
22 			    region->tcam_region_info);
23 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(ptar), ptar_pl);
24 }
25 
26 static void
27 mlxsw_sp_acl_ctcam_region_move(struct mlxsw_sp *mlxsw_sp,
28 			       struct mlxsw_sp_acl_tcam_region *region,
29 			       u16 src_offset, u16 dst_offset, u16 size)
30 {
31 	char prcr_pl[MLXSW_REG_PRCR_LEN];
32 
33 	mlxsw_reg_prcr_pack(prcr_pl, MLXSW_REG_PRCR_OP_MOVE,
34 			    region->tcam_region_info, src_offset,
35 			    region->tcam_region_info, dst_offset, size);
36 	mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(prcr), prcr_pl);
37 }
38 
39 static int
40 mlxsw_sp_acl_ctcam_region_entry_insert(struct mlxsw_sp *mlxsw_sp,
41 				       struct mlxsw_sp_acl_ctcam_region *cregion,
42 				       struct mlxsw_sp_acl_ctcam_entry *centry,
43 				       struct mlxsw_sp_acl_rule_info *rulei,
44 				       bool fillup_priority)
45 {
46 	struct mlxsw_sp_acl_tcam_region *region = cregion->region;
47 	struct mlxsw_afk *afk = mlxsw_sp_acl_afk(mlxsw_sp->acl);
48 	char ptce2_pl[MLXSW_REG_PTCE2_LEN];
49 	char *act_set;
50 	u32 priority;
51 	char *mask;
52 	char *key;
53 	int err;
54 
55 	err = mlxsw_sp_acl_tcam_priority_get(mlxsw_sp, rulei, &priority,
56 					     fillup_priority);
57 	if (err)
58 		return err;
59 
60 	mlxsw_reg_ptce2_pack(ptce2_pl, true, MLXSW_REG_PTCE2_OP_WRITE_WRITE,
61 			     region->tcam_region_info,
62 			     centry->parman_item.index, priority);
63 	key = mlxsw_reg_ptce2_flex_key_blocks_data(ptce2_pl);
64 	mask = mlxsw_reg_ptce2_mask_data(ptce2_pl);
65 	mlxsw_afk_encode(afk, region->key_info, &rulei->values, key, mask);
66 
67 	err = cregion->ops->entry_insert(cregion, centry, mask);
68 	if (err)
69 		return err;
70 
71 	/* Only the first action set belongs here, the rest is in KVD */
72 	act_set = mlxsw_afa_block_first_set(rulei->act_block);
73 	mlxsw_reg_ptce2_flex_action_set_memcpy_to(ptce2_pl, act_set);
74 
75 	err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(ptce2), ptce2_pl);
76 	if (err)
77 		goto err_ptce2_write;
78 
79 	return 0;
80 
81 err_ptce2_write:
82 	cregion->ops->entry_remove(cregion, centry);
83 	return err;
84 }
85 
86 static void
87 mlxsw_sp_acl_ctcam_region_entry_remove(struct mlxsw_sp *mlxsw_sp,
88 				       struct mlxsw_sp_acl_ctcam_region *cregion,
89 				       struct mlxsw_sp_acl_ctcam_entry *centry)
90 {
91 	char ptce2_pl[MLXSW_REG_PTCE2_LEN];
92 
93 	mlxsw_reg_ptce2_pack(ptce2_pl, false, MLXSW_REG_PTCE2_OP_WRITE_WRITE,
94 			     cregion->region->tcam_region_info,
95 			     centry->parman_item.index, 0);
96 	mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(ptce2), ptce2_pl);
97 	cregion->ops->entry_remove(cregion, centry);
98 }
99 
100 static int
101 mlxsw_sp_acl_ctcam_region_entry_action_replace(struct mlxsw_sp *mlxsw_sp,
102 					       struct mlxsw_sp_acl_ctcam_region *cregion,
103 					       struct mlxsw_sp_acl_ctcam_entry *centry,
104 					       struct mlxsw_afa_block *afa_block,
105 					       unsigned int priority)
106 {
107 	char ptce2_pl[MLXSW_REG_PTCE2_LEN];
108 	char *act_set;
109 
110 	mlxsw_reg_ptce2_pack(ptce2_pl, true, MLXSW_REG_PTCE2_OP_WRITE_UPDATE,
111 			     cregion->region->tcam_region_info,
112 			     centry->parman_item.index, priority);
113 
114 	act_set = mlxsw_afa_block_first_set(afa_block);
115 	mlxsw_reg_ptce2_flex_action_set_memcpy_to(ptce2_pl, act_set);
116 
117 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(ptce2), ptce2_pl);
118 }
119 
120 
121 static int mlxsw_sp_acl_ctcam_region_parman_resize(void *priv,
122 						   unsigned long new_count)
123 {
124 	struct mlxsw_sp_acl_ctcam_region *cregion = priv;
125 	struct mlxsw_sp_acl_tcam_region *region = cregion->region;
126 	struct mlxsw_sp *mlxsw_sp = region->mlxsw_sp;
127 	u64 max_tcam_rules;
128 
129 	max_tcam_rules = MLXSW_CORE_RES_GET(mlxsw_sp->core, ACL_MAX_TCAM_RULES);
130 	if (new_count > max_tcam_rules)
131 		return -EINVAL;
132 	return mlxsw_sp_acl_ctcam_region_resize(mlxsw_sp, region, new_count);
133 }
134 
135 static void mlxsw_sp_acl_ctcam_region_parman_move(void *priv,
136 						  unsigned long from_index,
137 						  unsigned long to_index,
138 						  unsigned long count)
139 {
140 	struct mlxsw_sp_acl_ctcam_region *cregion = priv;
141 	struct mlxsw_sp_acl_tcam_region *region = cregion->region;
142 	struct mlxsw_sp *mlxsw_sp = region->mlxsw_sp;
143 
144 	mlxsw_sp_acl_ctcam_region_move(mlxsw_sp, region,
145 				       from_index, to_index, count);
146 }
147 
148 static const struct parman_ops mlxsw_sp_acl_ctcam_region_parman_ops = {
149 	.base_count	= MLXSW_SP_ACL_TCAM_REGION_BASE_COUNT,
150 	.resize_step	= MLXSW_SP_ACL_TCAM_REGION_RESIZE_STEP,
151 	.resize		= mlxsw_sp_acl_ctcam_region_parman_resize,
152 	.move		= mlxsw_sp_acl_ctcam_region_parman_move,
153 	.algo		= PARMAN_ALGO_TYPE_LSORT,
154 };
155 
156 int
157 mlxsw_sp_acl_ctcam_region_init(struct mlxsw_sp *mlxsw_sp,
158 			       struct mlxsw_sp_acl_ctcam_region *cregion,
159 			       struct mlxsw_sp_acl_tcam_region *region,
160 			       const struct mlxsw_sp_acl_ctcam_region_ops *ops)
161 {
162 	cregion->region = region;
163 	cregion->ops = ops;
164 	cregion->parman = parman_create(&mlxsw_sp_acl_ctcam_region_parman_ops,
165 					cregion);
166 	if (!cregion->parman)
167 		return -ENOMEM;
168 	return 0;
169 }
170 
171 void mlxsw_sp_acl_ctcam_region_fini(struct mlxsw_sp_acl_ctcam_region *cregion)
172 {
173 	parman_destroy(cregion->parman);
174 }
175 
176 void mlxsw_sp_acl_ctcam_chunk_init(struct mlxsw_sp_acl_ctcam_region *cregion,
177 				   struct mlxsw_sp_acl_ctcam_chunk *cchunk,
178 				   unsigned int priority)
179 {
180 	parman_prio_init(cregion->parman, &cchunk->parman_prio, priority);
181 }
182 
183 void mlxsw_sp_acl_ctcam_chunk_fini(struct mlxsw_sp_acl_ctcam_chunk *cchunk)
184 {
185 	parman_prio_fini(&cchunk->parman_prio);
186 }
187 
188 int mlxsw_sp_acl_ctcam_entry_add(struct mlxsw_sp *mlxsw_sp,
189 				 struct mlxsw_sp_acl_ctcam_region *cregion,
190 				 struct mlxsw_sp_acl_ctcam_chunk *cchunk,
191 				 struct mlxsw_sp_acl_ctcam_entry *centry,
192 				 struct mlxsw_sp_acl_rule_info *rulei,
193 				 bool fillup_priority)
194 {
195 	int err;
196 
197 	err = parman_item_add(cregion->parman, &cchunk->parman_prio,
198 			      &centry->parman_item);
199 	if (err)
200 		return err;
201 
202 	err = mlxsw_sp_acl_ctcam_region_entry_insert(mlxsw_sp, cregion, centry,
203 						     rulei, fillup_priority);
204 	if (err)
205 		goto err_rule_insert;
206 	return 0;
207 
208 err_rule_insert:
209 	parman_item_remove(cregion->parman, &cchunk->parman_prio,
210 			   &centry->parman_item);
211 	return err;
212 }
213 
214 void mlxsw_sp_acl_ctcam_entry_del(struct mlxsw_sp *mlxsw_sp,
215 				  struct mlxsw_sp_acl_ctcam_region *cregion,
216 				  struct mlxsw_sp_acl_ctcam_chunk *cchunk,
217 				  struct mlxsw_sp_acl_ctcam_entry *centry)
218 {
219 	mlxsw_sp_acl_ctcam_region_entry_remove(mlxsw_sp, cregion, centry);
220 	parman_item_remove(cregion->parman, &cchunk->parman_prio,
221 			   &centry->parman_item);
222 }
223 
224 int mlxsw_sp_acl_ctcam_entry_action_replace(struct mlxsw_sp *mlxsw_sp,
225 					    struct mlxsw_sp_acl_ctcam_region *cregion,
226 					    struct mlxsw_sp_acl_ctcam_entry *centry,
227 					    struct mlxsw_sp_acl_rule_info *rulei)
228 {
229 	return mlxsw_sp_acl_ctcam_region_entry_action_replace(mlxsw_sp, cregion,
230 							      centry,
231 							      rulei->act_block,
232 							      rulei->priority);
233 }
234