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
45typedef 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
56static inline void
57pg_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
77uword
78unformat_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
158