marvell/prestera/prestera_dsa.c

0001 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
0002 /* Copyright (c) 2020 Marvell International Ltd. All rights reserved */
0003
0004 #include <linux/bitfield.h>
0005 #include <linux/bitops.h>
0006 #include <linux/errno.h>
0007 #include <linux/string.h>
0008
0009 #include "prestera_dsa.h"
0010
0011 #define PRESTERA_DSA_W0_CMD     GENMASK(31, 30)
0012 #define PRESTERA_DSA_W0_IS_TAGGED   BIT(29)
0013 #define PRESTERA_DSA_W0_DEV_NUM     GENMASK(28, 24)
0014 #define PRESTERA_DSA_W0_PORT_NUM    GENMASK(23, 19)
0015 #define PRESTERA_DSA_W0_VPT     GENMASK(15, 13)
0016 #define PRESTERA_DSA_W0_EXT_BIT     BIT(12)
0017 #define PRESTERA_DSA_W0_VID     GENMASK(11, 0)
0018
0019 #define PRESTERA_DSA_W1_EXT_BIT     BIT(31)
0020 #define PRESTERA_DSA_W1_CFI_BIT     BIT(30)
0021 #define PRESTERA_DSA_W1_PORT_NUM    GENMASK(11, 10)
0022 #define PRESTERA_DSA_W1_MASK_CPU_CODE   GENMASK(7, 0)
0023
0024 #define PRESTERA_DSA_W2_EXT_BIT     BIT(31)
0025 #define PRESTERA_DSA_W2_PORT_NUM    BIT(20)
0026
0027 #define PRESTERA_DSA_W3_VID     GENMASK(30, 27)
0028 #define PRESTERA_DSA_W3_DST_EPORT   GENMASK(23, 7)
0029 #define PRESTERA_DSA_W3_DEV_NUM     GENMASK(6, 0)
0030
0031 #define PRESTERA_DSA_VID        GENMASK(15, 12)
0032 #define PRESTERA_DSA_DEV_NUM        GENMASK(11, 5)
0033
0034 int prestera_dsa_parse(struct prestera_dsa *dsa, const u8 *dsa_buf)
0035 {
0036     __be32 *dsa_words = (__be32 *)dsa_buf;
0037     enum prestera_dsa_cmd cmd;
0038     u32 words[4];
0039     u32 field;
0040
0041     words[0] = ntohl(dsa_words[0]);
0042     words[1] = ntohl(dsa_words[1]);
0043     words[2] = ntohl(dsa_words[2]);
0044     words[3] = ntohl(dsa_words[3]);
0045
0046     /* set the common parameters */
0047     cmd = (enum prestera_dsa_cmd)FIELD_GET(PRESTERA_DSA_W0_CMD, words[0]);
0048
0049     /* only to CPU is supported */
0050     if (unlikely(cmd != PRESTERA_DSA_CMD_TO_CPU))
0051         return -EINVAL;
0052
0053     if (FIELD_GET(PRESTERA_DSA_W0_EXT_BIT, words[0]) == 0)
0054         return -EINVAL;
0055     if (FIELD_GET(PRESTERA_DSA_W1_EXT_BIT, words[1]) == 0)
0056         return -EINVAL;
0057     if (FIELD_GET(PRESTERA_DSA_W2_EXT_BIT, words[2]) == 0)
0058         return -EINVAL;
0059
0060     field = FIELD_GET(PRESTERA_DSA_W3_VID, words[3]);
0061
0062     dsa->vlan.is_tagged = FIELD_GET(PRESTERA_DSA_W0_IS_TAGGED, words[0]);
0063     dsa->vlan.cfi_bit = FIELD_GET(PRESTERA_DSA_W1_CFI_BIT, words[1]);
0064     dsa->vlan.vpt = FIELD_GET(PRESTERA_DSA_W0_VPT, words[0]);
0065     dsa->vlan.vid = FIELD_GET(PRESTERA_DSA_W0_VID, words[0]);
0066     dsa->vlan.vid &= ~PRESTERA_DSA_VID;
0067     dsa->vlan.vid |= FIELD_PREP(PRESTERA_DSA_VID, field);
0068
0069     field = FIELD_GET(PRESTERA_DSA_W3_DEV_NUM, words[3]);
0070
0071     dsa->hw_dev_num = FIELD_GET(PRESTERA_DSA_W0_DEV_NUM, words[0]);
0072     dsa->hw_dev_num |= FIELD_PREP(PRESTERA_DSA_DEV_NUM, field);
0073
0074     dsa->port_num = (FIELD_GET(PRESTERA_DSA_W0_PORT_NUM, words[0]) << 0) |
0075             (FIELD_GET(PRESTERA_DSA_W1_PORT_NUM, words[1]) << 5) |
0076             (FIELD_GET(PRESTERA_DSA_W2_PORT_NUM, words[2]) << 7);
0077
0078     dsa->cpu_code = FIELD_GET(PRESTERA_DSA_W1_MASK_CPU_CODE, words[1]);
0079
0080     return 0;
0081 }
0082
0083 int prestera_dsa_build(const struct prestera_dsa *dsa, u8 *dsa_buf)
0084 {
0085     __be32 *dsa_words = (__be32 *)dsa_buf;
0086     u32 dev_num = dsa->hw_dev_num;
0087     u32 words[4] = { 0 };
0088
0089     words[0] |= FIELD_PREP(PRESTERA_DSA_W0_CMD, PRESTERA_DSA_CMD_FROM_CPU);
0090
0091     words[0] |= FIELD_PREP(PRESTERA_DSA_W0_DEV_NUM, dev_num);
0092     dev_num = FIELD_GET(PRESTERA_DSA_DEV_NUM, dev_num);
0093     words[3] |= FIELD_PREP(PRESTERA_DSA_W3_DEV_NUM, dev_num);
0094
0095     words[3] |= FIELD_PREP(PRESTERA_DSA_W3_DST_EPORT, dsa->port_num);
0096
0097     words[0] |= FIELD_PREP(PRESTERA_DSA_W0_EXT_BIT, 1);
0098     words[1] |= FIELD_PREP(PRESTERA_DSA_W1_EXT_BIT, 1);
0099     words[2] |= FIELD_PREP(PRESTERA_DSA_W2_EXT_BIT, 1);
0100
0101     dsa_words[0] = htonl(words[0]);
0102     dsa_words[1] = htonl(words[1]);
0103     dsa_words[2] = htonl(words[2]);
0104     dsa_words[3] = htonl(words[3]);
0105
0106     return 0;
0107 }