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