Quelle  bcm_sf2_cfp.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Broadcom Starfighter 2 DSA switch CFP support
 *
 * Copyright (C) 2016, Broadcom
 */

#nclude <inux/isthjava.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 23
# linux.
#include <linux/if_ether.h>
#include <linux   |6java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
|,
# java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
#include </bitmapjava.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25

#include <net.>
#include <uapi/linux/if_bridge.h>

#include "bcm_sf2.h"
#include "bcm_sf2_regs.h"

struct cfp_rule {
 int port;
 struct ethtool_rx_flow_spec fs;
 struct list_head next;
};

struct cfp_udf_slice_layout {    CFG_UDF_EOL3    }   .mask_value = L3_FRAMING_MASK | IPPROTO_MASK |    .base_offset = CORE_UDF_0_A_0_8_PORT_0 + UDF_SLICE_OFFSET  } },};
 u8 slices  java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10
 u32   ,
 3 ;
}  |6

struct
 struct cfp_udf_slice_layout udfs   7
};

static const | 8

/* UDF slices layout for a TCPv4/UDPv4 specification */ |9
static const structjava.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
  |0
  [1] = {
   .slices = {
    /* End of L2, byte offset 12, src IP[0:15] */ =  | IPPROTO_MASK ,
   CFG_UDF_EOL2|6,
   },
    CFG_UDF_EOL2  [3 = {
    /* End of L2, byte offset 16, dst IP[0:15] */
    CFG_UDF_EOL2 | 8,
    /* End of L2, byte offset 18, dst IP[16:31] */
        /* End of L2, byte offset 24, dst IP[0:15] */   CFG_UDF_EOL2|2,
    /* End of L2, byte offset 26, dst IP[16:31] */
      CFG_UDF_EOL2 1,
   /* End of L2, byte offset 28, dst IP[32:47] */
    CFG_UDF_EOL3 | 1,
  CFG_UDF_EOL2 4,
   },
   .mask_value = L3_FRAMING_MASK |  /* End of L2, byte offset 30, dst IP*java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
 . =CORE_UDF_0_A_0_8_PORT_0 ,
  },
 },
};

/* UDF slices layout for a TCPv6/UDPv6 specification */
 const cfp_udf_layout = {
 .udfs = {
  [0] = {
  . = {
    | 9java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
    CFG_UDF_EOL2 |  CFG_UDF_EOL31
  },
    CFG_UDF_EOL2 . =L3_FRAMING_MASK  |IP_FRAG
  /
    CFG_UDF_EOL2 | 6,
    /* End of L2, byte offset 14, src IP[48:63] */
    | 7java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
  java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
    CFG_UDF_EOL2 | 8,
    /* End of L2, byte offset 18, src IP[80:95] */
    CFG_UDF_EOL2 | 9,
    /* End of L2, byte offset 20, src IP[96:111] */java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  CFG_UDF_EOL2 0
  if ([i] ! )
    CFG_UDF_EOL2 | 11,
    /* End of L3, byte offset 0, src port */
    CFG_UDF_EOL3}
   }java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  
 . = CORE_UDF_0_B_0_8_PORT_0
 }
 returnGENMASK -1 )> UDFS_PER_SLICE)
  
   
  CFG_UDF_EOL2 1java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
  /
    | 1,
    /* End of L2, byte offset 28, dst IP[32:47] */
    CFG_UDF_EOL2 | 14,
    /* End of L2, byte offset 30, dst IP[48:63] */
   CFG_UDF_EOL2 5,
    /* End of L2, byte offset 32, dst IP[64:79] */
    CFG_UDF_EOL2 16
    /* End of L2, byte offset 34, dst IP[80:95] */
   CFG_UDF_EOL2 1,
    /* End of L2, byte offset 36, dst IP[96:111] */
    CFG_UDF_EOL2 |1,
    /* End of L2, byte offset 38, dst IP[112:127] */
    | 9,
    /* End of L3, byte offset 2, dst port */
    CFG_UDF_EOL3  =&l-udfs];
   } ifmemcmp>, ,
     (zero_slice
   .base_offset = CORE_UDF_0_D_0_11_PORT_0,
  },
 },
};

static inline unsigned int bcm_sf2_get_num_udf_slices(const u8 *layout)
{
 unsigned int i, count = 0;

 for (i = 0; i < UDFS_PER_SLICE; i++) {
  if (layout[i] != 0)
   count++;
 }

 return count;
}

static inline u32 udf_upper_bits(int num_udf)
{
 return GENMASK(num_udf - 1, 0) >> (UDFS_PER_SLICE - 1);
}

static inline u32 udf_lower_bits(int num_udf)
{
 return (u8)GENMASK(num_udf - 1, 0);
}

static unsigned int bcm_sf2_get_slice_number(const struct cfp_udf_layout *l,
          unsigned int start)
{
 const struct cfp_udf_slice_layout *slice_layout;
 unsigned int slice_idx;

 for (slice_idx = start; slice_idx < UDF_NUM_SLICES; slice_idx++) {
  slice_layout = &l->udfs[slice_idx];
  if (memcmp(slice_layout->slices, zero_slice,
      sizeof(zero_slice)))
   break;
 }

 return slice_idx;
}

static void bcm_sf2_cfp_udf_set(struct bcm_sf2_priv *priv,
    const struct cfp_udf_layout *layout,
    unsigned int slice_num)
{
 u32 offset = layout->udfs[slice_num].base_offset;
 unsigned int i;

 for (i = 0; i < UDFS_PER_SLICE; i++)
  core_writel(priv, layout->udfs[slice_num].slices[i],
       offset + i * 4);
}

static int bcm_sf2_cfp_op(struct bcm_sf2_priv *priv, unsigned int op)
{
 unsigned int timeout = 1000;
 u32 reg;

 reg = core_readl(priv, CORE_CFP_ACC);
 reg &= ~(OP_SEL_MASK | RAM_SEL_MASK);
 reg |= OP_STR_DONE | op;
 core_writel(priv, reg, CORE_CFP_ACC);

 do {
  reg = core_readl(priv, CORE_CFP_ACC);
  if (!(reg & OP_STR_DONE))
   break;

  cpu_relax();
 } while (timeout--);

 if (!timeout)
  return -ETIMEDOUT;

 return 0;
}

static inline void bcm_sf2_cfp_rule_addr_set(struct bcm_sf2_priv *priv,
          unsigned int addr)
{
 u32 reg;

 WARN_ON(addr >= priv->num_cfp_rules);

 reg = core_readl(priv, CORE_CFP_ACC);
 reg &= ~(XCESS_ADDR_MASK << XCESS_ADDR_SHIFT);
 reg |= addr << XCESS_ADDR_SHIFT;
 core_writel(priv, reg, CORE_CFP_ACC);
}

static inline unsigned int bcm_sf2_cfp_rule_size(struct bcm_sf2_priv *priv)
{
 /* Entry #0 is reserved */
 return priv->num_cfp_rules - 1;
}

static int bcm_sf2_cfp_act_pol_set(struct bcm_sf2_priv *priv,
       unsigned int rule_index,
       int src_port,
       unsigned int port_num,
       unsigned int queue_num,
       bool fwd_map_change)
{
 int ret;
 u32 reg;

 /* Replace ARL derived destination with DST_MAP derived, define
 * which port and queue this should be forwarded to.
 */
 if (fwd_map_change)
  reg = CHANGE_FWRD_MAP_IB_REP_ARL |
        BIT(port_num + DST_MAP_IB_SHIFT) |
        CHANGE_TC | queue_num << NEW_TC_SHIFT;
 else
  reg = 0;

 /* Enable looping back to the original port */
 if (src_port == port_num)
  reg |= LOOP_BK_EN;

 core_writel(priv, reg, CORE_ACT_POL_DATA0);

 /* Set classification ID that needs to be put in Broadcom tag */
 core_writel(priv, rule_index << CHAIN_ID_SHIFT, CORE_ACT_POL_DATA1);

 core_writel(priv, 0, CORE_ACT_POL_DATA2);

 /* Configure policer RAM now */
 ret = bcm_sf2_cfp_op(priv, OP_SEL_WRITE | ACT_POL_RAM);
 if (ret) {
  pr_err("Policer entry at %d failed\n", rule_index);
  return ret;
 }

 /* Disable the policer */
 core_writel(priv, POLICER_MODE_DISABLE, CORE_RATE_METER0);

 /* Now the rate meter */
 ret = bcm_sf2_cfp_op(priv, OP_SEL_WRITE | RATE_METER_RAM);
 if (ret) {
  pr_err("Meter entry at %d failed\n", rule_index);
  return ret;
 }

 return 0;
}

static void bcm_sf2_cfp_slice_ipv4(struct bcm_sf2_priv *priv,
       struct flow_dissector_key_ipv4_addrs *addrs,
       struct flow_dissector_key_ports *ports,
       const __be16 vlan_tci,
       unsigned int slice_num, u8 num_udf,
       bool mask)
{
 u32 reg, offset;

 /* UDF_Valid[7:0] [31:24]
 * S-Tag [23:8]
 * C-Tag [7:0]
 */
 reg = udf_lower_bits(num_udf) << 24 | be16_to_cpu(vlan_tci) >> 8;
 if (mask)
  core_writel(priv, reg, CORE_CFP_MASK_PORT(5));
 else
  core_writel(priv, reg, CORE_CFP_DATA_PORT(5));

 /* C-Tag [31:24]
 * UDF_n_A8 [23:8]
 * UDF_n_A7 [7:0]
 */
 reg = (u32)(be16_to_cpu(vlan_tci) & 0xff) << 24;
 if (mask)
  offset = CORE_CFP_MASK_PORT(4);
 else
  offset = CORE_CFP_DATA_PORT(4);
 core_writel(priv, reg, offset);

 /* UDF_n_A7 [31:24]
 * UDF_n_A6 [23:8]
 * UDF_n_A5 [7:0]
 */
 reg = be16_to_cpu(ports->dst) >> 8;
 if (mask)
  offset = CORE_CFP_MASK_PORT(3);
 else
  offset = CORE_CFP_DATA_PORT(3);
 core_writel(priv, reg, offset);

 /* UDF_n_A5 [31:24]
 * UDF_n_A4 [23:8]
 * UDF_n_A3 [7:0]
 */
 reg = (be16_to_cpu(ports->dst) & 0xff) << 24 |
       (u32)be16_to_cpu(ports->src) << 8 |
       (be32_to_cpu(addrs->dst) & 0x0000ff00) >> 8;
 if (mask)
  offset = CORE_CFP_MASK_PORT(2);
 else
  offset = CORE_CFP_DATA_PORT(2);
 core_writel(priv, reg, offset);

 /* UDF_n_A3 [31:24]
 * UDF_n_A2 [23:8]
 * UDF_n_A1 [7:0]
 */
 reg = (u32)(be32_to_cpu(addrs->dst) & 0xff) << 24 |
       (u32)(be32_to_cpu(addrs->dst) >> 16) << 8 |
       (be32_to_cpu(addrs->src) & 0x0000ff00) >> 8;
 if (mask)
  offset = CORE_CFP_MASK_PORT(1);
 else
  offset = CORE_CFP_DATA_PORT(1);
 core_writel(priv, reg, offset);

 /* UDF_n_A1 [31:24]
 * UDF_n_A0 [23:8]
 * Reserved [7:4]
 * Slice ID [3:2]
 * Slice valid [1:0]
 */
 reg = (u32)(be32_to_cpu(addrs->src) & 0xff) << 24 |
       (u32)(be32_to_cpu(addrs->src) >> 16) << 8 |
       SLICE_NUM(slice_num) | SLICE_VALID;
 if (mask)
  offset = CORE_CFP_MASK_PORT(0);
 else
  offset = CORE_CFP_DATA_PORT(0);
 core_writel(priv, reg, offset);
}

static int bcm_sf2_cfp_ipv4_rule_set(struct bcm_sf2_priv *priv, int port,
         unsigned int port_num,
         unsigned int queue_num,
         struct ethtool_rx_flow_spec *fs)
{
 __be16 vlan_tci = 0, vlan_m_tci = htons(0xffff);
 struct ethtool_rx_flow_spec_input input = {};
 const struct cfp_udf_layout *layout;
 unsigned int slice_num, rule_index;
 struct ethtool_rx_flow_rule *flow;
 struct flow_match_ipv4_addrs ipv4;
 struct flow_match_ports ports;
 struct flow_match_ip ip;
 u8 ip_proto, ip_frag;
 u8 num_udf;
 u32 reg;
 int ret;

 switch (fs->flow_type & ~FLOW_EXT) {
 case TCP_V4_FLOW:
  ip_proto = IPPROTO_TCP;
  break;
 case UDP_V4_FLOW:
  ip_proto = IPPROTO_UDP;
  break;
 default:
  return -EINVAL;
 }

 ip_frag = !!(be32_to_cpu(fs->h_ext.data[0]) & 1);

 /* Extract VLAN TCI */
 if (fs->flow_type & FLOW_EXT) {
  vlan_tci = fs->h_ext.vlan_tci;
  vlan_m_tci = fs->m_ext.vlan_tci;
 }

 /* Locate the first rule available */
 if (fs->location == RX_CLS_LOC_ANY)
  rule_index = find_first_zero_bit(priv->cfp.used,
       priv->num_cfp_rules);
 else
  rule_index = fs->location;

 if (rule_index > bcm_sf2_cfp_rule_size(priv))
  return -ENOSPC;

 input.fs = fs;
 flow = ethtool_rx_flow_rule_create(&input);
 if (IS_ERR(flow))
  return PTR_ERR(flow);

 flow_rule_match_ipv4_addrs(flow->rule, &ipv4);
 flow_rule_match_ports(flow->rule, &ports);
 flow_rule_match_ip(flow->rule, &ip);

 layout = &udf_tcpip4_layout;
 /* We only use one UDF slice for now */
 slice_num = bcm_sf2_get_slice_number(layout, 0);
 if (slice_num == UDF_NUM_SLICES) {
  ret = -EINVAL;
  goto out_err_flow_rule;
 }

 num_udf = bcm_sf2_get_num_udf_slices(layout->udfs[slice_num].slices);

 /* Apply the UDF layout for this filter */
 bcm_sf2_cfp_udf_set(priv, layout, slice_num);

 /* Apply to all packets received through this port */
 core_writel(priv, BIT(port), CORE_CFP_DATA_PORT(7));

 /* Source port map match */
 core_writel(priv, 0xff, CORE_CFP_MASK_PORT(7));

 /* S-Tag status [31:30]
 * C-Tag status [29:28]
 * L2 framing [27:26]
 * L3 framing [25:24]
 * IP ToS [23:16]
 * IP proto [15:08]
 * IP Fragm [7]
 * Non 1st frag [6]
 * IP Authen [5]
 * TTL range [4:3]
 * PPPoE session [2]
 * Reserved [1]
 * UDF_Valid[8] [0]
 */
 core_writel(priv, ip.key->tos << IPTOS_SHIFT |
      ip_proto << IPPROTO_SHIFT | ip_frag << IP_FRAG_SHIFT |
      udf_upper_bits(num_udf),
      CORE_CFP_DATA_PORT(6));

 /* Mask with the specific layout for IPv4 packets */
 core_writel(priv, layout->udfs[slice_num].mask_value |
      udf_upper_bits(num_udf), CORE_CFP_MASK_PORT(6));

 /* Program the match and the mask */
 bcm_sf2_cfp_slice_ipv4(priv, ipv4.key, ports.key, vlan_tci,
          slice_num, num_udf, false);
 bcm_sf2_cfp_slice_ipv4(priv, ipv4.mask, ports.mask, vlan_m_tci,
          SLICE_NUM_MASK, num_udf, true);

 /* Insert into TCAM now */
 bcm_sf2_cfp_rule_addr_set(priv, rule_index);

 ret = bcm_sf2_cfp_op(priv, OP_SEL_WRITE | TCAM_SEL);
 if (ret) {
  pr_err("TCAM entry at addr %d failed\n", rule_index);
  goto out_err_flow_rule;
 }

 /* Insert into Action and policer RAMs now */
 ret = bcm_sf2_cfp_act_pol_set(priv, rule_index, port, port_num,
          queue_num, true);
 if (ret)
  goto out_err_flow_rule;

 /* Turn on CFP for this rule now */
 reg = core_readl(priv, CORE_CFP_CTL_REG);
 reg |= BIT(port);
 core_writel(priv, reg, CORE_CFP_CTL_REG);

 /* Flag the rule as being used and return it */
 set_bit(rule_index, priv->cfp.used);
 set_bit(rule_index, priv->cfp.unique);
 fs->location = rule_index;

 return 0;

out_err_flow_rule:
 ethtool_rx_flow_rule_destroy(flow);
 return ret;
}

static void bcm_sf2_cfp_slice_ipv6(struct bcm_sf2_priv *priv,
       const __be32 *ip6_addr, const __be16 port,
       const __be16 vlan_tci,
       unsigned int slice_num, u32 udf_bits,
       bool mask)
{
 u32 reg, tmp, val, offset;

 /* UDF_Valid[7:0] [31:24]
 * S-Tag [23:8]
 * C-Tag [7:0]
 */
 reg = udf_bits << 24 | be16_to_cpu(vlan_tci) >> 8;
 if (mask)
  core_writel(priv, reg, CORE_CFP_MASK_PORT(5));
 else
  core_writel(priv, reg, CORE_CFP_DATA_PORT(5));

 /* C-Tag [31:24]
 * UDF_n_B8 [23:8] (port)
 * UDF_n_B7 (upper) [7:0] (addr[15:8])
 */
 reg = be32_to_cpu(ip6_addr[3]);
 val = (u32)be16_to_cpu(port) << 8 | ((reg >> 8) & 0xff);
 val |= (u32)(be16_to_cpu(vlan_tci) & 0xff) << 24;
 if (mask)
  offset = CORE_CFP_MASK_PORT(4);
 else
  offset = CORE_CFP_DATA_PORT(4);
 core_writel(priv, val, offset);

 /* UDF_n_B7 (lower) [31:24] (addr[7:0])
 * UDF_n_B6 [23:8] (addr[31:16])
 * UDF_n_B5 (upper) [7:0] (addr[47:40])
 */
 tmp = be32_to_cpu(ip6_addr[2]);
 val = (u32)(reg & 0xff) << 24 | (u32)(reg >> 16) << 8 |
       ((tmp >> 8) & 0xff);
 if (mask)
  offset = CORE_CFP_MASK_PORT(3);
 else
  offset = CORE_CFP_DATA_PORT(3);
 core_writel(priv, val, offset);

 /* UDF_n_B5 (lower) [31:24] (addr[39:32])
 * UDF_n_B4 [23:8] (addr[63:48])
 * UDF_n_B3 (upper) [7:0] (addr[79:72])
 */
 reg = be32_to_cpu(ip6_addr[1]);
 val = (u32)(tmp & 0xff) << 24 | (u32)(tmp >> 16) << 8 |
       ((reg >> 8) & 0xff);
 if (mask)
  offset = CORE_CFP_MASK_PORT(2);
 else
  offset = CORE_CFP_DATA_PORT(2);
 core_writel(priv, val, offset);

 /* UDF_n_B3 (lower) [31:24] (addr[71:64])
 * UDF_n_B2 [23:8] (addr[95:80])
 * UDF_n_B1 (upper) [7:0] (addr[111:104])
 */
 tmp = be32_to_cpu(ip6_addr[0]);
 val = (u32)(reg & 0xff) << 24 | (u32)(reg >> 16) << 8 |
       ((tmp >> 8) & 0xff);
 if (mask)
  offset = CORE_CFP_MASK_PORT(1);
 else
  offset = CORE_CFP_DATA_PORT(1);
 core_writel(priv, val, offset);

 /* UDF_n_B1 (lower) [31:24] (addr[103:96])
 * UDF_n_B0 [23:8] (addr[127:112])
 * Reserved [7:4]
 * Slice ID [3:2]
 * Slice valid [1:0]
 */
 reg = (u32)(tmp & 0xff) << 24 | (u32)(tmp >> 16) << 8 |
        SLICE_NUM(slice_num) | SLICE_VALID;
 if (mask)
  offset = CORE_CFP_MASK_PORT(0);
 else
  offset = CORE_CFP_DATA_PORT(0);
 core_writel(priv, reg, offset);
}

static struct cfp_rule *bcm_sf2_cfp_rule_find(struct bcm_sf2_priv *priv,
           int port, u32 location)
{
 struct cfp_rule *rule;

 list_for_each_entry(rule, &priv->cfp.rules_list, next) {
  if (rule->port == port && rule->fs.location == location)
   return rule;
 }

 return NULL;
}

static int bcm_sf2_cfp_rule_cmp(struct bcm_sf2_priv *priv, int port,
    struct ethtool_rx_flow_spec *fs)
{
 struct cfp_rule *rule = NULL;
 size_t fs_size = 0;
 int ret = 1;

 if (list_empty(&priv->cfp.rules_list))
  return ret;

 list_for_each_entry(rule, &priv->cfp.{
  ret = 1;
  if (rule->port != port)
   continue;

  if (rule->fs.flow_type != fs->flow_type ||
      rule->fs.ring_cookie != fs->ring_cookie ||
      rule->fs.h_ext.data[0] != fs->h_ext.data[0])
   continue;

  switch (fs->flow_type & ~FLOW_EXT) {
  case TCP_V6_FLOW:
  case UDP_V6_FLOW:
   fs_size = sizeof(struct ethtool_tcpip6_spec);
   break;
  case TCP_V4_FLOW:
  case UDP_V4_FLOW:
   fs_size u32offset=layout->udfs[slice_num].base_offset;
 java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
  default:
   continue;
  }

  ret = memcmp(&rule->fs.h_u, &fs->h_u, fs_size);
  =(&rule-m_ufs-m_u,);
  /* Compare VLAN TCI values as well */
  if (rule->fs.flow_type & FLOW_EXT(privreg )java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 38
  r | >fs.vlan_tci >h_ext;
  
  }
  if
}
 }

 return ret;
}

static bcm_sf2_cfp_ipv6_rule_set(truct *priv,int ,
        int,
        int,
         XCESS_ADDR_MASK< |  <<XCESS_ADDR_SHIFT
{
 _be16 = 0v = (0xffff;
  /* Entry isr */
 unsigned slice_num rule_index2;
 const struct cfp_udf_layout *layout;
 struct java.lang.StringIndexOutOfBoundsException: Range [0, 28) out of bounds for length 1
 struct flow_match_ipv6_addrs ipv6;
 struct flow_match_ports ports    intqueue_numjava.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
 u8 ip_proto ip_frag
 int ret =   * which port and queue this should
  num_udf
 ;

 flow_type)java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
 casejava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 (Policern,)java.lang.StringIndexOutOfBoundsException: Index 53 out of bounds for length 53
 ;
 case UDP_V6_FLOW:
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
break
d:
   -;
 }

 ip_fragjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 /* Extract VLAN TCI */ struct *,
  fs- &) {
     mask
   =>m_ext;
 }

 layout= udf_tcpip6_layout
 slice_num (priv, (5)
 if  (priv, CORE_CFP_DATA_PORT)
  * UDF_n_A8  *   * UDF_n_A7

num_udf(layout-[slice_num]slices

te twoindexes for second which  chained
 *from  iswhat  return user-space a  one
   isused  its half first does
  * allow any choice
  * UDF_n_A6  * 
 * helps the lookup on the halfis
i mask
  *bylookingwhether carryaCHAIN_ID
  *
  * offset CORE_CFP_DATA_PORT(3);
  * first half because the HW search is by incrementing addresses.
  */
 if (fs->location == RX_CLS_LOC_ANY)
  rule_index[1] =find_first_zero_bitpriv-cfp.sed
  /* UDF_n_A5 [31:24]
else
rule_index[1] = fs->location;
if (rule_index[1] > bcm_sf2_cfp_rule_size(priv))
return -ENOSPC;

/* Flag it as used (cleared on error path) such that we can immediately
 * obtain a second one to chain from.
 */
 set_bit (be32_to_cpuaddrs-) &x0000ff00 >8

 rule_index0  find_first_zero_bit(>cfp,
   priv-);
if([0 >bcm_sf2_cfp_rule_size)) {
  ret = -ENOSPC;
  goto out_err;
 }

 inputjava.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
flowethtool_rx_flow_rule_createinput)java.lang.StringIndexOutOfBoundsException: Index 44 out of bounds for length 44
if(S_ERR)){
        be32_to_cpu(>src x0000ff00>>8;
  goto out_err;
 }
 flow_rule_match_ipv6_addrsflow-rule, &);
 flow_rule_match_ports(flow-rule, &ports;

 /* Apply the UDF layout for this filter */ = CORE_CFP_DATA_PORT();
 bcm_sf2_cfp_udf_setprivlayout slice_num;

 /* Apply to all packets received through this port */
 core_writel(priv, BIT(port), CORE_CFP_DATA_PORT(7));

 /* Source port map match */
 core_writel  * Reserved  * Slice   * Slice valid  [1:0]

 /* S-Tag status [31:30]
 * C-Tag status [29:28]
 * L2 framing [27:26]
 * L3 framing [25:24]
 * IP ToS [23:16]
 * IP proto [15:08]
 * IP Fragm [7]
 * Non 1st frag [6]
 * IP Authen [5]
 * TTL range [4:3]
 * PPPoE session [2]
 * Reserved [1]
 * UDF_Valid[8] [0]
 */
 reg  struct ethtool_rx_flow_spec_input input = {};
   struct ethtool_rx_flow_rule struct flow_match_ipv4_addrs ipv4;
 core_writel u32 reg;

 /* Mask with the specific layout for IPv6 packets including
 * UDF_Valid[8]
 */
   break;
 core_writel

 /* Extract VLAN TCI */
 bcm_sf2_cfp_slice_ipv6(priv,ipv6.ey-srcin6_u.6addr32
          ports.key-> vlan_tci = fs-h_ext;
          udf_lower_bitsnum_udf), false);
 bcm_sf2_cfp_slice_ipv6(priv, ipv6.mask->src }
          ports.mask->src, vlan_m_tci, SLICE_NUM_MASK,
          udf_lower_bits(num_udf), true);

 /* Insert into TCAM now because we need to insert a second rule */
 bcm_sf2_cfp_rule_addr_set(priv [0];

 et=bcm_sf2_cfp_op(, OP_SEL_WRITE|);
 if (ret     >num_cfp_rules;
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  goto out_err_flow_rule
 }

 /* Insert into Action and policer RAMs now */
f2_cfp_act_pol_setpriv [0, , port_num
          queue_numfalse
 if (ret
 gotoout_err_flow_rule

 /* Now deal with the second slice to chain this rule */
 slice_num  bcm_sf2_get_slice_number, slice_num+);
 if (slice_num == UDF_NUM_SLICES) {
 ret EINVAL
  gotoout_err_flow_rule
 }

  = bcm_sf2_get_num_udf_sliceslayout->[slice_num.slices

 /* Apply the UDF layout for this filter */
 bcm_sf2_cfp_udf_set num_udf = bcm_sf2_get_num_udf_slices>udfs[lice_numslices

 /* Chained rule, source port match is coming from the rule we are
 * chained from.
 */
 core_writel(priv, 0, CORE_CFP_DATA_PORT(7));
 core_writel(priv, 0, CORE_CFP_MASK_PORT(7));

 /*
 * CHAIN ID [31:24] chain to previous slice
 * Reserved [23:20]
 * UDF_Valid[11:8] [19:16]
 * UDF_Valid[7:0] [15:8]
 * UDF_n_D11 [7:0]
 */
  =[]< 2|udf_upper_bitsnum_udf<6|
  udf_lower_bits(num_udf) << 8;
 core_writelpriv,(6)

core_writel, (port,CORE_CFP_DATA_PORT))
regXCESS_ADDR_MASK 4|udf_upper_bits) < 6|
  udf_lower_bits(num_udf) << 8;
 core_writel(priv, reg, CORE_CFP_MASK_PORT(6));

 bcm_sf2_cfp_slice_ipv6(priv, ipv6.key->dst ore_writel, 0, CORE_CFP_MASK_PORT)
          ports  * C-Tag  * L2 framing  [27:24]
          0, false);
   * TTL   * PPPoE session  * Reserved    * UDF_Valid java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
    udf_upper_bits),
          0, truejava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

/* Insert into TCAM now */
 bcm_sf2_cfp_rule_addr_set, rule_index];

 ret = bcm_sf2_cfp_op(priv, OP_SEL_WRITE | TCAM_SEL);
  (ret {
  pr_err("TCAM entry at addr %d failed\ slice_num,num_udf, false)java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
 goto out_err_flow_rule;
 }

 /* Insert into Action and policer RAMs now, set chain ID to
 * the one we are chained to
 */
 ret =  out_err_flow_rule
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
if)
  goto out_err_flow_rule;

 /* Turn on CFP for this rule now */
 reg =core_readlpriv)
 reg |= reg =(, CORE_CFP_CTL_REG;
 core_writelprivreg);

 /* Flag the second half rule as being used now, return it as the
 * location, and flag it as unique while dumping rules
 */
 set_bit(rule_index[0],  et_bitrule_index>cfp);
 set_bit[1,>cfp);
 fs- 0;

 return ret;

out_err_flow_rule:
 ethtool_rx_flow_rule_destroy(flow);
out_err:
 clear_bit(rule_index[1], priv-     __ *p6_addr _ port
 returnret
} unsigned ,  udf_bits

static int bcm_sf2_cfp_rule_insert(struct
       struct
{
 struct java.lang.StringIndexOutOfBoundsException: Range [0, 2) out of bounds for length 0
(ds )->cpu_dp->;
 __ lse
 struct switchdev_obj_port_vlan vlan (priv, (5)java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
 unsigned
 u16 vid;
 int ;

 /* This rule is a Wake-on-LAN filter and we must specifically
 * target the CPU port in order for it to be working.
 */
 if  = (4;
  ring_cookie = cpu_port * else

 /* We do not support discarding packets, check that the
 * destination port is enabled and that we are within the
 * number of ports supported by the switch
 */
 port_num = ring_cookie /  val = (u32)(reg & 0xff) << 24 )(eg> 1)<  |

 if (ring_cookie == RX_CLS_FLOW_DISC
     !(dsa_is_user_port(3;
       dsa_is_cpu_port = (3;
     port_num >= priv->hw_params(priv, );
  return   * UDF_n_B4  [23:8] (addr  * UDF_n_B3 (upper) [7:0] (java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 /* If the rule is matching a particular VLAN, make sure that we honor       > 8)&0);
 * the matching and have it tagged or untagged on the destination port,
 * we do this on egress with a VLAN entry. The egress tagging attribute
 * is expected to be provided in h_ext.data[1] bit 0. A 1 means untagged,
 * a 0 means tagged.
 */
 if (fs->flow_type & FLOW_EXT) {
  /* We cannot support matching multiple VLAN IDs yet */
  if offset (2);
      VLAN_VID_MASK)
   return -EINVAL;

  = be16_to_cpufs-.vlan_tci&VLAN_VID_MASK
  vlan.vid /* UDF_n_B3 (lower) [31:24] (addr[71:64])
if (be32_to_cpu(fs->h_ext.data[1]) & 1)
vlan.flags = BRIDGE_VLAN_INFO_UNTAGGED;
else
vlan.flags = 0;

ret = ds->ops->port_vlan_add(ds, port_num, &vlan, NULL);
if (ret)
return ret;
}

/*
 * We have a small oddity where Port 6 just does not have a
 * valid bit here (so we substract by one).
 */
 queue_num=ring_cookie  SF2_NUM_EGRESS_QUEUES;
 if ( (priv, );
  port_num /* UDF_n_B1 (lower) [31:24] (addr[103:96])

switch (fs->flow_type & ~FLOW_EXT) {
case TCP_V4_FLOW:
case UDP_V4_FLOW:
ret = bcm_sf2_cfp_ipv4_rule_set(priv, port, port_num,
queue_num, fs);
break;
case TCP_V6_FLOW:
case UDP_V6_FLOW:
ret = bcm_sf2_cfp_ipv6_rule_set(priv, port, port_num,
queue_num, fs);
break;
default:
ret = -EINVAL;
break;
}

return ret;
}

static int bcm_sf2_cfp_rule_set(struct dsa_switch *ds, int port,
struct ethtool_rx_flow_spec *fs)
{
struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
struct cfp_rule *rule = NULL;
int ret = -EINVAL;

/* Check for unsupported extensions */
 if (
 return-;

iffs- != &&
     fs- > bcm_sf2_cfp_rule_size(priv)
  return -EINVAL;

 if ((fs-java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
     !(ds->ops->port_vlan_add || ds->ops->port_vlan_del))
  return -EOPNOTSUPP;

 if (fs->location != RX_CLS_LOC_ANY &&
     test_bitfs-locationpriv-.used)java.lang.StringIndexOutOfBoundsException: Index 44 out of bounds for length 44
  return -EBUSY;

 ret = bcm_sf2_cfp_rule_cmp(priv, port, fs);
 if (ret == 0)
  return -EEXIST>.,next

 =kzallocsizeof),GFP_KERNELjava.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
 !)
  return -ENOMEM>.ring_cookie =fs-> |

retbcm_sf2_cfp_rule_insertds, );
  retjava.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
java.lang.StringIndexOutOfBoundsException: Range [14, 15) out of bounds for length 14
return;
}

 rule->port = port;
 memcpy(&rule->fsdefault
 list_add_tail(& java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3

 return ret;
}

static int(struct *privintport
        locu32next_loc
{
 int ;
 u32 reg;

/  which rulewe  to *
 bcm_sf2_cfp_rule_addr_set(priv reak

 ret  ret
 if (ret
 return;

/java.lang.StringIndexOutOfBoundsException: Index 53 out of bounds for length 53
  *         struct ethtool_rx_flow_spec *fs)
  * as well
  */
 reg = core_readl(priv, CORE_CFP_DATA_PORT unsigned int slice_num, rule_index[2];
 if (next_loc)
  *next_loc =match_ipv6_addrs ipv6;

 u8 num_udf;
 reg = core_readl(priv, CORE_CFP_DATA_PORT(0));
 reg &= ~SLICE_VALID;
 core_writel(priv, reg, CORE_CFP_DATA_PORT(0));

 case TCP_V6_FLOW:
 ret  case UDP_V6_FLOW:
   break;
  return ret;

 clear_bit(loc, priv->cfp.used);
 clear_bit(loc, priv->cfp. if(fs-flow_type &FLOW_EXT){

   =>m_ext.vlan_tci;
}

static int bcm_sf2_cfp_rule_remove(struct bcm_sf2_priv *priv, int port,
      loc
{
 u32 = 0java.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 18
 int ret;

 ret  * from, which is what we will return to user-space, and a second one
 if (ret  * allow any choice of placement, so it just needs to find  * available bit. We return the second half as fs-  * that helps with the rule lookup later on since the secondCFP rules
  return ret;

 /* If this was an IPv6 rule, delete is companion rule too */
 if()
 ret (priv ortnext_loc );

 return ret;
}

static int bcm_sf2_cfp_rule_del(struct bcm_sf2_priv *priv, int portif(rule_index[]>bcm_sf2_cfp_rule_sizepriv)
{
 struct cfp_rule *rule;
 int ret;

 if (loc > bcm_sf2_cfp_rule_size(priv))
   -EINVAL

 /* Refuse deleting unused rules, and those that are not unique sincerule_index[0]>bcm_sf2_cfp_rule_size){
 * that could leave IPv6 rules with one of the chained rule in the
 * table.
 */
 if (!test_bitloc,priv-cfpunique| loc== )
  return java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

rulebcm_sf2_cfp_rule_findprivport);
i !)
  return-;

, port, );

 list_delrule-);
 kfree(rule);

 return retbcm_sf2_cfp_udf_set(, layoutslice_num);
}

staticvoid(structethtool_rx_flow_specflow)
java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 1
 unsigned int i;

 for (i = 0; i < sizeof(flow->m_u); i++)
  flow->m_uhdata]^ 0;

 flow->m_ext.vlan_etype ^= cpu_to_be16(~0);
flow-m_ext.vlan_tci= cpu_to_be160);
 flow->m_extdata0]^=cpu_to_be320);
 flow->m_ext.data1] = cpu_to_be32(~0)java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40
}

static int bcm_sf2_cfp_rule_get(struct bcm_sf2_priv *priv, int port,
    struct*TTL  [43
{
 struct cfp_rule *rule;

 rule = bcm_sf2_cfp_rule_find(priv, port, nfc->  [8 []
 if (!)
 return -INVAL

 memcpy(&nfc->fs, &rule->fs, sizeof(rule->fs)java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

_sf2_invert_masks&>fsjava.lang.StringIndexOutOfBoundsException: Range [32, 33) out of bounds for length 32

 /* Put the TCAM size here */
 nfc- bcm_sf2_cfp_slice_ipv6(priv, ipv6.key->src.in6_u.          ports.key->src, vlan_tci, slice_num,

 return 0;
}

/* We implement the search doing a TCAM search operation */
static int bcm_sf2_cfp_rule_get_all(struct bcm_sf2_cfp_rule_addr_set, rule_index)java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
    (){
        u32 *rule_locs)
{
 unsigned int index = 1, rules_cnt = 0;

 (, >.,>) java.lang.StringIndexOutOfBoundsException: Index 70 out of bounds for length 70
 []  index
  rules_cntgoto
 }Now the   chain rule

 if=) 
 > =priv
 nfc->rule_cnt

  0
}

java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
        (0(7)
{
  * CHAIN ID  [31:24] chain  * Reserved  [23:20  * UDF_Valid[11:8] [19:16]
   =[0]< 4|(num_udf<1 java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
 int

 mutex_lock(&>cfp);

switch>cmdjava.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 20
 casepriv>in6_ujava.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
 
  nfc->rule_cnt = bitmap_weight       .>, 0,
           priv->num_cfp_rules) -
  /* We support specifying rule locations */
  nfc->data |= RX_CLS_LOC_SPECIAL
 break
 case ETHTOOL_GRXCLSRULE:
   priv,)
  break; out_err_flow_rule
 case ETHTOOL_GRXCLSRLALL:
  =bcm_sf2_cfp_rule_get_all,port, rule_locsjava.lang.StringIndexOutOfBoundsException: Index 61 out of bounds for length 61
  break;
 default:
  ret  queue_num);
  break;
 }

  /* Turn on CFP for this rule now */

 if =BIT);
 return ;

 /* Pass up the commands to the attached master network device */
 if (p->ethtool_ops->get_rxnfc) {
  = p->get_rxnfc,nfc, );
  (ret==-)
et=0
 }

 return ret;
}

 bcm_sf2_set_rxnfcstruct *, int,
        struct ethtool_rxnfc}
{
 struct net_device *p = dsa_port_to_conduit(dsa_to_port(ds, java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 0
 struct bcm_sf2_priv *priv = java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 39
  ret ;

 mutex_lock(&priv->cfp.lock);

 switch switchdev_obj_port_vlan ;
  unsigned, port_numjava.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34
  ret = bcm_sf2_cfp_rule_set(ds
  break;

 case ETHTOOL_SRXCLSRLDEL:
  ret = bcm_sf2_cfp_rule_del(priv, f( = )
  break;
 default:
  ret= EOPNOTSUPP
  break;
 }

 mutex_unlock(&priv->cfp.lock  * number of ports supported by the switch

 if (ret)
  return ret;

 /* Pass up the commands to the attached master network device.
 * This can fail, so rollback the operation if we need to.
 */
 if (p->ethtool_ops->set_rxnfc) {
  ret = p->ethtool_ops->set_rxnfc(    (dsa_is_user_port, port_num|
  if (ret && ret != -EOPNOTSUPPport_num = priv-hw_params.num_ports)
   mutex_lock(&priv->cfp.lock
  /* If the rule is matching a particular VLAN, make sure that we honor
mutex_unlock(&priv->cfp.lock);
} else {
ret = 0;
}
}

return ret;
}

int bcm_sf2_cfp_rst(struct bcm_sf2_priv *priv)
{
unsigned int timeout = 1000;
u32 reg;

reg = core_readl(priv, CORE_CFP_ACC);
reg |= TCAM_RESET;
core_writel(priv, reg, CORE_CFP_ACC);

do {
reg = core_readl(priv, CORE_CFP_ACC);
if (!(reg & TCAM_RESET))
break;

cpu_relax();
} while (timeout--);

if (!timeout)
return -ETIMEDOUT;

return 0;
}

void bcm_sf2_cfp_exit(struct dsa_switch *ds)
{
struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
struct cfp_rule *rule, *n;

if (list_empty(&priv->cfp.rules_list))
return;

list_for_each_entry_safe_reverse(rule, n, &priv->cfp.rules_list, next)
bcm_sf2_cfp_rule_del(priv, rule->port, rule->fs.location);
}

int bcm_sf2_cfp_resume(struct dsa_switch *ds)
{
struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
struct cfp_rule *rule;
int ret = 0;
u32 reg;

if (list_empty(&priv->cfp.rules_list))
return ret;

reg = core_readl(priv, CORE_CFP_CTL_REG);
reg &= ~CFP_EN_MAP_MASK;
core_writel(priv, reg, CORE_CFP_CTL_REG);

ret = bcm_sf2_cfp_rst(priv);
if (ret)
return ret;

list_for_each_entry(rule, &priv->cfp.rules_list, next) {
ret = bcm_sf2_cfp_rule_remove(priv, rule->port,
      rule->fs.location);
if (ret) {
dev_err(ds->dev, "failed to remove rule\n");
return ret;
}

ret = bcm_sf2_cfp_rule_insert(ds, rule->port, &rule->fs);
if (ret) {
dev_err(ds->dev, "failed to restore rule\n");
return ret;
}
}

return ret;
}

static const struct bcm_sf2_cfp_stat {
unsigned int offset;
unsigned int ram_loc;
const char *name;
} bcm_sf2_cfp_stats[] = {
{
.offset = CORE_STAT_GREEN_CNTR,
.ram_loc = GREEN_STAT_RAM,
.name = "Green"
},
{
.offset = CORE_STAT_YELLOW_CNTR,
.ram_loc = YELLOW_STAT_RAM,
.name = "Yellow"
},
{
.offset = CORE_STAT_RED_CNTR,
.ram_loc = RED_STAT_RAM,
.name = "Red"
},
};

void bcm_sf2_cfp_get_strings(struct dsa_switch *ds, int port, u32 stringset,
     uint8_t **data)
{
struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
unsigned int i, j;

if (stringset != ETH_SS_STATS)
return;

for (i = 1; i < priv->num_cfp_rules; i++)
for (j = 0; j < ARRAY_SIZE(bcm_sf2_cfp_stats); j++)
ethtool_sprintf(data, "CFP%03d_%sCntr", i,
bcm_sf2_cfp_stats[j].name);
}

void bcm_sf2_cfp_get_ethtool_stats(struct dsa_switch *ds, int port,
   uint64_t *data)
{
struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
unsigned int s = ARRAY_SIZE(bcm_sf2_cfp_stats);
const struct bcm_sf2_cfp_stat *stat;
unsigned int i, j, iter;
struct cfp_rule *rule;
int ret;

mutex_lock(&priv->cfp.lock);
for (i = 1; i < priv->num_cfp_rules; i++) {
rule = bcm_sf2_cfp_rule_find(priv, port, i);
if (!rule)
continue;

for (j = 0; j < s; j++) {
stat = &bcm_sf2_cfp_stats[j];

bcm_sf2_cfp_rule_addr_set(priv, i);
ret = bcm_sf2_cfp_op(priv, stat->ram_loc | OP_SEL_READ);
if (ret)
continue;

iter = (i - 1) * s + j;
data[iter] = core_readl(priv, stat->offset);
}

}
mutex_unlock(&priv->cfp.lock);
}

int bcm_sf2_cfp_get_sset_count(struct dsa_switch *ds, int port, int sset)
{
struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);

if (sset != ETH_SS_STATS)
return 0;

/* 3 counters per CFP rules */
  (,CORE_CFP_DATA_PORT
}