src/vnet/srp/pg.c

   1 /*
   2  * Copyright (c) 2015 Cisco and/or its affiliates.
   3  * Licensed under the Apache License, Version 2.0 (the "License");
   4  * you may not use this file except in compliance with the License.
   5  * You may obtain a copy of the License at:
   6  *
   7  *     http://www.apache.org/licenses/LICENSE-2.0
   8  *
   9  * Unless required by applicable law or agreed to in writing, software
  10  * distributed under the License is distributed on an "AS IS" BASIS,
  11  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  12  * See the License for the specific language governing permissions and
  13  * limitations under the License.
  14  */
  15 /*
  16  * srp/pg.c: packet generator srp interface
  17  *
  18  * Copyright (c) 2008 Eliot Dresselhaus
  19  *
  20  * Permission is hereby granted, free of charge, to any person obtaining
  21  * a copy of this software and associated documentation files (the
  22  * "Software"), to deal in the Software without restriction, including
  23  * without limitation the rights to use, copy, modify, merge, publish,
  24  * distribute, sublicense, and/or sell copies of the Software, and to
  25  * permit persons to whom the Software is furnished to do so, subject to
  26  * the following conditions:
  27  *
  28  * The above copyright notice and this permission notice shall be
  29  * included in all copies or substantial portions of the Software.
  30  *
  31  *  THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  32  *  EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  33  *  MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  34  *  NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
  35  *  LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
  36  *  OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
  37  *  WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  38  */
  39
  40 #include <vlib/vlib.h>
  41 #include <vnet/pg/pg.h>
  42 #include <vnet/srp/srp.h>
  43 #include <vnet/ethernet/ethernet.h>
  44
  45 typedef struct {
  46   pg_edit_t ttl;
  47   pg_edit_t is_inner_ring;
  48   pg_edit_t mode;
  49   pg_edit_t priority;
  50   pg_edit_t parity;
  51   pg_edit_t type;
  52   pg_edit_t src_address;
  53   pg_edit_t dst_address;
  54 } pg_srp_header_t;
  55
  56 static inline void
  57 pg_srp_header_init (pg_srp_header_t * e)
  58 {
  59   pg_edit_init (&e->ttl, srp_and_ethernet_header_t, srp.ttl);
  60   pg_edit_init_bitfield (&e->is_inner_ring, srp_and_ethernet_header_t,
  61                          srp.as_u16,
  62                          7, 1);
  63   pg_edit_init_bitfield (&e->mode, srp_and_ethernet_header_t,
  64                          srp.as_u16,
  65                          4, 3);
  66   pg_edit_init_bitfield (&e->priority, srp_and_ethernet_header_t,
  67                          srp.as_u16,
  68                          1, 3);
  69   pg_edit_init_bitfield (&e->parity, srp_and_ethernet_header_t,
  70                          srp.as_u16,
  71                          0, 1);
  72   pg_edit_init (&e->type, srp_and_ethernet_header_t, ethernet.type);
  73   pg_edit_init (&e->src_address, srp_and_ethernet_header_t, ethernet.src_address);
  74   pg_edit_init (&e->dst_address, srp_and_ethernet_header_t, ethernet.dst_address);
  75 }
  76
  77 uword
  78 unformat_pg_srp_header (unformat_input_t * input, va_list * args)
  79 {
  80   pg_stream_t * s = va_arg (*args, pg_stream_t *);
  81   pg_srp_header_t * e;
  82   u32 error, group_index;
  83
  84   e = pg_create_edit_group (s, sizeof (e[0]), sizeof (srp_header_t),
  85                             &group_index);
  86   pg_srp_header_init (e);
  87
  88   error = 1;
  89   if (! unformat (input, "%U: %U -> %U",
  90                   unformat_pg_edit,
  91                     unformat_ethernet_type_net_byte_order, &e->type,
  92                   unformat_pg_edit,
  93                     unformat_ethernet_address, &e->src_address,
  94                   unformat_pg_edit,
  95                     unformat_ethernet_address, &e->dst_address))
  96     goto done;
  97
  98   {
  99     srp_header_t h;
 100
 101     h.as_u16 = 0;
 102     h.mode = SRP_MODE_data;
 103     h.ttl = 255;
 104     h.parity = count_set_bits (h.as_u16) ^ 1;
 105
 106     pg_edit_set_fixed (&e->mode, h.mode);
 107     pg_edit_set_fixed (&e->ttl, h.ttl);
 108     pg_edit_set_fixed (&e->is_inner_ring, h.is_inner_ring);
 109     pg_edit_set_fixed (&e->priority, h.priority);
 110     pg_edit_set_fixed (&e->parity, h.parity);
 111   }
 112
 113   error = 0;
 114   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
 115     {
 116       if (unformat (input, "mode %U",
 117                     unformat_pg_edit,
 118                     unformat_pg_number, &e->mode))
 119         ;
 120       else if (unformat (input, "ttl %U",
 121                          unformat_pg_edit,
 122                          unformat_pg_number, &e->ttl))
 123         ;
 124       else if (unformat (input, "priority %U",
 125                          unformat_pg_edit,
 126                          unformat_pg_number, &e->priority))
 127         ;
 128       else
 129         break;
 130     }
 131
 132   {
 133     ethernet_main_t * em = &ethernet_main;
 134     ethernet_type_info_t * ti = 0;
 135     pg_node_t * pg_node = 0;
 136
 137     if (e->type.type == PG_EDIT_FIXED)
 138       {
 139         u16 t = *(u16 *) e->type.values[PG_EDIT_LO];
 140         ti = ethernet_get_type_info (em, clib_net_to_host_u16 (t));
 141         if (ti && ti->node_index != ~0)
 142           pg_node = pg_get_node (ti->node_index);
 143       }
 144
 145     if (pg_node && pg_node->unformat_edit
 146         && unformat_user (input, pg_node->unformat_edit, s))
 147       ;
 148     else if (! unformat_user (input, unformat_pg_payload, s))
 149       goto done;
 150   }
 151
 152  done:
 153   if (error)
 154     pg_free_edit_group (s);
 155   return error == 0;
 156 }
 157