Lines Matching full:sparx5
2 /* Microchip Sparx5 Switch driver
24 void sparx5_new_base_time(struct sparx5 *sparx5, const u32 cycle_time, in sparx5_new_base_time() argument
35 sparx5_ptp_gettime64(&sparx5->phc[SPARX5_PHC_PORT].info, &ts); in sparx5_new_base_time()
84 static u32 sparx5_lg_get_leak_time(struct sparx5 *sparx5, u32 layer, u32 group) in sparx5_lg_get_leak_time() argument
88 value = spx5_rd(sparx5, HSCH_HSCH_TIMER_CFG(layer, group)); in sparx5_lg_get_leak_time()
92 static void sparx5_lg_set_leak_time(struct sparx5 *sparx5, u32 layer, u32 group, in sparx5_lg_set_leak_time() argument
95 spx5_wr(HSCH_HSCH_TIMER_CFG_LEAK_TIME_SET(leak_time), sparx5, in sparx5_lg_set_leak_time()
99 static u32 sparx5_lg_get_first(struct sparx5 *sparx5, u32 layer, u32 group) in sparx5_lg_get_first() argument
103 value = spx5_rd(sparx5, HSCH_HSCH_LEAK_CFG(layer, group)); in sparx5_lg_get_first()
107 static u32 sparx5_lg_get_next(struct sparx5 *sparx5, u32 layer, u32 group, in sparx5_lg_get_next() argument
113 value = spx5_rd(sparx5, HSCH_SE_CONNECT(idx)); in sparx5_lg_get_next()
117 static u32 sparx5_lg_get_last(struct sparx5 *sparx5, u32 layer, u32 group) in sparx5_lg_get_last() argument
121 itr = sparx5_lg_get_first(sparx5, layer, group); in sparx5_lg_get_last()
124 next = sparx5_lg_get_next(sparx5, layer, group, itr); in sparx5_lg_get_last()
132 static bool sparx5_lg_is_last(struct sparx5 *sparx5, u32 layer, u32 group, in sparx5_lg_is_last() argument
135 return idx == sparx5_lg_get_next(sparx5, layer, group, idx); in sparx5_lg_is_last()
138 static bool sparx5_lg_is_first(struct sparx5 *sparx5, u32 layer, u32 group, in sparx5_lg_is_first() argument
141 return idx == sparx5_lg_get_first(sparx5, layer, group); in sparx5_lg_is_first()
144 static bool sparx5_lg_is_empty(struct sparx5 *sparx5, u32 layer, u32 group) in sparx5_lg_is_empty() argument
146 return sparx5_lg_get_leak_time(sparx5, layer, group) == 0; in sparx5_lg_is_empty()
149 static bool sparx5_lg_is_singular(struct sparx5 *sparx5, u32 layer, u32 group) in sparx5_lg_is_singular() argument
151 if (sparx5_lg_is_empty(sparx5, layer, group)) in sparx5_lg_is_singular()
154 return sparx5_lg_get_first(sparx5, layer, group) == in sparx5_lg_is_singular()
155 sparx5_lg_get_last(sparx5, layer, group); in sparx5_lg_is_singular()
158 static void sparx5_lg_enable(struct sparx5 *sparx5, u32 layer, u32 group, in sparx5_lg_enable() argument
161 sparx5_lg_set_leak_time(sparx5, layer, group, leak_time); in sparx5_lg_enable()
164 static void sparx5_lg_disable(struct sparx5 *sparx5, u32 layer, u32 group) in sparx5_lg_disable() argument
166 sparx5_lg_set_leak_time(sparx5, layer, group, 0); in sparx5_lg_disable()
169 static int sparx5_lg_get_group_by_index(struct sparx5 *sparx5, u32 layer, in sparx5_lg_get_group_by_index() argument
176 if (sparx5_lg_is_empty(sparx5, layer, i)) in sparx5_lg_get_group_by_index()
179 itr = sparx5_lg_get_first(sparx5, layer, i); in sparx5_lg_get_group_by_index()
182 next = sparx5_lg_get_next(sparx5, layer, i, itr); in sparx5_lg_get_group_by_index()
215 static int sparx5_lg_get_adjacent(struct sparx5 *sparx5, u32 layer, u32 group, in sparx5_lg_get_adjacent() argument
220 *first = sparx5_lg_get_first(sparx5, layer, group); in sparx5_lg_get_adjacent()
226 *next = sparx5_lg_get_next(sparx5, layer, group, itr); in sparx5_lg_get_adjacent()
241 static int sparx5_lg_conf_set(struct sparx5 *sparx5, u32 layer, u32 group, in sparx5_lg_conf_set() argument
247 sparx5_lg_disable(sparx5, layer, group); in sparx5_lg_conf_set()
254 HSCH_HSCH_CFG_CFG_HSCH_LAYER, sparx5, HSCH_HSCH_CFG_CFG); in sparx5_lg_conf_set()
257 spx5_wr(HSCH_SE_CONNECT_SE_LEAK_LINK_SET(idx_next), sparx5, in sparx5_lg_conf_set()
262 HSCH_HSCH_LEAK_CFG_LEAK_FIRST, sparx5, in sparx5_lg_conf_set()
266 sparx5_lg_enable(sparx5, layer, group, leak_time); in sparx5_lg_conf_set()
271 static int sparx5_lg_del(struct sparx5 *sparx5, u32 layer, u32 group, u32 idx) in sparx5_lg_del() argument
277 WARN_ON(sparx5_lg_get_adjacent(sparx5, layer, group, idx, &prev, &next, in sparx5_lg_del()
280 if (sparx5_lg_is_singular(sparx5, layer, group)) { in sparx5_lg_del()
282 } else if (sparx5_lg_is_last(sparx5, layer, group, idx)) { in sparx5_lg_del()
286 } else if (sparx5_lg_is_first(sparx5, layer, group, idx)) { in sparx5_lg_del()
295 return sparx5_lg_conf_set(sparx5, layer, group, first, idx, next, in sparx5_lg_del()
299 static int sparx5_lg_add(struct sparx5 *sparx5, u32 layer, u32 new_group, in sparx5_lg_add() argument
308 if (sparx5_lg_get_group_by_index(sparx5, layer, idx, &old_group) >= 0) { in sparx5_lg_add()
311 sparx5_lg_del(sparx5, layer, old_group, idx); in sparx5_lg_add()
321 if (sparx5_lg_is_empty(sparx5, layer, new_group)) in sparx5_lg_add()
324 next = sparx5_lg_get_first(sparx5, layer, new_group); in sparx5_lg_add()
326 return sparx5_lg_conf_set(sparx5, layer, new_group, first, idx, next, in sparx5_lg_add()
334 int (*sparx5_lg_action)(struct sparx5 *, u32, u32, u32); in sparx5_shaper_conf_set()
335 struct sparx5 *sparx5 = port->sparx5; in sparx5_shaper_conf_set() local
344 HSCH_HSCH_CFG_CFG_HSCH_LAYER, sparx5, HSCH_HSCH_CFG_CFG); in sparx5_shaper_conf_set()
348 sparx5, HSCH_SE_CFG(idx)); in sparx5_shaper_conf_set()
353 sparx5, HSCH_CIR_CFG(idx)); in sparx5_shaper_conf_set()
356 sparx5_lg_action(sparx5, layer, group, idx); in sparx5_shaper_conf_set()
370 u32 layer = is_sparx5(port->sparx5) ? 2 : 1; in sparx5_dwrr_conf_set()
376 port->sparx5, HSCH_HSCH_CFG_CFG); in sparx5_dwrr_conf_set()
380 HSCH_SE_CFG_SE_DWRR_CNT, port->sparx5, in sparx5_dwrr_conf_set()
385 HSCH_DWRR_ENTRY_DWRR_COST, port->sparx5, in sparx5_dwrr_conf_set()
392 static int sparx5_leak_groups_init(struct sparx5 *sparx5) in sparx5_leak_groups_init() argument
394 const struct sparx5_ops *ops = sparx5->data->ops; in sparx5_leak_groups_init()
401 sys_clk_per_100ps = spx5_rd(sparx5, HSCH_SYS_CLK_PER); in sparx5_leak_groups_init()
441 sparx5_lg_disable(sparx5, i, ii); in sparx5_leak_groups_init()
448 int sparx5_qos_init(struct sparx5 *sparx5) in sparx5_qos_init() argument
452 ret = sparx5_leak_groups_init(sparx5); in sparx5_qos_init()
456 ret = sparx5_dcb_init(sparx5); in sparx5_qos_init()
460 sparx5_psfp_init(sparx5); in sparx5_qos_init()
537 sparx5_lg_get_group_by_index(port->sparx5, layer, idx, &group); in sparx5_tc_tbf_del()
564 /* On the sparx5, bands with higher indexes are preferred and in sparx5_tc_ets_add()