vppinfra: add clib_mem_vm_ext_alloc function
[vpp.git] / src / plugins / memif / memif.c
1 /*
2  *------------------------------------------------------------------
3  * Copyright (c) 2017 Cisco and/or its affiliates.
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
18
19 #define _GNU_SOURCE
20 #include <stdint.h>
21 #include <net/if.h>
22 #include <sys/types.h>
23 #include <fcntl.h>
24 #include <sys/ioctl.h>
25 #include <sys/socket.h>
26 #include <sys/un.h>
27 #include <sys/uio.h>
28 #include <sys/mman.h>
29 #include <sys/prctl.h>
30 #include <sys/eventfd.h>
31 #include <inttypes.h>
32 #include <limits.h>
33
34 #include <vlib/vlib.h>
35 #include <vlib/unix/unix.h>
36 #include <vppinfra/linux/syscall.h>
37 #include <vnet/plugin/plugin.h>
38 #include <vnet/ethernet/ethernet.h>
39 #include <vpp/app/version.h>
40 #include <memif/memif.h>
41 #include <memif/private.h>
42
43 memif_main_t memif_main;
44
45 static u32
46 memif_eth_flag_change (vnet_main_t * vnm, vnet_hw_interface_t * hi, u32 flags)
47 {
48   /* nothing for now */
49   return 0;
50 }
51
52 static void
53 memif_queue_intfd_close (memif_queue_t * mq)
54 {
55   if (mq->int_clib_file_index != ~0)
56     {
57       memif_file_del_by_index (mq->int_clib_file_index);
58       mq->int_clib_file_index = ~0;
59       mq->int_fd = -1;
60     }
61   else if (mq->int_fd > -1)
62     {
63       close (mq->int_fd);
64       mq->int_fd = -1;
65     }
66 }
67
68 void
69 memif_disconnect (memif_if_t * mif, clib_error_t * err)
70 {
71   memif_main_t *mm = &memif_main;
72   vnet_main_t *vnm = vnet_get_main ();
73   memif_region_t *mr;
74   memif_queue_t *mq;
75   int i;
76
77   if (mif == 0)
78     return;
79
80   DBG ("disconnect %u (%v)", mif->dev_instance, err ? err->what : 0);
81
82   if (err)
83     {
84       clib_error_t *e = 0;
85       mif->local_disc_string = vec_dup (err->what);
86       if (mif->conn_fd > -1)
87         e = memif_msg_send_disconnect (mif, err);
88       clib_error_free (e);
89     }
90
91   /* set interface down */
92   mif->flags &= ~(MEMIF_IF_FLAG_CONNECTED | MEMIF_IF_FLAG_CONNECTING);
93   if (mif->hw_if_index != ~0)
94     vnet_hw_interface_set_flags (vnm, mif->hw_if_index, 0);
95
96   /* close connection socket */
97   if (mif->conn_clib_file_index != ~0)
98     {
99       memif_socket_file_t *msf = vec_elt_at_index (mm->socket_files,
100                                                    mif->socket_file_index);
101       hash_unset (msf->dev_instance_by_fd, mif->conn_fd);
102       memif_file_del_by_index (mif->conn_clib_file_index);
103       mif->conn_clib_file_index = ~0;
104     }
105   else if (mif->conn_fd > -1)
106     close (mif->conn_fd);
107   mif->conn_fd = -1;
108
109   vec_foreach_index (i, mif->rx_queues)
110   {
111     mq = vec_elt_at_index (mif->rx_queues, i);
112     if (mq->ring)
113       {
114         int rv;
115         rv = vnet_hw_interface_unassign_rx_thread (vnm, mif->hw_if_index, i);
116         if (rv)
117           DBG ("Warning: unable to unassign interface %d, "
118                "queue %d: rc=%d", mif->hw_if_index, i, rv);
119         mq->ring = 0;
120       }
121   }
122
123   /* free tx and rx queues */
124   vec_foreach (mq, mif->rx_queues) memif_queue_intfd_close (mq);
125   vec_free (mif->rx_queues);
126
127   vec_foreach (mq, mif->tx_queues) memif_queue_intfd_close (mq);
128   vec_free (mif->tx_queues);
129
130   /* free memory regions */
131   vec_foreach (mr, mif->regions)
132   {
133     int rv;
134     if ((rv = munmap (mr->shm, mr->region_size)))
135       clib_warning ("munmap failed, rv = %d", rv);
136     if (mr->fd > -1)
137       close (mr->fd);
138   }
139   vec_free (mif->regions);
140
141   mif->remote_pid = 0;
142   vec_free (mif->remote_name);
143   vec_free (mif->remote_if_name);
144   clib_fifo_free (mif->msg_queue);
145 }
146
147 static clib_error_t *
148 memif_int_fd_read_ready (clib_file_t * uf)
149 {
150   memif_main_t *mm = &memif_main;
151   vnet_main_t *vnm = vnet_get_main ();
152   u16 qid = uf->private_data & 0xFFFF;
153   memif_if_t *mif = vec_elt_at_index (mm->interfaces, uf->private_data >> 16);
154   memif_queue_t *mq = vec_elt_at_index (mif->rx_queues, qid);
155   u64 b;
156   ssize_t size;
157
158   size = read (uf->file_descriptor, &b, sizeof (b));
159   if (size < 0)
160     {
161       DBG_UNIX_LOG ("Failed to read from socket");
162       return 0;
163     }
164
165   vnet_device_input_set_interrupt_pending (vnm, mif->hw_if_index, qid);
166   mq->int_count++;
167
168   return 0;
169 }
170
171
172 clib_error_t *
173 memif_connect (memif_if_t * mif)
174 {
175   vnet_main_t *vnm = vnet_get_main ();
176   clib_file_t template = { 0 };
177   memif_region_t *mr;
178   int i;
179
180   DBG ("connect %u", mif->dev_instance);
181
182   vec_free (mif->local_disc_string);
183   vec_free (mif->remote_disc_string);
184
185   vec_foreach (mr, mif->regions)
186   {
187     if (mr->shm)
188       continue;
189
190     if (mr->fd < 0)
191       clib_error_return (0, "no memory region fd");
192
193     if ((mr->shm = mmap (NULL, mr->region_size, PROT_READ | PROT_WRITE,
194                          MAP_SHARED, mr->fd, 0)) == MAP_FAILED)
195       return clib_error_return_unix (0, "mmap");
196   }
197
198   template.read_function = memif_int_fd_read_ready;
199
200   vec_foreach_index (i, mif->tx_queues)
201   {
202     memif_queue_t *mq = vec_elt_at_index (mif->tx_queues, i);
203
204     mq->ring = mif->regions[mq->region].shm + mq->offset;
205     if (mq->ring->cookie != MEMIF_COOKIE)
206       return clib_error_return (0, "wrong cookie on tx ring %u", i);
207   }
208
209   vec_foreach_index (i, mif->rx_queues)
210   {
211     memif_queue_t *mq = vec_elt_at_index (mif->rx_queues, i);
212     int rv;
213
214     mq->ring = mif->regions[mq->region].shm + mq->offset;
215     if (mq->ring->cookie != MEMIF_COOKIE)
216       return clib_error_return (0, "wrong cookie on tx ring %u", i);
217
218     if (mq->int_fd > -1)
219       {
220         template.file_descriptor = mq->int_fd;
221         template.private_data = (mif->dev_instance << 16) | (i & 0xFFFF);
222         memif_file_add (&mq->int_clib_file_index, &template);
223       }
224     vnet_hw_interface_assign_rx_thread (vnm, mif->hw_if_index, i, ~0);
225     rv = vnet_hw_interface_set_rx_mode (vnm, mif->hw_if_index, i,
226                                         VNET_HW_INTERFACE_RX_MODE_DEFAULT);
227     if (rv)
228       clib_warning
229         ("Warning: unable to set rx mode for interface %d queue %d: "
230          "rc=%d", mif->hw_if_index, i, rv);
231     else
232       {
233         vnet_hw_interface_rx_mode rxmode;
234         vnet_hw_interface_get_rx_mode (vnm, mif->hw_if_index, i, &rxmode);
235
236         if (rxmode == VNET_HW_INTERFACE_RX_MODE_POLLING)
237           mq->ring->flags |= MEMIF_RING_FLAG_MASK_INT;
238       }
239   }
240
241   mif->flags &= ~MEMIF_IF_FLAG_CONNECTING;
242   mif->flags |= MEMIF_IF_FLAG_CONNECTED;
243
244   vnet_hw_interface_set_flags (vnm, mif->hw_if_index,
245                                VNET_HW_INTERFACE_FLAG_LINK_UP);
246   return 0;
247 }
248
249 static_always_inline memif_ring_t *
250 memif_get_ring (memif_if_t * mif, memif_ring_type_t type, u16 ring_num)
251 {
252   if (vec_len (mif->regions) == 0)
253     return NULL;
254   void *p = mif->regions[0].shm;
255   int ring_size =
256     sizeof (memif_ring_t) +
257     sizeof (memif_desc_t) * (1 << mif->run.log2_ring_size);
258   p += (ring_num + type * mif->run.num_s2m_rings) * ring_size;
259
260   return (memif_ring_t *) p;
261 }
262
263 clib_error_t *
264 memif_init_regions_and_queues (memif_if_t * mif)
265 {
266   memif_ring_t *ring = NULL;
267   int i, j;
268   u64 buffer_offset;
269   memif_region_t *r;
270   clib_mem_vm_alloc_t alloc = { 0 };
271   clib_error_t *err;
272
273   vec_validate_aligned (mif->regions, 0, CLIB_CACHE_LINE_BYTES);
274   r = vec_elt_at_index (mif->regions, 0);
275
276   buffer_offset = (mif->run.num_s2m_rings + mif->run.num_m2s_rings) *
277     (sizeof (memif_ring_t) +
278      sizeof (memif_desc_t) * (1 << mif->run.log2_ring_size));
279
280   r->region_size = buffer_offset +
281     mif->run.buffer_size * (1 << mif->run.log2_ring_size) *
282     (mif->run.num_s2m_rings + mif->run.num_m2s_rings);
283
284   alloc.name = "memif region";
285   alloc.size = r->region_size;
286   alloc.flags = CLIB_MEM_VM_F_SHARED;
287
288   err = clib_mem_vm_ext_alloc (&alloc);
289   if (err)
290     return err;
291
292   r->fd = alloc.fd;
293
294   for (i = 0; i < mif->run.num_s2m_rings; i++)
295     {
296       ring = memif_get_ring (mif, MEMIF_RING_S2M, i);
297       ring->head = ring->tail = 0;
298       ring->cookie = MEMIF_COOKIE;
299       for (j = 0; j < (1 << mif->run.log2_ring_size); j++)
300         {
301           u16 slot = i * (1 << mif->run.log2_ring_size) + j;
302           ring->desc[j].region = 0;
303           ring->desc[j].offset =
304             buffer_offset + (u32) (slot * mif->run.buffer_size);
305           ring->desc[j].buffer_length = mif->run.buffer_size;
306         }
307     }
308   for (i = 0; i < mif->run.num_m2s_rings; i++)
309     {
310       ring = memif_get_ring (mif, MEMIF_RING_M2S, i);
311       ring->head = ring->tail = 0;
312       ring->cookie = MEMIF_COOKIE;
313       for (j = 0; j < (1 << mif->run.log2_ring_size); j++)
314         {
315           u16 slot =
316             (i + mif->run.num_s2m_rings) * (1 << mif->run.log2_ring_size) + j;
317           ring->desc[j].region = 0;
318           ring->desc[j].offset =
319             buffer_offset + (u32) (slot * mif->run.buffer_size);
320           ring->desc[j].buffer_length = mif->run.buffer_size;
321         }
322     }
323
324   ASSERT (mif->tx_queues == 0);
325   vec_validate_aligned (mif->tx_queues, mif->run.num_s2m_rings - 1,
326                         CLIB_CACHE_LINE_BYTES);
327   vec_foreach_index (i, mif->tx_queues)
328   {
329     memif_queue_t *mq = vec_elt_at_index (mif->tx_queues, i);
330     if ((mq->int_fd = eventfd (0, EFD_NONBLOCK)) < 0)
331       return clib_error_return_unix (0, "eventfd[tx queue %u]", i);
332     mq->int_clib_file_index = ~0;
333     mq->ring = memif_get_ring (mif, MEMIF_RING_S2M, i);
334     mq->log2_ring_size = mif->cfg.log2_ring_size;
335     mq->region = 0;
336     mq->offset = (void *) mq->ring - (void *) mif->regions[mq->region].shm;
337     mq->last_head = 0;
338   }
339
340   ASSERT (mif->rx_queues == 0);
341   vec_validate_aligned (mif->rx_queues, mif->run.num_m2s_rings - 1,
342                         CLIB_CACHE_LINE_BYTES);
343   vec_foreach_index (i, mif->rx_queues)
344   {
345     memif_queue_t *mq = vec_elt_at_index (mif->rx_queues, i);
346     if ((mq->int_fd = eventfd (0, EFD_NONBLOCK)) < 0)
347       return clib_error_return_unix (0, "eventfd[rx queue %u]", i);
348     mq->int_clib_file_index = ~0;
349     mq->ring = memif_get_ring (mif, MEMIF_RING_M2S, i);
350     mq->log2_ring_size = mif->cfg.log2_ring_size;
351     mq->region = 0;
352     mq->offset = (void *) mq->ring - (void *) mif->regions[mq->region].shm;
353     mq->last_head = 0;
354   }
355
356   return 0;
357 }
358
359 static uword
360 memif_process (vlib_main_t * vm, vlib_node_runtime_t * rt, vlib_frame_t * f)
361 {
362   memif_main_t *mm = &memif_main;
363   memif_if_t *mif;
364   struct sockaddr_un sun;
365   int sockfd;
366   uword *event_data = 0, event_type;
367   u8 enabled = 0;
368   f64 start_time, last_run_duration = 0, now;
369
370   sockfd = socket (AF_UNIX, SOCK_SEQPACKET, 0);
371   if (sockfd < 0)
372     {
373       DBG_UNIX_LOG ("socket AF_UNIX");
374       return 0;
375     }
376   sun.sun_family = AF_UNIX;
377
378   while (1)
379     {
380       if (enabled)
381         vlib_process_wait_for_event_or_clock (vm, (f64) 3 -
382                                               last_run_duration);
383       else
384         vlib_process_wait_for_event (vm);
385
386       event_type = vlib_process_get_events (vm, &event_data);
387       vec_reset_length (event_data);
388
389       switch (event_type)
390         {
391         case ~0:
392           break;
393         case MEMIF_PROCESS_EVENT_START:
394           enabled = 1;
395           break;
396         case MEMIF_PROCESS_EVENT_STOP:
397           enabled = 0;
398           continue;
399         default:
400           ASSERT (0);
401         }
402
403       last_run_duration = start_time = vlib_time_now (vm);
404       /* *INDENT-OFF* */
405       pool_foreach (mif, mm->interfaces,
406         ({
407           memif_socket_file_t * msf = vec_elt_at_index (mm->socket_files, mif->socket_file_index);
408           /* Allow no more than 10us without a pause */
409           now = vlib_time_now (vm);
410           if (now > start_time + 10e-6)
411             {
412               vlib_process_suspend (vm, 100e-6);        /* suspend for 100 us */
413               start_time = vlib_time_now (vm);
414             }
415
416           if ((mif->flags & MEMIF_IF_FLAG_ADMIN_UP) == 0)
417             continue;
418
419           if (mif->flags & MEMIF_IF_FLAG_CONNECTING)
420             continue;
421
422           if (mif->flags & MEMIF_IF_FLAG_CONNECTED)
423             continue;
424
425           if (mif->flags & MEMIF_IF_FLAG_IS_SLAVE)
426             {
427               strncpy (sun.sun_path, (char *) msf->filename,
428                        sizeof (sun.sun_path) - 1);
429
430               if (connect
431                   (sockfd, (struct sockaddr *) &sun,
432                    sizeof (struct sockaddr_un)) == 0)
433                 {
434                   clib_file_t t = { 0 };
435
436                   mif->conn_fd = sockfd;
437                   t.read_function = memif_slave_conn_fd_read_ready;
438                   t.write_function = memif_slave_conn_fd_write_ready;
439                   t.error_function = memif_slave_conn_fd_error;
440                   t.file_descriptor = mif->conn_fd;
441                   t.private_data = mif->dev_instance;
442                   memif_file_add (&mif->conn_clib_file_index, &t);
443                   hash_set (msf->dev_instance_by_fd, mif->conn_fd, mif->dev_instance);
444
445                   mif->flags |= MEMIF_IF_FLAG_CONNECTING;
446
447                   /* grab another fd */
448                   sockfd = socket (AF_UNIX, SOCK_SEQPACKET, 0);
449                   if (sockfd < 0)
450                     {
451                       DBG_UNIX_LOG ("socket AF_UNIX");
452                       return 0;
453                     }
454                 }
455             }
456         }));
457       /* *INDENT-ON* */
458       last_run_duration = vlib_time_now (vm) - last_run_duration;
459     }
460   return 0;
461 }
462
463 /* *INDENT-OFF* */
464 VLIB_REGISTER_NODE (memif_process_node,static) = {
465   .function = memif_process,
466   .type = VLIB_NODE_TYPE_PROCESS,
467   .name = "memif-process",
468 };
469 /* *INDENT-ON* */
470
471 int
472 memif_delete_if (vlib_main_t * vm, memif_if_t * mif)
473 {
474   vnet_main_t *vnm = vnet_get_main ();
475   memif_main_t *mm = &memif_main;
476   memif_socket_file_t *msf =
477     vec_elt_at_index (mm->socket_files, mif->socket_file_index);
478   clib_error_t *err;
479
480   mif->flags |= MEMIF_IF_FLAG_DELETING;
481   vec_free (mif->local_disc_string);
482   vec_free (mif->remote_disc_string);
483
484   /* bring down the interface */
485   vnet_hw_interface_set_flags (vnm, mif->hw_if_index, 0);
486   vnet_sw_interface_set_flags (vnm, mif->sw_if_index, 0);
487
488   err = clib_error_return (0, "interface deleted");
489   memif_disconnect (mif, err);
490   clib_error_free (err);
491
492   /* remove the interface */
493   if (mif->mode == MEMIF_INTERFACE_MODE_IP)
494     vnet_delete_hw_interface (vnm, mif->hw_if_index);
495   else
496     ethernet_delete_interface (vnm, mif->hw_if_index);
497   mif->hw_if_index = ~0;
498
499   /* free interface data structures */
500   clib_spinlock_free (&mif->lockp);
501   mhash_unset (&msf->dev_instance_by_id, &mif->id, 0);
502
503   /* remove socket file */
504   if (--(msf->ref_cnt) == 0)
505     {
506       if (msf->is_listener)
507         {
508           uword *x;
509           memif_file_del_by_index (msf->clib_file_index);
510           vec_foreach (x, msf->pending_file_indices)
511           {
512             memif_file_del_by_index (*x);
513           }
514           vec_free (msf->pending_file_indices);
515         }
516       mhash_free (&msf->dev_instance_by_id);
517       hash_free (msf->dev_instance_by_fd);
518       mhash_unset (&mm->socket_file_index_by_filename, msf->filename, 0);
519       vec_free (msf->filename);
520       pool_put (mm->socket_files, msf);
521     }
522
523   memset (mif, 0, sizeof (*mif));
524   pool_put (mm->interfaces, mif);
525
526   if (pool_elts (mm->interfaces) == 0)
527     vlib_process_signal_event (vm, memif_process_node.index,
528                                MEMIF_PROCESS_EVENT_STOP, 0);
529
530   return 0;
531 }
532
533 /* *INDENT-OFF* */
534 VNET_HW_INTERFACE_CLASS (memif_ip_hw_if_class, static) =
535 {
536   .name = "memif-ip",
537   .flags = VNET_HW_INTERFACE_CLASS_FLAG_P2P,
538 };
539 /* *INDENT-ON* */
540
541 int
542 memif_create_if (vlib_main_t * vm, memif_create_if_args_t * args)
543 {
544   memif_main_t *mm = &memif_main;
545   vlib_thread_main_t *tm = vlib_get_thread_main ();
546   vnet_main_t *vnm = vnet_get_main ();
547   memif_if_t *mif = 0;
548   vnet_sw_interface_t *sw;
549   clib_error_t *error = 0;
550   int ret = 0;
551   uword *p;
552   vnet_hw_interface_t *hw;
553   memif_socket_file_t *msf = 0;
554   u8 *socket_filename;
555   int rv = 0;
556
557   if (args->socket_filename == 0 || args->socket_filename[0] != '/')
558     {
559       clib_error_t *error;
560       error = vlib_unix_recursive_mkdir (vlib_unix_get_runtime_dir ());
561       if (error)
562         {
563           clib_error_free (error);
564           return VNET_API_ERROR_SYSCALL_ERROR_1;
565         }
566
567       if (args->socket_filename == 0)
568         socket_filename = format (0, "%s/%s%c", vlib_unix_get_runtime_dir (),
569                                   MEMIF_DEFAULT_SOCKET_FILENAME, 0);
570       else
571         socket_filename = format (0, "%s/%s%c", vlib_unix_get_runtime_dir (),
572                                   args->socket_filename, 0);
573
574     }
575   else
576     socket_filename = vec_dup (args->socket_filename);
577
578   p = mhash_get (&mm->socket_file_index_by_filename, socket_filename);
579
580   if (p)
581     {
582       msf = vec_elt_at_index (mm->socket_files, p[0]);
583
584       /* existing socket file can be either master or slave but cannot be both */
585       if (!msf->is_listener != !args->is_master)
586         {
587           rv = VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
588           goto done;
589         }
590
591       p = mhash_get (&msf->dev_instance_by_id, &args->id);
592       if (p)
593         {
594           rv = VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
595           goto done;
596         }
597     }
598
599   /* Create new socket file */
600   if (msf == 0)
601     {
602       struct stat file_stat;
603       /* If we are creating listener make sure file doesn't exist or if it
604        * exists thn delete it if it is old socket file */
605       if (args->is_master &&
606           (stat ((char *) socket_filename, &file_stat) == 0))
607         {
608           if (S_ISSOCK (file_stat.st_mode))
609             {
610               unlink ((char *) socket_filename);
611             }
612           else
613             {
614               error = clib_error_return (0, "File exists for %s",
615                                          socket_filename);
616               clib_error_report (error);
617               rv = VNET_API_ERROR_VALUE_EXIST;
618               goto done;
619             }
620         }
621       pool_get (mm->socket_files, msf);
622       memset (msf, 0, sizeof (memif_socket_file_t));
623       mhash_init (&msf->dev_instance_by_id, sizeof (uword),
624                   sizeof (memif_interface_id_t));
625       msf->dev_instance_by_fd = hash_create (0, sizeof (uword));
626       msf->filename = socket_filename;
627       msf->fd = -1;
628       msf->is_listener = (args->is_master != 0);
629       socket_filename = 0;
630       mhash_set (&mm->socket_file_index_by_filename, msf->filename,
631                  msf - mm->socket_files, 0);
632       DBG ("creating socket file %s", msf->filename);
633     }
634
635   pool_get (mm->interfaces, mif);
636   memset (mif, 0, sizeof (*mif));
637   mif->dev_instance = mif - mm->interfaces;
638   mif->socket_file_index = msf - mm->socket_files;
639   mif->id = args->id;
640   mif->sw_if_index = mif->hw_if_index = mif->per_interface_next_index = ~0;
641   mif->conn_clib_file_index = ~0;
642   mif->conn_fd = -1;
643   mif->mode = args->mode;
644   if (args->secret)
645     mif->secret = vec_dup (args->secret);
646
647   if (tm->n_vlib_mains > 1)
648     clib_spinlock_init (&mif->lockp);
649
650
651   if (mif->mode == MEMIF_INTERFACE_MODE_ETHERNET)
652     {
653
654       if (!args->hw_addr_set)
655         {
656           f64 now = vlib_time_now (vm);
657           u32 rnd;
658           rnd = (u32) (now * 1e6);
659           rnd = random_u32 (&rnd);
660
661           memcpy (args->hw_addr + 2, &rnd, sizeof (rnd));
662           args->hw_addr[0] = 2;
663           args->hw_addr[1] = 0xfe;
664         }
665       error = ethernet_register_interface (vnm, memif_device_class.index,
666                                            mif->dev_instance, args->hw_addr,
667                                            &mif->hw_if_index,
668                                            memif_eth_flag_change);
669     }
670   else if (mif->mode == MEMIF_INTERFACE_MODE_IP)
671     {
672       mif->hw_if_index =
673         vnet_register_interface (vnm, memif_device_class.index,
674                                  mif->dev_instance,
675                                  memif_ip_hw_if_class.index,
676                                  mif->dev_instance);
677     }
678   else
679     error = clib_error_return (0, "unsupported interface mode");
680
681   if (error)
682     {
683       clib_error_report (error);
684       ret = VNET_API_ERROR_SYSCALL_ERROR_2;
685       goto error;
686     }
687
688   sw = vnet_get_hw_sw_interface (vnm, mif->hw_if_index);
689   mif->sw_if_index = sw->sw_if_index;
690
691   mif->cfg.log2_ring_size = args->log2_ring_size;
692   mif->cfg.buffer_size = args->buffer_size;
693   mif->cfg.num_s2m_rings =
694     args->is_master ? args->rx_queues : args->tx_queues;
695   mif->cfg.num_m2s_rings =
696     args->is_master ? args->tx_queues : args->rx_queues;
697
698   args->sw_if_index = mif->sw_if_index;
699
700   /* If this is new one, start listening */
701   if (msf->is_listener && msf->ref_cnt == 0)
702     {
703       struct sockaddr_un un = { 0 };
704       struct stat file_stat;
705       int on = 1;
706
707       if ((msf->fd = socket (AF_UNIX, SOCK_SEQPACKET, 0)) < 0)
708         {
709           ret = VNET_API_ERROR_SYSCALL_ERROR_4;
710           goto error;
711         }
712
713       un.sun_family = AF_UNIX;
714       strncpy ((char *) un.sun_path, (char *) msf->filename,
715                sizeof (un.sun_path) - 1);
716
717       if (setsockopt (msf->fd, SOL_SOCKET, SO_PASSCRED, &on, sizeof (on)) < 0)
718         {
719           ret = VNET_API_ERROR_SYSCALL_ERROR_5;
720           goto error;
721         }
722       if (bind (msf->fd, (struct sockaddr *) &un, sizeof (un)) == -1)
723         {
724           ret = VNET_API_ERROR_SYSCALL_ERROR_6;
725           goto error;
726         }
727       if (listen (msf->fd, 1) == -1)
728         {
729           ret = VNET_API_ERROR_SYSCALL_ERROR_7;
730           goto error;
731         }
732
733       if (stat ((char *) msf->filename, &file_stat) == -1)
734         {
735           ret = VNET_API_ERROR_SYSCALL_ERROR_8;
736           goto error;
737         }
738
739       msf->clib_file_index = ~0;
740       clib_file_t template = { 0 };
741       template.read_function = memif_conn_fd_accept_ready;
742       template.file_descriptor = msf->fd;
743       template.private_data = mif->socket_file_index;
744       memif_file_add (&msf->clib_file_index, &template);
745     }
746
747   msf->ref_cnt++;
748
749   if (args->is_master == 0)
750     mif->flags |= MEMIF_IF_FLAG_IS_SLAVE;
751
752   hw = vnet_get_hw_interface (vnm, mif->hw_if_index);
753   hw->flags |= VNET_HW_INTERFACE_FLAG_SUPPORTS_INT_MODE;
754   vnet_hw_interface_set_input_node (vnm, mif->hw_if_index,
755                                     memif_input_node.index);
756
757   mhash_set (&msf->dev_instance_by_id, &mif->id, mif->dev_instance, 0);
758
759   if (pool_elts (mm->interfaces) == 1)
760     {
761       vlib_process_signal_event (vm, memif_process_node.index,
762                                  MEMIF_PROCESS_EVENT_START, 0);
763     }
764   goto done;
765
766 error:
767   if (mif->hw_if_index != ~0)
768     {
769       if (mif->mode == MEMIF_INTERFACE_MODE_IP)
770         vnet_delete_hw_interface (vnm, mif->hw_if_index);
771       else
772         ethernet_delete_interface (vnm, mif->hw_if_index);
773       mif->hw_if_index = ~0;
774     }
775   memif_delete_if (vm, mif);
776   return ret;
777
778 done:
779   vec_free (socket_filename);
780   return rv;
781 }
782
783
784 static clib_error_t *
785 memif_init (vlib_main_t * vm)
786 {
787   memif_main_t *mm = &memif_main;
788   vlib_thread_main_t *tm = vlib_get_thread_main ();
789
790   memset (mm, 0, sizeof (memif_main_t));
791
792   /* initialize binary API */
793   memif_plugin_api_hookup (vm);
794
795   mhash_init_c_string (&mm->socket_file_index_by_filename, sizeof (uword));
796
797   vec_validate_aligned (mm->rx_buffers, tm->n_vlib_mains - 1,
798                         CLIB_CACHE_LINE_BYTES);
799
800   return 0;
801 }
802
803 VLIB_INIT_FUNCTION (memif_init);
804
805 /* *INDENT-OFF* */
806 VLIB_PLUGIN_REGISTER () = {
807     .version = VPP_BUILD_VER,
808     .description = "Packet Memory Interface (experimetal)",
809 };
810 /* *INDENT-ON* */
811
812 /*
813  * fd.io coding-style-patch-verification: ON
814  *
815  * Local Variables:
816  * eval: (c-set-style "gnu")
817  * End:
818  */