// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0 
 | 
/* Copyright (c) 2017-2018 Mellanox Technologies. All rights reserved */ 
 | 
  
 | 
#include <linux/kernel.h> 
 | 
#include <linux/module.h> 
 | 
#include "spectrum.h" 
 | 
#include "item.h" 
 | 
#include "core_acl_flex_keys.h" 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_l2_dmac[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DMAC_32_47, 0x00, 2), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DMAC_0_31, 0x02, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(PCP, 0x08, 13, 3), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VID, 0x08, 0, 12), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(SRC_SYS_PORT, 0x0C, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_l2_smac[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SMAC_32_47, 0x00, 2), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SMAC_0_31, 0x02, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(PCP, 0x08, 13, 3), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VID, 0x08, 0, 12), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(SRC_SYS_PORT, 0x0C, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_l2_smac_ex[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SMAC_32_47, 0x02, 2), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SMAC_0_31, 0x04, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(ETHERTYPE, 0x0C, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4_sip[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_0_31, 0x00, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_PROTO, 0x08, 0, 8), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(SRC_SYS_PORT, 0x0C, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4_dip[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_0_31, 0x00, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_PROTO, 0x08, 0, 8), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(SRC_SYS_PORT, 0x0C, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_0_31, 0x00, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_ECN, 0x04, 4, 2), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_TTL_, 0x04, 24, 8), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_DSCP, 0x08, 0, 6), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(TCP_FLAGS, 0x08, 8, 9), /* TCP_CONTROL+TCP_ECN */ 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4_ex[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VID, 0x00, 0, 12), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(PCP, 0x08, 29, 3), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(SRC_L4_PORT, 0x08, 0, 16), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(DST_L4_PORT, 0x0C, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_dip[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_32_63, 0x00, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_0_31, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_ex1[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_96_127, 0x00, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_64_95, 0x04, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_PROTO, 0x08, 0, 8), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_sip[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_32_63, 0x00, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_0_31, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_sip_ex[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_96_127, 0x00, 4), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_64_95, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_packet_type[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(ETHERTYPE, 0x00, 0, 16), 
 | 
}; 
 | 
  
 | 
static const struct mlxsw_afk_block mlxsw_sp1_afk_blocks[] = { 
 | 
    MLXSW_AFK_BLOCK(0x10, mlxsw_sp_afk_element_info_l2_dmac), 
 | 
    MLXSW_AFK_BLOCK(0x11, mlxsw_sp_afk_element_info_l2_smac), 
 | 
    MLXSW_AFK_BLOCK(0x12, mlxsw_sp_afk_element_info_l2_smac_ex), 
 | 
    MLXSW_AFK_BLOCK(0x30, mlxsw_sp_afk_element_info_ipv4_sip), 
 | 
    MLXSW_AFK_BLOCK(0x31, mlxsw_sp_afk_element_info_ipv4_dip), 
 | 
    MLXSW_AFK_BLOCK(0x32, mlxsw_sp_afk_element_info_ipv4), 
 | 
    MLXSW_AFK_BLOCK(0x33, mlxsw_sp_afk_element_info_ipv4_ex), 
 | 
    MLXSW_AFK_BLOCK(0x60, mlxsw_sp_afk_element_info_ipv6_dip), 
 | 
    MLXSW_AFK_BLOCK(0x65, mlxsw_sp_afk_element_info_ipv6_ex1), 
 | 
    MLXSW_AFK_BLOCK(0x62, mlxsw_sp_afk_element_info_ipv6_sip), 
 | 
    MLXSW_AFK_BLOCK(0x63, mlxsw_sp_afk_element_info_ipv6_sip_ex), 
 | 
    MLXSW_AFK_BLOCK(0xB0, mlxsw_sp_afk_element_info_packet_type), 
 | 
}; 
 | 
  
 | 
#define MLXSW_SP1_AFK_KEY_BLOCK_SIZE 16 
 | 
  
 | 
static void mlxsw_sp1_afk_encode_block(char *output, int block_index, 
 | 
                       char *block) 
 | 
{ 
 | 
    unsigned int offset = block_index * MLXSW_SP1_AFK_KEY_BLOCK_SIZE; 
 | 
    char *output_indexed = output + offset; 
 | 
  
 | 
    memcpy(output_indexed, block, MLXSW_SP1_AFK_KEY_BLOCK_SIZE); 
 | 
} 
 | 
  
 | 
static void mlxsw_sp1_afk_clear_block(char *output, int block_index) 
 | 
{ 
 | 
    unsigned int offset = block_index * MLXSW_SP1_AFK_KEY_BLOCK_SIZE; 
 | 
    char *output_indexed = output + offset; 
 | 
  
 | 
    memset(output_indexed, 0, MLXSW_SP1_AFK_KEY_BLOCK_SIZE); 
 | 
} 
 | 
  
 | 
const struct mlxsw_afk_ops mlxsw_sp1_afk_ops = { 
 | 
    .blocks        = mlxsw_sp1_afk_blocks, 
 | 
    .blocks_count    = ARRAY_SIZE(mlxsw_sp1_afk_blocks), 
 | 
    .encode_block    = mlxsw_sp1_afk_encode_block, 
 | 
    .clear_block    = mlxsw_sp1_afk_clear_block, 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_mac_0[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DMAC_0_31, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_mac_1[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SMAC_0_31, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_mac_2[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SMAC_32_47, 0x04, 2), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DMAC_32_47, 0x06, 2), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_mac_3[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(PCP, 0x00, 0, 3), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VID, 0x04, 16, 12), 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DMAC_32_47, 0x06, 2), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_mac_4[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(PCP, 0x00, 0, 3), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VID, 0x04, 16, 12), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(ETHERTYPE, 0x04, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_mac_5[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VID, 0x04, 16, 12), 
 | 
    MLXSW_AFK_ELEMENT_INST_EXT_U32(SRC_SYS_PORT, 0x04, 0, 8, -1, true), /* RX_ACL_SYSTEM_PORT */ 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4_0[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_0_31, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4_1[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_0_31, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4_2[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_DSCP, 0x04, 0, 6), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_ECN, 0x04, 6, 2), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_TTL_, 0x04, 8, 8), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(IP_PROTO, 0x04, 16, 8), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv4_4[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VIRT_ROUTER_0_7, 0x04, 24, 8), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(VIRT_ROUTER_8_10, 0x00, 0, 3), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_0[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_32_63, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_1[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_64_95, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_2[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(DST_IP_96_127, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_3[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_32_63, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_4[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_64_95, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_ipv6_5[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_BUF(SRC_IP_96_127, 0x04, 4), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_l4_0[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(SRC_L4_PORT, 0x04, 16, 16), 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(DST_L4_PORT, 0x04, 0, 16), 
 | 
}; 
 | 
  
 | 
static struct mlxsw_afk_element_inst mlxsw_sp_afk_element_info_l4_2[] = { 
 | 
    MLXSW_AFK_ELEMENT_INST_U32(TCP_FLAGS, 0x04, 16, 9), /* TCP_CONTROL + TCP_ECN */ 
 | 
}; 
 | 
  
 | 
static const struct mlxsw_afk_block mlxsw_sp2_afk_blocks[] = { 
 | 
    MLXSW_AFK_BLOCK(0x10, mlxsw_sp_afk_element_info_mac_0), 
 | 
    MLXSW_AFK_BLOCK(0x11, mlxsw_sp_afk_element_info_mac_1), 
 | 
    MLXSW_AFK_BLOCK(0x12, mlxsw_sp_afk_element_info_mac_2), 
 | 
    MLXSW_AFK_BLOCK(0x13, mlxsw_sp_afk_element_info_mac_3), 
 | 
    MLXSW_AFK_BLOCK(0x14, mlxsw_sp_afk_element_info_mac_4), 
 | 
    MLXSW_AFK_BLOCK(0x15, mlxsw_sp_afk_element_info_mac_5), 
 | 
    MLXSW_AFK_BLOCK(0x38, mlxsw_sp_afk_element_info_ipv4_0), 
 | 
    MLXSW_AFK_BLOCK(0x39, mlxsw_sp_afk_element_info_ipv4_1), 
 | 
    MLXSW_AFK_BLOCK(0x3A, mlxsw_sp_afk_element_info_ipv4_2), 
 | 
    MLXSW_AFK_BLOCK(0x3C, mlxsw_sp_afk_element_info_ipv4_4), 
 | 
    MLXSW_AFK_BLOCK(0x40, mlxsw_sp_afk_element_info_ipv6_0), 
 | 
    MLXSW_AFK_BLOCK(0x41, mlxsw_sp_afk_element_info_ipv6_1), 
 | 
    MLXSW_AFK_BLOCK(0x42, mlxsw_sp_afk_element_info_ipv6_2), 
 | 
    MLXSW_AFK_BLOCK(0x43, mlxsw_sp_afk_element_info_ipv6_3), 
 | 
    MLXSW_AFK_BLOCK(0x44, mlxsw_sp_afk_element_info_ipv6_4), 
 | 
    MLXSW_AFK_BLOCK(0x45, mlxsw_sp_afk_element_info_ipv6_5), 
 | 
    MLXSW_AFK_BLOCK(0x90, mlxsw_sp_afk_element_info_l4_0), 
 | 
    MLXSW_AFK_BLOCK(0x92, mlxsw_sp_afk_element_info_l4_2), 
 | 
}; 
 | 
  
 | 
#define MLXSW_SP2_AFK_BITS_PER_BLOCK 36 
 | 
  
 | 
/* A block in Spectrum-2 is of the following form: 
 | 
 * 
 | 
 * +--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ 
 | 
 * |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |35|34|33|32| 
 | 
 * +-----------------------------------------------------------------------------------------------+ 
 | 
 * |31|30|29|28|27|26|25|24|23|22|21|20|19|18|17|16|15|14|13|12|11|10| 9| 8| 7| 6| 5| 4| 3| 2| 1| 0| 
 | 
 * +--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ 
 | 
 */ 
 | 
MLXSW_ITEM64(sp2_afk, block, value, 0x00, 0, MLXSW_SP2_AFK_BITS_PER_BLOCK); 
 | 
  
 | 
/* The key / mask block layout in Spectrum-2 is of the following form: 
 | 
 * 
 | 
 * +--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ 
 | 
 * |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |  |                block11_high                   | 
 | 
 * +-----------------------------------------------------------------------------------------------+ 
 | 
 * |                    block11_low                               |         block10_high           | 
 | 
 * +--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ 
 | 
 * ... 
 | 
 */ 
 | 
  
 | 
struct mlxsw_sp2_afk_block_layout { 
 | 
    unsigned short offset; 
 | 
    struct mlxsw_item item; 
 | 
}; 
 | 
  
 | 
#define MLXSW_SP2_AFK_BLOCK_LAYOUT(_block, _offset, _shift)            \ 
 | 
    {                                    \ 
 | 
        .offset = _offset,                        \ 
 | 
        {                                \ 
 | 
            .shift = _shift,                    \ 
 | 
            .size = {.bits = MLXSW_SP2_AFK_BITS_PER_BLOCK},        \ 
 | 
            .name = #_block,                    \ 
 | 
        }                                \ 
 | 
    }                                    \ 
 | 
  
 | 
static const struct mlxsw_sp2_afk_block_layout mlxsw_sp2_afk_blocks_layout[] = { 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block0, 0x30, 0), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block1, 0x2C, 4), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block2, 0x28, 8), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block3, 0x24, 12), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block4, 0x20, 16), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block5, 0x1C, 20), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block6, 0x18, 24), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block7, 0x14, 28), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block8, 0x0C, 0), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block9, 0x08, 4), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block10, 0x04, 8), 
 | 
    MLXSW_SP2_AFK_BLOCK_LAYOUT(block11, 0x00, 12), 
 | 
}; 
 | 
  
 | 
static void __mlxsw_sp2_afk_block_value_set(char *output, int block_index, 
 | 
                        u64 block_value) 
 | 
{ 
 | 
    const struct mlxsw_sp2_afk_block_layout *block_layout; 
 | 
  
 | 
    if (WARN_ON(block_index < 0 || 
 | 
            block_index >= ARRAY_SIZE(mlxsw_sp2_afk_blocks_layout))) 
 | 
        return; 
 | 
  
 | 
    block_layout = &mlxsw_sp2_afk_blocks_layout[block_index]; 
 | 
    __mlxsw_item_set64(output + block_layout->offset, 
 | 
               &block_layout->item, 0, block_value); 
 | 
} 
 | 
  
 | 
static void mlxsw_sp2_afk_encode_block(char *output, int block_index, 
 | 
                       char *block) 
 | 
{ 
 | 
    u64 block_value = mlxsw_sp2_afk_block_value_get(block); 
 | 
  
 | 
    __mlxsw_sp2_afk_block_value_set(output, block_index, block_value); 
 | 
} 
 | 
  
 | 
static void mlxsw_sp2_afk_clear_block(char *output, int block_index) 
 | 
{ 
 | 
    __mlxsw_sp2_afk_block_value_set(output, block_index, 0); 
 | 
} 
 | 
  
 | 
const struct mlxsw_afk_ops mlxsw_sp2_afk_ops = { 
 | 
    .blocks        = mlxsw_sp2_afk_blocks, 
 | 
    .blocks_count    = ARRAY_SIZE(mlxsw_sp2_afk_blocks), 
 | 
    .encode_block    = mlxsw_sp2_afk_encode_block, 
 | 
    .clear_block    = mlxsw_sp2_afk_clear_block, 
 | 
}; 
 |