22 static u32 sparx5_lg_get_leak_time(struct sparx5 *sparx5, u32 layer, u32 group)  in sparx5_lg_get_leak_time()  argument
26 	value = spx5_rd(sparx5, HSCH_HSCH_TIMER_CFG(layer, group));  in sparx5_lg_get_leak_time()
30 static void sparx5_lg_set_leak_time(struct sparx5 *sparx5, u32 layer, u32 group,  in sparx5_lg_set_leak_time()  argument
34 		HSCH_HSCH_TIMER_CFG(layer, group));  in sparx5_lg_set_leak_time()
37 static u32 sparx5_lg_get_first(struct sparx5 *sparx5, u32 layer, u32 group)  in sparx5_lg_get_first()  argument
41 	value = spx5_rd(sparx5, HSCH_HSCH_LEAK_CFG(layer, group));  in sparx5_lg_get_first()
45 static u32 sparx5_lg_get_next(struct sparx5 *sparx5, u32 layer, u32 group,  in sparx5_lg_get_next()  argument
55 static u32 sparx5_lg_get_last(struct sparx5 *sparx5, u32 layer, u32 group)  in sparx5_lg_get_last()  argument
59 	itr = sparx5_lg_get_first(sparx5, layer, group);  in sparx5_lg_get_last()
62 		next = sparx5_lg_get_next(sparx5, layer, group, itr);  in sparx5_lg_get_last()
70 static bool sparx5_lg_is_last(struct sparx5 *sparx5, u32 layer, u32 group,  in sparx5_lg_is_last()  argument
73 	return idx == sparx5_lg_get_next(sparx5, layer, group, idx);  in sparx5_lg_is_last()
76 static bool sparx5_lg_is_first(struct sparx5 *sparx5, u32 layer, u32 group,  in sparx5_lg_is_first()  argument
79 	return idx == sparx5_lg_get_first(sparx5, layer, group);  in sparx5_lg_is_first()
82 static bool sparx5_lg_is_empty(struct sparx5 *sparx5, u32 layer, u32 group)  in sparx5_lg_is_empty()  argument
84 	return sparx5_lg_get_leak_time(sparx5, layer, group) == 0;  in sparx5_lg_is_empty()
87 static bool sparx5_lg_is_singular(struct sparx5 *sparx5, u32 layer, u32 group)  in sparx5_lg_is_singular()  argument
89 	if (sparx5_lg_is_empty(sparx5, layer, group))  in sparx5_lg_is_singular()
92 	return sparx5_lg_get_first(sparx5, layer, group) ==  in sparx5_lg_is_singular()
93 	       sparx5_lg_get_last(sparx5, layer, group);  in sparx5_lg_is_singular()
96 static void sparx5_lg_enable(struct sparx5 *sparx5, u32 layer, u32 group,  in sparx5_lg_enable()  argument
99 	sparx5_lg_set_leak_time(sparx5, layer, group, leak_time);  in sparx5_lg_enable()
102 static void sparx5_lg_disable(struct sparx5 *sparx5, u32 layer, u32 group)  in sparx5_lg_disable()  argument
104 	sparx5_lg_set_leak_time(sparx5, layer, group, 0);  in sparx5_lg_disable()
107 static int sparx5_lg_get_group_by_index(struct sparx5 *sparx5, u32 layer,  in sparx5_lg_get_group_by_index()  argument
114 		if (sparx5_lg_is_empty(sparx5, layer, i))  in sparx5_lg_get_group_by_index()
117 		itr = sparx5_lg_get_first(sparx5, layer, i);  in sparx5_lg_get_group_by_index()
120 			next = sparx5_lg_get_next(sparx5, layer, i, itr);  in sparx5_lg_get_group_by_index()
136 static int sparx5_lg_get_group_by_rate(u32 layer, u32 rate, u32 *group)  in sparx5_lg_get_group_by_rate()  argument
138 	struct sparx5_layer *l = &layers[layer];  in sparx5_lg_get_group_by_rate()
153 static int sparx5_lg_get_adjacent(struct sparx5 *sparx5, u32 layer, u32 group,  in sparx5_lg_get_adjacent()  argument
158 	*first = sparx5_lg_get_first(sparx5, layer, group);  in sparx5_lg_get_adjacent()
164 		*next = sparx5_lg_get_next(sparx5, layer, group, itr);  in sparx5_lg_get_adjacent()
179 static int sparx5_lg_conf_set(struct sparx5 *sparx5, u32 layer, u32 group,  in sparx5_lg_conf_set()  argument
182 	u32 leak_time = layers[layer].leak_groups[group].leak_time;  in sparx5_lg_conf_set()
185 	sparx5_lg_disable(sparx5, layer, group);  in sparx5_lg_conf_set()
190 	/* Select layer */  in sparx5_lg_conf_set()
191 	spx5_rmw(HSCH_HSCH_CFG_CFG_HSCH_LAYER_SET(layer),  in sparx5_lg_conf_set()
201 		 HSCH_HSCH_LEAK_CFG(layer, group));  in sparx5_lg_conf_set()
204 	sparx5_lg_enable(sparx5, layer, group, leak_time);  in sparx5_lg_conf_set()
209 static int sparx5_lg_del(struct sparx5 *sparx5, u32 layer, u32 group, u32 idx)  in sparx5_lg_del()  argument
215 	WARN_ON(sparx5_lg_get_adjacent(sparx5, layer, group, idx, &prev, &next,  in sparx5_lg_del()
218 	if (sparx5_lg_is_singular(sparx5, layer, group)) {  in sparx5_lg_del()
220 	} else if (sparx5_lg_is_last(sparx5, layer, group, idx)) {  in sparx5_lg_del()
224 	} else if (sparx5_lg_is_first(sparx5, layer, group, idx)) {  in sparx5_lg_del()
233 	return sparx5_lg_conf_set(sparx5, layer, group, first, idx, next,  in sparx5_lg_del()
237 static int sparx5_lg_add(struct sparx5 *sparx5, u32 layer, u32 new_group,  in sparx5_lg_add()  argument
242 	pr_debug("ADD: layer: %d, new_group: %d, idx: %d", layer, new_group,  in sparx5_lg_add()
246 	if (sparx5_lg_get_group_by_index(sparx5, layer, idx, &old_group) >= 0) {  in sparx5_lg_add()
249 			sparx5_lg_del(sparx5, layer, old_group, idx);  in sparx5_lg_add()
259 	if (sparx5_lg_is_empty(sparx5, layer, new_group))  in sparx5_lg_add()
262 		next = sparx5_lg_get_first(sparx5, layer, new_group);  in sparx5_lg_add()
264 	return sparx5_lg_conf_set(sparx5, layer, new_group, first, idx, next,  in sparx5_lg_add()
269 				  const struct sparx5_shaper *sh, u32 layer,  in sparx5_shaper_conf_set()  argument
280 	/* Select layer */  in sparx5_shaper_conf_set()
281 	spx5_rmw(HSCH_HSCH_CFG_CFG_HSCH_LAYER_SET(layer),  in sparx5_shaper_conf_set()
294 	sparx5_lg_action(sparx5, layer, group, idx);  in sparx5_shaper_conf_set()
331 	struct sparx5_layer *layer;  in sparx5_leak_groups_init()  local
340 		layer = &layers[i];  in sparx5_leak_groups_init()
342 			lg = &layer->leak_groups[ii];  in sparx5_leak_groups_init()
428 		      u32 layer, u32 idx)  in sparx5_tc_tbf_add()  argument
439 	if (sparx5_lg_get_group_by_rate(layer, sh.rate, &group) < 0) {  in sparx5_tc_tbf_add()
445 	lg = &layers[layer].leak_groups[group];  in sparx5_tc_tbf_add()
459 	return sparx5_shaper_conf_set(port, &sh, layer, idx, group);  in sparx5_tc_tbf_add()
462 int sparx5_tc_tbf_del(struct sparx5_port *port, u32 layer, u32 idx)  in sparx5_tc_tbf_del()  argument
467 	sparx5_lg_get_group_by_index(port->sparx5, layer, idx, &group);  in sparx5_tc_tbf_del()
469 	return sparx5_shaper_conf_set(port, &sh, layer, idx, group);  in sparx5_tc_tbf_del()