xref: /OK3568_Linux_fs/kernel/drivers/net/ethernet/ti/cpsw_ale.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Texas Instruments N-Port Ethernet Switch Address Lookup Engine
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2012 Texas Instruments
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun #include <linux/bitmap.h>
9*4882a593Smuzhiyun #include <linux/if_vlan.h>
10*4882a593Smuzhiyun #include <linux/kernel.h>
11*4882a593Smuzhiyun #include <linux/module.h>
12*4882a593Smuzhiyun #include <linux/platform_device.h>
13*4882a593Smuzhiyun #include <linux/seq_file.h>
14*4882a593Smuzhiyun #include <linux/slab.h>
15*4882a593Smuzhiyun #include <linux/err.h>
16*4882a593Smuzhiyun #include <linux/io.h>
17*4882a593Smuzhiyun #include <linux/stat.h>
18*4882a593Smuzhiyun #include <linux/sysfs.h>
19*4882a593Smuzhiyun #include <linux/etherdevice.h>
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun #include "cpsw_ale.h"
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun #define BITMASK(bits)		(BIT(bits) - 1)
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun #define ALE_VERSION_MAJOR(rev, mask) (((rev) >> 8) & (mask))
26*4882a593Smuzhiyun #define ALE_VERSION_MINOR(rev)	(rev & 0xff)
27*4882a593Smuzhiyun #define ALE_VERSION_1R3		0x0103
28*4882a593Smuzhiyun #define ALE_VERSION_1R4		0x0104
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun /* ALE Registers */
31*4882a593Smuzhiyun #define ALE_IDVER		0x00
32*4882a593Smuzhiyun #define ALE_STATUS		0x04
33*4882a593Smuzhiyun #define ALE_CONTROL		0x08
34*4882a593Smuzhiyun #define ALE_PRESCALE		0x10
35*4882a593Smuzhiyun #define ALE_AGING_TIMER		0x14
36*4882a593Smuzhiyun #define ALE_UNKNOWNVLAN		0x18
37*4882a593Smuzhiyun #define ALE_TABLE_CONTROL	0x20
38*4882a593Smuzhiyun #define ALE_TABLE		0x34
39*4882a593Smuzhiyun #define ALE_PORTCTL		0x40
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun /* ALE NetCP NU switch specific Registers */
42*4882a593Smuzhiyun #define ALE_UNKNOWNVLAN_MEMBER			0x90
43*4882a593Smuzhiyun #define ALE_UNKNOWNVLAN_UNREG_MCAST_FLOOD	0x94
44*4882a593Smuzhiyun #define ALE_UNKNOWNVLAN_REG_MCAST_FLOOD		0x98
45*4882a593Smuzhiyun #define ALE_UNKNOWNVLAN_FORCE_UNTAG_EGRESS	0x9C
46*4882a593Smuzhiyun #define ALE_VLAN_MASK_MUX(reg)			(0xc0 + (0x4 * (reg)))
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun #define AM65_CPSW_ALE_THREAD_DEF_REG 0x134
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun /* ALE_AGING_TIMER */
51*4882a593Smuzhiyun #define ALE_AGING_TIMER_MASK	GENMASK(23, 0)
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun /**
54*4882a593Smuzhiyun  * struct ale_entry_fld - The ALE tbl entry field description
55*4882a593Smuzhiyun  * @start_bit: field start bit
56*4882a593Smuzhiyun  * @num_bits: field bit length
57*4882a593Smuzhiyun  * @flags: field flags
58*4882a593Smuzhiyun  */
59*4882a593Smuzhiyun struct ale_entry_fld {
60*4882a593Smuzhiyun 	u8 start_bit;
61*4882a593Smuzhiyun 	u8 num_bits;
62*4882a593Smuzhiyun 	u8 flags;
63*4882a593Smuzhiyun };
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun enum {
66*4882a593Smuzhiyun 	CPSW_ALE_F_STATUS_REG = BIT(0), /* Status register present */
67*4882a593Smuzhiyun 	CPSW_ALE_F_HW_AUTOAGING = BIT(1), /* HW auto aging */
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun 	CPSW_ALE_F_COUNT
70*4882a593Smuzhiyun };
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun /**
73*4882a593Smuzhiyun  * struct ale_dev_id - The ALE version/SoC specific configuration
74*4882a593Smuzhiyun  * @dev_id: ALE version/SoC id
75*4882a593Smuzhiyun  * @features: features supported by ALE
76*4882a593Smuzhiyun  * @tbl_entries: number of ALE entries
77*4882a593Smuzhiyun  * @major_ver_mask: mask of ALE Major Version Value in ALE_IDVER reg.
78*4882a593Smuzhiyun  * @nu_switch_ale: NU Switch ALE
79*4882a593Smuzhiyun  * @vlan_entry_tbl: ALE vlan entry fields description tbl
80*4882a593Smuzhiyun  */
81*4882a593Smuzhiyun struct cpsw_ale_dev_id {
82*4882a593Smuzhiyun 	const char *dev_id;
83*4882a593Smuzhiyun 	u32 features;
84*4882a593Smuzhiyun 	u32 tbl_entries;
85*4882a593Smuzhiyun 	u32 major_ver_mask;
86*4882a593Smuzhiyun 	bool nu_switch_ale;
87*4882a593Smuzhiyun 	const struct ale_entry_fld *vlan_entry_tbl;
88*4882a593Smuzhiyun };
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun #define ALE_TABLE_WRITE		BIT(31)
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun #define ALE_TYPE_FREE			0
93*4882a593Smuzhiyun #define ALE_TYPE_ADDR			1
94*4882a593Smuzhiyun #define ALE_TYPE_VLAN			2
95*4882a593Smuzhiyun #define ALE_TYPE_VLAN_ADDR		3
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun #define ALE_UCAST_PERSISTANT		0
98*4882a593Smuzhiyun #define ALE_UCAST_UNTOUCHED		1
99*4882a593Smuzhiyun #define ALE_UCAST_OUI			2
100*4882a593Smuzhiyun #define ALE_UCAST_TOUCHED		3
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun #define ALE_TABLE_SIZE_MULTIPLIER	1024
103*4882a593Smuzhiyun #define ALE_STATUS_SIZE_MASK		0x1f
104*4882a593Smuzhiyun 
cpsw_ale_get_field(u32 * ale_entry,u32 start,u32 bits)105*4882a593Smuzhiyun static inline int cpsw_ale_get_field(u32 *ale_entry, u32 start, u32 bits)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun 	int idx;
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 	idx    = start / 32;
110*4882a593Smuzhiyun 	start -= idx * 32;
111*4882a593Smuzhiyun 	idx    = 2 - idx; /* flip */
112*4882a593Smuzhiyun 	return (ale_entry[idx] >> start) & BITMASK(bits);
113*4882a593Smuzhiyun }
114*4882a593Smuzhiyun 
cpsw_ale_set_field(u32 * ale_entry,u32 start,u32 bits,u32 value)115*4882a593Smuzhiyun static inline void cpsw_ale_set_field(u32 *ale_entry, u32 start, u32 bits,
116*4882a593Smuzhiyun 				      u32 value)
117*4882a593Smuzhiyun {
118*4882a593Smuzhiyun 	int idx;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	value &= BITMASK(bits);
121*4882a593Smuzhiyun 	idx    = start / 32;
122*4882a593Smuzhiyun 	start -= idx * 32;
123*4882a593Smuzhiyun 	idx    = 2 - idx; /* flip */
124*4882a593Smuzhiyun 	ale_entry[idx] &= ~(BITMASK(bits) << start);
125*4882a593Smuzhiyun 	ale_entry[idx] |=  (value << start);
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun #define DEFINE_ALE_FIELD(name, start, bits)				\
129*4882a593Smuzhiyun static inline int cpsw_ale_get_##name(u32 *ale_entry)			\
130*4882a593Smuzhiyun {									\
131*4882a593Smuzhiyun 	return cpsw_ale_get_field(ale_entry, start, bits);		\
132*4882a593Smuzhiyun }									\
133*4882a593Smuzhiyun static inline void cpsw_ale_set_##name(u32 *ale_entry, u32 value)	\
134*4882a593Smuzhiyun {									\
135*4882a593Smuzhiyun 	cpsw_ale_set_field(ale_entry, start, bits, value);		\
136*4882a593Smuzhiyun }
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun #define DEFINE_ALE_FIELD1(name, start)					\
139*4882a593Smuzhiyun static inline int cpsw_ale_get_##name(u32 *ale_entry, u32 bits)		\
140*4882a593Smuzhiyun {									\
141*4882a593Smuzhiyun 	return cpsw_ale_get_field(ale_entry, start, bits);		\
142*4882a593Smuzhiyun }									\
143*4882a593Smuzhiyun static inline void cpsw_ale_set_##name(u32 *ale_entry, u32 value,	\
144*4882a593Smuzhiyun 		u32 bits)						\
145*4882a593Smuzhiyun {									\
146*4882a593Smuzhiyun 	cpsw_ale_set_field(ale_entry, start, bits, value);		\
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun enum {
150*4882a593Smuzhiyun 	ALE_ENT_VID_MEMBER_LIST = 0,
151*4882a593Smuzhiyun 	ALE_ENT_VID_UNREG_MCAST_MSK,
152*4882a593Smuzhiyun 	ALE_ENT_VID_REG_MCAST_MSK,
153*4882a593Smuzhiyun 	ALE_ENT_VID_FORCE_UNTAGGED_MSK,
154*4882a593Smuzhiyun 	ALE_ENT_VID_UNREG_MCAST_IDX,
155*4882a593Smuzhiyun 	ALE_ENT_VID_REG_MCAST_IDX,
156*4882a593Smuzhiyun 	ALE_ENT_VID_LAST,
157*4882a593Smuzhiyun };
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun #define ALE_FLD_ALLOWED			BIT(0)
160*4882a593Smuzhiyun #define ALE_FLD_SIZE_PORT_MASK_BITS	BIT(1)
161*4882a593Smuzhiyun #define ALE_FLD_SIZE_PORT_NUM_BITS	BIT(2)
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun #define ALE_ENTRY_FLD(id, start, bits)	\
164*4882a593Smuzhiyun [id] = {				\
165*4882a593Smuzhiyun 	.start_bit = start,		\
166*4882a593Smuzhiyun 	.num_bits = bits,		\
167*4882a593Smuzhiyun 	.flags = ALE_FLD_ALLOWED,	\
168*4882a593Smuzhiyun }
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun #define ALE_ENTRY_FLD_DYN_MSK_SIZE(id, start)	\
171*4882a593Smuzhiyun [id] = {					\
172*4882a593Smuzhiyun 	.start_bit = start,			\
173*4882a593Smuzhiyun 	.num_bits = 0,				\
174*4882a593Smuzhiyun 	.flags = ALE_FLD_ALLOWED |		\
175*4882a593Smuzhiyun 		 ALE_FLD_SIZE_PORT_MASK_BITS,	\
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun /* dm814x, am3/am4/am5, k2hk */
179*4882a593Smuzhiyun static const struct ale_entry_fld vlan_entry_cpsw[ALE_ENT_VID_LAST] = {
180*4882a593Smuzhiyun 	ALE_ENTRY_FLD(ALE_ENT_VID_MEMBER_LIST, 0, 3),
181*4882a593Smuzhiyun 	ALE_ENTRY_FLD(ALE_ENT_VID_UNREG_MCAST_MSK, 8, 3),
182*4882a593Smuzhiyun 	ALE_ENTRY_FLD(ALE_ENT_VID_REG_MCAST_MSK, 16, 3),
183*4882a593Smuzhiyun 	ALE_ENTRY_FLD(ALE_ENT_VID_FORCE_UNTAGGED_MSK, 24, 3),
184*4882a593Smuzhiyun };
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun /* k2e/k2l, k3 am65/j721e cpsw2g  */
187*4882a593Smuzhiyun static const struct ale_entry_fld vlan_entry_nu[ALE_ENT_VID_LAST] = {
188*4882a593Smuzhiyun 	ALE_ENTRY_FLD_DYN_MSK_SIZE(ALE_ENT_VID_MEMBER_LIST, 0),
189*4882a593Smuzhiyun 	ALE_ENTRY_FLD(ALE_ENT_VID_UNREG_MCAST_IDX, 20, 3),
190*4882a593Smuzhiyun 	ALE_ENTRY_FLD_DYN_MSK_SIZE(ALE_ENT_VID_FORCE_UNTAGGED_MSK, 24),
191*4882a593Smuzhiyun 	ALE_ENTRY_FLD(ALE_ENT_VID_REG_MCAST_IDX, 44, 3),
192*4882a593Smuzhiyun };
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun /* K3 j721e/j7200 cpsw9g/5g, am64x cpsw3g  */
195*4882a593Smuzhiyun static const struct ale_entry_fld vlan_entry_k3_cpswxg[] = {
196*4882a593Smuzhiyun 	ALE_ENTRY_FLD_DYN_MSK_SIZE(ALE_ENT_VID_MEMBER_LIST, 0),
197*4882a593Smuzhiyun 	ALE_ENTRY_FLD_DYN_MSK_SIZE(ALE_ENT_VID_UNREG_MCAST_MSK, 12),
198*4882a593Smuzhiyun 	ALE_ENTRY_FLD_DYN_MSK_SIZE(ALE_ENT_VID_FORCE_UNTAGGED_MSK, 24),
199*4882a593Smuzhiyun 	ALE_ENTRY_FLD_DYN_MSK_SIZE(ALE_ENT_VID_REG_MCAST_MSK, 36),
200*4882a593Smuzhiyun };
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun DEFINE_ALE_FIELD(entry_type,		60,	2)
203*4882a593Smuzhiyun DEFINE_ALE_FIELD(vlan_id,		48,	12)
204*4882a593Smuzhiyun DEFINE_ALE_FIELD(mcast_state,		62,	2)
205*4882a593Smuzhiyun DEFINE_ALE_FIELD1(port_mask,		66)
206*4882a593Smuzhiyun DEFINE_ALE_FIELD(super,			65,	1)
207*4882a593Smuzhiyun DEFINE_ALE_FIELD(ucast_type,		62,     2)
208*4882a593Smuzhiyun DEFINE_ALE_FIELD1(port_num,		66)
209*4882a593Smuzhiyun DEFINE_ALE_FIELD(blocked,		65,     1)
210*4882a593Smuzhiyun DEFINE_ALE_FIELD(secure,		64,     1)
211*4882a593Smuzhiyun DEFINE_ALE_FIELD(mcast,			40,	1)
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun #define NU_VLAN_UNREG_MCAST_IDX	1
214*4882a593Smuzhiyun 
cpsw_ale_entry_get_fld(struct cpsw_ale * ale,u32 * ale_entry,const struct ale_entry_fld * entry_tbl,int fld_id)215*4882a593Smuzhiyun static int cpsw_ale_entry_get_fld(struct cpsw_ale *ale,
216*4882a593Smuzhiyun 				  u32 *ale_entry,
217*4882a593Smuzhiyun 				  const struct ale_entry_fld *entry_tbl,
218*4882a593Smuzhiyun 				  int fld_id)
219*4882a593Smuzhiyun {
220*4882a593Smuzhiyun 	const struct ale_entry_fld *entry_fld;
221*4882a593Smuzhiyun 	u32 bits;
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun 	if (!ale || !ale_entry)
224*4882a593Smuzhiyun 		return -EINVAL;
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	entry_fld = &entry_tbl[fld_id];
227*4882a593Smuzhiyun 	if (!(entry_fld->flags & ALE_FLD_ALLOWED)) {
228*4882a593Smuzhiyun 		dev_err(ale->params.dev, "get: wrong ale fld id %d\n", fld_id);
229*4882a593Smuzhiyun 		return -ENOENT;
230*4882a593Smuzhiyun 	}
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	bits = entry_fld->num_bits;
233*4882a593Smuzhiyun 	if (entry_fld->flags & ALE_FLD_SIZE_PORT_MASK_BITS)
234*4882a593Smuzhiyun 		bits = ale->port_mask_bits;
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	return cpsw_ale_get_field(ale_entry, entry_fld->start_bit, bits);
237*4882a593Smuzhiyun }
238*4882a593Smuzhiyun 
cpsw_ale_entry_set_fld(struct cpsw_ale * ale,u32 * ale_entry,const struct ale_entry_fld * entry_tbl,int fld_id,u32 value)239*4882a593Smuzhiyun static void cpsw_ale_entry_set_fld(struct cpsw_ale *ale,
240*4882a593Smuzhiyun 				   u32 *ale_entry,
241*4882a593Smuzhiyun 				   const struct ale_entry_fld *entry_tbl,
242*4882a593Smuzhiyun 				   int fld_id,
243*4882a593Smuzhiyun 				   u32 value)
244*4882a593Smuzhiyun {
245*4882a593Smuzhiyun 	const struct ale_entry_fld *entry_fld;
246*4882a593Smuzhiyun 	u32 bits;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	if (!ale || !ale_entry)
249*4882a593Smuzhiyun 		return;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	entry_fld = &entry_tbl[fld_id];
252*4882a593Smuzhiyun 	if (!(entry_fld->flags & ALE_FLD_ALLOWED)) {
253*4882a593Smuzhiyun 		dev_err(ale->params.dev, "set: wrong ale fld id %d\n", fld_id);
254*4882a593Smuzhiyun 		return;
255*4882a593Smuzhiyun 	}
256*4882a593Smuzhiyun 
257*4882a593Smuzhiyun 	bits = entry_fld->num_bits;
258*4882a593Smuzhiyun 	if (entry_fld->flags & ALE_FLD_SIZE_PORT_MASK_BITS)
259*4882a593Smuzhiyun 		bits = ale->port_mask_bits;
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun 	cpsw_ale_set_field(ale_entry, entry_fld->start_bit, bits, value);
262*4882a593Smuzhiyun }
263*4882a593Smuzhiyun 
cpsw_ale_vlan_get_fld(struct cpsw_ale * ale,u32 * ale_entry,int fld_id)264*4882a593Smuzhiyun static int cpsw_ale_vlan_get_fld(struct cpsw_ale *ale,
265*4882a593Smuzhiyun 				 u32 *ale_entry,
266*4882a593Smuzhiyun 				 int fld_id)
267*4882a593Smuzhiyun {
268*4882a593Smuzhiyun 	return cpsw_ale_entry_get_fld(ale, ale_entry,
269*4882a593Smuzhiyun 				      ale->vlan_entry_tbl, fld_id);
270*4882a593Smuzhiyun }
271*4882a593Smuzhiyun 
cpsw_ale_vlan_set_fld(struct cpsw_ale * ale,u32 * ale_entry,int fld_id,u32 value)272*4882a593Smuzhiyun static void cpsw_ale_vlan_set_fld(struct cpsw_ale *ale,
273*4882a593Smuzhiyun 				  u32 *ale_entry,
274*4882a593Smuzhiyun 				  int fld_id,
275*4882a593Smuzhiyun 				  u32 value)
276*4882a593Smuzhiyun {
277*4882a593Smuzhiyun 	cpsw_ale_entry_set_fld(ale, ale_entry,
278*4882a593Smuzhiyun 			       ale->vlan_entry_tbl, fld_id, value);
279*4882a593Smuzhiyun }
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun /* The MAC address field in the ALE entry cannot be macroized as above */
cpsw_ale_get_addr(u32 * ale_entry,u8 * addr)282*4882a593Smuzhiyun static inline void cpsw_ale_get_addr(u32 *ale_entry, u8 *addr)
283*4882a593Smuzhiyun {
284*4882a593Smuzhiyun 	int i;
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	for (i = 0; i < 6; i++)
287*4882a593Smuzhiyun 		addr[i] = cpsw_ale_get_field(ale_entry, 40 - 8*i, 8);
288*4882a593Smuzhiyun }
289*4882a593Smuzhiyun 
cpsw_ale_set_addr(u32 * ale_entry,const u8 * addr)290*4882a593Smuzhiyun static inline void cpsw_ale_set_addr(u32 *ale_entry, const u8 *addr)
291*4882a593Smuzhiyun {
292*4882a593Smuzhiyun 	int i;
293*4882a593Smuzhiyun 
294*4882a593Smuzhiyun 	for (i = 0; i < 6; i++)
295*4882a593Smuzhiyun 		cpsw_ale_set_field(ale_entry, 40 - 8*i, 8, addr[i]);
296*4882a593Smuzhiyun }
297*4882a593Smuzhiyun 
cpsw_ale_read(struct cpsw_ale * ale,int idx,u32 * ale_entry)298*4882a593Smuzhiyun static int cpsw_ale_read(struct cpsw_ale *ale, int idx, u32 *ale_entry)
299*4882a593Smuzhiyun {
300*4882a593Smuzhiyun 	int i;
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	WARN_ON(idx > ale->params.ale_entries);
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	writel_relaxed(idx, ale->params.ale_regs + ALE_TABLE_CONTROL);
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun 	for (i = 0; i < ALE_ENTRY_WORDS; i++)
307*4882a593Smuzhiyun 		ale_entry[i] = readl_relaxed(ale->params.ale_regs +
308*4882a593Smuzhiyun 					     ALE_TABLE + 4 * i);
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	return idx;
311*4882a593Smuzhiyun }
312*4882a593Smuzhiyun 
cpsw_ale_write(struct cpsw_ale * ale,int idx,u32 * ale_entry)313*4882a593Smuzhiyun static int cpsw_ale_write(struct cpsw_ale *ale, int idx, u32 *ale_entry)
314*4882a593Smuzhiyun {
315*4882a593Smuzhiyun 	int i;
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 	WARN_ON(idx > ale->params.ale_entries);
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	for (i = 0; i < ALE_ENTRY_WORDS; i++)
320*4882a593Smuzhiyun 		writel_relaxed(ale_entry[i], ale->params.ale_regs +
321*4882a593Smuzhiyun 			       ALE_TABLE + 4 * i);
322*4882a593Smuzhiyun 
323*4882a593Smuzhiyun 	writel_relaxed(idx | ALE_TABLE_WRITE, ale->params.ale_regs +
324*4882a593Smuzhiyun 		       ALE_TABLE_CONTROL);
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun 	return idx;
327*4882a593Smuzhiyun }
328*4882a593Smuzhiyun 
cpsw_ale_match_addr(struct cpsw_ale * ale,const u8 * addr,u16 vid)329*4882a593Smuzhiyun static int cpsw_ale_match_addr(struct cpsw_ale *ale, const u8 *addr, u16 vid)
330*4882a593Smuzhiyun {
331*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS];
332*4882a593Smuzhiyun 	int type, idx;
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	for (idx = 0; idx < ale->params.ale_entries; idx++) {
335*4882a593Smuzhiyun 		u8 entry_addr[6];
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
338*4882a593Smuzhiyun 		type = cpsw_ale_get_entry_type(ale_entry);
339*4882a593Smuzhiyun 		if (type != ALE_TYPE_ADDR && type != ALE_TYPE_VLAN_ADDR)
340*4882a593Smuzhiyun 			continue;
341*4882a593Smuzhiyun 		if (cpsw_ale_get_vlan_id(ale_entry) != vid)
342*4882a593Smuzhiyun 			continue;
343*4882a593Smuzhiyun 		cpsw_ale_get_addr(ale_entry, entry_addr);
344*4882a593Smuzhiyun 		if (ether_addr_equal(entry_addr, addr))
345*4882a593Smuzhiyun 			return idx;
346*4882a593Smuzhiyun 	}
347*4882a593Smuzhiyun 	return -ENOENT;
348*4882a593Smuzhiyun }
349*4882a593Smuzhiyun 
cpsw_ale_match_vlan(struct cpsw_ale * ale,u16 vid)350*4882a593Smuzhiyun static int cpsw_ale_match_vlan(struct cpsw_ale *ale, u16 vid)
351*4882a593Smuzhiyun {
352*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS];
353*4882a593Smuzhiyun 	int type, idx;
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun 	for (idx = 0; idx < ale->params.ale_entries; idx++) {
356*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
357*4882a593Smuzhiyun 		type = cpsw_ale_get_entry_type(ale_entry);
358*4882a593Smuzhiyun 		if (type != ALE_TYPE_VLAN)
359*4882a593Smuzhiyun 			continue;
360*4882a593Smuzhiyun 		if (cpsw_ale_get_vlan_id(ale_entry) == vid)
361*4882a593Smuzhiyun 			return idx;
362*4882a593Smuzhiyun 	}
363*4882a593Smuzhiyun 	return -ENOENT;
364*4882a593Smuzhiyun }
365*4882a593Smuzhiyun 
cpsw_ale_match_free(struct cpsw_ale * ale)366*4882a593Smuzhiyun static int cpsw_ale_match_free(struct cpsw_ale *ale)
367*4882a593Smuzhiyun {
368*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS];
369*4882a593Smuzhiyun 	int type, idx;
370*4882a593Smuzhiyun 
371*4882a593Smuzhiyun 	for (idx = 0; idx < ale->params.ale_entries; idx++) {
372*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
373*4882a593Smuzhiyun 		type = cpsw_ale_get_entry_type(ale_entry);
374*4882a593Smuzhiyun 		if (type == ALE_TYPE_FREE)
375*4882a593Smuzhiyun 			return idx;
376*4882a593Smuzhiyun 	}
377*4882a593Smuzhiyun 	return -ENOENT;
378*4882a593Smuzhiyun }
379*4882a593Smuzhiyun 
cpsw_ale_find_ageable(struct cpsw_ale * ale)380*4882a593Smuzhiyun static int cpsw_ale_find_ageable(struct cpsw_ale *ale)
381*4882a593Smuzhiyun {
382*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS];
383*4882a593Smuzhiyun 	int type, idx;
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	for (idx = 0; idx < ale->params.ale_entries; idx++) {
386*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
387*4882a593Smuzhiyun 		type = cpsw_ale_get_entry_type(ale_entry);
388*4882a593Smuzhiyun 		if (type != ALE_TYPE_ADDR && type != ALE_TYPE_VLAN_ADDR)
389*4882a593Smuzhiyun 			continue;
390*4882a593Smuzhiyun 		if (cpsw_ale_get_mcast(ale_entry))
391*4882a593Smuzhiyun 			continue;
392*4882a593Smuzhiyun 		type = cpsw_ale_get_ucast_type(ale_entry);
393*4882a593Smuzhiyun 		if (type != ALE_UCAST_PERSISTANT &&
394*4882a593Smuzhiyun 		    type != ALE_UCAST_OUI)
395*4882a593Smuzhiyun 			return idx;
396*4882a593Smuzhiyun 	}
397*4882a593Smuzhiyun 	return -ENOENT;
398*4882a593Smuzhiyun }
399*4882a593Smuzhiyun 
cpsw_ale_flush_mcast(struct cpsw_ale * ale,u32 * ale_entry,int port_mask)400*4882a593Smuzhiyun static void cpsw_ale_flush_mcast(struct cpsw_ale *ale, u32 *ale_entry,
401*4882a593Smuzhiyun 				 int port_mask)
402*4882a593Smuzhiyun {
403*4882a593Smuzhiyun 	int mask;
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun 	mask = cpsw_ale_get_port_mask(ale_entry,
406*4882a593Smuzhiyun 				      ale->port_mask_bits);
407*4882a593Smuzhiyun 	if ((mask & port_mask) == 0)
408*4882a593Smuzhiyun 		return; /* ports dont intersect, not interested */
409*4882a593Smuzhiyun 	mask &= ~port_mask;
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	/* free if only remaining port is host port */
412*4882a593Smuzhiyun 	if (mask)
413*4882a593Smuzhiyun 		cpsw_ale_set_port_mask(ale_entry, mask,
414*4882a593Smuzhiyun 				       ale->port_mask_bits);
415*4882a593Smuzhiyun 	else
416*4882a593Smuzhiyun 		cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_FREE);
417*4882a593Smuzhiyun }
418*4882a593Smuzhiyun 
cpsw_ale_flush_multicast(struct cpsw_ale * ale,int port_mask,int vid)419*4882a593Smuzhiyun int cpsw_ale_flush_multicast(struct cpsw_ale *ale, int port_mask, int vid)
420*4882a593Smuzhiyun {
421*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS];
422*4882a593Smuzhiyun 	int ret, idx;
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	for (idx = 0; idx < ale->params.ale_entries; idx++) {
425*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
426*4882a593Smuzhiyun 		ret = cpsw_ale_get_entry_type(ale_entry);
427*4882a593Smuzhiyun 		if (ret != ALE_TYPE_ADDR && ret != ALE_TYPE_VLAN_ADDR)
428*4882a593Smuzhiyun 			continue;
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 		/* if vid passed is -1 then remove all multicast entry from
431*4882a593Smuzhiyun 		 * the table irrespective of vlan id, if a valid vlan id is
432*4882a593Smuzhiyun 		 * passed then remove only multicast added to that vlan id.
433*4882a593Smuzhiyun 		 * if vlan id doesn't match then move on to next entry.
434*4882a593Smuzhiyun 		 */
435*4882a593Smuzhiyun 		if (vid != -1 && cpsw_ale_get_vlan_id(ale_entry) != vid)
436*4882a593Smuzhiyun 			continue;
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 		if (cpsw_ale_get_mcast(ale_entry)) {
439*4882a593Smuzhiyun 			u8 addr[6];
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 			if (cpsw_ale_get_super(ale_entry))
442*4882a593Smuzhiyun 				continue;
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 			cpsw_ale_get_addr(ale_entry, addr);
445*4882a593Smuzhiyun 			if (!is_broadcast_ether_addr(addr))
446*4882a593Smuzhiyun 				cpsw_ale_flush_mcast(ale, ale_entry, port_mask);
447*4882a593Smuzhiyun 		}
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 		cpsw_ale_write(ale, idx, ale_entry);
450*4882a593Smuzhiyun 	}
451*4882a593Smuzhiyun 	return 0;
452*4882a593Smuzhiyun }
453*4882a593Smuzhiyun 
cpsw_ale_set_vlan_entry_type(u32 * ale_entry,int flags,u16 vid)454*4882a593Smuzhiyun static inline void cpsw_ale_set_vlan_entry_type(u32 *ale_entry,
455*4882a593Smuzhiyun 						int flags, u16 vid)
456*4882a593Smuzhiyun {
457*4882a593Smuzhiyun 	if (flags & ALE_VLAN) {
458*4882a593Smuzhiyun 		cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_VLAN_ADDR);
459*4882a593Smuzhiyun 		cpsw_ale_set_vlan_id(ale_entry, vid);
460*4882a593Smuzhiyun 	} else {
461*4882a593Smuzhiyun 		cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_ADDR);
462*4882a593Smuzhiyun 	}
463*4882a593Smuzhiyun }
464*4882a593Smuzhiyun 
cpsw_ale_add_ucast(struct cpsw_ale * ale,const u8 * addr,int port,int flags,u16 vid)465*4882a593Smuzhiyun int cpsw_ale_add_ucast(struct cpsw_ale *ale, const u8 *addr, int port,
466*4882a593Smuzhiyun 		       int flags, u16 vid)
467*4882a593Smuzhiyun {
468*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
469*4882a593Smuzhiyun 	int idx;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	cpsw_ale_set_vlan_entry_type(ale_entry, flags, vid);
472*4882a593Smuzhiyun 
473*4882a593Smuzhiyun 	cpsw_ale_set_addr(ale_entry, addr);
474*4882a593Smuzhiyun 	cpsw_ale_set_ucast_type(ale_entry, ALE_UCAST_PERSISTANT);
475*4882a593Smuzhiyun 	cpsw_ale_set_secure(ale_entry, (flags & ALE_SECURE) ? 1 : 0);
476*4882a593Smuzhiyun 	cpsw_ale_set_blocked(ale_entry, (flags & ALE_BLOCKED) ? 1 : 0);
477*4882a593Smuzhiyun 	cpsw_ale_set_port_num(ale_entry, port, ale->port_num_bits);
478*4882a593Smuzhiyun 
479*4882a593Smuzhiyun 	idx = cpsw_ale_match_addr(ale, addr, (flags & ALE_VLAN) ? vid : 0);
480*4882a593Smuzhiyun 	if (idx < 0)
481*4882a593Smuzhiyun 		idx = cpsw_ale_match_free(ale);
482*4882a593Smuzhiyun 	if (idx < 0)
483*4882a593Smuzhiyun 		idx = cpsw_ale_find_ageable(ale);
484*4882a593Smuzhiyun 	if (idx < 0)
485*4882a593Smuzhiyun 		return -ENOMEM;
486*4882a593Smuzhiyun 
487*4882a593Smuzhiyun 	cpsw_ale_write(ale, idx, ale_entry);
488*4882a593Smuzhiyun 	return 0;
489*4882a593Smuzhiyun }
490*4882a593Smuzhiyun 
cpsw_ale_del_ucast(struct cpsw_ale * ale,const u8 * addr,int port,int flags,u16 vid)491*4882a593Smuzhiyun int cpsw_ale_del_ucast(struct cpsw_ale *ale, const u8 *addr, int port,
492*4882a593Smuzhiyun 		       int flags, u16 vid)
493*4882a593Smuzhiyun {
494*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
495*4882a593Smuzhiyun 	int idx;
496*4882a593Smuzhiyun 
497*4882a593Smuzhiyun 	idx = cpsw_ale_match_addr(ale, addr, (flags & ALE_VLAN) ? vid : 0);
498*4882a593Smuzhiyun 	if (idx < 0)
499*4882a593Smuzhiyun 		return -ENOENT;
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_FREE);
502*4882a593Smuzhiyun 	cpsw_ale_write(ale, idx, ale_entry);
503*4882a593Smuzhiyun 	return 0;
504*4882a593Smuzhiyun }
505*4882a593Smuzhiyun 
cpsw_ale_add_mcast(struct cpsw_ale * ale,const u8 * addr,int port_mask,int flags,u16 vid,int mcast_state)506*4882a593Smuzhiyun int cpsw_ale_add_mcast(struct cpsw_ale *ale, const u8 *addr, int port_mask,
507*4882a593Smuzhiyun 		       int flags, u16 vid, int mcast_state)
508*4882a593Smuzhiyun {
509*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
510*4882a593Smuzhiyun 	int idx, mask;
511*4882a593Smuzhiyun 
512*4882a593Smuzhiyun 	idx = cpsw_ale_match_addr(ale, addr, (flags & ALE_VLAN) ? vid : 0);
513*4882a593Smuzhiyun 	if (idx >= 0)
514*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	cpsw_ale_set_vlan_entry_type(ale_entry, flags, vid);
517*4882a593Smuzhiyun 
518*4882a593Smuzhiyun 	cpsw_ale_set_addr(ale_entry, addr);
519*4882a593Smuzhiyun 	cpsw_ale_set_super(ale_entry, (flags & ALE_SUPER) ? 1 : 0);
520*4882a593Smuzhiyun 	cpsw_ale_set_mcast_state(ale_entry, mcast_state);
521*4882a593Smuzhiyun 
522*4882a593Smuzhiyun 	mask = cpsw_ale_get_port_mask(ale_entry,
523*4882a593Smuzhiyun 				      ale->port_mask_bits);
524*4882a593Smuzhiyun 	port_mask |= mask;
525*4882a593Smuzhiyun 	cpsw_ale_set_port_mask(ale_entry, port_mask,
526*4882a593Smuzhiyun 			       ale->port_mask_bits);
527*4882a593Smuzhiyun 
528*4882a593Smuzhiyun 	if (idx < 0)
529*4882a593Smuzhiyun 		idx = cpsw_ale_match_free(ale);
530*4882a593Smuzhiyun 	if (idx < 0)
531*4882a593Smuzhiyun 		idx = cpsw_ale_find_ageable(ale);
532*4882a593Smuzhiyun 	if (idx < 0)
533*4882a593Smuzhiyun 		return -ENOMEM;
534*4882a593Smuzhiyun 
535*4882a593Smuzhiyun 	cpsw_ale_write(ale, idx, ale_entry);
536*4882a593Smuzhiyun 	return 0;
537*4882a593Smuzhiyun }
538*4882a593Smuzhiyun 
cpsw_ale_del_mcast(struct cpsw_ale * ale,const u8 * addr,int port_mask,int flags,u16 vid)539*4882a593Smuzhiyun int cpsw_ale_del_mcast(struct cpsw_ale *ale, const u8 *addr, int port_mask,
540*4882a593Smuzhiyun 		       int flags, u16 vid)
541*4882a593Smuzhiyun {
542*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
543*4882a593Smuzhiyun 	int mcast_members = 0;
544*4882a593Smuzhiyun 	int idx;
545*4882a593Smuzhiyun 
546*4882a593Smuzhiyun 	idx = cpsw_ale_match_addr(ale, addr, (flags & ALE_VLAN) ? vid : 0);
547*4882a593Smuzhiyun 	if (idx < 0)
548*4882a593Smuzhiyun 		return -ENOENT;
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 	cpsw_ale_read(ale, idx, ale_entry);
551*4882a593Smuzhiyun 
552*4882a593Smuzhiyun 	if (port_mask) {
553*4882a593Smuzhiyun 		mcast_members = cpsw_ale_get_port_mask(ale_entry,
554*4882a593Smuzhiyun 						       ale->port_mask_bits);
555*4882a593Smuzhiyun 		mcast_members &= ~port_mask;
556*4882a593Smuzhiyun 	}
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun 	if (mcast_members)
559*4882a593Smuzhiyun 		cpsw_ale_set_port_mask(ale_entry, mcast_members,
560*4882a593Smuzhiyun 				       ale->port_mask_bits);
561*4882a593Smuzhiyun 	else
562*4882a593Smuzhiyun 		cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_FREE);
563*4882a593Smuzhiyun 
564*4882a593Smuzhiyun 	cpsw_ale_write(ale, idx, ale_entry);
565*4882a593Smuzhiyun 	return 0;
566*4882a593Smuzhiyun }
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun /* ALE NetCP NU switch specific vlan functions */
cpsw_ale_set_vlan_mcast(struct cpsw_ale * ale,u32 * ale_entry,int reg_mcast,int unreg_mcast)569*4882a593Smuzhiyun static void cpsw_ale_set_vlan_mcast(struct cpsw_ale *ale, u32 *ale_entry,
570*4882a593Smuzhiyun 				    int reg_mcast, int unreg_mcast)
571*4882a593Smuzhiyun {
572*4882a593Smuzhiyun 	int idx;
573*4882a593Smuzhiyun 
574*4882a593Smuzhiyun 	/* Set VLAN registered multicast flood mask */
575*4882a593Smuzhiyun 	idx = cpsw_ale_vlan_get_fld(ale, ale_entry,
576*4882a593Smuzhiyun 				    ALE_ENT_VID_REG_MCAST_IDX);
577*4882a593Smuzhiyun 	writel(reg_mcast, ale->params.ale_regs + ALE_VLAN_MASK_MUX(idx));
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	/* Set VLAN unregistered multicast flood mask */
580*4882a593Smuzhiyun 	idx = cpsw_ale_vlan_get_fld(ale, ale_entry,
581*4882a593Smuzhiyun 				    ALE_ENT_VID_UNREG_MCAST_IDX);
582*4882a593Smuzhiyun 	writel(unreg_mcast, ale->params.ale_regs + ALE_VLAN_MASK_MUX(idx));
583*4882a593Smuzhiyun }
584*4882a593Smuzhiyun 
cpsw_ale_set_vlan_untag(struct cpsw_ale * ale,u32 * ale_entry,u16 vid,int untag_mask)585*4882a593Smuzhiyun static void cpsw_ale_set_vlan_untag(struct cpsw_ale *ale, u32 *ale_entry,
586*4882a593Smuzhiyun 				    u16 vid, int untag_mask)
587*4882a593Smuzhiyun {
588*4882a593Smuzhiyun 	cpsw_ale_vlan_set_fld(ale, ale_entry,
589*4882a593Smuzhiyun 			      ALE_ENT_VID_FORCE_UNTAGGED_MSK,
590*4882a593Smuzhiyun 			      untag_mask);
591*4882a593Smuzhiyun 	if (untag_mask & ALE_PORT_HOST)
592*4882a593Smuzhiyun 		bitmap_set(ale->p0_untag_vid_mask, vid, 1);
593*4882a593Smuzhiyun 	else
594*4882a593Smuzhiyun 		bitmap_clear(ale->p0_untag_vid_mask, vid, 1);
595*4882a593Smuzhiyun }
596*4882a593Smuzhiyun 
cpsw_ale_add_vlan(struct cpsw_ale * ale,u16 vid,int port_mask,int untag,int reg_mcast,int unreg_mcast)597*4882a593Smuzhiyun int cpsw_ale_add_vlan(struct cpsw_ale *ale, u16 vid, int port_mask, int untag,
598*4882a593Smuzhiyun 		      int reg_mcast, int unreg_mcast)
599*4882a593Smuzhiyun {
600*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
601*4882a593Smuzhiyun 	int idx;
602*4882a593Smuzhiyun 
603*4882a593Smuzhiyun 	idx = cpsw_ale_match_vlan(ale, vid);
604*4882a593Smuzhiyun 	if (idx >= 0)
605*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
606*4882a593Smuzhiyun 
607*4882a593Smuzhiyun 	cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_VLAN);
608*4882a593Smuzhiyun 	cpsw_ale_set_vlan_id(ale_entry, vid);
609*4882a593Smuzhiyun 	cpsw_ale_set_vlan_untag(ale, ale_entry, vid, untag);
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 	if (!ale->params.nu_switch_ale) {
612*4882a593Smuzhiyun 		cpsw_ale_vlan_set_fld(ale, ale_entry,
613*4882a593Smuzhiyun 				      ALE_ENT_VID_REG_MCAST_MSK, reg_mcast);
614*4882a593Smuzhiyun 		cpsw_ale_vlan_set_fld(ale, ale_entry,
615*4882a593Smuzhiyun 				      ALE_ENT_VID_UNREG_MCAST_MSK, unreg_mcast);
616*4882a593Smuzhiyun 	} else {
617*4882a593Smuzhiyun 		cpsw_ale_vlan_set_fld(ale, ale_entry,
618*4882a593Smuzhiyun 				      ALE_ENT_VID_UNREG_MCAST_IDX,
619*4882a593Smuzhiyun 				      NU_VLAN_UNREG_MCAST_IDX);
620*4882a593Smuzhiyun 		cpsw_ale_set_vlan_mcast(ale, ale_entry, reg_mcast, unreg_mcast);
621*4882a593Smuzhiyun 	}
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	cpsw_ale_vlan_set_fld(ale, ale_entry,
624*4882a593Smuzhiyun 			      ALE_ENT_VID_MEMBER_LIST, port_mask);
625*4882a593Smuzhiyun 
626*4882a593Smuzhiyun 	if (idx < 0)
627*4882a593Smuzhiyun 		idx = cpsw_ale_match_free(ale);
628*4882a593Smuzhiyun 	if (idx < 0)
629*4882a593Smuzhiyun 		idx = cpsw_ale_find_ageable(ale);
630*4882a593Smuzhiyun 	if (idx < 0)
631*4882a593Smuzhiyun 		return -ENOMEM;
632*4882a593Smuzhiyun 
633*4882a593Smuzhiyun 	cpsw_ale_write(ale, idx, ale_entry);
634*4882a593Smuzhiyun 	return 0;
635*4882a593Smuzhiyun }
636*4882a593Smuzhiyun 
cpsw_ale_del_vlan_modify(struct cpsw_ale * ale,u32 * ale_entry,u16 vid,int port_mask)637*4882a593Smuzhiyun static void cpsw_ale_del_vlan_modify(struct cpsw_ale *ale, u32 *ale_entry,
638*4882a593Smuzhiyun 				     u16 vid, int port_mask)
639*4882a593Smuzhiyun {
640*4882a593Smuzhiyun 	int reg_mcast, unreg_mcast;
641*4882a593Smuzhiyun 	int members, untag;
642*4882a593Smuzhiyun 
643*4882a593Smuzhiyun 	members = cpsw_ale_vlan_get_fld(ale, ale_entry,
644*4882a593Smuzhiyun 					ALE_ENT_VID_MEMBER_LIST);
645*4882a593Smuzhiyun 	members &= ~port_mask;
646*4882a593Smuzhiyun 	if (!members) {
647*4882a593Smuzhiyun 		cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_FREE);
648*4882a593Smuzhiyun 		return;
649*4882a593Smuzhiyun 	}
650*4882a593Smuzhiyun 
651*4882a593Smuzhiyun 	untag = cpsw_ale_vlan_get_fld(ale, ale_entry,
652*4882a593Smuzhiyun 				      ALE_ENT_VID_FORCE_UNTAGGED_MSK);
653*4882a593Smuzhiyun 	reg_mcast = cpsw_ale_vlan_get_fld(ale, ale_entry,
654*4882a593Smuzhiyun 					  ALE_ENT_VID_REG_MCAST_MSK);
655*4882a593Smuzhiyun 	unreg_mcast = cpsw_ale_vlan_get_fld(ale, ale_entry,
656*4882a593Smuzhiyun 					    ALE_ENT_VID_UNREG_MCAST_MSK);
657*4882a593Smuzhiyun 	untag &= members;
658*4882a593Smuzhiyun 	reg_mcast &= members;
659*4882a593Smuzhiyun 	unreg_mcast &= members;
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 	cpsw_ale_set_vlan_untag(ale, ale_entry, vid, untag);
662*4882a593Smuzhiyun 
663*4882a593Smuzhiyun 	if (!ale->params.nu_switch_ale) {
664*4882a593Smuzhiyun 		cpsw_ale_vlan_set_fld(ale, ale_entry,
665*4882a593Smuzhiyun 				      ALE_ENT_VID_REG_MCAST_MSK, reg_mcast);
666*4882a593Smuzhiyun 		cpsw_ale_vlan_set_fld(ale, ale_entry,
667*4882a593Smuzhiyun 				      ALE_ENT_VID_UNREG_MCAST_MSK, unreg_mcast);
668*4882a593Smuzhiyun 	} else {
669*4882a593Smuzhiyun 		cpsw_ale_set_vlan_mcast(ale, ale_entry, reg_mcast,
670*4882a593Smuzhiyun 					unreg_mcast);
671*4882a593Smuzhiyun 	}
672*4882a593Smuzhiyun 	cpsw_ale_vlan_set_fld(ale, ale_entry,
673*4882a593Smuzhiyun 			      ALE_ENT_VID_MEMBER_LIST, members);
674*4882a593Smuzhiyun }
675*4882a593Smuzhiyun 
cpsw_ale_del_vlan(struct cpsw_ale * ale,u16 vid,int port_mask)676*4882a593Smuzhiyun int cpsw_ale_del_vlan(struct cpsw_ale *ale, u16 vid, int port_mask)
677*4882a593Smuzhiyun {
678*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
679*4882a593Smuzhiyun 	int idx;
680*4882a593Smuzhiyun 
681*4882a593Smuzhiyun 	idx = cpsw_ale_match_vlan(ale, vid);
682*4882a593Smuzhiyun 	if (idx < 0)
683*4882a593Smuzhiyun 		return -ENOENT;
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	cpsw_ale_read(ale, idx, ale_entry);
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 	if (port_mask) {
688*4882a593Smuzhiyun 		cpsw_ale_del_vlan_modify(ale, ale_entry, vid, port_mask);
689*4882a593Smuzhiyun 	} else {
690*4882a593Smuzhiyun 		cpsw_ale_set_vlan_untag(ale, ale_entry, vid, 0);
691*4882a593Smuzhiyun 		cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_FREE);
692*4882a593Smuzhiyun 	}
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun 	cpsw_ale_write(ale, idx, ale_entry);
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 	return 0;
697*4882a593Smuzhiyun }
698*4882a593Smuzhiyun 
cpsw_ale_vlan_add_modify(struct cpsw_ale * ale,u16 vid,int port_mask,int untag_mask,int reg_mask,int unreg_mask)699*4882a593Smuzhiyun int cpsw_ale_vlan_add_modify(struct cpsw_ale *ale, u16 vid, int port_mask,
700*4882a593Smuzhiyun 			     int untag_mask, int reg_mask, int unreg_mask)
701*4882a593Smuzhiyun {
702*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
703*4882a593Smuzhiyun 	int reg_mcast_members, unreg_mcast_members;
704*4882a593Smuzhiyun 	int vlan_members, untag_members;
705*4882a593Smuzhiyun 	int idx, ret = 0;
706*4882a593Smuzhiyun 
707*4882a593Smuzhiyun 	idx = cpsw_ale_match_vlan(ale, vid);
708*4882a593Smuzhiyun 	if (idx >= 0)
709*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun 	vlan_members = cpsw_ale_vlan_get_fld(ale, ale_entry,
712*4882a593Smuzhiyun 					     ALE_ENT_VID_MEMBER_LIST);
713*4882a593Smuzhiyun 	reg_mcast_members = cpsw_ale_vlan_get_fld(ale, ale_entry,
714*4882a593Smuzhiyun 						  ALE_ENT_VID_REG_MCAST_MSK);
715*4882a593Smuzhiyun 	unreg_mcast_members =
716*4882a593Smuzhiyun 		cpsw_ale_vlan_get_fld(ale, ale_entry,
717*4882a593Smuzhiyun 				      ALE_ENT_VID_UNREG_MCAST_MSK);
718*4882a593Smuzhiyun 	untag_members = cpsw_ale_vlan_get_fld(ale, ale_entry,
719*4882a593Smuzhiyun 					      ALE_ENT_VID_FORCE_UNTAGGED_MSK);
720*4882a593Smuzhiyun 
721*4882a593Smuzhiyun 	vlan_members |= port_mask;
722*4882a593Smuzhiyun 	untag_members = (untag_members & ~port_mask) | untag_mask;
723*4882a593Smuzhiyun 	reg_mcast_members = (reg_mcast_members & ~port_mask) | reg_mask;
724*4882a593Smuzhiyun 	unreg_mcast_members = (unreg_mcast_members & ~port_mask) | unreg_mask;
725*4882a593Smuzhiyun 
726*4882a593Smuzhiyun 	ret = cpsw_ale_add_vlan(ale, vid, vlan_members, untag_members,
727*4882a593Smuzhiyun 				reg_mcast_members, unreg_mcast_members);
728*4882a593Smuzhiyun 	if (ret) {
729*4882a593Smuzhiyun 		dev_err(ale->params.dev, "Unable to add vlan\n");
730*4882a593Smuzhiyun 		return ret;
731*4882a593Smuzhiyun 	}
732*4882a593Smuzhiyun 	dev_dbg(ale->params.dev, "port mask 0x%x untag 0x%x\n", vlan_members,
733*4882a593Smuzhiyun 		untag_mask);
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun 	return ret;
736*4882a593Smuzhiyun }
737*4882a593Smuzhiyun 
cpsw_ale_set_unreg_mcast(struct cpsw_ale * ale,int unreg_mcast_mask,bool add)738*4882a593Smuzhiyun void cpsw_ale_set_unreg_mcast(struct cpsw_ale *ale, int unreg_mcast_mask,
739*4882a593Smuzhiyun 			      bool add)
740*4882a593Smuzhiyun {
741*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS];
742*4882a593Smuzhiyun 	int unreg_members = 0;
743*4882a593Smuzhiyun 	int type, idx;
744*4882a593Smuzhiyun 
745*4882a593Smuzhiyun 	for (idx = 0; idx < ale->params.ale_entries; idx++) {
746*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
747*4882a593Smuzhiyun 		type = cpsw_ale_get_entry_type(ale_entry);
748*4882a593Smuzhiyun 		if (type != ALE_TYPE_VLAN)
749*4882a593Smuzhiyun 			continue;
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 		unreg_members =
752*4882a593Smuzhiyun 			cpsw_ale_vlan_get_fld(ale, ale_entry,
753*4882a593Smuzhiyun 					      ALE_ENT_VID_UNREG_MCAST_MSK);
754*4882a593Smuzhiyun 		if (add)
755*4882a593Smuzhiyun 			unreg_members |= unreg_mcast_mask;
756*4882a593Smuzhiyun 		else
757*4882a593Smuzhiyun 			unreg_members &= ~unreg_mcast_mask;
758*4882a593Smuzhiyun 		cpsw_ale_vlan_set_fld(ale, ale_entry,
759*4882a593Smuzhiyun 				      ALE_ENT_VID_UNREG_MCAST_MSK,
760*4882a593Smuzhiyun 				      unreg_members);
761*4882a593Smuzhiyun 		cpsw_ale_write(ale, idx, ale_entry);
762*4882a593Smuzhiyun 	}
763*4882a593Smuzhiyun }
764*4882a593Smuzhiyun 
cpsw_ale_vlan_set_unreg_mcast(struct cpsw_ale * ale,u32 * ale_entry,int allmulti)765*4882a593Smuzhiyun static void cpsw_ale_vlan_set_unreg_mcast(struct cpsw_ale *ale, u32 *ale_entry,
766*4882a593Smuzhiyun 					  int allmulti)
767*4882a593Smuzhiyun {
768*4882a593Smuzhiyun 	int unreg_mcast;
769*4882a593Smuzhiyun 
770*4882a593Smuzhiyun 	unreg_mcast = cpsw_ale_vlan_get_fld(ale, ale_entry,
771*4882a593Smuzhiyun 					    ALE_ENT_VID_UNREG_MCAST_MSK);
772*4882a593Smuzhiyun 	if (allmulti)
773*4882a593Smuzhiyun 		unreg_mcast |= ALE_PORT_HOST;
774*4882a593Smuzhiyun 	else
775*4882a593Smuzhiyun 		unreg_mcast &= ~ALE_PORT_HOST;
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 	cpsw_ale_vlan_set_fld(ale, ale_entry,
778*4882a593Smuzhiyun 			      ALE_ENT_VID_UNREG_MCAST_MSK, unreg_mcast);
779*4882a593Smuzhiyun }
780*4882a593Smuzhiyun 
781*4882a593Smuzhiyun static void
cpsw_ale_vlan_set_unreg_mcast_idx(struct cpsw_ale * ale,u32 * ale_entry,int allmulti)782*4882a593Smuzhiyun cpsw_ale_vlan_set_unreg_mcast_idx(struct cpsw_ale *ale, u32 *ale_entry,
783*4882a593Smuzhiyun 				  int allmulti)
784*4882a593Smuzhiyun {
785*4882a593Smuzhiyun 	int unreg_mcast;
786*4882a593Smuzhiyun 	int idx;
787*4882a593Smuzhiyun 
788*4882a593Smuzhiyun 	idx = cpsw_ale_vlan_get_fld(ale, ale_entry,
789*4882a593Smuzhiyun 				    ALE_ENT_VID_UNREG_MCAST_IDX);
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun 	unreg_mcast = readl(ale->params.ale_regs + ALE_VLAN_MASK_MUX(idx));
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	if (allmulti)
794*4882a593Smuzhiyun 		unreg_mcast |= ALE_PORT_HOST;
795*4882a593Smuzhiyun 	else
796*4882a593Smuzhiyun 		unreg_mcast &= ~ALE_PORT_HOST;
797*4882a593Smuzhiyun 
798*4882a593Smuzhiyun 	writel(unreg_mcast, ale->params.ale_regs + ALE_VLAN_MASK_MUX(idx));
799*4882a593Smuzhiyun }
800*4882a593Smuzhiyun 
cpsw_ale_set_allmulti(struct cpsw_ale * ale,int allmulti,int port)801*4882a593Smuzhiyun void cpsw_ale_set_allmulti(struct cpsw_ale *ale, int allmulti, int port)
802*4882a593Smuzhiyun {
803*4882a593Smuzhiyun 	u32 ale_entry[ALE_ENTRY_WORDS];
804*4882a593Smuzhiyun 	int type, idx;
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun 	for (idx = 0; idx < ale->params.ale_entries; idx++) {
807*4882a593Smuzhiyun 		int vlan_members;
808*4882a593Smuzhiyun 
809*4882a593Smuzhiyun 		cpsw_ale_read(ale, idx, ale_entry);
810*4882a593Smuzhiyun 		type = cpsw_ale_get_entry_type(ale_entry);
811*4882a593Smuzhiyun 		if (type != ALE_TYPE_VLAN)
812*4882a593Smuzhiyun 			continue;
813*4882a593Smuzhiyun 
814*4882a593Smuzhiyun 		vlan_members = cpsw_ale_vlan_get_fld(ale, ale_entry,
815*4882a593Smuzhiyun 						     ALE_ENT_VID_MEMBER_LIST);
816*4882a593Smuzhiyun 
817*4882a593Smuzhiyun 		if (port != -1 && !(vlan_members & BIT(port)))
818*4882a593Smuzhiyun 			continue;
819*4882a593Smuzhiyun 
820*4882a593Smuzhiyun 		if (!ale->params.nu_switch_ale)
821*4882a593Smuzhiyun 			cpsw_ale_vlan_set_unreg_mcast(ale, ale_entry, allmulti);
822*4882a593Smuzhiyun 		else
823*4882a593Smuzhiyun 			cpsw_ale_vlan_set_unreg_mcast_idx(ale, ale_entry,
824*4882a593Smuzhiyun 							  allmulti);
825*4882a593Smuzhiyun 
826*4882a593Smuzhiyun 		cpsw_ale_write(ale, idx, ale_entry);
827*4882a593Smuzhiyun 	}
828*4882a593Smuzhiyun }
829*4882a593Smuzhiyun 
830*4882a593Smuzhiyun struct ale_control_info {
831*4882a593Smuzhiyun 	const char	*name;
832*4882a593Smuzhiyun 	int		offset, port_offset;
833*4882a593Smuzhiyun 	int		shift, port_shift;
834*4882a593Smuzhiyun 	int		bits;
835*4882a593Smuzhiyun };
836*4882a593Smuzhiyun 
837*4882a593Smuzhiyun static struct ale_control_info ale_controls[ALE_NUM_CONTROLS] = {
838*4882a593Smuzhiyun 	[ALE_ENABLE]		= {
839*4882a593Smuzhiyun 		.name		= "enable",
840*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
841*4882a593Smuzhiyun 		.port_offset	= 0,
842*4882a593Smuzhiyun 		.shift		= 31,
843*4882a593Smuzhiyun 		.port_shift	= 0,
844*4882a593Smuzhiyun 		.bits		= 1,
845*4882a593Smuzhiyun 	},
846*4882a593Smuzhiyun 	[ALE_CLEAR]		= {
847*4882a593Smuzhiyun 		.name		= "clear",
848*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
849*4882a593Smuzhiyun 		.port_offset	= 0,
850*4882a593Smuzhiyun 		.shift		= 30,
851*4882a593Smuzhiyun 		.port_shift	= 0,
852*4882a593Smuzhiyun 		.bits		= 1,
853*4882a593Smuzhiyun 	},
854*4882a593Smuzhiyun 	[ALE_AGEOUT]		= {
855*4882a593Smuzhiyun 		.name		= "ageout",
856*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
857*4882a593Smuzhiyun 		.port_offset	= 0,
858*4882a593Smuzhiyun 		.shift		= 29,
859*4882a593Smuzhiyun 		.port_shift	= 0,
860*4882a593Smuzhiyun 		.bits		= 1,
861*4882a593Smuzhiyun 	},
862*4882a593Smuzhiyun 	[ALE_P0_UNI_FLOOD]	= {
863*4882a593Smuzhiyun 		.name		= "port0_unicast_flood",
864*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
865*4882a593Smuzhiyun 		.port_offset	= 0,
866*4882a593Smuzhiyun 		.shift		= 8,
867*4882a593Smuzhiyun 		.port_shift	= 0,
868*4882a593Smuzhiyun 		.bits		= 1,
869*4882a593Smuzhiyun 	},
870*4882a593Smuzhiyun 	[ALE_VLAN_NOLEARN]	= {
871*4882a593Smuzhiyun 		.name		= "vlan_nolearn",
872*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
873*4882a593Smuzhiyun 		.port_offset	= 0,
874*4882a593Smuzhiyun 		.shift		= 7,
875*4882a593Smuzhiyun 		.port_shift	= 0,
876*4882a593Smuzhiyun 		.bits		= 1,
877*4882a593Smuzhiyun 	},
878*4882a593Smuzhiyun 	[ALE_NO_PORT_VLAN]	= {
879*4882a593Smuzhiyun 		.name		= "no_port_vlan",
880*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
881*4882a593Smuzhiyun 		.port_offset	= 0,
882*4882a593Smuzhiyun 		.shift		= 6,
883*4882a593Smuzhiyun 		.port_shift	= 0,
884*4882a593Smuzhiyun 		.bits		= 1,
885*4882a593Smuzhiyun 	},
886*4882a593Smuzhiyun 	[ALE_OUI_DENY]		= {
887*4882a593Smuzhiyun 		.name		= "oui_deny",
888*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
889*4882a593Smuzhiyun 		.port_offset	= 0,
890*4882a593Smuzhiyun 		.shift		= 5,
891*4882a593Smuzhiyun 		.port_shift	= 0,
892*4882a593Smuzhiyun 		.bits		= 1,
893*4882a593Smuzhiyun 	},
894*4882a593Smuzhiyun 	[ALE_BYPASS]		= {
895*4882a593Smuzhiyun 		.name		= "bypass",
896*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
897*4882a593Smuzhiyun 		.port_offset	= 0,
898*4882a593Smuzhiyun 		.shift		= 4,
899*4882a593Smuzhiyun 		.port_shift	= 0,
900*4882a593Smuzhiyun 		.bits		= 1,
901*4882a593Smuzhiyun 	},
902*4882a593Smuzhiyun 	[ALE_RATE_LIMIT_TX]	= {
903*4882a593Smuzhiyun 		.name		= "rate_limit_tx",
904*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
905*4882a593Smuzhiyun 		.port_offset	= 0,
906*4882a593Smuzhiyun 		.shift		= 3,
907*4882a593Smuzhiyun 		.port_shift	= 0,
908*4882a593Smuzhiyun 		.bits		= 1,
909*4882a593Smuzhiyun 	},
910*4882a593Smuzhiyun 	[ALE_VLAN_AWARE]	= {
911*4882a593Smuzhiyun 		.name		= "vlan_aware",
912*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
913*4882a593Smuzhiyun 		.port_offset	= 0,
914*4882a593Smuzhiyun 		.shift		= 2,
915*4882a593Smuzhiyun 		.port_shift	= 0,
916*4882a593Smuzhiyun 		.bits		= 1,
917*4882a593Smuzhiyun 	},
918*4882a593Smuzhiyun 	[ALE_AUTH_ENABLE]	= {
919*4882a593Smuzhiyun 		.name		= "auth_enable",
920*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
921*4882a593Smuzhiyun 		.port_offset	= 0,
922*4882a593Smuzhiyun 		.shift		= 1,
923*4882a593Smuzhiyun 		.port_shift	= 0,
924*4882a593Smuzhiyun 		.bits		= 1,
925*4882a593Smuzhiyun 	},
926*4882a593Smuzhiyun 	[ALE_RATE_LIMIT]	= {
927*4882a593Smuzhiyun 		.name		= "rate_limit",
928*4882a593Smuzhiyun 		.offset		= ALE_CONTROL,
929*4882a593Smuzhiyun 		.port_offset	= 0,
930*4882a593Smuzhiyun 		.shift		= 0,
931*4882a593Smuzhiyun 		.port_shift	= 0,
932*4882a593Smuzhiyun 		.bits		= 1,
933*4882a593Smuzhiyun 	},
934*4882a593Smuzhiyun 	[ALE_PORT_STATE]	= {
935*4882a593Smuzhiyun 		.name		= "port_state",
936*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
937*4882a593Smuzhiyun 		.port_offset	= 4,
938*4882a593Smuzhiyun 		.shift		= 0,
939*4882a593Smuzhiyun 		.port_shift	= 0,
940*4882a593Smuzhiyun 		.bits		= 2,
941*4882a593Smuzhiyun 	},
942*4882a593Smuzhiyun 	[ALE_PORT_DROP_UNTAGGED] = {
943*4882a593Smuzhiyun 		.name		= "drop_untagged",
944*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
945*4882a593Smuzhiyun 		.port_offset	= 4,
946*4882a593Smuzhiyun 		.shift		= 2,
947*4882a593Smuzhiyun 		.port_shift	= 0,
948*4882a593Smuzhiyun 		.bits		= 1,
949*4882a593Smuzhiyun 	},
950*4882a593Smuzhiyun 	[ALE_PORT_DROP_UNKNOWN_VLAN] = {
951*4882a593Smuzhiyun 		.name		= "drop_unknown",
952*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
953*4882a593Smuzhiyun 		.port_offset	= 4,
954*4882a593Smuzhiyun 		.shift		= 3,
955*4882a593Smuzhiyun 		.port_shift	= 0,
956*4882a593Smuzhiyun 		.bits		= 1,
957*4882a593Smuzhiyun 	},
958*4882a593Smuzhiyun 	[ALE_PORT_NOLEARN]	= {
959*4882a593Smuzhiyun 		.name		= "nolearn",
960*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
961*4882a593Smuzhiyun 		.port_offset	= 4,
962*4882a593Smuzhiyun 		.shift		= 4,
963*4882a593Smuzhiyun 		.port_shift	= 0,
964*4882a593Smuzhiyun 		.bits		= 1,
965*4882a593Smuzhiyun 	},
966*4882a593Smuzhiyun 	[ALE_PORT_NO_SA_UPDATE]	= {
967*4882a593Smuzhiyun 		.name		= "no_source_update",
968*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
969*4882a593Smuzhiyun 		.port_offset	= 4,
970*4882a593Smuzhiyun 		.shift		= 5,
971*4882a593Smuzhiyun 		.port_shift	= 0,
972*4882a593Smuzhiyun 		.bits		= 1,
973*4882a593Smuzhiyun 	},
974*4882a593Smuzhiyun 	[ALE_PORT_MACONLY]	= {
975*4882a593Smuzhiyun 		.name		= "mac_only_port_mode",
976*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
977*4882a593Smuzhiyun 		.port_offset	= 4,
978*4882a593Smuzhiyun 		.shift		= 11,
979*4882a593Smuzhiyun 		.port_shift	= 0,
980*4882a593Smuzhiyun 		.bits		= 1,
981*4882a593Smuzhiyun 	},
982*4882a593Smuzhiyun 	[ALE_PORT_MACONLY_CAF]	= {
983*4882a593Smuzhiyun 		.name		= "mac_only_port_caf",
984*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
985*4882a593Smuzhiyun 		.port_offset	= 4,
986*4882a593Smuzhiyun 		.shift		= 13,
987*4882a593Smuzhiyun 		.port_shift	= 0,
988*4882a593Smuzhiyun 		.bits		= 1,
989*4882a593Smuzhiyun 	},
990*4882a593Smuzhiyun 	[ALE_PORT_MCAST_LIMIT]	= {
991*4882a593Smuzhiyun 		.name		= "mcast_limit",
992*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
993*4882a593Smuzhiyun 		.port_offset	= 4,
994*4882a593Smuzhiyun 		.shift		= 16,
995*4882a593Smuzhiyun 		.port_shift	= 0,
996*4882a593Smuzhiyun 		.bits		= 8,
997*4882a593Smuzhiyun 	},
998*4882a593Smuzhiyun 	[ALE_PORT_BCAST_LIMIT]	= {
999*4882a593Smuzhiyun 		.name		= "bcast_limit",
1000*4882a593Smuzhiyun 		.offset		= ALE_PORTCTL,
1001*4882a593Smuzhiyun 		.port_offset	= 4,
1002*4882a593Smuzhiyun 		.shift		= 24,
1003*4882a593Smuzhiyun 		.port_shift	= 0,
1004*4882a593Smuzhiyun 		.bits		= 8,
1005*4882a593Smuzhiyun 	},
1006*4882a593Smuzhiyun 	[ALE_PORT_UNKNOWN_VLAN_MEMBER] = {
1007*4882a593Smuzhiyun 		.name		= "unknown_vlan_member",
1008*4882a593Smuzhiyun 		.offset		= ALE_UNKNOWNVLAN,
1009*4882a593Smuzhiyun 		.port_offset	= 0,
1010*4882a593Smuzhiyun 		.shift		= 0,
1011*4882a593Smuzhiyun 		.port_shift	= 0,
1012*4882a593Smuzhiyun 		.bits		= 6,
1013*4882a593Smuzhiyun 	},
1014*4882a593Smuzhiyun 	[ALE_PORT_UNKNOWN_MCAST_FLOOD] = {
1015*4882a593Smuzhiyun 		.name		= "unknown_mcast_flood",
1016*4882a593Smuzhiyun 		.offset		= ALE_UNKNOWNVLAN,
1017*4882a593Smuzhiyun 		.port_offset	= 0,
1018*4882a593Smuzhiyun 		.shift		= 8,
1019*4882a593Smuzhiyun 		.port_shift	= 0,
1020*4882a593Smuzhiyun 		.bits		= 6,
1021*4882a593Smuzhiyun 	},
1022*4882a593Smuzhiyun 	[ALE_PORT_UNKNOWN_REG_MCAST_FLOOD] = {
1023*4882a593Smuzhiyun 		.name		= "unknown_reg_flood",
1024*4882a593Smuzhiyun 		.offset		= ALE_UNKNOWNVLAN,
1025*4882a593Smuzhiyun 		.port_offset	= 0,
1026*4882a593Smuzhiyun 		.shift		= 16,
1027*4882a593Smuzhiyun 		.port_shift	= 0,
1028*4882a593Smuzhiyun 		.bits		= 6,
1029*4882a593Smuzhiyun 	},
1030*4882a593Smuzhiyun 	[ALE_PORT_UNTAGGED_EGRESS] = {
1031*4882a593Smuzhiyun 		.name		= "untagged_egress",
1032*4882a593Smuzhiyun 		.offset		= ALE_UNKNOWNVLAN,
1033*4882a593Smuzhiyun 		.port_offset	= 0,
1034*4882a593Smuzhiyun 		.shift		= 24,
1035*4882a593Smuzhiyun 		.port_shift	= 0,
1036*4882a593Smuzhiyun 		.bits		= 6,
1037*4882a593Smuzhiyun 	},
1038*4882a593Smuzhiyun 	[ALE_DEFAULT_THREAD_ID] = {
1039*4882a593Smuzhiyun 		.name		= "default_thread_id",
1040*4882a593Smuzhiyun 		.offset		= AM65_CPSW_ALE_THREAD_DEF_REG,
1041*4882a593Smuzhiyun 		.port_offset	= 0,
1042*4882a593Smuzhiyun 		.shift		= 0,
1043*4882a593Smuzhiyun 		.port_shift	= 0,
1044*4882a593Smuzhiyun 		.bits		= 6,
1045*4882a593Smuzhiyun 	},
1046*4882a593Smuzhiyun 	[ALE_DEFAULT_THREAD_ENABLE] = {
1047*4882a593Smuzhiyun 		.name		= "default_thread_id_enable",
1048*4882a593Smuzhiyun 		.offset		= AM65_CPSW_ALE_THREAD_DEF_REG,
1049*4882a593Smuzhiyun 		.port_offset	= 0,
1050*4882a593Smuzhiyun 		.shift		= 15,
1051*4882a593Smuzhiyun 		.port_shift	= 0,
1052*4882a593Smuzhiyun 		.bits		= 1,
1053*4882a593Smuzhiyun 	},
1054*4882a593Smuzhiyun };
1055*4882a593Smuzhiyun 
cpsw_ale_control_set(struct cpsw_ale * ale,int port,int control,int value)1056*4882a593Smuzhiyun int cpsw_ale_control_set(struct cpsw_ale *ale, int port, int control,
1057*4882a593Smuzhiyun 			 int value)
1058*4882a593Smuzhiyun {
1059*4882a593Smuzhiyun 	const struct ale_control_info *info;
1060*4882a593Smuzhiyun 	int offset, shift;
1061*4882a593Smuzhiyun 	u32 tmp, mask;
1062*4882a593Smuzhiyun 
1063*4882a593Smuzhiyun 	if (control < 0 || control >= ARRAY_SIZE(ale_controls))
1064*4882a593Smuzhiyun 		return -EINVAL;
1065*4882a593Smuzhiyun 
1066*4882a593Smuzhiyun 	info = &ale_controls[control];
1067*4882a593Smuzhiyun 	if (info->port_offset == 0 && info->port_shift == 0)
1068*4882a593Smuzhiyun 		port = 0; /* global, port is a dont care */
1069*4882a593Smuzhiyun 
1070*4882a593Smuzhiyun 	if (port < 0 || port >= ale->params.ale_ports)
1071*4882a593Smuzhiyun 		return -EINVAL;
1072*4882a593Smuzhiyun 
1073*4882a593Smuzhiyun 	mask = BITMASK(info->bits);
1074*4882a593Smuzhiyun 	if (value & ~mask)
1075*4882a593Smuzhiyun 		return -EINVAL;
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun 	offset = info->offset + (port * info->port_offset);
1078*4882a593Smuzhiyun 	shift  = info->shift  + (port * info->port_shift);
1079*4882a593Smuzhiyun 
1080*4882a593Smuzhiyun 	tmp = readl_relaxed(ale->params.ale_regs + offset);
1081*4882a593Smuzhiyun 	tmp = (tmp & ~(mask << shift)) | (value << shift);
1082*4882a593Smuzhiyun 	writel_relaxed(tmp, ale->params.ale_regs + offset);
1083*4882a593Smuzhiyun 
1084*4882a593Smuzhiyun 	return 0;
1085*4882a593Smuzhiyun }
1086*4882a593Smuzhiyun 
cpsw_ale_control_get(struct cpsw_ale * ale,int port,int control)1087*4882a593Smuzhiyun int cpsw_ale_control_get(struct cpsw_ale *ale, int port, int control)
1088*4882a593Smuzhiyun {
1089*4882a593Smuzhiyun 	const struct ale_control_info *info;
1090*4882a593Smuzhiyun 	int offset, shift;
1091*4882a593Smuzhiyun 	u32 tmp;
1092*4882a593Smuzhiyun 
1093*4882a593Smuzhiyun 	if (control < 0 || control >= ARRAY_SIZE(ale_controls))
1094*4882a593Smuzhiyun 		return -EINVAL;
1095*4882a593Smuzhiyun 
1096*4882a593Smuzhiyun 	info = &ale_controls[control];
1097*4882a593Smuzhiyun 	if (info->port_offset == 0 && info->port_shift == 0)
1098*4882a593Smuzhiyun 		port = 0; /* global, port is a dont care */
1099*4882a593Smuzhiyun 
1100*4882a593Smuzhiyun 	if (port < 0 || port >= ale->params.ale_ports)
1101*4882a593Smuzhiyun 		return -EINVAL;
1102*4882a593Smuzhiyun 
1103*4882a593Smuzhiyun 	offset = info->offset + (port * info->port_offset);
1104*4882a593Smuzhiyun 	shift  = info->shift  + (port * info->port_shift);
1105*4882a593Smuzhiyun 
1106*4882a593Smuzhiyun 	tmp = readl_relaxed(ale->params.ale_regs + offset) >> shift;
1107*4882a593Smuzhiyun 	return tmp & BITMASK(info->bits);
1108*4882a593Smuzhiyun }
1109*4882a593Smuzhiyun 
cpsw_ale_timer(struct timer_list * t)1110*4882a593Smuzhiyun static void cpsw_ale_timer(struct timer_list *t)
1111*4882a593Smuzhiyun {
1112*4882a593Smuzhiyun 	struct cpsw_ale *ale = from_timer(ale, t, timer);
1113*4882a593Smuzhiyun 
1114*4882a593Smuzhiyun 	cpsw_ale_control_set(ale, 0, ALE_AGEOUT, 1);
1115*4882a593Smuzhiyun 
1116*4882a593Smuzhiyun 	if (ale->ageout) {
1117*4882a593Smuzhiyun 		ale->timer.expires = jiffies + ale->ageout;
1118*4882a593Smuzhiyun 		add_timer(&ale->timer);
1119*4882a593Smuzhiyun 	}
1120*4882a593Smuzhiyun }
1121*4882a593Smuzhiyun 
cpsw_ale_hw_aging_timer_start(struct cpsw_ale * ale)1122*4882a593Smuzhiyun static void cpsw_ale_hw_aging_timer_start(struct cpsw_ale *ale)
1123*4882a593Smuzhiyun {
1124*4882a593Smuzhiyun 	u32 aging_timer;
1125*4882a593Smuzhiyun 
1126*4882a593Smuzhiyun 	aging_timer = ale->params.bus_freq / 1000000;
1127*4882a593Smuzhiyun 	aging_timer *= ale->params.ale_ageout;
1128*4882a593Smuzhiyun 
1129*4882a593Smuzhiyun 	if (aging_timer & ~ALE_AGING_TIMER_MASK) {
1130*4882a593Smuzhiyun 		aging_timer = ALE_AGING_TIMER_MASK;
1131*4882a593Smuzhiyun 		dev_warn(ale->params.dev,
1132*4882a593Smuzhiyun 			 "ALE aging timer overflow, set to max\n");
1133*4882a593Smuzhiyun 	}
1134*4882a593Smuzhiyun 
1135*4882a593Smuzhiyun 	writel(aging_timer, ale->params.ale_regs + ALE_AGING_TIMER);
1136*4882a593Smuzhiyun }
1137*4882a593Smuzhiyun 
cpsw_ale_hw_aging_timer_stop(struct cpsw_ale * ale)1138*4882a593Smuzhiyun static void cpsw_ale_hw_aging_timer_stop(struct cpsw_ale *ale)
1139*4882a593Smuzhiyun {
1140*4882a593Smuzhiyun 	writel(0, ale->params.ale_regs + ALE_AGING_TIMER);
1141*4882a593Smuzhiyun }
1142*4882a593Smuzhiyun 
cpsw_ale_aging_start(struct cpsw_ale * ale)1143*4882a593Smuzhiyun static void cpsw_ale_aging_start(struct cpsw_ale *ale)
1144*4882a593Smuzhiyun {
1145*4882a593Smuzhiyun 	if (!ale->params.ale_ageout)
1146*4882a593Smuzhiyun 		return;
1147*4882a593Smuzhiyun 
1148*4882a593Smuzhiyun 	if (ale->features & CPSW_ALE_F_HW_AUTOAGING) {
1149*4882a593Smuzhiyun 		cpsw_ale_hw_aging_timer_start(ale);
1150*4882a593Smuzhiyun 		return;
1151*4882a593Smuzhiyun 	}
1152*4882a593Smuzhiyun 
1153*4882a593Smuzhiyun 	timer_setup(&ale->timer, cpsw_ale_timer, 0);
1154*4882a593Smuzhiyun 	ale->timer.expires = jiffies + ale->ageout;
1155*4882a593Smuzhiyun 	add_timer(&ale->timer);
1156*4882a593Smuzhiyun }
1157*4882a593Smuzhiyun 
cpsw_ale_aging_stop(struct cpsw_ale * ale)1158*4882a593Smuzhiyun static void cpsw_ale_aging_stop(struct cpsw_ale *ale)
1159*4882a593Smuzhiyun {
1160*4882a593Smuzhiyun 	if (!ale->params.ale_ageout)
1161*4882a593Smuzhiyun 		return;
1162*4882a593Smuzhiyun 
1163*4882a593Smuzhiyun 	if (ale->features & CPSW_ALE_F_HW_AUTOAGING) {
1164*4882a593Smuzhiyun 		cpsw_ale_hw_aging_timer_stop(ale);
1165*4882a593Smuzhiyun 		return;
1166*4882a593Smuzhiyun 	}
1167*4882a593Smuzhiyun 
1168*4882a593Smuzhiyun 	del_timer_sync(&ale->timer);
1169*4882a593Smuzhiyun }
1170*4882a593Smuzhiyun 
cpsw_ale_start(struct cpsw_ale * ale)1171*4882a593Smuzhiyun void cpsw_ale_start(struct cpsw_ale *ale)
1172*4882a593Smuzhiyun {
1173*4882a593Smuzhiyun 	cpsw_ale_control_set(ale, 0, ALE_ENABLE, 1);
1174*4882a593Smuzhiyun 	cpsw_ale_control_set(ale, 0, ALE_CLEAR, 1);
1175*4882a593Smuzhiyun 
1176*4882a593Smuzhiyun 	cpsw_ale_aging_start(ale);
1177*4882a593Smuzhiyun }
1178*4882a593Smuzhiyun 
cpsw_ale_stop(struct cpsw_ale * ale)1179*4882a593Smuzhiyun void cpsw_ale_stop(struct cpsw_ale *ale)
1180*4882a593Smuzhiyun {
1181*4882a593Smuzhiyun 	cpsw_ale_aging_stop(ale);
1182*4882a593Smuzhiyun 	cpsw_ale_control_set(ale, 0, ALE_CLEAR, 1);
1183*4882a593Smuzhiyun 	cpsw_ale_control_set(ale, 0, ALE_ENABLE, 0);
1184*4882a593Smuzhiyun }
1185*4882a593Smuzhiyun 
1186*4882a593Smuzhiyun static const struct cpsw_ale_dev_id cpsw_ale_id_match[] = {
1187*4882a593Smuzhiyun 	{
1188*4882a593Smuzhiyun 		/* am3/4/5, dra7. dm814x, 66ak2hk-gbe */
1189*4882a593Smuzhiyun 		.dev_id = "cpsw",
1190*4882a593Smuzhiyun 		.tbl_entries = 1024,
1191*4882a593Smuzhiyun 		.major_ver_mask = 0xff,
1192*4882a593Smuzhiyun 		.vlan_entry_tbl = vlan_entry_cpsw,
1193*4882a593Smuzhiyun 	},
1194*4882a593Smuzhiyun 	{
1195*4882a593Smuzhiyun 		/* 66ak2h_xgbe */
1196*4882a593Smuzhiyun 		.dev_id = "66ak2h-xgbe",
1197*4882a593Smuzhiyun 		.tbl_entries = 2048,
1198*4882a593Smuzhiyun 		.major_ver_mask = 0xff,
1199*4882a593Smuzhiyun 		.vlan_entry_tbl = vlan_entry_cpsw,
1200*4882a593Smuzhiyun 	},
1201*4882a593Smuzhiyun 	{
1202*4882a593Smuzhiyun 		.dev_id = "66ak2el",
1203*4882a593Smuzhiyun 		.features = CPSW_ALE_F_STATUS_REG,
1204*4882a593Smuzhiyun 		.major_ver_mask = 0x7,
1205*4882a593Smuzhiyun 		.nu_switch_ale = true,
1206*4882a593Smuzhiyun 		.vlan_entry_tbl = vlan_entry_nu,
1207*4882a593Smuzhiyun 	},
1208*4882a593Smuzhiyun 	{
1209*4882a593Smuzhiyun 		.dev_id = "66ak2g",
1210*4882a593Smuzhiyun 		.features = CPSW_ALE_F_STATUS_REG,
1211*4882a593Smuzhiyun 		.tbl_entries = 64,
1212*4882a593Smuzhiyun 		.major_ver_mask = 0x7,
1213*4882a593Smuzhiyun 		.nu_switch_ale = true,
1214*4882a593Smuzhiyun 		.vlan_entry_tbl = vlan_entry_nu,
1215*4882a593Smuzhiyun 	},
1216*4882a593Smuzhiyun 	{
1217*4882a593Smuzhiyun 		.dev_id = "am65x-cpsw2g",
1218*4882a593Smuzhiyun 		.features = CPSW_ALE_F_STATUS_REG | CPSW_ALE_F_HW_AUTOAGING,
1219*4882a593Smuzhiyun 		.tbl_entries = 64,
1220*4882a593Smuzhiyun 		.major_ver_mask = 0x7,
1221*4882a593Smuzhiyun 		.nu_switch_ale = true,
1222*4882a593Smuzhiyun 		.vlan_entry_tbl = vlan_entry_nu,
1223*4882a593Smuzhiyun 	},
1224*4882a593Smuzhiyun 	{
1225*4882a593Smuzhiyun 		.dev_id = "j721e-cpswxg",
1226*4882a593Smuzhiyun 		.features = CPSW_ALE_F_STATUS_REG | CPSW_ALE_F_HW_AUTOAGING,
1227*4882a593Smuzhiyun 		.major_ver_mask = 0x7,
1228*4882a593Smuzhiyun 		.vlan_entry_tbl = vlan_entry_k3_cpswxg,
1229*4882a593Smuzhiyun 	},
1230*4882a593Smuzhiyun 	{ },
1231*4882a593Smuzhiyun };
1232*4882a593Smuzhiyun 
1233*4882a593Smuzhiyun static const struct
cpsw_ale_match_id(const struct cpsw_ale_dev_id * id,const char * dev_id)1234*4882a593Smuzhiyun cpsw_ale_dev_id *cpsw_ale_match_id(const struct cpsw_ale_dev_id *id,
1235*4882a593Smuzhiyun 				   const char *dev_id)
1236*4882a593Smuzhiyun {
1237*4882a593Smuzhiyun 	if (!dev_id)
1238*4882a593Smuzhiyun 		return NULL;
1239*4882a593Smuzhiyun 
1240*4882a593Smuzhiyun 	while (id->dev_id) {
1241*4882a593Smuzhiyun 		if (strcmp(dev_id, id->dev_id) == 0)
1242*4882a593Smuzhiyun 			return id;
1243*4882a593Smuzhiyun 		id++;
1244*4882a593Smuzhiyun 	}
1245*4882a593Smuzhiyun 	return NULL;
1246*4882a593Smuzhiyun }
1247*4882a593Smuzhiyun 
cpsw_ale_create(struct cpsw_ale_params * params)1248*4882a593Smuzhiyun struct cpsw_ale *cpsw_ale_create(struct cpsw_ale_params *params)
1249*4882a593Smuzhiyun {
1250*4882a593Smuzhiyun 	const struct cpsw_ale_dev_id *ale_dev_id;
1251*4882a593Smuzhiyun 	struct cpsw_ale *ale;
1252*4882a593Smuzhiyun 	u32 rev, ale_entries;
1253*4882a593Smuzhiyun 
1254*4882a593Smuzhiyun 	ale_dev_id = cpsw_ale_match_id(cpsw_ale_id_match, params->dev_id);
1255*4882a593Smuzhiyun 	if (!ale_dev_id)
1256*4882a593Smuzhiyun 		return ERR_PTR(-EINVAL);
1257*4882a593Smuzhiyun 
1258*4882a593Smuzhiyun 	params->ale_entries = ale_dev_id->tbl_entries;
1259*4882a593Smuzhiyun 	params->major_ver_mask = ale_dev_id->major_ver_mask;
1260*4882a593Smuzhiyun 	params->nu_switch_ale = ale_dev_id->nu_switch_ale;
1261*4882a593Smuzhiyun 
1262*4882a593Smuzhiyun 	ale = devm_kzalloc(params->dev, sizeof(*ale), GFP_KERNEL);
1263*4882a593Smuzhiyun 	if (!ale)
1264*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
1265*4882a593Smuzhiyun 
1266*4882a593Smuzhiyun 	ale->p0_untag_vid_mask =
1267*4882a593Smuzhiyun 		devm_kmalloc_array(params->dev, BITS_TO_LONGS(VLAN_N_VID),
1268*4882a593Smuzhiyun 				   sizeof(unsigned long),
1269*4882a593Smuzhiyun 				   GFP_KERNEL);
1270*4882a593Smuzhiyun 	if (!ale->p0_untag_vid_mask)
1271*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
1272*4882a593Smuzhiyun 
1273*4882a593Smuzhiyun 	ale->params = *params;
1274*4882a593Smuzhiyun 	ale->ageout = ale->params.ale_ageout * HZ;
1275*4882a593Smuzhiyun 	ale->features = ale_dev_id->features;
1276*4882a593Smuzhiyun 	ale->vlan_entry_tbl = ale_dev_id->vlan_entry_tbl;
1277*4882a593Smuzhiyun 
1278*4882a593Smuzhiyun 	rev = readl_relaxed(ale->params.ale_regs + ALE_IDVER);
1279*4882a593Smuzhiyun 	ale->version =
1280*4882a593Smuzhiyun 		(ALE_VERSION_MAJOR(rev, ale->params.major_ver_mask) << 8) |
1281*4882a593Smuzhiyun 		 ALE_VERSION_MINOR(rev);
1282*4882a593Smuzhiyun 	dev_info(ale->params.dev, "initialized cpsw ale version %d.%d\n",
1283*4882a593Smuzhiyun 		 ALE_VERSION_MAJOR(rev, ale->params.major_ver_mask),
1284*4882a593Smuzhiyun 		 ALE_VERSION_MINOR(rev));
1285*4882a593Smuzhiyun 
1286*4882a593Smuzhiyun 	if (ale->features & CPSW_ALE_F_STATUS_REG &&
1287*4882a593Smuzhiyun 	    !ale->params.ale_entries) {
1288*4882a593Smuzhiyun 		ale_entries =
1289*4882a593Smuzhiyun 			readl_relaxed(ale->params.ale_regs + ALE_STATUS) &
1290*4882a593Smuzhiyun 			ALE_STATUS_SIZE_MASK;
1291*4882a593Smuzhiyun 		/* ALE available on newer NetCP switches has introduced
1292*4882a593Smuzhiyun 		 * a register, ALE_STATUS, to indicate the size of ALE
1293*4882a593Smuzhiyun 		 * table which shows the size as a multiple of 1024 entries.
1294*4882a593Smuzhiyun 		 * For these, params.ale_entries will be set to zero. So
1295*4882a593Smuzhiyun 		 * read the register and update the value of ale_entries.
1296*4882a593Smuzhiyun 		 * return error if ale_entries is zero in ALE_STATUS.
1297*4882a593Smuzhiyun 		 */
1298*4882a593Smuzhiyun 		if (!ale_entries)
1299*4882a593Smuzhiyun 			return ERR_PTR(-EINVAL);
1300*4882a593Smuzhiyun 
1301*4882a593Smuzhiyun 		ale_entries *= ALE_TABLE_SIZE_MULTIPLIER;
1302*4882a593Smuzhiyun 		ale->params.ale_entries = ale_entries;
1303*4882a593Smuzhiyun 	}
1304*4882a593Smuzhiyun 	dev_info(ale->params.dev,
1305*4882a593Smuzhiyun 		 "ALE Table size %ld\n", ale->params.ale_entries);
1306*4882a593Smuzhiyun 
1307*4882a593Smuzhiyun 	/* set default bits for existing h/w */
1308*4882a593Smuzhiyun 	ale->port_mask_bits = ale->params.ale_ports;
1309*4882a593Smuzhiyun 	ale->port_num_bits = order_base_2(ale->params.ale_ports);
1310*4882a593Smuzhiyun 	ale->vlan_field_bits = ale->params.ale_ports;
1311*4882a593Smuzhiyun 
1312*4882a593Smuzhiyun 	/* Set defaults override for ALE on NetCP NU switch and for version
1313*4882a593Smuzhiyun 	 * 1R3
1314*4882a593Smuzhiyun 	 */
1315*4882a593Smuzhiyun 	if (ale->params.nu_switch_ale) {
1316*4882a593Smuzhiyun 		/* Separate registers for unknown vlan configuration.
1317*4882a593Smuzhiyun 		 * Also there are N bits, where N is number of ale
1318*4882a593Smuzhiyun 		 * ports and shift value should be 0
1319*4882a593Smuzhiyun 		 */
1320*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_VLAN_MEMBER].bits =
1321*4882a593Smuzhiyun 					ale->params.ale_ports;
1322*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_VLAN_MEMBER].offset =
1323*4882a593Smuzhiyun 					ALE_UNKNOWNVLAN_MEMBER;
1324*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_MCAST_FLOOD].bits =
1325*4882a593Smuzhiyun 					ale->params.ale_ports;
1326*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_MCAST_FLOOD].shift = 0;
1327*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_MCAST_FLOOD].offset =
1328*4882a593Smuzhiyun 					ALE_UNKNOWNVLAN_UNREG_MCAST_FLOOD;
1329*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_REG_MCAST_FLOOD].bits =
1330*4882a593Smuzhiyun 					ale->params.ale_ports;
1331*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_REG_MCAST_FLOOD].shift = 0;
1332*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNKNOWN_REG_MCAST_FLOOD].offset =
1333*4882a593Smuzhiyun 					ALE_UNKNOWNVLAN_REG_MCAST_FLOOD;
1334*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNTAGGED_EGRESS].bits =
1335*4882a593Smuzhiyun 					ale->params.ale_ports;
1336*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNTAGGED_EGRESS].shift = 0;
1337*4882a593Smuzhiyun 		ale_controls[ALE_PORT_UNTAGGED_EGRESS].offset =
1338*4882a593Smuzhiyun 					ALE_UNKNOWNVLAN_FORCE_UNTAG_EGRESS;
1339*4882a593Smuzhiyun 	}
1340*4882a593Smuzhiyun 
1341*4882a593Smuzhiyun 	cpsw_ale_control_set(ale, 0, ALE_CLEAR, 1);
1342*4882a593Smuzhiyun 	return ale;
1343*4882a593Smuzhiyun }
1344*4882a593Smuzhiyun 
cpsw_ale_dump(struct cpsw_ale * ale,u32 * data)1345*4882a593Smuzhiyun void cpsw_ale_dump(struct cpsw_ale *ale, u32 *data)
1346*4882a593Smuzhiyun {
1347*4882a593Smuzhiyun 	int i;
1348*4882a593Smuzhiyun 
1349*4882a593Smuzhiyun 	for (i = 0; i < ale->params.ale_entries; i++) {
1350*4882a593Smuzhiyun 		cpsw_ale_read(ale, i, data);
1351*4882a593Smuzhiyun 		data += ALE_ENTRY_WORDS;
1352*4882a593Smuzhiyun 	}
1353*4882a593Smuzhiyun }
1354*4882a593Smuzhiyun 
cpsw_ale_get_num_entries(struct cpsw_ale * ale)1355*4882a593Smuzhiyun u32 cpsw_ale_get_num_entries(struct cpsw_ale *ale)
1356*4882a593Smuzhiyun {
1357*4882a593Smuzhiyun 	return ale ? ale->params.ale_entries : 0;
1358*4882a593Smuzhiyun }
1359