1 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
2 /* Copyright (c) 2020 Marvell International Ltd. All rights reserved */
3 
4 #include <linux/bitfield.h>
5 #include <linux/bitops.h>
6 #include <linux/errno.h>
7 #include <linux/string.h>
8 
9 #include "prestera_dsa.h"
10 
11 #define PRESTERA_DSA_W0_CMD		GENMASK(31, 30)
12 #define PRESTERA_DSA_W0_IS_TAGGED	BIT(29)
13 #define PRESTERA_DSA_W0_DEV_NUM		GENMASK(28, 24)
14 #define PRESTERA_DSA_W0_PORT_NUM	GENMASK(23, 19)
15 #define PRESTERA_DSA_W0_VPT		GENMASK(15, 13)
16 #define PRESTERA_DSA_W0_EXT_BIT		BIT(12)
17 #define PRESTERA_DSA_W0_VID		GENMASK(11, 0)
18 
19 #define PRESTERA_DSA_W1_EXT_BIT		BIT(31)
20 #define PRESTERA_DSA_W1_CFI_BIT		BIT(30)
21 #define PRESTERA_DSA_W1_PORT_NUM	GENMASK(11, 10)
22 #define PRESTERA_DSA_W1_MASK_CPU_CODE	GENMASK(7, 0)
23 
24 #define PRESTERA_DSA_W2_EXT_BIT		BIT(31)
25 #define PRESTERA_DSA_W2_PORT_NUM	BIT(20)
26 
27 #define PRESTERA_DSA_W3_VID		GENMASK(30, 27)
28 #define PRESTERA_DSA_W3_DST_EPORT	GENMASK(23, 7)
29 #define PRESTERA_DSA_W3_DEV_NUM		GENMASK(6, 0)
30 
31 #define PRESTERA_DSA_VID		GENMASK(15, 12)
32 #define PRESTERA_DSA_DEV_NUM		GENMASK(11, 5)
33 
34 int prestera_dsa_parse(struct prestera_dsa *dsa, const u8 *dsa_buf)
35 {
36 	__be32 *dsa_words = (__be32 *)dsa_buf;
37 	enum prestera_dsa_cmd cmd;
38 	u32 words[4];
39 	u32 field;
40 
41 	words[0] = ntohl(dsa_words[0]);
42 	words[1] = ntohl(dsa_words[1]);
43 	words[2] = ntohl(dsa_words[2]);
44 	words[3] = ntohl(dsa_words[3]);
45 
46 	/* set the common parameters */
47 	cmd = (enum prestera_dsa_cmd)FIELD_GET(PRESTERA_DSA_W0_CMD, words[0]);
48 
49 	/* only to CPU is supported */
50 	if (unlikely(cmd != PRESTERA_DSA_CMD_TO_CPU))
51 		return -EINVAL;
52 
53 	if (FIELD_GET(PRESTERA_DSA_W0_EXT_BIT, words[0]) == 0)
54 		return -EINVAL;
55 	if (FIELD_GET(PRESTERA_DSA_W1_EXT_BIT, words[1]) == 0)
56 		return -EINVAL;
57 	if (FIELD_GET(PRESTERA_DSA_W2_EXT_BIT, words[2]) == 0)
58 		return -EINVAL;
59 
60 	field = FIELD_GET(PRESTERA_DSA_W3_VID, words[3]);
61 
62 	dsa->vlan.is_tagged = FIELD_GET(PRESTERA_DSA_W0_IS_TAGGED, words[0]);
63 	dsa->vlan.cfi_bit = FIELD_GET(PRESTERA_DSA_W1_CFI_BIT, words[1]);
64 	dsa->vlan.vpt = FIELD_GET(PRESTERA_DSA_W0_VPT, words[0]);
65 	dsa->vlan.vid = FIELD_GET(PRESTERA_DSA_W0_VID, words[0]);
66 	dsa->vlan.vid &= ~PRESTERA_DSA_VID;
67 	dsa->vlan.vid |= FIELD_PREP(PRESTERA_DSA_VID, field);
68 
69 	field = FIELD_GET(PRESTERA_DSA_W3_DEV_NUM, words[3]);
70 
71 	dsa->hw_dev_num = FIELD_GET(PRESTERA_DSA_W0_DEV_NUM, words[0]);
72 	dsa->hw_dev_num |= FIELD_PREP(PRESTERA_DSA_DEV_NUM, field);
73 
74 	dsa->port_num = (FIELD_GET(PRESTERA_DSA_W0_PORT_NUM, words[0]) << 0) |
75 			(FIELD_GET(PRESTERA_DSA_W1_PORT_NUM, words[1]) << 5) |
76 			(FIELD_GET(PRESTERA_DSA_W2_PORT_NUM, words[2]) << 7);
77 
78 	dsa->cpu_code = FIELD_GET(PRESTERA_DSA_W1_MASK_CPU_CODE, words[1]);
79 
80 	return 0;
81 }
82 
83 int prestera_dsa_build(const struct prestera_dsa *dsa, u8 *dsa_buf)
84 {
85 	__be32 *dsa_words = (__be32 *)dsa_buf;
86 	u32 dev_num = dsa->hw_dev_num;
87 	u32 words[4] = { 0 };
88 
89 	words[0] |= FIELD_PREP(PRESTERA_DSA_W0_CMD, PRESTERA_DSA_CMD_FROM_CPU);
90 
91 	words[0] |= FIELD_PREP(PRESTERA_DSA_W0_DEV_NUM, dev_num);
92 	dev_num = FIELD_GET(PRESTERA_DSA_DEV_NUM, dev_num);
93 	words[3] |= FIELD_PREP(PRESTERA_DSA_W3_DEV_NUM, dev_num);
94 
95 	words[3] |= FIELD_PREP(PRESTERA_DSA_W3_DST_EPORT, dsa->port_num);
96 
97 	words[0] |= FIELD_PREP(PRESTERA_DSA_W0_EXT_BIT, 1);
98 	words[1] |= FIELD_PREP(PRESTERA_DSA_W1_EXT_BIT, 1);
99 	words[2] |= FIELD_PREP(PRESTERA_DSA_W2_EXT_BIT, 1);
100 
101 	dsa_words[0] = htonl(words[0]);
102 	dsa_words[1] = htonl(words[1]);
103 	dsa_words[2] = htonl(words[2]);
104 	dsa_words[3] = htonl(words[3]);
105 
106 	return 0;
107 }
108