netdev: Extend rx_recv to pass multiple packets.
[sliver-openvswitch.git] / lib / netdev-dummy.c
1 /*
2  * Copyright (c) 2010, 2011, 2012, 2013 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 "connectivity.h"
24 #include "dpif-netdev.h"
25 #include "flow.h"
26 #include "list.h"
27 #include "netdev-provider.h"
28 #include "netdev-vport.h"
29 #include "odp-util.h"
30 #include "ofp-print.h"
31 #include "ofpbuf.h"
32 #include "packets.h"
33 #include "pcap-file.h"
34 #include "poll-loop.h"
35 #include "seq.h"
36 #include "shash.h"
37 #include "sset.h"
38 #include "stream.h"
39 #include "unaligned.h"
40 #include "timeval.h"
41 #include "unixctl.h"
42 #include "reconnect.h"
43 #include "vlog.h"
44
45 VLOG_DEFINE_THIS_MODULE(netdev_dummy);
46
47 struct reconnect;
48
49 struct dummy_packet_stream {
50     struct stream *stream;
51     struct ofpbuf rxbuf;
52     struct list txq;
53 };
54
55 enum dummy_packet_conn_type {
56     NONE,       /* No connection is configured. */
57     PASSIVE,    /* Listener. */
58     ACTIVE      /* Connect to listener. */
59 };
60
61 struct dummy_packet_pconn {
62     struct pstream *pstream;
63     struct dummy_packet_stream *streams;
64     size_t n_streams;
65 };
66
67 struct dummy_packet_rconn {
68     struct dummy_packet_stream *rstream;
69     struct reconnect *reconnect;
70 };
71
72 struct dummy_packet_conn {
73     enum dummy_packet_conn_type type;
74     union {
75         struct dummy_packet_pconn pconn;
76         struct dummy_packet_rconn rconn;
77     } u;
78 };
79
80 /* Protects 'dummy_list'. */
81 static struct ovs_mutex dummy_list_mutex = OVS_MUTEX_INITIALIZER;
82
83 /* Contains all 'struct dummy_dev's. */
84 static struct list dummy_list OVS_GUARDED_BY(dummy_list_mutex)
85     = LIST_INITIALIZER(&dummy_list);
86
87 struct netdev_dummy {
88     struct netdev up;
89
90     /* In dummy_list. */
91     struct list list_node OVS_GUARDED_BY(dummy_list_mutex);
92
93     /* Protects all members below. */
94     struct ovs_mutex mutex OVS_ACQ_AFTER(dummy_list_mutex);
95
96     uint8_t hwaddr[ETH_ADDR_LEN] OVS_GUARDED;
97     int mtu OVS_GUARDED;
98     struct netdev_stats stats OVS_GUARDED;
99     enum netdev_flags flags OVS_GUARDED;
100     int ifindex OVS_GUARDED;
101
102     struct dummy_packet_conn conn OVS_GUARDED;
103
104     FILE *tx_pcap, *rx_pcap OVS_GUARDED;
105
106     struct list rxes OVS_GUARDED; /* List of child "netdev_rx_dummy"s. */
107 };
108
109 /* Max 'recv_queue_len' in struct netdev_dummy. */
110 #define NETDEV_DUMMY_MAX_QUEUE 100
111
112 struct netdev_rx_dummy {
113     struct netdev_rx up;
114     struct list node;           /* In netdev_dummy's "rxes" list. */
115     struct list recv_queue;
116     int recv_queue_len;         /* list_size(&recv_queue). */
117     struct seq *seq;            /* Reports newly queued packets. */
118 };
119
120 static unixctl_cb_func netdev_dummy_set_admin_state;
121 static int netdev_dummy_construct(struct netdev *);
122 static void netdev_dummy_queue_packet(struct netdev_dummy *, struct ofpbuf *);
123
124 static void dummy_packet_stream_close(struct dummy_packet_stream *);
125
126 static bool
127 is_dummy_class(const struct netdev_class *class)
128 {
129     return class->construct == netdev_dummy_construct;
130 }
131
132 static struct netdev_dummy *
133 netdev_dummy_cast(const struct netdev *netdev)
134 {
135     ovs_assert(is_dummy_class(netdev_get_class(netdev)));
136     return CONTAINER_OF(netdev, struct netdev_dummy, up);
137 }
138
139 static struct netdev_rx_dummy *
140 netdev_rx_dummy_cast(const struct netdev_rx *rx)
141 {
142     ovs_assert(is_dummy_class(netdev_get_class(rx->netdev)));
143     return CONTAINER_OF(rx, struct netdev_rx_dummy, up);
144 }
145
146 static void
147 dummy_packet_stream_init(struct dummy_packet_stream *s, struct stream *stream)
148 {
149     int rxbuf_size = stream ? 2048 : 0;
150     s->stream = stream;
151     ofpbuf_init(&s->rxbuf, rxbuf_size);
152     list_init(&s->txq);
153 }
154
155 static struct dummy_packet_stream *
156 dummy_packet_stream_create(struct stream *stream)
157 {
158     struct dummy_packet_stream *s;
159
160     s = xzalloc(sizeof *s);
161     dummy_packet_stream_init(s, stream);
162
163     return s;
164 }
165
166 static void
167 dummy_packet_stream_wait(struct dummy_packet_stream *s)
168 {
169     stream_run_wait(s->stream);
170     if (!list_is_empty(&s->txq)) {
171         stream_send_wait(s->stream);
172     }
173     stream_recv_wait(s->stream);
174 }
175
176 static void
177 dummy_packet_stream_send(struct dummy_packet_stream *s, const void *buffer, size_t size)
178 {
179     if (list_size(&s->txq) < NETDEV_DUMMY_MAX_QUEUE) {
180         struct ofpbuf *b;
181
182         b = ofpbuf_clone_data_with_headroom(buffer, size, 2);
183         put_unaligned_be16(ofpbuf_push_uninit(b, 2), htons(size));
184         list_push_back(&s->txq, &b->list_node);
185     }
186 }
187
188 static int
189 dummy_packet_stream_run(struct netdev_dummy *dev, struct dummy_packet_stream *s)
190 {
191     int error = 0;
192     size_t n;
193
194     stream_run(s->stream);
195
196     if (!list_is_empty(&s->txq)) {
197         struct ofpbuf *txbuf;
198         int retval;
199
200         txbuf = ofpbuf_from_list(list_front(&s->txq));
201         retval = stream_send(s->stream, txbuf->data, txbuf->size);
202
203         if (retval > 0) {
204             ofpbuf_pull(txbuf, retval);
205             if (!txbuf->size) {
206                 list_remove(&txbuf->list_node);
207                 ofpbuf_delete(txbuf);
208             }
209         } else if (retval != -EAGAIN) {
210             error = -retval;
211         }
212     }
213
214     if (!error) {
215         if (s->rxbuf.size < 2) {
216             n = 2 - s->rxbuf.size;
217         } else {
218             uint16_t frame_len;
219
220             frame_len = ntohs(get_unaligned_be16(s->rxbuf.data));
221             if (frame_len < ETH_HEADER_LEN) {
222                 error = EPROTO;
223                 n = 0;
224             } else {
225                 n = (2 + frame_len) - s->rxbuf.size;
226             }
227         }
228     }
229     if (!error) {
230         int retval;
231
232         ofpbuf_prealloc_tailroom(&s->rxbuf, n);
233         retval = stream_recv(s->stream, ofpbuf_tail(&s->rxbuf), n);
234
235         if (retval > 0) {
236             s->rxbuf.size += retval;
237             if (retval == n && s->rxbuf.size > 2) {
238                 ofpbuf_pull(&s->rxbuf, 2);
239                 netdev_dummy_queue_packet(dev,
240                                           ofpbuf_clone(&s->rxbuf));
241                 ofpbuf_clear(&s->rxbuf);
242             }
243         } else if (retval != -EAGAIN) {
244             error = (retval < 0 ? -retval
245                      : s->rxbuf.size ? EPROTO
246                      : EOF);
247         }
248     }
249
250     return error;
251 }
252
253 static void
254 dummy_packet_stream_close(struct dummy_packet_stream *s)
255 {
256     stream_close(s->stream);
257     ofpbuf_uninit(&s->rxbuf);
258     ofpbuf_list_delete(&s->txq);
259 }
260
261 static void
262 dummy_packet_conn_init(struct dummy_packet_conn *conn)
263 {
264     memset(conn, 0, sizeof *conn);
265     conn->type = NONE;
266 }
267
268 static void
269 dummy_packet_conn_get_config(struct dummy_packet_conn *conn, struct smap *args)
270 {
271
272     switch (conn->type) {
273     case PASSIVE:
274         smap_add(args, "pstream", pstream_get_name(conn->u.pconn.pstream));
275         break;
276
277     case ACTIVE:
278         smap_add(args, "stream", stream_get_name(conn->u.rconn.rstream->stream));
279         break;
280
281     case NONE:
282     default:
283         break;
284     }
285 }
286
287 static void
288 dummy_packet_conn_close(struct dummy_packet_conn *conn)
289 {
290     int i;
291     struct dummy_packet_pconn *pconn = &conn->u.pconn;
292     struct dummy_packet_rconn *rconn = &conn->u.rconn;
293
294     switch (conn->type) {
295     case PASSIVE:
296         pstream_close(pconn->pstream);
297         for (i = 0; i < pconn->n_streams; i++) {
298             dummy_packet_stream_close(&pconn->streams[i]);
299         }
300         free(pconn->streams);
301         pconn->pstream = NULL;
302         pconn->streams = NULL;
303         break;
304
305     case ACTIVE:
306         dummy_packet_stream_close(rconn->rstream);
307         free(rconn->rstream);
308         rconn->rstream = NULL;
309         reconnect_destroy(rconn->reconnect);
310         rconn->reconnect = NULL;
311         break;
312
313     case NONE:
314     default:
315         break;
316     }
317
318     conn->type = NONE;
319     memset(conn, 0, sizeof *conn);
320 }
321
322 static void
323 dummy_packet_conn_set_config(struct dummy_packet_conn *conn,
324                              const struct smap *args)
325 {
326     const char *pstream = smap_get(args, "pstream");
327     const char *stream = smap_get(args, "stream");
328
329     if (pstream && stream) {
330          VLOG_WARN("Open failed: both %s and %s are configured",
331                    pstream, stream);
332          return;
333     }
334
335     switch (conn->type) {
336     case PASSIVE:
337         if (!strcmp(pstream_get_name(conn->u.pconn.pstream), pstream)) {
338             return;
339         }
340         dummy_packet_conn_close(conn);
341         break;
342     case ACTIVE:
343         if (!strcmp(stream_get_name(conn->u.rconn.rstream->stream), stream)) {
344             return;
345         }
346         dummy_packet_conn_close(conn);
347         break;
348     case NONE:
349     default:
350         break;
351     }
352
353     if (pstream) {
354         int error;
355
356         error = pstream_open(pstream, &conn->u.pconn.pstream, DSCP_DEFAULT);
357         if (error) {
358             VLOG_WARN("%s: open failed (%s)", pstream, ovs_strerror(error));
359         } else {
360             conn->type = PASSIVE;
361         }
362     }
363
364     if (stream) {
365         int error;
366         struct stream *active_stream;
367         struct reconnect *reconnect;;
368
369         reconnect = reconnect_create(time_msec());
370         reconnect_set_name(reconnect, stream);
371         reconnect_set_passive(reconnect, false, time_msec());
372         reconnect_enable(reconnect, time_msec());
373         reconnect_set_backoff(reconnect, 100, INT_MAX);
374         reconnect_set_probe_interval(reconnect, 0);
375         conn->u.rconn.reconnect = reconnect;
376         conn->type = ACTIVE;
377
378         error = stream_open(stream, &active_stream, DSCP_DEFAULT);
379         conn->u.rconn.rstream = dummy_packet_stream_create(active_stream);
380
381         switch (error) {
382         case 0:
383             reconnect_connected(reconnect, time_msec());
384             break;
385
386         case EAGAIN:
387             reconnect_connecting(reconnect, time_msec());
388             break;
389
390         default:
391             reconnect_connect_failed(reconnect, time_msec(), error);
392             stream_close(active_stream);
393             conn->u.rconn.rstream->stream = NULL;
394             break;
395         }
396     }
397 }
398
399 static void
400 dummy_pconn_run(struct netdev_dummy *dev)
401     OVS_REQUIRES(dev->mutex)
402 {
403     struct stream *new_stream;
404     struct dummy_packet_pconn *pconn = &dev->conn.u.pconn;
405     int error;
406     size_t i;
407
408     error = pstream_accept(pconn->pstream, &new_stream);
409     if (!error) {
410         struct dummy_packet_stream *s;
411
412         pconn->streams = xrealloc(pconn->streams,
413                                 ((pconn->n_streams + 1)
414                                  * sizeof *s));
415         s = &pconn->streams[pconn->n_streams++];
416         dummy_packet_stream_init(s, new_stream);
417     } else if (error != EAGAIN) {
418         VLOG_WARN("%s: accept failed (%s)",
419                   pstream_get_name(pconn->pstream), ovs_strerror(error));
420         pstream_close(pconn->pstream);
421         pconn->pstream = NULL;
422         dev->conn.type = NONE;
423     }
424
425     for (i = 0; i < pconn->n_streams; i++) {
426         struct dummy_packet_stream *s = &pconn->streams[i];
427
428         error = dummy_packet_stream_run(dev, s);
429         if (error) {
430             VLOG_DBG("%s: closing connection (%s)",
431                      stream_get_name(s->stream),
432                      ovs_retval_to_string(error));
433             dummy_packet_stream_close(s);
434             pconn->streams[i] = pconn->streams[--pconn->n_streams];
435         }
436     }
437 }
438
439 static void
440 dummy_rconn_run(struct netdev_dummy *dev)
441 OVS_REQUIRES(dev->mutex)
442 {
443     struct dummy_packet_rconn *rconn = &dev->conn.u.rconn;
444
445     switch (reconnect_run(rconn->reconnect, time_msec())) {
446     case RECONNECT_CONNECT:
447         {
448             int error;
449
450             if (rconn->rstream->stream) {
451                 error = stream_connect(rconn->rstream->stream);
452             } else {
453                 error = stream_open(reconnect_get_name(rconn->reconnect),
454                                     &rconn->rstream->stream, DSCP_DEFAULT);
455             }
456
457             switch (error) {
458             case 0:
459                 reconnect_connected(rconn->reconnect, time_msec());
460                 break;
461
462             case EAGAIN:
463                 reconnect_connecting(rconn->reconnect, time_msec());
464                 break;
465
466             default:
467                 reconnect_connect_failed(rconn->reconnect, time_msec(), error);
468                 stream_close(rconn->rstream->stream);
469                 rconn->rstream->stream = NULL;
470                 break;
471             }
472         }
473         break;
474
475     case RECONNECT_DISCONNECT:
476     case RECONNECT_PROBE:
477     default:
478         break;
479     }
480
481     if (reconnect_is_connected(rconn->reconnect)) {
482         int err;
483
484         err = dummy_packet_stream_run(dev, rconn->rstream);
485
486         if (err) {
487             reconnect_disconnected(rconn->reconnect, time_msec(), err);
488             stream_close(rconn->rstream->stream);
489             rconn->rstream->stream = NULL;
490         }
491     }
492 }
493
494 static void
495 dummy_packet_conn_run(struct netdev_dummy *dev)
496     OVS_REQUIRES(dev->mutex)
497 {
498     switch (dev->conn.type) {
499     case PASSIVE:
500         dummy_pconn_run(dev);
501         break;
502
503     case ACTIVE:
504         dummy_rconn_run(dev);
505         break;
506
507     case NONE:
508     default:
509         break;
510     }
511 }
512
513 static void
514 dummy_packet_conn_wait(struct dummy_packet_conn *conn)
515 {
516     int i;
517     switch (conn->type) {
518     case PASSIVE:
519         pstream_wait(conn->u.pconn.pstream);
520         for (i = 0; i < conn->u.pconn.n_streams; i++) {
521             struct dummy_packet_stream *s = &conn->u.pconn.streams[i];
522             dummy_packet_stream_wait(s);
523         }
524         break;
525     case ACTIVE:
526         if (reconnect_is_connected(conn->u.rconn.reconnect)) {
527             dummy_packet_stream_wait(conn->u.rconn.rstream);
528         }
529         break;
530
531     case NONE:
532     default:
533         break;
534     }
535 }
536
537 static void
538 dummy_packet_conn_send(struct dummy_packet_conn *conn,
539                        const void *buffer, size_t size)
540 {
541     int i;
542
543     switch (conn->type) {
544     case PASSIVE:
545         for (i = 0; i < conn->u.pconn.n_streams; i++) {
546             struct dummy_packet_stream *s = &conn->u.pconn.streams[i];
547
548             dummy_packet_stream_send(s, buffer, size);
549             pstream_wait(conn->u.pconn.pstream);
550         }
551         break;
552
553     case ACTIVE:
554         if (reconnect_is_connected(conn->u.rconn.reconnect)) {
555             dummy_packet_stream_send(conn->u.rconn.rstream, buffer, size);
556             dummy_packet_stream_wait(conn->u.rconn.rstream);
557         }
558         break;
559
560     case NONE:
561     default:
562         break;
563     }
564 }
565
566 static void
567 netdev_dummy_run(void)
568 {
569     struct netdev_dummy *dev;
570
571     ovs_mutex_lock(&dummy_list_mutex);
572     LIST_FOR_EACH (dev, list_node, &dummy_list) {
573         ovs_mutex_lock(&dev->mutex);
574         dummy_packet_conn_run(dev);
575         ovs_mutex_unlock(&dev->mutex);
576     }
577     ovs_mutex_unlock(&dummy_list_mutex);
578 }
579
580 static void
581 netdev_dummy_wait(void)
582 {
583     struct netdev_dummy *dev;
584
585     ovs_mutex_lock(&dummy_list_mutex);
586     LIST_FOR_EACH (dev, list_node, &dummy_list) {
587         ovs_mutex_lock(&dev->mutex);
588         dummy_packet_conn_wait(&dev->conn);
589         ovs_mutex_unlock(&dev->mutex);
590     }
591     ovs_mutex_unlock(&dummy_list_mutex);
592 }
593
594 static struct netdev *
595 netdev_dummy_alloc(void)
596 {
597     struct netdev_dummy *netdev = xzalloc(sizeof *netdev);
598     return &netdev->up;
599 }
600
601 static int
602 netdev_dummy_construct(struct netdev *netdev_)
603 {
604     static atomic_uint next_n = ATOMIC_VAR_INIT(0xaa550000);
605     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
606     unsigned int n;
607
608     atomic_add(&next_n, 1, &n);
609
610     ovs_mutex_init(&netdev->mutex);
611     ovs_mutex_lock(&netdev->mutex);
612     netdev->hwaddr[0] = 0xaa;
613     netdev->hwaddr[1] = 0x55;
614     netdev->hwaddr[2] = n >> 24;
615     netdev->hwaddr[3] = n >> 16;
616     netdev->hwaddr[4] = n >> 8;
617     netdev->hwaddr[5] = n;
618     netdev->mtu = 1500;
619     netdev->flags = 0;
620     netdev->ifindex = -EOPNOTSUPP;
621
622     dummy_packet_conn_init(&netdev->conn);
623
624     list_init(&netdev->rxes);
625     ovs_mutex_unlock(&netdev->mutex);
626
627     ovs_mutex_lock(&dummy_list_mutex);
628     list_push_back(&dummy_list, &netdev->list_node);
629     ovs_mutex_unlock(&dummy_list_mutex);
630
631     return 0;
632 }
633
634 static void
635 netdev_dummy_destruct(struct netdev *netdev_)
636 {
637     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
638
639     ovs_mutex_lock(&dummy_list_mutex);
640     list_remove(&netdev->list_node);
641     ovs_mutex_unlock(&dummy_list_mutex);
642
643     ovs_mutex_lock(&netdev->mutex);
644     dummy_packet_conn_close(&netdev->conn);
645     netdev->conn.type = NONE;
646
647     ovs_mutex_unlock(&netdev->mutex);
648     ovs_mutex_destroy(&netdev->mutex);
649 }
650
651 static void
652 netdev_dummy_dealloc(struct netdev *netdev_)
653 {
654     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
655
656     free(netdev);
657 }
658
659 static int
660 netdev_dummy_get_config(const struct netdev *netdev_, struct smap *args)
661 {
662     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
663
664     ovs_mutex_lock(&netdev->mutex);
665
666     if (netdev->ifindex >= 0) {
667         smap_add_format(args, "ifindex", "%d", netdev->ifindex);
668     }
669
670     dummy_packet_conn_get_config(&netdev->conn, args);
671
672     ovs_mutex_unlock(&netdev->mutex);
673     return 0;
674 }
675
676 static int
677 netdev_dummy_set_config(struct netdev *netdev_, const struct smap *args)
678 {
679     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
680     const char *pcap;
681
682     ovs_mutex_lock(&netdev->mutex);
683     netdev->ifindex = smap_get_int(args, "ifindex", -EOPNOTSUPP);
684
685     dummy_packet_conn_set_config(&netdev->conn, args);
686
687     if (netdev->rx_pcap) {
688         fclose(netdev->rx_pcap);
689     }
690     if (netdev->tx_pcap && netdev->tx_pcap != netdev->rx_pcap) {
691         fclose(netdev->tx_pcap);
692     }
693     netdev->rx_pcap = netdev->tx_pcap = NULL;
694     pcap = smap_get(args, "pcap");
695     if (pcap) {
696         netdev->rx_pcap = netdev->tx_pcap = ovs_pcap_open(pcap, "ab");
697     } else {
698         const char *rx_pcap = smap_get(args, "rx_pcap");
699         const char *tx_pcap = smap_get(args, "tx_pcap");
700
701         if (rx_pcap) {
702             netdev->rx_pcap = ovs_pcap_open(rx_pcap, "ab");
703         }
704         if (tx_pcap) {
705             netdev->tx_pcap = ovs_pcap_open(tx_pcap, "ab");
706         }
707     }
708
709     ovs_mutex_unlock(&netdev->mutex);
710
711     return 0;
712 }
713
714 static struct netdev_rx *
715 netdev_dummy_rx_alloc(void)
716 {
717     struct netdev_rx_dummy *rx = xzalloc(sizeof *rx);
718     return &rx->up;
719 }
720
721 static int
722 netdev_dummy_rx_construct(struct netdev_rx *rx_)
723 {
724     struct netdev_rx_dummy *rx = netdev_rx_dummy_cast(rx_);
725     struct netdev_dummy *netdev = netdev_dummy_cast(rx->up.netdev);
726
727     ovs_mutex_lock(&netdev->mutex);
728     list_push_back(&netdev->rxes, &rx->node);
729     list_init(&rx->recv_queue);
730     rx->recv_queue_len = 0;
731     rx->seq = seq_create();
732     ovs_mutex_unlock(&netdev->mutex);
733
734     return 0;
735 }
736
737 static void
738 netdev_dummy_rx_destruct(struct netdev_rx *rx_)
739 {
740     struct netdev_rx_dummy *rx = netdev_rx_dummy_cast(rx_);
741     struct netdev_dummy *netdev = netdev_dummy_cast(rx->up.netdev);
742
743     ovs_mutex_lock(&netdev->mutex);
744     list_remove(&rx->node);
745     ofpbuf_list_delete(&rx->recv_queue);
746     ovs_mutex_unlock(&netdev->mutex);
747     seq_destroy(rx->seq);
748 }
749
750 static void
751 netdev_dummy_rx_dealloc(struct netdev_rx *rx_)
752 {
753     struct netdev_rx_dummy *rx = netdev_rx_dummy_cast(rx_);
754
755     free(rx);
756 }
757
758 static int
759 netdev_dummy_rx_recv(struct netdev_rx *rx_, struct ofpbuf **arr, int *c)
760 {
761     struct netdev_rx_dummy *rx = netdev_rx_dummy_cast(rx_);
762     struct netdev_dummy *netdev = netdev_dummy_cast(rx->up.netdev);
763     struct ofpbuf *packet;
764
765     ovs_mutex_lock(&netdev->mutex);
766     if (!list_is_empty(&rx->recv_queue)) {
767         packet = ofpbuf_from_list(list_pop_front(&rx->recv_queue));
768         rx->recv_queue_len--;
769     } else {
770         packet = NULL;
771     }
772     ovs_mutex_unlock(&netdev->mutex);
773
774     if (!packet) {
775         return EAGAIN;
776     }
777     ovs_mutex_lock(&netdev->mutex);
778     netdev->stats.rx_packets++;
779     netdev->stats.rx_bytes += packet->size;
780     ovs_mutex_unlock(&netdev->mutex);
781
782     dp_packet_pad(packet);
783     arr[0] = packet;
784     *c = 1;
785     return 0;
786 }
787
788 static void
789 netdev_dummy_rx_wait(struct netdev_rx *rx_)
790 {
791     struct netdev_rx_dummy *rx = netdev_rx_dummy_cast(rx_);
792     struct netdev_dummy *netdev = netdev_dummy_cast(rx->up.netdev);
793     uint64_t seq = seq_read(rx->seq);
794
795     ovs_mutex_lock(&netdev->mutex);
796     if (!list_is_empty(&rx->recv_queue)) {
797         poll_immediate_wake();
798     } else {
799         seq_wait(rx->seq, seq);
800     }
801     ovs_mutex_unlock(&netdev->mutex);
802 }
803
804 static int
805 netdev_dummy_rx_drain(struct netdev_rx *rx_)
806 {
807     struct netdev_rx_dummy *rx = netdev_rx_dummy_cast(rx_);
808     struct netdev_dummy *netdev = netdev_dummy_cast(rx->up.netdev);
809
810     ovs_mutex_lock(&netdev->mutex);
811     ofpbuf_list_delete(&rx->recv_queue);
812     rx->recv_queue_len = 0;
813     ovs_mutex_unlock(&netdev->mutex);
814
815     seq_change(rx->seq);
816
817     return 0;
818 }
819
820 static int
821 netdev_dummy_send(struct netdev *netdev, const void *buffer, size_t size)
822 {
823     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
824
825     if (size < ETH_HEADER_LEN) {
826         return EMSGSIZE;
827     } else {
828         const struct eth_header *eth = buffer;
829         int max_size;
830
831         ovs_mutex_lock(&dev->mutex);
832         max_size = dev->mtu + ETH_HEADER_LEN;
833         ovs_mutex_unlock(&dev->mutex);
834
835         if (eth->eth_type == htons(ETH_TYPE_VLAN)) {
836             max_size += VLAN_HEADER_LEN;
837         }
838         if (size > max_size) {
839             return EMSGSIZE;
840         }
841     }
842
843     ovs_mutex_lock(&dev->mutex);
844     dev->stats.tx_packets++;
845     dev->stats.tx_bytes += size;
846
847     dummy_packet_conn_send(&dev->conn, buffer, size);
848
849     if (dev->tx_pcap) {
850         struct ofpbuf packet;
851
852         ofpbuf_use_const(&packet, buffer, size);
853         ovs_pcap_write(dev->tx_pcap, &packet);
854         fflush(dev->tx_pcap);
855     }
856
857     ovs_mutex_unlock(&dev->mutex);
858
859     return 0;
860 }
861
862 static int
863 netdev_dummy_set_etheraddr(struct netdev *netdev,
864                            const uint8_t mac[ETH_ADDR_LEN])
865 {
866     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
867
868     ovs_mutex_lock(&dev->mutex);
869     if (!eth_addr_equals(dev->hwaddr, mac)) {
870         memcpy(dev->hwaddr, mac, ETH_ADDR_LEN);
871         seq_change(connectivity_seq_get());
872     }
873     ovs_mutex_unlock(&dev->mutex);
874
875     return 0;
876 }
877
878 static int
879 netdev_dummy_get_etheraddr(const struct netdev *netdev,
880                            uint8_t mac[ETH_ADDR_LEN])
881 {
882     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
883
884     ovs_mutex_lock(&dev->mutex);
885     memcpy(mac, dev->hwaddr, ETH_ADDR_LEN);
886     ovs_mutex_unlock(&dev->mutex);
887
888     return 0;
889 }
890
891 static int
892 netdev_dummy_get_mtu(const struct netdev *netdev, int *mtup)
893 {
894     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
895
896     ovs_mutex_lock(&dev->mutex);
897     *mtup = dev->mtu;
898     ovs_mutex_unlock(&dev->mutex);
899
900     return 0;
901 }
902
903 static int
904 netdev_dummy_set_mtu(const struct netdev *netdev, int mtu)
905 {
906     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
907
908     ovs_mutex_lock(&dev->mutex);
909     dev->mtu = mtu;
910     ovs_mutex_unlock(&dev->mutex);
911
912     return 0;
913 }
914
915 static int
916 netdev_dummy_get_stats(const struct netdev *netdev, struct netdev_stats *stats)
917 {
918     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
919
920     ovs_mutex_lock(&dev->mutex);
921     *stats = dev->stats;
922     ovs_mutex_unlock(&dev->mutex);
923
924     return 0;
925 }
926
927 static int
928 netdev_dummy_set_stats(struct netdev *netdev, const struct netdev_stats *stats)
929 {
930     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
931
932     ovs_mutex_lock(&dev->mutex);
933     dev->stats = *stats;
934     ovs_mutex_unlock(&dev->mutex);
935
936     return 0;
937 }
938
939 static int
940 netdev_dummy_get_ifindex(const struct netdev *netdev)
941 {
942     struct netdev_dummy *dev = netdev_dummy_cast(netdev);
943     int ifindex;
944
945     ovs_mutex_lock(&dev->mutex);
946     ifindex = dev->ifindex;
947     ovs_mutex_unlock(&dev->mutex);
948
949     return ifindex;
950 }
951
952 static int
953 netdev_dummy_update_flags__(struct netdev_dummy *netdev,
954                             enum netdev_flags off, enum netdev_flags on,
955                             enum netdev_flags *old_flagsp)
956     OVS_REQUIRES(netdev->mutex)
957 {
958     if ((off | on) & ~(NETDEV_UP | NETDEV_PROMISC)) {
959         return EINVAL;
960     }
961
962     *old_flagsp = netdev->flags;
963     netdev->flags |= on;
964     netdev->flags &= ~off;
965     if (*old_flagsp != netdev->flags) {
966         seq_change(connectivity_seq_get());
967     }
968
969     return 0;
970 }
971
972 static int
973 netdev_dummy_update_flags(struct netdev *netdev_,
974                           enum netdev_flags off, enum netdev_flags on,
975                           enum netdev_flags *old_flagsp)
976 {
977     struct netdev_dummy *netdev = netdev_dummy_cast(netdev_);
978     int error;
979
980     ovs_mutex_lock(&netdev->mutex);
981     error = netdev_dummy_update_flags__(netdev, off, on, old_flagsp);
982     ovs_mutex_unlock(&netdev->mutex);
983
984     return error;
985 }
986 \f
987 /* Helper functions. */
988
989 static const struct netdev_class dummy_class = {
990     "dummy",
991     NULL,                       /* init */
992     netdev_dummy_run,
993     netdev_dummy_wait,
994
995     netdev_dummy_alloc,
996     netdev_dummy_construct,
997     netdev_dummy_destruct,
998     netdev_dummy_dealloc,
999     netdev_dummy_get_config,
1000     netdev_dummy_set_config,
1001     NULL,                       /* get_tunnel_config */
1002
1003     netdev_dummy_send,          /* send */
1004     NULL,                       /* send_wait */
1005
1006     netdev_dummy_set_etheraddr,
1007     netdev_dummy_get_etheraddr,
1008     netdev_dummy_get_mtu,
1009     netdev_dummy_set_mtu,
1010     netdev_dummy_get_ifindex,
1011     NULL,                       /* get_carrier */
1012     NULL,                       /* get_carrier_resets */
1013     NULL,                       /* get_miimon */
1014     netdev_dummy_get_stats,
1015     netdev_dummy_set_stats,
1016
1017     NULL,                       /* get_features */
1018     NULL,                       /* set_advertisements */
1019
1020     NULL,                       /* set_policing */
1021     NULL,                       /* get_qos_types */
1022     NULL,                       /* get_qos_capabilities */
1023     NULL,                       /* get_qos */
1024     NULL,                       /* set_qos */
1025     NULL,                       /* get_queue */
1026     NULL,                       /* set_queue */
1027     NULL,                       /* delete_queue */
1028     NULL,                       /* get_queue_stats */
1029     NULL,                       /* queue_dump_start */
1030     NULL,                       /* queue_dump_next */
1031     NULL,                       /* queue_dump_done */
1032     NULL,                       /* dump_queue_stats */
1033
1034     NULL,                       /* get_in4 */
1035     NULL,                       /* set_in4 */
1036     NULL,                       /* get_in6 */
1037     NULL,                       /* add_router */
1038     NULL,                       /* get_next_hop */
1039     NULL,                       /* get_status */
1040     NULL,                       /* arp_lookup */
1041
1042     netdev_dummy_update_flags,
1043
1044     netdev_dummy_rx_alloc,
1045     netdev_dummy_rx_construct,
1046     netdev_dummy_rx_destruct,
1047     netdev_dummy_rx_dealloc,
1048     netdev_dummy_rx_recv,
1049     netdev_dummy_rx_wait,
1050     netdev_dummy_rx_drain,
1051 };
1052
1053 static struct ofpbuf *
1054 eth_from_packet_or_flow(const char *s)
1055 {
1056     enum odp_key_fitness fitness;
1057     struct ofpbuf *packet;
1058     struct ofpbuf odp_key;
1059     struct flow flow;
1060     int error;
1061
1062     if (!eth_from_hex(s, &packet)) {
1063         return packet;
1064     }
1065
1066     /* Convert string to datapath key.
1067      *
1068      * It would actually be nicer to parse an OpenFlow-like flow key here, but
1069      * the code for that currently calls exit() on parse error.  We have to
1070      * settle for parsing a datapath key for now.
1071      */
1072     ofpbuf_init(&odp_key, 0);
1073     error = odp_flow_from_string(s, NULL, &odp_key, NULL);
1074     if (error) {
1075         ofpbuf_uninit(&odp_key);
1076         return NULL;
1077     }
1078
1079     /* Convert odp_key to flow. */
1080     fitness = odp_flow_key_to_flow(odp_key.data, odp_key.size, &flow);
1081     if (fitness == ODP_FIT_ERROR) {
1082         ofpbuf_uninit(&odp_key);
1083         return NULL;
1084     }
1085
1086     packet = ofpbuf_new(0);
1087     flow_compose(packet, &flow);
1088
1089     ofpbuf_uninit(&odp_key);
1090     return packet;
1091 }
1092
1093 static void
1094 netdev_dummy_queue_packet__(struct netdev_rx_dummy *rx, struct ofpbuf *packet)
1095 {
1096     list_push_back(&rx->recv_queue, &packet->list_node);
1097     rx->recv_queue_len++;
1098     seq_change(rx->seq);
1099 }
1100
1101 static void
1102 netdev_dummy_queue_packet(struct netdev_dummy *dummy, struct ofpbuf *packet)
1103     OVS_REQUIRES(dummy->mutex)
1104 {
1105     struct netdev_rx_dummy *rx, *prev;
1106
1107     if (dummy->rx_pcap) {
1108         ovs_pcap_write(dummy->rx_pcap, packet);
1109         fflush(dummy->rx_pcap);
1110     }
1111     prev = NULL;
1112     LIST_FOR_EACH (rx, node, &dummy->rxes) {
1113         if (rx->recv_queue_len < NETDEV_DUMMY_MAX_QUEUE) {
1114             if (prev) {
1115                 netdev_dummy_queue_packet__(prev, ofpbuf_clone(packet));
1116             }
1117             prev = rx;
1118         }
1119     }
1120     if (prev) {
1121         netdev_dummy_queue_packet__(prev, packet);
1122     } else {
1123         ofpbuf_delete(packet);
1124     }
1125 }
1126
1127 static void
1128 netdev_dummy_receive(struct unixctl_conn *conn,
1129                      int argc, const char *argv[], void *aux OVS_UNUSED)
1130 {
1131     struct netdev_dummy *dummy_dev;
1132     struct netdev *netdev;
1133     int i;
1134
1135     netdev = netdev_from_name(argv[1]);
1136     if (!netdev || !is_dummy_class(netdev->netdev_class)) {
1137         unixctl_command_reply_error(conn, "no such dummy netdev");
1138         goto exit;
1139     }
1140     dummy_dev = netdev_dummy_cast(netdev);
1141
1142     for (i = 2; i < argc; i++) {
1143         struct ofpbuf *packet;
1144
1145         packet = eth_from_packet_or_flow(argv[i]);
1146         if (!packet) {
1147             unixctl_command_reply_error(conn, "bad packet syntax");
1148             goto exit;
1149         }
1150
1151         ovs_mutex_lock(&dummy_dev->mutex);
1152         netdev_dummy_queue_packet(dummy_dev, packet);
1153         ovs_mutex_unlock(&dummy_dev->mutex);
1154     }
1155
1156     unixctl_command_reply(conn, NULL);
1157
1158 exit:
1159     netdev_close(netdev);
1160 }
1161
1162 static void
1163 netdev_dummy_set_admin_state__(struct netdev_dummy *dev, bool admin_state)
1164     OVS_REQUIRES(dev->mutex)
1165 {
1166     enum netdev_flags old_flags;
1167
1168     if (admin_state) {
1169         netdev_dummy_update_flags__(dev, 0, NETDEV_UP, &old_flags);
1170     } else {
1171         netdev_dummy_update_flags__(dev, NETDEV_UP, 0, &old_flags);
1172     }
1173 }
1174
1175 static void
1176 netdev_dummy_set_admin_state(struct unixctl_conn *conn, int argc,
1177                              const char *argv[], void *aux OVS_UNUSED)
1178 {
1179     bool up;
1180
1181     if (!strcasecmp(argv[argc - 1], "up")) {
1182         up = true;
1183     } else if ( !strcasecmp(argv[argc - 1], "down")) {
1184         up = false;
1185     } else {
1186         unixctl_command_reply_error(conn, "Invalid Admin State");
1187         return;
1188     }
1189
1190     if (argc > 2) {
1191         struct netdev *netdev = netdev_from_name(argv[1]);
1192         if (netdev && is_dummy_class(netdev->netdev_class)) {
1193             struct netdev_dummy *dummy_dev = netdev_dummy_cast(netdev);
1194
1195             ovs_mutex_lock(&dummy_dev->mutex);
1196             netdev_dummy_set_admin_state__(dummy_dev, up);
1197             ovs_mutex_unlock(&dummy_dev->mutex);
1198
1199             netdev_close(netdev);
1200         } else {
1201             unixctl_command_reply_error(conn, "Unknown Dummy Interface");
1202             netdev_close(netdev);
1203             return;
1204         }
1205     } else {
1206         struct netdev_dummy *netdev;
1207
1208         ovs_mutex_lock(&dummy_list_mutex);
1209         LIST_FOR_EACH (netdev, list_node, &dummy_list) {
1210             ovs_mutex_lock(&netdev->mutex);
1211             netdev_dummy_set_admin_state__(netdev, up);
1212             ovs_mutex_unlock(&netdev->mutex);
1213         }
1214         ovs_mutex_unlock(&dummy_list_mutex);
1215     }
1216     unixctl_command_reply(conn, "OK");
1217 }
1218
1219 void
1220 netdev_dummy_register(bool override)
1221 {
1222     unixctl_command_register("netdev-dummy/receive", "NAME PACKET|FLOW...",
1223                              2, INT_MAX, netdev_dummy_receive, NULL);
1224     unixctl_command_register("netdev-dummy/set-admin-state",
1225                              "[netdev] up|down", 1, 2,
1226                              netdev_dummy_set_admin_state, NULL);
1227
1228     if (override) {
1229         struct sset types;
1230         const char *type;
1231
1232         sset_init(&types);
1233         netdev_enumerate_types(&types);
1234         SSET_FOR_EACH (type, &types) {
1235             if (!strcmp(type, "patch")) {
1236                 continue;
1237             }
1238             if (!netdev_unregister_provider(type)) {
1239                 struct netdev_class *class;
1240                 int error;
1241
1242                 class = xmemdup(&dummy_class, sizeof dummy_class);
1243                 class->type = xstrdup(type);
1244                 error = netdev_register_provider(class);
1245                 if (error) {
1246                     VLOG_ERR("%s: failed to register netdev provider (%s)",
1247                              type, ovs_strerror(error));
1248                     free(CONST_CAST(char *, class->type));
1249                     free(class);
1250                 }
1251             }
1252         }
1253         sset_destroy(&types);
1254     }
1255     netdev_register_provider(&dummy_class);
1256
1257     netdev_vport_tunnel_register();
1258 }