tests: test input policer
[vpp.git] / src / vnet / policer / node_funcs.c
index 457dd09..30e5c50 100644 (file)
 #include <vlib/vlib.h>
 #include <vnet/vnet.h>
 #include <vnet/policer/policer.h>
+#include <vnet/policer/police_inlines.h>
 #include <vnet/ip/ip.h>
 #include <vnet/classify/policer_classify.h>
 #include <vnet/classify/vnet_classify.h>
+#include <vnet/l2/feat_bitmap.h>
+#include <vnet/l2/l2_input.h>
 
-#define IP4_NON_DSCP_BITS 0x03
-#define IP4_DSCP_SHIFT    2
-#define IP6_NON_DSCP_BITS 0xf03fffff
-#define IP6_DSCP_SHIFT    22
 
 /* Dispatch functions meant to be instantiated elsewhere */
 
@@ -67,64 +66,9 @@ static char *vnet_policer_error_strings[] = {
 #undef _
 };
 
-static_always_inline void
-vnet_policer_mark (vlib_buffer_t * b, u8 dscp)
-{
-  ethernet_header_t *eh;
-  ip4_header_t *ip4h;
-  ip6_header_t *ip6h;
-  u16 type;
-
-  eh = (ethernet_header_t *) b->data;
-  type = clib_net_to_host_u16 (eh->type);
-
-  if (PREDICT_TRUE (type == ETHERNET_TYPE_IP4))
-    {
-      ip4h = (ip4_header_t *) & (b->data[sizeof (ethernet_header_t)]);;
-      ip4h->tos &= IP4_NON_DSCP_BITS;
-      ip4h->tos |= dscp << IP4_DSCP_SHIFT;
-      ip4h->checksum = ip4_header_checksum (ip4h);
-    }
-  else
-    {
-      if (PREDICT_TRUE (type == ETHERNET_TYPE_IP6))
-       {
-         ip6h = (ip6_header_t *) & (b->data[sizeof (ethernet_header_t)]);
-         ip6h->ip_version_traffic_class_and_flow_label &=
-           clib_host_to_net_u32 (IP6_NON_DSCP_BITS);
-         ip6h->ip_version_traffic_class_and_flow_label |=
-           clib_host_to_net_u32 (dscp << IP6_DSCP_SHIFT);
-       }
-    }
-}
-
-static_always_inline
-  u8 vnet_policer_police (vlib_main_t * vm,
-                         vlib_buffer_t * b,
-                         u32 policer_index,
-                         u64 time_in_policer_periods,
-                         policer_result_e packet_color)
-{
-  u8 act;
-  u32 len;
-  u32 col;
-  policer_read_response_type_st *pol;
-  vnet_policer_main_t *pm = &vnet_policer_main;
-
-  len = vlib_buffer_length_in_chain (vm, b);
-  pol = &pm->policers[policer_index];
-  col = vnet_police_packet (pol, len, packet_color, time_in_policer_periods);
-  act = pol->action[col];
-  if (PREDICT_TRUE (act == SSE2_QOS_ACTION_MARK_AND_TRANSMIT))
-    vnet_policer_mark (b, pol->mark_dscp[col]);
-
-  return act;
-}
-
 static inline uword
-vnet_policer_inline (vlib_main_t * vm,
-                    vlib_node_runtime_t * node,
-                    vlib_frame_t * frame, vnet_policer_index_t which)
+vnet_policer_inline (vlib_main_t *vm, vlib_node_runtime_t *node,
+                    vlib_frame_t *frame)
 {
   u32 n_left_from, *from, *to_next;
   vnet_policer_next_t next_index;
@@ -177,33 +121,10 @@ vnet_policer_inline (vlib_main_t * vm,
          b1 = vlib_get_buffer (vm, bi1);
 
          sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
-         next0 = VNET_POLICER_NEXT_TRANSMIT;
-
          sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
-         next1 = VNET_POLICER_NEXT_TRANSMIT;
-
-
-         if (which == VNET_POLICER_INDEX_BY_SW_IF_INDEX)
-           {
-             pi0 = pm->policer_index_by_sw_if_index[sw_if_index0];
-             pi1 = pm->policer_index_by_sw_if_index[sw_if_index1];
-           }
 
-         if (which == VNET_POLICER_INDEX_BY_OPAQUE)
-           {
-             pi0 = vnet_buffer (b0)->policer.index;
-             pi1 = vnet_buffer (b1)->policer.index;
-           }
-
-         if (which == VNET_POLICER_INDEX_BY_EITHER)
-           {
-             pi0 = vnet_buffer (b0)->policer.index;
-             pi0 = (pi0 != ~0) ? pi0 :
-               pm->policer_index_by_sw_if_index[sw_if_index0];
-             pi1 = vnet_buffer (b1)->policer.index;
-             pi1 = (pi1 != ~0) ? pi1 :
-               pm->policer_index_by_sw_if_index[sw_if_index1];
-           }
+         pi0 = pm->policer_index_by_sw_if_index[sw_if_index0];
+         pi1 = pm->policer_index_by_sw_if_index[sw_if_index1];
 
          act0 = vnet_policer_police (vm, b0, pi0, time_in_policer_periods,
                                      POLICE_CONFORM /* no chaining */ );
@@ -211,7 +132,7 @@ vnet_policer_inline (vlib_main_t * vm,
          act1 = vnet_policer_police (vm, b1, pi1, time_in_policer_periods,
                                      POLICE_CONFORM /* no chaining */ );
 
-         if (PREDICT_FALSE (act0 == SSE2_QOS_ACTION_DROP))     /* drop action */
+         if (PREDICT_FALSE (act0 == QOS_ACTION_DROP)) /* drop action */
            {
              next0 = VNET_POLICER_NEXT_DROP;
              b0->error = node->errors[VNET_POLICER_ERROR_DROP];
@@ -219,9 +140,10 @@ vnet_policer_inline (vlib_main_t * vm,
          else                  /* transmit or mark-and-transmit action */
            {
              transmitted++;
+             vnet_feature_next (&next0, b0);
            }
 
-         if (PREDICT_FALSE (act1 == SSE2_QOS_ACTION_DROP))     /* drop action */
+         if (PREDICT_FALSE (act1 == QOS_ACTION_DROP)) /* drop action */
            {
              next1 = VNET_POLICER_NEXT_DROP;
              b1->error = node->errors[VNET_POLICER_ERROR_DROP];
@@ -229,9 +151,9 @@ vnet_policer_inline (vlib_main_t * vm,
          else                  /* transmit or mark-and-transmit action */
            {
              transmitted++;
+             vnet_feature_next (&next1, b1);
            }
 
-
          if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)))
            {
              if (b0->flags & VLIB_BUFFER_IS_TRACED)
@@ -275,25 +197,13 @@ vnet_policer_inline (vlib_main_t * vm,
          b0 = vlib_get_buffer (vm, bi0);
 
          sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
-         next0 = VNET_POLICER_NEXT_TRANSMIT;
-
-         if (which == VNET_POLICER_INDEX_BY_SW_IF_INDEX)
-           pi0 = pm->policer_index_by_sw_if_index[sw_if_index0];
 
-         if (which == VNET_POLICER_INDEX_BY_OPAQUE)
-           pi0 = vnet_buffer (b0)->policer.index;
-
-         if (which == VNET_POLICER_INDEX_BY_EITHER)
-           {
-             pi0 = vnet_buffer (b0)->policer.index;
-             pi0 = (pi0 != ~0) ? pi0 :
-               pm->policer_index_by_sw_if_index[sw_if_index0];
-           }
+         pi0 = pm->policer_index_by_sw_if_index[sw_if_index0];
 
          act0 = vnet_policer_police (vm, b0, pi0, time_in_policer_periods,
                                      POLICE_CONFORM /* no chaining */ );
 
-         if (PREDICT_FALSE (act0 == SSE2_QOS_ACTION_DROP))     /* drop action */
+         if (PREDICT_FALSE (act0 == QOS_ACTION_DROP)) /* drop action */
            {
              next0 = VNET_POLICER_NEXT_DROP;
              b0->error = node->errors[VNET_POLICER_ERROR_DROP];
@@ -301,6 +211,7 @@ vnet_policer_inline (vlib_main_t * vm,
          else                  /* transmit or mark-and-transmit action */
            {
              transmitted++;
+             vnet_feature_next (&next0, b0);
            }
 
          if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)
@@ -327,199 +238,30 @@ vnet_policer_inline (vlib_main_t * vm,
   return frame->n_vectors;
 }
 
-uword
-vnet_policer_by_sw_if_index (vlib_main_t * vm,
-                            vlib_node_runtime_t * node, vlib_frame_t * frame)
-{
-  return vnet_policer_inline (vm, node, frame,
-                             VNET_POLICER_INDEX_BY_SW_IF_INDEX);
-}
-
-uword
-vnet_policer_by_opaque (vlib_main_t * vm,
-                       vlib_node_runtime_t * node, vlib_frame_t * frame)
+VLIB_NODE_FN (policer_input_node)
+(vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *frame)
 {
-  return vnet_policer_inline (vm, node, frame, VNET_POLICER_INDEX_BY_OPAQUE);
+  return vnet_policer_inline (vm, node, frame);
 }
 
-uword
-vnet_policer_by_either (vlib_main_t * vm,
-                       vlib_node_runtime_t * node, vlib_frame_t * frame)
-{
-  return vnet_policer_inline (vm, node, frame, VNET_POLICER_INDEX_BY_EITHER);
-}
-
-void
-vnet_policer_node_funcs_reference (void)
-{
-}
-
-
-#define TEST_CODE 1
-
-#ifdef TEST_CODE
-
-/* *INDENT-OFF* */
-VLIB_REGISTER_NODE (policer_by_sw_if_index_node, static) = {
-  .function = vnet_policer_by_sw_if_index,
-  .name = "policer-by-sw-if-index",
+VLIB_REGISTER_NODE (policer_input_node) = {
+  .name = "policer-input",
   .vector_size = sizeof (u32),
   .format_trace = format_policer_trace,
   .type = VLIB_NODE_TYPE_INTERNAL,
-
   .n_errors = ARRAY_LEN(vnet_policer_error_strings),
   .error_strings = vnet_policer_error_strings,
-
   .n_next_nodes = VNET_POLICER_N_NEXT,
-
-  /* edit / add dispositions here */
   .next_nodes = {
-    [VNET_POLICER_NEXT_TRANSMIT] = "ethernet-input",
-    [VNET_POLICER_NEXT_DROP] = "error-drop",
-  },
+                [VNET_POLICER_NEXT_DROP] = "error-drop",
+                },
 };
 
-VLIB_NODE_FUNCTION_MULTIARCH (policer_by_sw_if_index_node,
-                             vnet_policer_by_sw_if_index);
-/* *INDENT-ON* */
-
-
-int
-test_policer_add_del (u32 rx_sw_if_index, u8 * config_name, int is_add)
-{
-  vnet_policer_main_t *pm = &vnet_policer_main;
-  policer_read_response_type_st *template;
-  policer_read_response_type_st *policer;
-  vnet_hw_interface_t *rxhi;
-  uword *p;
-
-  rxhi = vnet_get_sup_hw_interface (pm->vnet_main, rx_sw_if_index);
-
-  /* Make sure caller didn't pass a vlan subif, etc. */
-  if (rxhi->sw_if_index != rx_sw_if_index)
-    return VNET_API_ERROR_INVALID_SW_IF_INDEX;
-
-  if (is_add)
-    {
-
-      p = hash_get_mem (pm->policer_config_by_name, config_name);
-
-      if (p == 0)
-       return -2;
-
-      template = pool_elt_at_index (pm->policer_templates, p[0]);
-
-      vnet_hw_interface_rx_redirect_to_node
-       (pm->vnet_main, rxhi->hw_if_index, policer_by_sw_if_index_node.index);
-
-      pool_get_aligned (pm->policers, policer, CLIB_CACHE_LINE_BYTES);
-
-      policer[0] = template[0];
-
-      vec_validate (pm->policer_index_by_sw_if_index, rx_sw_if_index);
-      pm->policer_index_by_sw_if_index[rx_sw_if_index]
-       = policer - pm->policers;
-    }
-  else
-    {
-      u32 pi;
-      vnet_hw_interface_rx_redirect_to_node (pm->vnet_main,
-                                            rxhi->hw_if_index,
-                                            ~0 /* disable */ );
-
-      pi = pm->policer_index_by_sw_if_index[rx_sw_if_index];
-      pm->policer_index_by_sw_if_index[rx_sw_if_index] = ~0;
-      pool_put_index (pm->policers, pi);
-    }
-
-  return 0;
-}
-
-static clib_error_t *
-test_policer_command_fn (vlib_main_t * vm,
-                        unformat_input_t * input, vlib_cli_command_t * cmd)
-{
-  vnet_policer_main_t *pm = &vnet_policer_main;
-  unformat_input_t _line_input, *line_input = &_line_input;
-  u32 rx_sw_if_index;
-  int rv;
-  u8 *config_name = 0;
-  int rx_set = 0;
-  int is_add = 1;
-  int is_show = 0;
-  clib_error_t *error = NULL;
-
-  /* Get a line of input. */
-  if (!unformat_user (input, unformat_line_input, line_input))
-    return 0;
-
-  while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
-    {
-      if (unformat (line_input, "intfc %U", unformat_vnet_sw_interface,
-                   pm->vnet_main, &rx_sw_if_index))
-       rx_set = 1;
-      else if (unformat (line_input, "show"))
-       is_show = 1;
-      else if (unformat (line_input, "policer %s", &config_name))
-       ;
-      else if (unformat (line_input, "del"))
-       is_add = 0;
-      else
-       break;
-    }
-
-  if (rx_set == 0)
-    {
-      error = clib_error_return (0, "interface not set");
-      goto done;
-    }
-
-  if (is_show)
-    {
-      u32 pi = pm->policer_index_by_sw_if_index[rx_sw_if_index];
-      policer_read_response_type_st *policer;
-      policer = pool_elt_at_index (pm->policers, pi);
-
-      vlib_cli_output (vm, "%U", format_policer_instance, policer);
-      goto done;
-    }
-
-  if (is_add && config_name == 0)
-    {
-      error = clib_error_return (0, "policer config name required");
-      goto done;
-    }
-
-  rv = test_policer_add_del (rx_sw_if_index, config_name, is_add);
-
-  switch (rv)
-    {
-    case 0:
-      break;
-
-    default:
-      error = clib_error_return
-       (0, "WARNING: vnet_vnet_policer_add_del returned %d", rv);
-      goto done;
-    }
-
-done:
-  unformat_free (line_input);
-
-  return error;
-}
-
-/* *INDENT-OFF* */
-VLIB_CLI_COMMAND (test_patch_command, static) = {
-    .path = "test policer",
-    .short_help =
-    "intfc <intfc> policer <policer-config-name> [del]",
-    .function = test_policer_command_fn,
+VNET_FEATURE_INIT (policer_input_node, static) = {
+  .arc_name = "device-input",
+  .node_name = "policer-input",
+  .runs_before = VNET_FEATURES ("ethernet-input"),
 };
-/* *INDENT-ON* */
-
-#endif /* TEST_CODE */
-
 
 typedef struct
 {
@@ -547,7 +289,7 @@ format_policer_classify_trace (u8 * s, va_list * args)
 #define foreach_policer_classify_error                 \
 _(MISS, "Policer classify misses")                     \
 _(HIT, "Policer classify hits")                        \
-_(CHAIN_HIT, "Polcier classify hits after chain walk") \
+_(CHAIN_HIT, "Policer classify hits after chain walk") \
 _(DROP, "Policer classify action drop")
 
 typedef enum
@@ -578,7 +320,6 @@ policer_classify_inline (vlib_main_t * vm,
   u32 hits = 0;
   u32 misses = 0;
   u32 chain_hits = 0;
-  u32 drop = 0;
   u32 n_next_nodes;
   u64 time_in_policer_periods;
 
@@ -736,14 +477,9 @@ policer_classify_inline (vlib_main_t * vm,
 
          if (tid == POLICER_CLASSIFY_TABLE_L2)
            {
-             /* Feature bitmap update */
-             vnet_buffer (b0)->l2.feature_bitmap &=
-               ~L2INPUT_FEAT_POLICER_CLAS;
-             /* Determine the next node */
-             next0 =
-               feat_bitmap_get_next_node_index (pcm->feat_next_node_index,
-                                                vnet_buffer (b0)->
-                                                l2.feature_bitmap);
+             /* Feature bitmap update and determine the next node */
+             next0 = vnet_l2_feature_next (b0, pcm->feat_next_node_index,
+                                           L2INPUT_FEAT_POLICER_CLAS);
            }
          else
            vnet_get_config_data (pcm->vnet_config_main[tid],
@@ -765,11 +501,10 @@ policer_classify_inline (vlib_main_t * vm,
                                              e0->next_index,
                                              time_in_policer_periods,
                                              e0->opaque_index);
-                 if (PREDICT_FALSE (act0 == SSE2_QOS_ACTION_DROP))
+                 if (PREDICT_FALSE (act0 == QOS_ACTION_DROP))
                    {
                      next0 = POLICER_CLASSIFY_NEXT_INDEX_DROP;
                      b0->error = node->errors[POLICER_CLASSIFY_ERROR_DROP];
-                     drop++;
                    }
                  hits++;
                }
@@ -800,12 +535,11 @@ policer_classify_inline (vlib_main_t * vm,
                                                      e0->next_index,
                                                      time_in_policer_periods,
                                                      e0->opaque_index);
-                         if (PREDICT_FALSE (act0 == SSE2_QOS_ACTION_DROP))
+                         if (PREDICT_FALSE (act0 == QOS_ACTION_DROP))
                            {
                              next0 = POLICER_CLASSIFY_NEXT_INDEX_DROP;
                              b0->error =
                                node->errors[POLICER_CLASSIFY_ERROR_DROP];
-                             drop++;
                            }
                          hits++;
                          chain_hits++;
@@ -840,15 +574,13 @@ policer_classify_inline (vlib_main_t * vm,
                               POLICER_CLASSIFY_ERROR_HIT, hits);
   vlib_node_increment_counter (vm, node->node_index,
                               POLICER_CLASSIFY_ERROR_CHAIN_HIT, chain_hits);
-  vlib_node_increment_counter (vm, node->node_index,
-                              POLICER_CLASSIFY_ERROR_DROP, drop);
 
   return frame->n_vectors;
 }
 
-static uword
-ip4_policer_classify (vlib_main_t * vm,
-                     vlib_node_runtime_t * node, vlib_frame_t * frame)
+VLIB_NODE_FN (ip4_policer_classify_node) (vlib_main_t * vm,
+                                         vlib_node_runtime_t * node,
+                                         vlib_frame_t * frame)
 {
   return policer_classify_inline (vm, node, frame,
                                  POLICER_CLASSIFY_TABLE_IP4);
@@ -856,7 +588,6 @@ ip4_policer_classify (vlib_main_t * vm,
 
 /* *INDENT-OFF* */
 VLIB_REGISTER_NODE (ip4_policer_classify_node) = {
-  .function = ip4_policer_classify,
   .name = "ip4-policer-classify",
   .vector_size = sizeof (u32),
   .format_trace = format_policer_classify_trace,
@@ -867,13 +598,11 @@ VLIB_REGISTER_NODE (ip4_policer_classify_node) = {
     [POLICER_CLASSIFY_NEXT_INDEX_DROP] = "error-drop",
   },
 };
-
-VLIB_NODE_FUNCTION_MULTIARCH (ip4_policer_classify_node, ip4_policer_classify);
 /* *INDENT-ON* */
 
-static uword
-ip6_policer_classify (vlib_main_t * vm,
-                     vlib_node_runtime_t * node, vlib_frame_t * frame)
+VLIB_NODE_FN (ip6_policer_classify_node) (vlib_main_t * vm,
+                                         vlib_node_runtime_t * node,
+                                         vlib_frame_t * frame)
 {
   return policer_classify_inline (vm, node, frame,
                                  POLICER_CLASSIFY_TABLE_IP6);
@@ -881,7 +610,6 @@ ip6_policer_classify (vlib_main_t * vm,
 
 /* *INDENT-OFF* */
 VLIB_REGISTER_NODE (ip6_policer_classify_node) = {
-  .function = ip6_policer_classify,
   .name = "ip6-policer-classify",
   .vector_size = sizeof (u32),
   .format_trace = format_policer_classify_trace,
@@ -892,31 +620,30 @@ VLIB_REGISTER_NODE (ip6_policer_classify_node) = {
     [POLICER_CLASSIFY_NEXT_INDEX_DROP] = "error-drop",
   },
 };
-
-VLIB_NODE_FUNCTION_MULTIARCH (ip6_policer_classify_node, ip6_policer_classify);
 /* *INDENT-ON* */
 
-static uword
-l2_policer_classify (vlib_main_t * vm,
-                    vlib_node_runtime_t * node, vlib_frame_t * frame)
+VLIB_NODE_FN (l2_policer_classify_node) (vlib_main_t * vm,
+                                        vlib_node_runtime_t * node,
+                                        vlib_frame_t * frame)
 {
   return policer_classify_inline (vm, node, frame, POLICER_CLASSIFY_TABLE_L2);
 }
 
-VLIB_REGISTER_NODE (l2_policer_classify_node) =
-{
-  .function = l2_policer_classify,.name = "l2-policer-classify",.vector_size =
-    sizeof (u32),.format_trace = format_policer_classify_trace,.n_errors =
-    ARRAY_LEN (policer_classify_error_strings),.error_strings =
-    policer_classify_error_strings,.n_next_nodes =
-    POLICER_CLASSIFY_NEXT_INDEX_N_NEXT,.next_nodes =
-  {
-  [POLICER_CLASSIFY_NEXT_INDEX_DROP] = "error-drop",}
-,};
-
-VLIB_NODE_FUNCTION_MULTIARCH (l2_policer_classify_node, l2_policer_classify);
-
+/* *INDENT-OFF* */
+VLIB_REGISTER_NODE (l2_policer_classify_node) = {
+  .name = "l2-policer-classify",
+  .vector_size = sizeof (u32),
+  .format_trace = format_policer_classify_trace,
+  .n_errors = ARRAY_LEN (policer_classify_error_strings),
+  .error_strings = policer_classify_error_strings,
+  .n_next_nodes = POLICER_CLASSIFY_NEXT_INDEX_N_NEXT,
+  .next_nodes = {
+    [POLICER_CLASSIFY_NEXT_INDEX_DROP] = "error-drop",
+  },
+};
+/* *INDENT-ON* */
 
+#ifndef CLIB_MARCH_VARIANT
 static clib_error_t *
 policer_classify_init (vlib_main_t * vm)
 {
@@ -937,6 +664,7 @@ policer_classify_init (vlib_main_t * vm)
 }
 
 VLIB_INIT_FUNCTION (policer_classify_init);
+#endif /* CLIB_MARCH_VARIANT */
 
 /*
  * fd.io coding-style-patch-verification: ON