netdev-dummy: New appctl command netdev-dummy/set-admin-state.
[sliver-openvswitch.git] / lib / netdev-dummy.c
1 /*
2  * Copyright (c) 2010, 2011, 2012 Nicira, Inc.
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at:
7  *
8  *     http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16
17 #include <config.h>
18
19 #include "dummy.h"
20
21 #include <errno.h>
22
23 #include "flow.h"
24 #include "list.h"
25 #include "netdev-provider.h"
26 #include "odp-util.h"
27 #include "ofp-print.h"
28 #include "ofpbuf.h"
29 #include "packets.h"
30 #include "poll-loop.h"
31 #include "shash.h"
32 #include "sset.h"
33 #include "unixctl.h"
34 #include "vlog.h"
35
36 VLOG_DEFINE_THIS_MODULE(netdev_dummy);
37
38 struct netdev_dev_dummy {
39     struct netdev_dev netdev_dev;
40     uint8_t hwaddr[ETH_ADDR_LEN];
41     int mtu;
42     struct netdev_stats stats;
43     enum netdev_flags flags;
44     unsigned int change_seq;
45
46     struct list devs;           /* List of child "netdev_dummy"s. */
47 };
48
49 struct netdev_dummy {
50     struct netdev netdev;
51     struct list node;           /* In netdev_dev_dummy's "devs" list. */
52     struct list recv_queue;
53     bool listening;
54 };
55
56 static struct shash dummy_netdev_devs = SHASH_INITIALIZER(&dummy_netdev_devs);
57
58 static unixctl_cb_func netdev_dummy_set_admin_state;
59 static int netdev_dummy_create(const struct netdev_class *, const char *,
60                                struct netdev_dev **);
61 static void netdev_dev_dummy_poll_notify(struct netdev_dev_dummy *);
62 static int netdev_dev_dummy_update_flags(struct netdev_dev_dummy *,
63                                          enum netdev_flags off,
64                                          enum netdev_flags on,
65                                          enum netdev_flags *old_flagsp);
66
67 static bool
68 is_dummy_class(const struct netdev_class *class)
69 {
70     return class->create == netdev_dummy_create;
71 }
72
73 static struct netdev_dev_dummy *
74 netdev_dev_dummy_cast(const struct netdev_dev *netdev_dev)
75 {
76     assert(is_dummy_class(netdev_dev_get_class(netdev_dev)));
77     return CONTAINER_OF(netdev_dev, struct netdev_dev_dummy, netdev_dev);
78 }
79
80 static struct netdev_dummy *
81 netdev_dummy_cast(const struct netdev *netdev)
82 {
83     struct netdev_dev *netdev_dev = netdev_get_dev(netdev);
84     assert(is_dummy_class(netdev_dev_get_class(netdev_dev)));
85     return CONTAINER_OF(netdev, struct netdev_dummy, netdev);
86 }
87
88 static int
89 netdev_dummy_create(const struct netdev_class *class, const char *name,
90                     struct netdev_dev **netdev_devp)
91 {
92     static unsigned int n = 0xaa550000;
93     struct netdev_dev_dummy *netdev_dev;
94
95     netdev_dev = xzalloc(sizeof *netdev_dev);
96     netdev_dev_init(&netdev_dev->netdev_dev, name, class);
97     netdev_dev->hwaddr[0] = 0xaa;
98     netdev_dev->hwaddr[1] = 0x55;
99     netdev_dev->hwaddr[2] = n >> 24;
100     netdev_dev->hwaddr[3] = n >> 16;
101     netdev_dev->hwaddr[4] = n >> 8;
102     netdev_dev->hwaddr[5] = n;
103     netdev_dev->mtu = 1500;
104     netdev_dev->flags = 0;
105     netdev_dev->change_seq = 1;
106     list_init(&netdev_dev->devs);
107
108     shash_add(&dummy_netdev_devs, name, netdev_dev);
109
110     n++;
111
112     *netdev_devp = &netdev_dev->netdev_dev;
113
114     return 0;
115 }
116
117 static void
118 netdev_dummy_destroy(struct netdev_dev *netdev_dev_)
119 {
120     struct netdev_dev_dummy *netdev_dev = netdev_dev_dummy_cast(netdev_dev_);
121
122     shash_find_and_delete(&dummy_netdev_devs,
123                           netdev_dev_get_name(netdev_dev_));
124     free(netdev_dev);
125 }
126
127 static int
128 netdev_dummy_open(struct netdev_dev *netdev_dev_, struct netdev **netdevp)
129 {
130     struct netdev_dev_dummy *netdev_dev = netdev_dev_dummy_cast(netdev_dev_);
131     struct netdev_dummy *netdev;
132
133     netdev = xmalloc(sizeof *netdev);
134     netdev_init(&netdev->netdev, netdev_dev_);
135     list_init(&netdev->recv_queue);
136     netdev->listening = false;
137
138     *netdevp = &netdev->netdev;
139     list_push_back(&netdev_dev->devs, &netdev->node);
140     return 0;
141 }
142
143 static void
144 netdev_dummy_close(struct netdev *netdev_)
145 {
146     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
147     list_remove(&netdev->node);
148     ofpbuf_list_delete(&netdev->recv_queue);
149     free(netdev);
150 }
151
152 static int
153 netdev_dummy_listen(struct netdev *netdev_)
154 {
155     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
156     netdev->listening = true;
157     return 0;
158 }
159
160 static int
161 netdev_dummy_recv(struct netdev *netdev_, void *buffer, size_t size)
162 {
163     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
164     struct ofpbuf *packet;
165     size_t packet_size;
166
167     if (list_is_empty(&netdev->recv_queue)) {
168         return -EAGAIN;
169     }
170
171     packet = ofpbuf_from_list(list_pop_front(&netdev->recv_queue));
172     if (packet->size > size) {
173         return -EMSGSIZE;
174     }
175     packet_size = packet->size;
176
177     memcpy(buffer, packet->data, packet->size);
178     ofpbuf_delete(packet);
179
180     return packet_size;
181 }
182
183 static void
184 netdev_dummy_recv_wait(struct netdev *netdev_)
185 {
186     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
187     if (!list_is_empty(&netdev->recv_queue)) {
188         poll_immediate_wake();
189     }
190 }
191
192 static int
193 netdev_dummy_drain(struct netdev *netdev_)
194 {
195     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
196     ofpbuf_list_delete(&netdev->recv_queue);
197     return 0;
198 }
199
200 static int
201 netdev_dummy_set_etheraddr(struct netdev *netdev,
202                            const uint8_t mac[ETH_ADDR_LEN])
203 {
204     struct netdev_dev_dummy *dev =
205         netdev_dev_dummy_cast(netdev_get_dev(netdev));
206
207     if (!eth_addr_equals(dev->hwaddr, mac)) {
208         memcpy(dev->hwaddr, mac, ETH_ADDR_LEN);
209         netdev_dev_dummy_poll_notify(dev);
210     }
211
212     return 0;
213 }
214
215 static int
216 netdev_dummy_get_etheraddr(const struct netdev *netdev,
217                            uint8_t mac[ETH_ADDR_LEN])
218 {
219     const struct netdev_dev_dummy *dev =
220         netdev_dev_dummy_cast(netdev_get_dev(netdev));
221
222     memcpy(mac, dev->hwaddr, ETH_ADDR_LEN);
223     return 0;
224 }
225
226 static int
227 netdev_dummy_get_mtu(const struct netdev *netdev, int *mtup)
228 {
229     const struct netdev_dev_dummy *dev =
230         netdev_dev_dummy_cast(netdev_get_dev(netdev));
231
232     *mtup = dev->mtu;
233     return 0;
234 }
235
236 static int
237 netdev_dummy_set_mtu(const struct netdev *netdev, int mtu)
238 {
239     struct netdev_dev_dummy *dev =
240         netdev_dev_dummy_cast(netdev_get_dev(netdev));
241
242     dev->mtu = mtu;
243     return 0;
244 }
245
246 static int
247 netdev_dummy_get_stats(const struct netdev *netdev, struct netdev_stats *stats)
248 {
249     const struct netdev_dev_dummy *dev =
250         netdev_dev_dummy_cast(netdev_get_dev(netdev));
251
252     *stats = dev->stats;
253     return 0;
254 }
255
256 static int
257 netdev_dummy_set_stats(struct netdev *netdev, const struct netdev_stats *stats)
258 {
259     struct netdev_dev_dummy *dev =
260         netdev_dev_dummy_cast(netdev_get_dev(netdev));
261
262     dev->stats = *stats;
263     return 0;
264 }
265
266 static int
267 netdev_dummy_update_flags(struct netdev *netdev,
268                           enum netdev_flags off, enum netdev_flags on,
269                           enum netdev_flags *old_flagsp)
270 {
271     struct netdev_dev_dummy *dev =
272         netdev_dev_dummy_cast(netdev_get_dev(netdev));
273
274     return netdev_dev_dummy_update_flags(dev, off, on, old_flagsp);
275 }
276
277 static int
278 netdev_dev_dummy_update_flags(struct netdev_dev_dummy *dev,
279                               enum netdev_flags off, enum netdev_flags on,
280                               enum netdev_flags *old_flagsp)
281 {
282     if ((off | on) & ~(NETDEV_UP | NETDEV_PROMISC)) {
283         return EINVAL;
284     }
285
286     *old_flagsp = dev->flags;
287     dev->flags |= on;
288     dev->flags &= ~off;
289     if (*old_flagsp != dev->flags) {
290         netdev_dev_dummy_poll_notify(dev);
291     }
292     return 0;
293 }
294
295 static unsigned int
296 netdev_dummy_change_seq(const struct netdev *netdev)
297 {
298     return netdev_dev_dummy_cast(netdev_get_dev(netdev))->change_seq;
299 }
300 \f
301 /* Helper functions. */
302
303 static void
304 netdev_dev_dummy_poll_notify(struct netdev_dev_dummy *dev)
305 {
306     dev->change_seq++;
307     if (!dev->change_seq) {
308         dev->change_seq++;
309     }
310 }
311
312 static const struct netdev_class dummy_class = {
313     "dummy",
314     NULL,                       /* init */
315     NULL,                       /* run */
316     NULL,                       /* wait */
317
318     netdev_dummy_create,
319     netdev_dummy_destroy,
320     NULL,                       /* get_config */
321     NULL,                       /* set_config */
322
323     netdev_dummy_open,
324     netdev_dummy_close,
325
326     netdev_dummy_listen,
327     netdev_dummy_recv,
328     netdev_dummy_recv_wait,
329     netdev_dummy_drain,
330
331     NULL,                       /* send */
332     NULL,                       /* send_wait */
333
334     netdev_dummy_set_etheraddr,
335     netdev_dummy_get_etheraddr,
336     netdev_dummy_get_mtu,
337     netdev_dummy_set_mtu,
338     NULL,                       /* get_ifindex */
339     NULL,                       /* get_carrier */
340     NULL,                       /* get_carrier_resets */
341     NULL,                       /* get_miimon */
342     netdev_dummy_get_stats,
343     netdev_dummy_set_stats,
344
345     NULL,                       /* get_features */
346     NULL,                       /* set_advertisements */
347
348     NULL,                       /* set_policing */
349     NULL,                       /* get_qos_types */
350     NULL,                       /* get_qos_capabilities */
351     NULL,                       /* get_qos */
352     NULL,                       /* set_qos */
353     NULL,                       /* get_queue */
354     NULL,                       /* set_queue */
355     NULL,                       /* delete_queue */
356     NULL,                       /* get_queue_stats */
357     NULL,                       /* dump_queues */
358     NULL,                       /* dump_queue_stats */
359
360     NULL,                       /* get_in4 */
361     NULL,                       /* set_in4 */
362     NULL,                       /* get_in6 */
363     NULL,                       /* add_router */
364     NULL,                       /* get_next_hop */
365     NULL,                       /* get_drv_info */
366     NULL,                       /* arp_lookup */
367
368     netdev_dummy_update_flags,
369
370     netdev_dummy_change_seq
371 };
372
373 static struct ofpbuf *
374 eth_from_packet_or_flow(const char *s)
375 {
376     enum odp_key_fitness fitness;
377     struct ofpbuf *packet;
378     struct ofpbuf odp_key;
379     struct flow flow;
380     int error;
381
382     if (!eth_from_hex(s, &packet)) {
383         return packet;
384     }
385
386     /* Convert string to datapath key.
387      *
388      * It would actually be nicer to parse an OpenFlow-like flow key here, but
389      * the code for that currently calls exit() on parse error.  We have to
390      * settle for parsing a datapath key for now.
391      */
392     ofpbuf_init(&odp_key, 0);
393     error = odp_flow_key_from_string(s, NULL, &odp_key);
394     if (error) {
395         ofpbuf_uninit(&odp_key);
396         return NULL;
397     }
398
399     /* Convert odp_key to flow. */
400     fitness = odp_flow_key_to_flow(odp_key.data, odp_key.size, &flow);
401     if (fitness == ODP_FIT_ERROR) {
402         ofpbuf_uninit(&odp_key);
403         return NULL;
404     }
405
406     packet = ofpbuf_new(0);
407     flow_compose(packet, &flow);
408
409     ofpbuf_uninit(&odp_key);
410     return packet;
411 }
412
413 static void
414 netdev_dummy_receive(struct unixctl_conn *conn,
415                      int argc, const char *argv[], void *aux OVS_UNUSED)
416 {
417     struct netdev_dev_dummy *dummy_dev;
418     int n_listeners;
419     int i;
420
421     dummy_dev = shash_find_data(&dummy_netdev_devs, argv[1]);
422     if (!dummy_dev) {
423         unixctl_command_reply_error(conn, "no such dummy netdev");
424         return;
425     }
426
427     n_listeners = 0;
428     for (i = 2; i < argc; i++) {
429         struct netdev_dummy *dev;
430         struct ofpbuf *packet;
431
432         packet = eth_from_packet_or_flow(argv[i]);
433         if (!packet) {
434             unixctl_command_reply_error(conn, "bad packet syntax");
435             return;
436         }
437
438         n_listeners = 0;
439         LIST_FOR_EACH (dev, node, &dummy_dev->devs) {
440             if (dev->listening) {
441                 struct ofpbuf *copy = ofpbuf_clone(packet);
442                 list_push_back(&dev->recv_queue, &copy->list_node);
443                 n_listeners++;
444             }
445         }
446         ofpbuf_delete(packet);
447     }
448
449     if (!n_listeners) {
450         unixctl_command_reply(conn, "packets queued but nobody listened");
451     } else {
452         unixctl_command_reply(conn, "success");
453     }
454 }
455
456 static void
457 netdev_dev_dummy_set_admin_state(struct netdev_dev_dummy *dev,
458                                  bool admin_state)
459 {
460     enum netdev_flags old_flags;
461
462     if (admin_state) {
463         netdev_dev_dummy_update_flags(dev, 0, NETDEV_UP, &old_flags);
464     } else {
465         netdev_dev_dummy_update_flags(dev, NETDEV_UP, 0, &old_flags);
466     }
467 }
468
469 static void
470 netdev_dummy_set_admin_state(struct unixctl_conn *conn, int argc,
471                              const char *argv[], void *aux OVS_UNUSED)
472 {
473     bool up;
474
475     if (!strcasecmp(argv[argc - 1], "up")) {
476         up = true;
477     } else if ( !strcasecmp(argv[argc - 1], "down")) {
478         up = false;
479     } else {
480         unixctl_command_reply_error(conn, "Invalid Admin State");
481         return;
482     }
483
484     if (argc > 2) {
485         struct netdev_dev_dummy *dummy_dev;
486
487         dummy_dev  = shash_find_data(&dummy_netdev_devs, argv[1]);
488         if (dummy_dev) {
489             netdev_dev_dummy_set_admin_state(dummy_dev, up);
490         } else {
491             unixctl_command_reply_error(conn, "Unknown Dummy Interface");
492             return;
493         }
494     } else {
495         struct shash_node *node;
496
497         SHASH_FOR_EACH (node, &dummy_netdev_devs) {
498             netdev_dev_dummy_set_admin_state(node->data, up);
499         }
500     }
501     unixctl_command_reply(conn, "OK");
502 }
503
504 void
505 netdev_dummy_register(bool override)
506 {
507     unixctl_command_register("netdev-dummy/receive", "NAME PACKET|FLOW...",
508                              2, INT_MAX, netdev_dummy_receive, NULL);
509     unixctl_command_register("netdev-dummy/set-admin-state",
510                              "[netdev] up|down", 1, 2,
511                              netdev_dummy_set_admin_state, NULL);
512
513     if (override) {
514         struct sset types;
515         const char *type;
516
517         sset_init(&types);
518         netdev_enumerate_types(&types);
519         SSET_FOR_EACH (type, &types) {
520             if (!netdev_unregister_provider(type)) {
521                 struct netdev_class *class;
522
523                 class = xmalloc(sizeof *class);
524                 *class = dummy_class;
525                 class->type = xstrdup(type);
526                 netdev_register_provider(class);
527             }
528         }
529         sset_destroy(&types);
530     }
531     netdev_register_provider(&dummy_class);
532 }