UDP Encap counters
[vpp.git] / src / vpp / stats / stats.c
index b07dc17..3fe03e4 100644 (file)
@@ -16,7 +16,9 @@
 #include <signal.h>
 #include <vnet/fib/ip4_fib.h>
 #include <vnet/fib/fib_entry.h>
+#include <vnet/mfib/mfib_entry.h>
 #include <vnet/dpo/load_balance.h>
+#include <vnet/udp/udp_encap.h>
 
 #define STATS_DEBUG 0
 
@@ -49,16 +51,21 @@ _(VNET_INTERFACE_SIMPLE_COUNTERS, vnet_interface_simple_counters)   \
 _(WANT_INTERFACE_SIMPLE_STATS, want_interface_simple_stats)    \
 _(VNET_INTERFACE_COMBINED_COUNTERS, vnet_interface_combined_counters)  \
 _(WANT_INTERFACE_COMBINED_STATS, want_interface_combined_stats)        \
+_(WANT_PER_INTERFACE_COMBINED_STATS, want_per_interface_combined_stats)        \
+_(WANT_PER_INTERFACE_SIMPLE_STATS, want_per_interface_simple_stats) \
 _(VNET_IP4_FIB_COUNTERS, vnet_ip4_fib_counters)                                \
 _(WANT_IP4_FIB_STATS, want_ip4_fib_stats)            \
 _(VNET_IP6_FIB_COUNTERS, vnet_ip6_fib_counters)                                \
 _(WANT_IP6_FIB_STATS, want_ip6_fib_stats)        \
+_(WANT_IP4_MFIB_STATS, want_ip4_mfib_stats)                             \
+_(WANT_IP6_MFIB_STATS, want_ip6_mfib_stats)                             \
 _(VNET_IP4_NBR_COUNTERS, vnet_ip4_nbr_counters)                                \
 _(WANT_IP4_NBR_STATS, want_ip4_nbr_stats)            \
 _(VNET_IP6_NBR_COUNTERS, vnet_ip6_nbr_counters) \
 _(WANT_IP6_NBR_STATS, want_ip6_nbr_stats) \
-_(VNET_GET_SUMMARY_STATS, vnet_get_summary_stats)
-
+_(VNET_GET_SUMMARY_STATS, vnet_get_summary_stats) \
+_(STATS_GET_POLLER_DELAY, stats_get_poller_delay) \
+_(WANT_UDP_ENCAP_STATS, want_udp_encap_stats)
 
 #define vl_msg_name_crc_list
 #include <vpp/stats/stats.api.h>
@@ -78,6 +85,9 @@ setup_message_id_table (api_main_t * am)
 #define COMBINED_COUNTER_BATCH_SIZE    63
 #define IP4_FIB_COUNTER_BATCH_SIZE     48
 #define IP6_FIB_COUNTER_BATCH_SIZE     30
+#define IP4_MFIB_COUNTER_BATCH_SIZE    24
+#define IP6_MFIB_COUNTER_BATCH_SIZE    15
+#define UDP_ENCAP_COUNTER_BATCH_SIZE   (1024 / sizeof(vl_api_udp_encap_counter_t))
 
 /* 5ms */
 #define STATS_RELEASE_DELAY_NS (1000 * 1000 * 5)
@@ -187,7 +197,7 @@ format_vnet_interface_simple_counters (u8 * s, va_list * args)
   return s;
 }
 
-void
+static void
 dslock (stats_main_t * sm, int release_hint, int tag)
 {
   u32 thread_index;
@@ -220,7 +230,7 @@ stats_dslock_with_hint (int hint, int tag)
   dslock (sm, hint, tag);
 }
 
-void
+static void
 dsunlock (stats_main_t * sm)
 {
   u32 thread_index;
@@ -248,6 +258,192 @@ stats_dsunlock (int hint, int tag)
   dsunlock (sm);
 }
 
+static vpe_client_registration_t *
+get_client_for_stat (u32 reg, u32 item, u32 client_index)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_stats_registration_t *registration;
+  uword *p;
+
+  /* Is there anything listening for item in that reg */
+  p = hash_get (sm->stats_registration_hash[reg], item);
+
+  if (!p)
+    return 0;                  // Fail
+
+  /* If there is, is our client_index one of them */
+  registration = pool_elt_at_index (sm->stats_registrations[reg], p[0]);
+  p = hash_get (registration->client_hash, client_index);
+
+  if (!p)
+    return 0;                  // Fail
+
+  return pool_elt_at_index (registration->clients, p[0]);
+
+}
+
+static int
+set_client_for_stat (u32 reg, u32 item, vpe_client_registration_t * client)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_stats_registration_t *registration;
+  vpe_client_registration_t *cr;
+  uword *p;
+
+  /* Is there anything listening for item in that reg */
+  p = hash_get (sm->stats_registration_hash[reg], item);
+
+  if (!p)
+    {
+      pool_get (sm->stats_registrations[reg], registration);
+      registration->item = item;
+      hash_set (sm->stats_registration_hash[reg], item,
+               registration - sm->stats_registrations[reg]);
+    }
+  else
+    {
+      registration = pool_elt_at_index (sm->stats_registrations[reg], p[0]);
+    }
+
+  p = hash_get (registration->client_hash, client->client_index);
+
+  if (!p)
+    {
+      pool_get (registration->clients, cr);
+      cr->client_index = client->client_index;
+      cr->client_pid = client->client_pid;
+      hash_set (registration->client_hash, cr->client_index,
+               cr - registration->clients);
+    }
+
+  return 1;                    //At least one client is doing something ... poll
+}
+
+int
+clear_client_for_stat (u32 reg, u32 item, u32 client_index)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_stats_registration_t *registration;
+  vpe_client_registration_t *client;
+  uword *p;
+  int i, elts;
+
+  /* Clear the client first */
+  /* Is there anything listening for item in that reg */
+  p = hash_get (sm->stats_registration_hash[reg], item);
+
+  if (!p)
+    goto exit;
+
+  /* If there is, is our client_index one of them */
+  registration = pool_elt_at_index (sm->stats_registrations[reg], p[0]);
+  p = hash_get (registration->client_hash, client_index);
+
+  if (!p)
+    goto exit;
+
+  client = pool_elt_at_index (registration->clients, p[0]);
+  hash_unset (registration->client_hash, client->client_index);
+  pool_put (registration->clients, client);
+
+  /* Now check if that was the last client for that item */
+  if (0 == pool_elts (registration->clients))
+    {
+      hash_unset (sm->stats_registration_hash[reg], item);
+      pool_put (sm->stats_registrations[reg], registration);
+    }
+
+exit:
+  elts = 0;
+  /* Now check if that was the last item in any of the listened to stats */
+  for (i = 0; i < STATS_REG_N_IDX; i++)
+    {
+      elts += pool_elts (sm->stats_registrations[i]);
+    }
+  return elts;
+}
+
+vpe_client_registration_t *
+get_clients_for_stat (u32 reg, u32 item)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_registration_t *client, *clients = 0;
+  vpe_client_stats_registration_t *registration;
+  uword *p;
+
+  /* Is there anything listening for item in that reg */
+  p = hash_get (sm->stats_registration_hash[reg], item);
+
+  if (!p)
+    return 0;                  // Fail
+
+  /* If there is, is our client_index one of them */
+  registration = pool_elt_at_index (sm->stats_registrations[reg], p[0]);
+
+  vec_reset_length (clients);
+  pool_foreach (client, registration->clients, (
+                                                {
+                                                vec_add1 (clients, *client);}
+               ));
+  return clients;
+}
+
+
+static void
+clear_client_reg (u32 ** registrations)
+{
+  /* When registrations[x] is a vector of pool indices
+     here is a good place to clean up the pools
+   */
+#define stats_reg(n) vec_free(registrations[IDX_##n]);
+#include <vpp/stats/stats.reg>
+#undef stats_reg
+
+  vec_free (registrations);
+}
+
+u32 **
+init_client_reg (u32 ** registrations)
+{
+
+  /*
+     Initialise the stats registrations for each
+     type of stat a client can register for as well as
+     a vector of "interested" indexes.
+     Initially this is a u32 of either sw_if_index or fib_index
+     but eventually this should migrate to a pool_index (u32)
+     with a type specific pool that can include more complex things
+     such as timing and structured events.
+   */
+  vec_validate (registrations, STATS_REG_N_IDX);
+#define stats_reg(n) \
+  vec_reset_length(registrations[IDX_##n]);
+#include <vpp/stats/stats.reg>
+#undef stats_reg
+
+  /*
+     When registrations[x] is a vector of pool indices, here
+     is a good place to init the pools.
+   */
+  return registrations;
+}
+
+u32 **
+enable_all_client_reg (u32 ** registrations)
+{
+
+  /*
+     Enable all stats known by adding
+     ~0 to the index vector. Eventually this
+     should be deprecated.
+   */
+#define stats_reg(n)                            \
+  vec_add1(registrations[IDX_##n], ~0);
+#include <vpp/stats/stats.reg>
+#undef stats_reg
+  return registrations;
+}
+
 static void
 do_simple_interface_counters (stats_main_t * sm)
 {
@@ -255,7 +451,7 @@ do_simple_interface_counters (stats_main_t * sm)
   vnet_interface_main_t *im = sm->interface_main;
   api_main_t *am = sm->api_main;
   vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
-  unix_shared_memory_queue_t *q = shmem_hdr->vl_input_queue;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
   vlib_simple_counter_main_t *cm;
   u32 items_this_message = 0;
   u64 v, *vp = 0;
@@ -302,6 +498,130 @@ do_simple_interface_counters (stats_main_t * sm)
   vnet_interface_counter_unlock (im);
 }
 
+void
+handle_client_registration (vpe_client_registration_t * client, u32 stat,
+                           u32 item, int enable_disable)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_registration_t *rp, _rp;
+
+  rp = get_client_for_stat (stat, item, client->client_index);
+
+  /* Disable case */
+  if (enable_disable == 0)
+    {
+      if (!rp)                 // No client to disable
+       {
+         clib_warning ("pid %d: already disabled for stats...",
+                       client->client_pid);
+         return;
+       }
+      sm->enable_poller =
+       clear_client_for_stat (stat, item, client->client_index);
+      return;
+    }
+  /* Enable case */
+  if (!rp)
+    {
+      rp = &_rp;
+      rp->client_index = client->client_index;
+      rp->client_pid = client->client_pid;
+      sm->enable_poller = set_client_for_stat (stat, item, rp);
+    }
+}
+
+
+/**********************************
+ * ALL Interface Combined stats - to be deprecated
+ **********************************/
+
+/*
+ * This API should be deprecated as _per_interface_ works with ~0 as sw_if_index.
+ */
+static void
+  vl_api_want_interface_combined_stats_t_handler
+  (vl_api_want_interface_combined_stats_t * mp)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_registration_t rp;
+  vl_api_want_interface_combined_stats_reply_t *rmp;
+  uword *p;
+  i32 retval = 0;
+  vl_api_registration_t *reg;
+  u32 swif;
+
+  swif = ~0;                   //Using same mechanism as _per_interface_
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
+
+  handle_client_registration (&rp, IDX_PER_INTERFACE_COMBINED_COUNTERS, swif,
+                             mp->enable_disable);
+
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
+    {
+      sm->enable_poller =
+       clear_client_for_stat (IDX_PER_INTERFACE_COMBINED_COUNTERS, swif,
+                              mp->client_index);
+      return;
+    }
+
+  rmp = vl_msg_api_alloc (sizeof (*rmp));
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_INTERFACE_COMBINED_STATS_REPLY);
+  rmp->context = mp->context;
+  rmp->retval = retval;
+
+  vl_api_send_msg (reg, (u8 *) rmp);
+}
+
+static void
+  vl_api_vnet_interface_combined_counters_t_handler
+  (vl_api_vnet_interface_combined_counters_t * mp)
+{
+  vpe_client_registration_t *clients, client;
+  stats_main_t *sm = &stats_main;
+  vl_api_registration_t *reg, *reg_prev = NULL;
+  vl_api_vnet_interface_combined_counters_t *mp_copy = NULL;
+  u32 mp_size;
+  int i;
+
+  mp_size = sizeof (*mp) + (ntohl (mp->count) * sizeof (vlib_counter_t));
+
+  clients =
+    get_clients_for_stat (IDX_PER_INTERFACE_COMBINED_COUNTERS,
+                         ~0 /*flag for all */ );
+
+  for (i = 0; i < vec_len (clients); i++)
+    {
+      client = clients[i];
+      reg = vl_api_client_index_to_registration (client.client_index);
+      if (reg)
+       {
+         if (reg_prev && vl_api_can_send_msg (reg_prev))
+           {
+             mp_copy = vl_msg_api_alloc_as_if_client (mp_size);
+             clib_memcpy (mp_copy, mp, mp_size);
+             vl_api_send_msg (reg_prev, (u8 *) mp);
+             mp = mp_copy;
+           }
+         reg_prev = reg;
+       }
+    }
+#if STATS_DEBUG > 0
+  fformat (stdout, "%U\n", format_vnet_combined_counters, mp);
+#endif
+
+  if (reg_prev && vl_api_can_send_msg (reg_prev))
+    {
+      vl_api_send_msg (reg_prev, (u8 *) mp);
+    }
+  else
+    {
+      vl_msg_api_free (mp);
+    }
+}
+
 static void
 do_combined_interface_counters (stats_main_t * sm)
 {
@@ -309,7 +629,7 @@ do_combined_interface_counters (stats_main_t * sm)
   vnet_interface_main_t *im = sm->interface_main;
   api_main_t *am = sm->api_main;
   vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
-  unix_shared_memory_queue_t *q = shmem_hdr->vl_input_queue;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
   vlib_combined_counter_main_t *cm;
   u32 items_this_message = 0;
   vlib_counter_t v, *vp = 0;
@@ -354,98 +674,518 @@ do_combined_interface_counters (stats_main_t * sm)
   vnet_interface_counter_unlock (im);
 }
 
+/**********************************
+ * Per Interface Combined stats
+ **********************************/
+
+/* Request from client registering interfaces it wants */
 static void
-ip46_fib_stats_delay (stats_main_t * sm, u32 sec, u32 nsec)
+  vl_api_want_per_interface_combined_stats_t_handler
+  (vl_api_want_per_interface_combined_stats_t * mp)
 {
-  struct timespec _req, *req = &_req;
-  struct timespec _rem, *rem = &_rem;
+  stats_main_t *sm = &stats_main;
+  vpe_client_registration_t rp;
+  vl_api_want_per_interface_combined_stats_reply_t *rmp;
+  vlib_combined_counter_main_t *cm;
+  uword *p;
+  i32 retval = 0;
+  vl_api_registration_t *reg;
+  u32 i, swif, num = 0;
 
-  req->tv_sec = sec;
-  req->tv_nsec = nsec;
-  while (1)
-    {
-      if (nanosleep (req, rem) == 0)
-       break;
-      *req = *rem;
-      if (errno == EINTR)
-       continue;
-      clib_unix_warning ("nanosleep");
-      break;
-    }
-}
+  num = ntohl (mp->num);
 
-/**
- * @brief The context passed when collecting adjacency counters
- */
-typedef struct ip4_nbr_stats_ctx_t_
-{
-  /**
-   * The SW IF index all these adjs belong to
+  /*
+   * Validate sw_if_indexes before registering
    */
-  u32 sw_if_index;
+  for (i = 0; i < num; i++)
+    {
+      swif = ntohl (mp->sw_ifs[i]);
 
-  /**
-   * A vector of ip4 nbr counters
-   */
-  vl_api_ip4_nbr_counter_t *counters;
-} ip4_nbr_stats_ctx_t;
+      /*
+       * Check its a real sw_if_index that the client is allowed to see
+       */
+      if (swif != ~0)
+       {
+         if (pool_is_free_index (sm->interface_main->sw_interfaces, swif))
+           {
+             retval = VNET_API_ERROR_INVALID_SW_IF_INDEX;
+             goto reply;
+           }
+       }
+    }
 
-static adj_walk_rc_t
-ip4_nbr_stats_cb (adj_index_t ai, void *arg)
-{
-  vl_api_ip4_nbr_counter_t *vl_counter;
-  vlib_counter_t adj_counter;
-  ip4_nbr_stats_ctx_t *ctx;
-  ip_adjacency_t *adj;
+  for (i = 0; i < num; i++)
+    {
+      swif = ntohl (mp->sw_ifs[i]);
 
-  ctx = arg;
-  vlib_get_combined_counter (&adjacency_counters, ai, &adj_counter);
+      rp.client_index = mp->client_index;
+      rp.client_pid = mp->pid;
+      handle_client_registration (&rp, IDX_PER_INTERFACE_COMBINED_COUNTERS,
+                                 swif, ntohl (mp->enable_disable));
+    }
 
-  if (0 != adj_counter.packets)
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
     {
-      vec_add2 (ctx->counters, vl_counter, 1);
-      adj = adj_get (ai);
+      for (i = 0; i < num; i++)
+       {
+         swif = ntohl (mp->sw_ifs[i]);
 
-      vl_counter->packets = clib_host_to_net_u64 (adj_counter.packets);
-      vl_counter->bytes = clib_host_to_net_u64 (adj_counter.bytes);
-      vl_counter->address = adj->sub_type.nbr.next_hop.ip4.as_u32;
-      vl_counter->link_type = adj->ia_link;
+         sm->enable_poller =
+           clear_client_for_stat (IDX_PER_INTERFACE_COMBINED_COUNTERS, swif,
+                                  mp->client_index);
+       }
+      return;
     }
-  return (ADJ_WALK_RC_CONTINUE);
-}
 
-#define MIN(x,y) (((x)<(y))?(x):(y))
+  rmp = vl_msg_api_alloc (sizeof (*rmp));
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_PER_INTERFACE_COMBINED_STATS_REPLY);
+  rmp->context = mp->context;
+  rmp->retval = retval;
+
+  vl_api_send_msg (reg, (u8 *) rmp);
+}
 
+/* Per Interface Combined distribution to client */
 static void
-ip4_nbr_ship (stats_main_t * sm, ip4_nbr_stats_ctx_t * ctx)
+do_combined_per_interface_counters (stats_main_t * sm)
 {
+  vl_api_vnet_per_interface_combined_counters_t *mp = 0;
+  vnet_interface_main_t *im = sm->interface_main;
   api_main_t *am = sm->api_main;
   vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
-  unix_shared_memory_queue_t *q = shmem_hdr->vl_input_queue;
-  vl_api_vnet_ip4_nbr_counters_t *mp = 0;
-  int first = 0;
+  vl_api_registration_t *vl_reg;
+  vlib_combined_counter_main_t *cm;
+  vl_api_vnet_combined_counter_t *vp = 0;
+  vlib_counter_t v;
+  u32 i, j;
+  vpe_client_stats_registration_t *reg;
+  vpe_client_registration_t *client;
+  u32 *sw_if_index = 0;
 
-  /*
-   * If the walk context has counters, which may be left over from the last
-   * suspend, then we continue from there.
-   */
-  while (0 != vec_len (ctx->counters))
-    {
-      u32 n_items = MIN (vec_len (ctx->counters),
-                        IP4_FIB_COUNTER_BATCH_SIZE);
-      u8 pause = 0;
+  vnet_interface_counter_lock (im);
 
-      dslock (sm, 0 /* release hint */ , 1 /* tag */ );
+  vec_reset_length (sm->regs_tmp);
 
-      mp = vl_msg_api_alloc_as_if_client (sizeof (*mp) +
-                                         (n_items *
-                                          sizeof
-                                          (vl_api_ip4_nbr_counter_t)));
-      mp->_vl_msg_id = ntohs (VL_API_VNET_IP4_NBR_COUNTERS);
-      mp->count = ntohl (n_items);
-      mp->sw_if_index = ntohl (ctx->sw_if_index);
-      mp->begin = first;
-      first = 0;
+  /* *INDENT-OFF* */
+  pool_foreach (reg,
+                sm->stats_registrations[IDX_PER_INTERFACE_COMBINED_COUNTERS],
+               ({ vec_add1 (sm->regs_tmp, reg); }));
+  /* *INDENT-ON* */
+
+  for (i = 0; i < vec_len (sm->regs_tmp); i++)
+    {
+      reg = sm->regs_tmp[i];
+      if (reg->item == ~0)
+       {
+         vnet_interface_counter_unlock (im);
+         do_combined_interface_counters (sm);
+         vnet_interface_counter_lock (im);
+         continue;
+       }
+      vec_reset_length (sm->clients_tmp);
+
+      /* *INDENT-OFF* */
+      pool_foreach (client, reg->clients, ({ vec_add1 (sm->clients_tmp,
+                                                     client);}));
+      /* *INDENT-ON* */
+
+      for (j = 0; j < vec_len (sm->clients_tmp); j++)
+       {
+         client = sm->clients_tmp[j];
+
+         vl_reg = vl_api_client_index_to_registration (client->client_index);
+
+         //Client may have disconnected abrubtly, clean up so we don't poll nothing.
+         if (!vl_reg)
+           {
+             sm->enable_poller =
+               clear_client_for_stat (IDX_PER_INTERFACE_COMBINED_COUNTERS,
+                                      reg->item, client->client_index);
+             continue;
+           }
+         mp = vl_msg_api_alloc_as_if_client (sizeof (*mp) + sizeof (*vp));
+         memset (mp, 0, sizeof (*mp));
+
+         mp->_vl_msg_id =
+           ntohs (VL_API_VNET_PER_INTERFACE_COMBINED_COUNTERS);
+
+         /*
+          * count will eventually be used to optimise the batching
+          * of per client messages for each stat. For now setting this to 1 then
+          * iterate. This will not affect API.
+          *
+          * FIXME instead of enqueueing here, this should be sent to a batch
+          * storer for per-client transmission. Each "mp" sent would be a single entry
+          * and if a client is listening to other sw_if_indexes for same, it would be
+          * appended to that *mp
+          *
+          *
+          * FIXME(s):
+          * - capturing the timestamp of the counters "when VPP knew them" is important.
+          * Less so is that the timing of the delivery to the control plane be in the same
+          * timescale.
+
+          * i.e. As long as the control plane can delta messages from VPP and work out
+          * velocity etc based on the timestamp, it can do so in a more "batch mode".
+
+          * It would be beneficial to keep a "per-client" message queue, and then
+          * batch all the stat messages for a client into one message, with
+          * discrete timestamps.
+
+          * Given this particular API is for "per interface" one assumes that the scale
+          * is less than the ~0 case, which the prior API is suited for.
+          */
+
+         /*
+          * 1 message per api call for now
+          */
+         mp->count = htonl (1);
+         mp->timestamp = htonl (vlib_time_now (sm->vlib_main));
+
+         vp = (vl_api_vnet_combined_counter_t *) mp->data;
+         vp->sw_if_index = htonl (reg->item);
+
+         im = &vnet_get_main ()->interface_main;
+         cm = im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_RX;
+         vlib_get_combined_counter (cm, reg->item, &v);
+         clib_mem_unaligned (&vp->rx_packets, u64) =
+           clib_host_to_net_u64 (v.packets);
+         clib_mem_unaligned (&vp->rx_bytes, u64) =
+           clib_host_to_net_u64 (v.bytes);
+         cm = im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX;
+         vlib_get_combined_counter (cm, reg->item, &v);
+         clib_mem_unaligned (&vp->tx_packets, u64) =
+           clib_host_to_net_u64 (v.packets);
+         clib_mem_unaligned (&vp->tx_bytes, u64) =
+           clib_host_to_net_u64 (v.bytes);
+
+         vl_api_send_msg (vl_reg, (u8 *) mp);
+       }
+    }
+
+  vnet_interface_counter_unlock (im);
+}
+
+/**********************************
+ * Per Interface simple stats
+ **********************************/
+
+/* Request from client registering interfaces it wants */
+static void
+  vl_api_want_per_interface_simple_stats_t_handler
+  (vl_api_want_per_interface_simple_stats_t * mp)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_registration_t rp;
+  vl_api_want_per_interface_simple_stats_reply_t *rmp;
+  vlib_simple_counter_main_t *cm;
+  uword *p;
+  i32 retval = 0;
+  vl_api_registration_t *reg;
+  u32 i, swif, num = 0;
+
+  num = ntohl (mp->num);
+
+  for (i = 0; i < num; i++)
+    {
+      swif = ntohl (mp->sw_ifs[i]);
+
+      /* Check its a real sw_if_index that the client is allowed to see */
+      if (swif != ~0)
+       {
+         if (pool_is_free_index (sm->interface_main->sw_interfaces, swif))
+           {
+             retval = VNET_API_ERROR_INVALID_SW_IF_INDEX;
+             goto reply;
+           }
+       }
+    }
+
+  for (i = 0; i < num; i++)
+    {
+      swif = ntohl (mp->sw_ifs[i]);
+
+      rp.client_index = mp->client_index;
+      rp.client_pid = mp->pid;
+      handle_client_registration (&rp, IDX_PER_INTERFACE_SIMPLE_COUNTERS,
+                                 swif, ntohl (mp->enable_disable));
+    }
+
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
+
+  /* Client may have disconnected abruptly, clean up */
+  if (!reg)
+    {
+      for (i = 0; i < num; i++)
+       {
+         swif = ntohl (mp->sw_ifs[i]);
+         sm->enable_poller =
+           clear_client_for_stat (IDX_PER_INTERFACE_SIMPLE_COUNTERS, swif,
+                                  mp->client_index);
+       }
+
+      return;
+    }
+
+
+  rmp = vl_msg_api_alloc (sizeof (*rmp));
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_PER_INTERFACE_SIMPLE_STATS_REPLY);
+  rmp->context = mp->context;
+  rmp->retval = retval;
+
+  vl_api_send_msg (reg, (u8 *) rmp);
+}
+
+/* Per Interface Simple distribution to client */
+static void
+do_simple_per_interface_counters (stats_main_t * sm)
+{
+  vl_api_vnet_per_interface_simple_counters_t *mp = 0;
+  vnet_interface_main_t *im = sm->interface_main;
+  api_main_t *am = sm->api_main;
+  vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
+  vl_api_registration_t *vl_reg;
+  vlib_simple_counter_main_t *cm;
+  u32 i, j, size;
+  vpe_client_stats_registration_t *reg;
+  vpe_client_registration_t *client;
+  u32 timestamp, count;
+  vl_api_vnet_simple_counter_t *vp = 0;
+  counter_t v;
+
+  vnet_interface_counter_lock (im);
+
+  vec_reset_length (sm->regs_tmp);
+
+  /* *INDENT-OFF* */
+  pool_foreach (reg,
+               sm->stats_registrations[IDX_PER_INTERFACE_SIMPLE_COUNTERS],
+                ({ vec_add1 (sm->regs_tmp, reg); }));
+  /* *INDENT-ON* */
+
+  for (i = 0; i < vec_len (sm->regs_tmp); i++)
+    {
+      reg = sm->regs_tmp[i];
+      if (reg->item == ~0)
+       {
+         vnet_interface_counter_unlock (im);
+         do_simple_interface_counters (sm);
+         vnet_interface_counter_lock (im);
+         continue;
+       }
+      vec_reset_length (sm->clients_tmp);
+
+      /* *INDENT-OFF* */
+      pool_foreach (client, reg->clients, ({ vec_add1 (sm->clients_tmp,
+                                                     client);}));
+      /* *INDENT-ON* */
+
+      for (j = 0; j < vec_len (sm->clients_tmp); j++)
+       {
+         client = sm->clients_tmp[j];
+         vl_reg = vl_api_client_index_to_registration (client->client_index);
+
+         /* Client may have disconnected abrubtly, clean up */
+         if (!vl_reg)
+           {
+             sm->enable_poller =
+               clear_client_for_stat (IDX_PER_INTERFACE_SIMPLE_COUNTERS,
+                                      reg->item, client->client_index);
+             continue;
+           }
+
+         mp = vl_msg_api_alloc_as_if_client (sizeof (*mp) + sizeof (*vp));
+         memset (mp, 0, sizeof (*mp));
+         mp->_vl_msg_id = ntohs (VL_API_VNET_PER_INTERFACE_SIMPLE_COUNTERS);
+
+         /*
+          * count will eventually be used to optimise the batching
+          * of per client messages for each stat. For now setting this to 1 then
+          * iterate. This will not affect API.
+          *
+          * FIXME instead of enqueueing here, this should be sent to a batch
+          * storer for per-client transmission. Each "mp" sent would be a single entry
+          * and if a client is listening to other sw_if_indexes for same, it would be
+          * appended to that *mp
+          *
+          *
+          * FIXME(s):
+          * - capturing the timestamp of the counters "when VPP knew them" is important.
+          * Less so is that the timing of the delivery to the control plane be in the same
+          * timescale.
+
+          * i.e. As long as the control plane can delta messages from VPP and work out
+          * velocity etc based on the timestamp, it can do so in a more "batch mode".
+
+          * It would be beneficial to keep a "per-client" message queue, and then
+          * batch all the stat messages for a client into one message, with
+          * discrete timestamps.
+
+          * Given this particular API is for "per interface" one assumes that the scale
+          * is less than the ~0 case, which the prior API is suited for.
+          */
+
+         /*
+          * 1 message per api call for now
+          */
+         mp->count = htonl (1);
+         mp->timestamp = htonl (vlib_time_now (sm->vlib_main));
+         vp = (vl_api_vnet_simple_counter_t *) mp->data;
+
+         vp->sw_if_index = htonl (reg->item);
+
+         // VNET_INTERFACE_COUNTER_DROP
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_DROP;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->drop, u64) = clib_host_to_net_u64 (v);
+
+         // VNET_INTERFACE_COUNTER_PUNT
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_PUNT;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->punt, u64) = clib_host_to_net_u64 (v);
+
+         // VNET_INTERFACE_COUNTER_IP4
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_IP4;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->rx_ip4, u64) = clib_host_to_net_u64 (v);
+
+         //VNET_INTERFACE_COUNTER_IP6
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_IP6;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->rx_ip6, u64) = clib_host_to_net_u64 (v);
+
+         //VNET_INTERFACE_COUNTER_RX_NO_BUF
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_RX_NO_BUF;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->rx_no_buffer, u64) =
+           clib_host_to_net_u64 (v);
+
+         //VNET_INTERFACE_COUNTER_RX_MISS
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_RX_MISS;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->rx_miss, u64) = clib_host_to_net_u64 (v);
+
+         //VNET_INTERFACE_COUNTER_RX_ERROR
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_RX_ERROR;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->rx_error, u64) = clib_host_to_net_u64 (v);
+
+         //VNET_INTERFACE_COUNTER_TX_ERROR
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_TX_ERROR;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->tx_error, u64) = clib_host_to_net_u64 (v);
+
+         //VNET_INTERFACE_COUNTER_MPLS
+         cm = im->sw_if_counters + VNET_INTERFACE_COUNTER_MPLS;
+         v = vlib_get_simple_counter (cm, reg->item);
+         clib_mem_unaligned (&vp->rx_mpls, u64) = clib_host_to_net_u64 (v);
+
+         vl_api_send_msg (vl_reg, (u8 *) mp);
+       }
+    }
+
+  vnet_interface_counter_unlock (im);
+}
+
+/**********************************
+ * Per FIB IP4 stats
+ **********************************/
+
+static void
+ip46_fib_stats_delay (stats_main_t * sm, u32 sec, u32 nsec)
+{
+  struct timespec _req, *req = &_req;
+  struct timespec _rem, *rem = &_rem;
+
+  req->tv_sec = sec;
+  req->tv_nsec = nsec;
+  while (1)
+    {
+      if (nanosleep (req, rem) == 0)
+       break;
+      *req = *rem;
+      if (errno == EINTR)
+       continue;
+      clib_unix_warning ("nanosleep");
+      break;
+    }
+}
+
+/**
+ * @brief The context passed when collecting adjacency counters
+ */
+typedef struct ip4_nbr_stats_ctx_t_
+{
+  /**
+   * The SW IF index all these adjs belong to
+   */
+  u32 sw_if_index;
+
+  /**
+   * A vector of ip4 nbr counters
+   */
+  vl_api_ip4_nbr_counter_t *counters;
+} ip4_nbr_stats_ctx_t;
+
+static adj_walk_rc_t
+ip4_nbr_stats_cb (adj_index_t ai, void *arg)
+{
+  vl_api_ip4_nbr_counter_t *vl_counter;
+  vlib_counter_t adj_counter;
+  ip4_nbr_stats_ctx_t *ctx;
+  ip_adjacency_t *adj;
+
+  ctx = arg;
+  vlib_get_combined_counter (&adjacency_counters, ai, &adj_counter);
+
+  if (0 != adj_counter.packets)
+    {
+      vec_add2 (ctx->counters, vl_counter, 1);
+      adj = adj_get (ai);
+
+      vl_counter->packets = clib_host_to_net_u64 (adj_counter.packets);
+      vl_counter->bytes = clib_host_to_net_u64 (adj_counter.bytes);
+      vl_counter->address = adj->sub_type.nbr.next_hop.ip4.as_u32;
+      vl_counter->link_type = adj->ia_link;
+    }
+  return (ADJ_WALK_RC_CONTINUE);
+}
+
+#define MIN(x,y) (((x)<(y))?(x):(y))
+
+static void
+ip4_nbr_ship (stats_main_t * sm, ip4_nbr_stats_ctx_t * ctx)
+{
+  api_main_t *am = sm->api_main;
+  vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
+  vl_api_vnet_ip4_nbr_counters_t *mp = 0;
+  int first = 0;
+
+  /*
+   * If the walk context has counters, which may be left over from the last
+   * suspend, then we continue from there.
+   */
+  while (0 != vec_len (ctx->counters))
+    {
+      u32 n_items = MIN (vec_len (ctx->counters),
+                        IP4_FIB_COUNTER_BATCH_SIZE);
+      u8 pause = 0;
+
+      dslock (sm, 0 /* release hint */ , 1 /* tag */ );
+
+      mp = vl_msg_api_alloc_as_if_client (sizeof (*mp) +
+                                         (n_items *
+                                          sizeof
+                                          (vl_api_ip4_nbr_counter_t)));
+      mp->_vl_msg_id = ntohs (VL_API_VNET_IP4_NBR_COUNTERS);
+      mp->count = ntohl (n_items);
+      mp->sw_if_index = ntohl (ctx->sw_if_index);
+      mp->begin = first;
+      first = 0;
 
       /*
        * copy the counters from the back of the context, then we can easily
@@ -461,11 +1201,11 @@ ip4_nbr_ship (stats_main_t * sm, ip4_nbr_stats_ctx_t * ctx)
       /*
        * send to the shm q
        */
-      unix_shared_memory_queue_lock (q);
-      pause = unix_shared_memory_queue_is_full (q);
+      svm_queue_lock (q);
+      pause = svm_queue_is_full (q);
 
       vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
-      unix_shared_memory_queue_unlock (q);
+      svm_queue_unlock (q);
       dsunlock (sm);
 
       if (pause)
@@ -475,7 +1215,7 @@ ip4_nbr_ship (stats_main_t * sm, ip4_nbr_stats_ctx_t * ctx)
 }
 
 static void
-do_ip4_nbrs (stats_main_t * sm)
+do_ip4_nbr_counters (stats_main_t * sm)
 {
   vnet_main_t *vnm = vnet_get_main ();
   vnet_interface_main_t *im = &vnm->interface_main;
@@ -576,7 +1316,7 @@ ip6_nbr_ship (stats_main_t * sm,
 {
   api_main_t *am = sm->api_main;
   vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
-  unix_shared_memory_queue_t *q = shmem_hdr->vl_input_queue;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
   vl_api_vnet_ip6_nbr_counters_t *mp = 0;
   int first = 0;
 
@@ -616,11 +1356,11 @@ ip6_nbr_ship (stats_main_t * sm,
       /*
        * send to the shm q
        */
-      unix_shared_memory_queue_lock (q);
-      pause = unix_shared_memory_queue_is_full (q);
+      svm_queue_lock (q);
+      pause = svm_queue_is_full (q);
 
       vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
-      unix_shared_memory_queue_unlock (q);
+      svm_queue_unlock (q);
       dsunlock (sm);
 
       if (pause)
@@ -630,7 +1370,7 @@ ip6_nbr_ship (stats_main_t * sm,
 }
 
 static void
-do_ip6_nbrs (stats_main_t * sm)
+do_ip6_nbr_counters (stats_main_t * sm)
 {
   vnet_main_t *vnm = vnet_get_main ();
   vnet_interface_main_t *im = &vnm->interface_main;
@@ -682,12 +1422,12 @@ do_ip6_nbrs (stats_main_t * sm)
 }
 
 static void
-do_ip4_fibs (stats_main_t * sm)
+do_ip4_fib_counters (stats_main_t * sm)
 {
   ip4_main_t *im4 = &ip4_main;
   api_main_t *am = sm->api_main;
   vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
-  unix_shared_memory_queue_t *q = shmem_hdr->vl_input_queue;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
   ip4_route_t *r;
   fib_table_t *fib;
   ip4_fib_t *v4_fib;
@@ -808,19 +1548,19 @@ again:
                 * drop the data structure lock (which the main thread
                 * may want), and take a pause.
                 */
-               unix_shared_memory_queue_lock (q);
-               if (unix_shared_memory_queue_is_full (q))
+               svm_queue_lock (q);
+               if (svm_queue_is_full (q))
                  {
                    dsunlock (sm);
                    vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
-                   unix_shared_memory_queue_unlock (q);
+                   svm_queue_unlock (q);
                    mp = 0;
                    ip46_fib_stats_delay (sm, 0 /* sec */ ,
                                          STATS_RELEASE_DELAY_NS);
                    goto again;
                  }
                vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
-               unix_shared_memory_queue_unlock (q);
+               svm_queue_unlock (q);
 
                items_this_message = IP4_FIB_COUNTER_BATCH_SIZE;
                mp = vl_msg_api_alloc_as_if_client
@@ -859,6 +1599,299 @@ again:
     vl_msg_api_free (mp);
 }
 
+static int
+mfib_table_stats_walk_cb (fib_node_index_t fei, void *ctx)
+{
+  stats_main_t *sm = ctx;
+  do_ip46_fibs_t *do_fibs;
+  mfib_entry_t *entry;
+
+  do_fibs = &sm->do_ip46_fibs;
+  entry = mfib_entry_get (fei);
+
+  vec_add1 (do_fibs->mroutes, entry->mfe_prefix);
+
+  return (1);
+}
+
+static void
+do_ip4_mfib_counters (stats_main_t * sm)
+{
+  ip4_main_t *im4 = &ip4_main;
+  api_main_t *am = sm->api_main;
+  vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
+  mfib_prefix_t *pfx;
+  mfib_table_t *mfib;
+  do_ip46_fibs_t *do_fibs;
+  vl_api_vnet_ip4_mfib_counters_t *mp = 0;
+  u32 items_this_message;
+  vl_api_ip4_mfib_counter_t *ctrp = 0;
+  u32 start_at_mfib_index = 0;
+  int i, j, k;
+
+  do_fibs = &sm->do_ip46_fibs;
+
+  vec_reset_length (do_fibs->mfibs);
+  /* *INDENT-OFF* */
+  pool_foreach (mfib, im4->mfibs, ({vec_add1(do_fibs->mfibs, mfib);}));
+  /* *INDENT-ON* */
+
+  for (j = 0; j < vec_len (do_fibs->mfibs); j++)
+    {
+      mfib = do_fibs->mfibs[j];
+      /* We may have bailed out due to control-plane activity */
+      while ((mfib - im4->mfibs) < start_at_mfib_index)
+       continue;
+
+      if (mp == 0)
+       {
+         items_this_message = IP4_MFIB_COUNTER_BATCH_SIZE;
+         mp = vl_msg_api_alloc_as_if_client
+           (sizeof (*mp) +
+            items_this_message * sizeof (vl_api_ip4_mfib_counter_t));
+         mp->_vl_msg_id = ntohs (VL_API_VNET_IP4_MFIB_COUNTERS);
+         mp->count = 0;
+         mp->vrf_id = ntohl (mfib->mft_table_id);
+         ctrp = (vl_api_ip4_mfib_counter_t *) mp->c;
+       }
+      else
+       {
+         /* happens if the last MFIB was empty... */
+         ASSERT (mp->count == 0);
+         mp->vrf_id = ntohl (mfib->mft_table_id);
+       }
+
+      vec_reset_length (do_fibs->mroutes);
+
+      /*
+       * walk the table with table updates blocked
+       */
+      dslock (sm, 0 /* release hint */ , 1 /* tag */ );
+
+      mfib_table_walk (mfib->mft_index,
+                      FIB_PROTOCOL_IP4, mfib_table_stats_walk_cb, sm);
+      dsunlock (sm);
+
+      vec_foreach (pfx, do_fibs->mroutes)
+      {
+       const dpo_id_t *dpo_id;
+       fib_node_index_t mfei;
+       vlib_counter_t c;
+       u32 index;
+
+       /*
+        * re-lookup the entry, since we suspend during the collection
+        */
+       mfei = mfib_table_lookup (mfib->mft_index, pfx);
+
+       if (FIB_NODE_INDEX_INVALID == mfei)
+         continue;
+
+       dpo_id = mfib_entry_contribute_ip_forwarding (mfei);
+       index = (u32) dpo_id->dpoi_index;
+
+       vlib_get_combined_counter (&replicate_main.repm_counters,
+                                  dpo_id->dpoi_index, &c);
+       /*
+        * If it has seen at least one packet, send it.
+        */
+       if (c.packets > 0)
+         {
+           /* already in net byte order */
+           memcpy (ctrp->group, &pfx->fp_grp_addr.ip4, 4);
+           memcpy (ctrp->source, &pfx->fp_src_addr.ip4, 4);
+           ctrp->group_length = pfx->fp_len;
+           ctrp->packets = clib_host_to_net_u64 (c.packets);
+           ctrp->bytes = clib_host_to_net_u64 (c.bytes);
+           mp->count++;
+           ctrp++;
+
+           if (mp->count == items_this_message)
+             {
+               mp->count = htonl (items_this_message);
+               /*
+                * If the main thread's input queue is stuffed,
+                * drop the data structure lock (which the main thread
+                * may want), and take a pause.
+                */
+               svm_queue_lock (q);
+
+               while (svm_queue_is_full (q))
+                 {
+                   svm_queue_unlock (q);
+                   ip46_fib_stats_delay (sm, 0 /* sec */ ,
+                                         STATS_RELEASE_DELAY_NS);
+                   svm_queue_lock (q);
+                 }
+               vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
+               svm_queue_unlock (q);
+
+               items_this_message = IP4_MFIB_COUNTER_BATCH_SIZE;
+               mp = vl_msg_api_alloc_as_if_client
+                 (sizeof (*mp) +
+                  items_this_message * sizeof (vl_api_ip4_mfib_counter_t));
+               mp->_vl_msg_id = ntohs (VL_API_VNET_IP4_MFIB_COUNTERS);
+               mp->count = 0;
+               mp->vrf_id = ntohl (mfib->mft_table_id);
+               ctrp = (vl_api_ip4_mfib_counter_t *) mp->c;
+             }
+         }
+      }
+
+      /* Flush any data from this mfib */
+      if (mp->count)
+       {
+         mp->count = htonl (mp->count);
+         vl_msg_api_send_shmem (q, (u8 *) & mp);
+         mp = 0;
+       }
+    }
+
+  /* If e.g. the last FIB had no reportable routes, free the buffer */
+  if (mp)
+    vl_msg_api_free (mp);
+}
+
+static void
+do_ip6_mfib_counters (stats_main_t * sm)
+{
+  ip6_main_t *im6 = &ip6_main;
+  api_main_t *am = sm->api_main;
+  vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
+  mfib_prefix_t *pfx;
+  mfib_table_t *mfib;
+  do_ip46_fibs_t *do_fibs;
+  vl_api_vnet_ip6_mfib_counters_t *mp = 0;
+  u32 items_this_message;
+  vl_api_ip6_mfib_counter_t *ctrp = 0;
+  u32 start_at_mfib_index = 0;
+  int i, j, k;
+
+  do_fibs = &sm->do_ip46_fibs;
+
+  vec_reset_length (do_fibs->mfibs);
+  /* *INDENT-OFF* */
+  pool_foreach (mfib, im6->mfibs, ({vec_add1(do_fibs->mfibs, mfib);}));
+  /* *INDENT-ON* */
+
+  for (j = 0; j < vec_len (do_fibs->mfibs); j++)
+    {
+      mfib = do_fibs->mfibs[j];
+      /* We may have bailed out due to control-plane activity */
+      while ((mfib - im6->mfibs) < start_at_mfib_index)
+       continue;
+
+      if (mp == 0)
+       {
+         items_this_message = IP6_MFIB_COUNTER_BATCH_SIZE;
+         mp = vl_msg_api_alloc_as_if_client
+           (sizeof (*mp) +
+            items_this_message * sizeof (vl_api_ip6_mfib_counter_t));
+         mp->_vl_msg_id = ntohs (VL_API_VNET_IP6_MFIB_COUNTERS);
+         mp->count = 0;
+         mp->vrf_id = ntohl (mfib->mft_table_id);
+         ctrp = (vl_api_ip6_mfib_counter_t *) mp->c;
+       }
+      else
+       {
+         /* happens if the last MFIB was empty... */
+         ASSERT (mp->count == 0);
+         mp->vrf_id = ntohl (mfib->mft_table_id);
+       }
+
+      vec_reset_length (do_fibs->mroutes);
+
+      /*
+       * walk the table with table updates blocked
+       */
+      dslock (sm, 0 /* release hint */ , 1 /* tag */ );
+
+      mfib_table_walk (mfib->mft_index,
+                      FIB_PROTOCOL_IP6, mfib_table_stats_walk_cb, sm);
+      dsunlock (sm);
+
+      vec_foreach (pfx, do_fibs->mroutes)
+      {
+       const dpo_id_t *dpo_id;
+       fib_node_index_t mfei;
+       vlib_counter_t c;
+       u32 index;
+
+       /*
+        * re-lookup the entry, since we suspend during the collection
+        */
+       mfei = mfib_table_lookup (mfib->mft_index, pfx);
+
+       if (FIB_NODE_INDEX_INVALID == mfei)
+         continue;
+
+       dpo_id = mfib_entry_contribute_ip_forwarding (mfei);
+       index = (u32) dpo_id->dpoi_index;
+
+       vlib_get_combined_counter (&replicate_main.repm_counters,
+                                  dpo_id->dpoi_index, &c);
+       /*
+        * If it has seen at least one packet, send it.
+        */
+       if (c.packets > 0)
+         {
+           /* already in net byte order */
+           memcpy (ctrp->group, &pfx->fp_grp_addr.ip6, 16);
+           memcpy (ctrp->source, &pfx->fp_src_addr.ip6, 16);
+           ctrp->group_length = pfx->fp_len;
+           ctrp->packets = clib_host_to_net_u64 (c.packets);
+           ctrp->bytes = clib_host_to_net_u64 (c.bytes);
+           mp->count++;
+           ctrp++;
+
+           if (mp->count == items_this_message)
+             {
+               mp->count = htonl (items_this_message);
+               /*
+                * If the main thread's input queue is stuffed,
+                * drop the data structure lock (which the main thread
+                * may want), and take a pause.
+                */
+               svm_queue_lock (q);
+
+               while (svm_queue_is_full (q))
+                 {
+                   svm_queue_unlock (q);
+                   ip46_fib_stats_delay (sm, 0 /* sec */ ,
+                                         STATS_RELEASE_DELAY_NS);
+                   svm_queue_lock (q);
+                 }
+               vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
+               svm_queue_unlock (q);
+
+               items_this_message = IP6_MFIB_COUNTER_BATCH_SIZE;
+               mp = vl_msg_api_alloc_as_if_client
+                 (sizeof (*mp) +
+                  items_this_message * sizeof (vl_api_ip6_mfib_counter_t));
+               mp->_vl_msg_id = ntohs (VL_API_VNET_IP6_MFIB_COUNTERS);
+               mp->count = 0;
+               mp->vrf_id = ntohl (mfib->mft_table_id);
+               ctrp = (vl_api_ip6_mfib_counter_t *) mp->c;
+             }
+         }
+      }
+
+      /* Flush any data from this mfib */
+      if (mp->count)
+       {
+         mp->count = htonl (mp->count);
+         vl_msg_api_send_shmem (q, (u8 *) & mp);
+         mp = 0;
+       }
+    }
+
+  /* If e.g. the last FIB had no reportable routes, free the buffer */
+  if (mp)
+    vl_msg_api_free (mp);
+}
+
 typedef struct
 {
   u32 fib_index;
@@ -888,12 +1921,12 @@ add_routes_in_fib (BVT (clib_bihash_kv) * kvp, void *arg)
 }
 
 static void
-do_ip6_fibs (stats_main_t * sm)
+do_ip6_fib_counters (stats_main_t * sm)
 {
   ip6_main_t *im6 = &ip6_main;
   api_main_t *am = sm->api_main;
   vl_shmem_hdr_t *shmem_hdr = am->shmem_hdr;
-  unix_shared_memory_queue_t *q = shmem_hdr->vl_input_queue;
+  svm_queue_t *q = shmem_hdr->vl_input_queue;
   ip6_route_t *r;
   fib_table_t *fib;
   do_ip46_fibs_t *do_fibs;
@@ -986,19 +2019,19 @@ again:
                 * drop the data structure lock (which the main thread
                 * may want), and take a pause.
                 */
-               unix_shared_memory_queue_lock (q);
-               if (unix_shared_memory_queue_is_full (q))
+               svm_queue_lock (q);
+               if (svm_queue_is_full (q))
                  {
                    dsunlock (sm);
                    vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
-                   unix_shared_memory_queue_unlock (q);
+                   svm_queue_unlock (q);
                    mp = 0;
                    ip46_fib_stats_delay (sm, 0 /* sec */ ,
                                          STATS_RELEASE_DELAY_NS);
                    goto again;
                  }
                vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
-               unix_shared_memory_queue_unlock (q);
+               svm_queue_unlock (q);
 
                items_this_message = IP6_FIB_COUNTER_BATCH_SIZE;
                mp = vl_msg_api_alloc_as_if_client
@@ -1038,6 +2071,182 @@ again:
     vl_msg_api_free (mp);
 }
 
+typedef struct udp_encap_stat_t_
+{
+  u32 ue_id;
+  u64 stats[2];
+} udp_encap_stat_t;
+
+typedef struct udp_encap_stats_walk_t_
+{
+  udp_encap_stat_t *stats;
+} udp_encap_stats_walk_t;
+
+static int
+udp_encap_stats_walk_cb (index_t uei, void *arg)
+{
+  udp_encap_stats_walk_t *ctx = arg;
+  udp_encap_stat_t *stat;
+  udp_encap_t *ue;
+
+  ue = udp_encap_get (uei);
+  vec_add2 (ctx->stats, stat, 1);
+
+  stat->ue_id = uei;
+  udp_encap_get_stats (ue->ue_id, &stat->stats[0], &stat->stats[1]);
+
+  return (1);
+}
+
+static void
+udp_encap_ship (udp_encap_stats_walk_t * ctx)
+{
+  vl_api_vnet_udp_encap_counters_t *mp;
+  vl_shmem_hdr_t *shmem_hdr;
+  stats_main_t *sm;
+  api_main_t *am;
+  svm_queue_t *q;
+
+  mp = NULL;
+  sm = &stats_main;
+  am = sm->api_main;
+  shmem_hdr = am->shmem_hdr;
+  q = shmem_hdr->vl_input_queue;
+
+  /*
+   * If the walk context has counters, which may be left over from the last
+   * suspend, then we continue from there.
+   */
+  while (0 != vec_len (ctx->stats))
+    {
+      u32 n_items = MIN (vec_len (ctx->stats),
+                        UDP_ENCAP_COUNTER_BATCH_SIZE);
+      u8 pause = 0;
+
+      dslock (sm, 0 /* release hint */ , 1 /* tag */ );
+
+      mp = vl_msg_api_alloc_as_if_client (sizeof (*mp) +
+                                         (n_items *
+                                          sizeof
+                                          (vl_api_udp_encap_counter_t)));
+      mp->_vl_msg_id = ntohs (VL_API_VNET_UDP_ENCAP_COUNTERS);
+      mp->count = ntohl (n_items);
+
+      /*
+       * copy the counters from the back of the context, then we can easily
+       * 'erase' them by resetting the vector length.
+       * The order we push the stats to the caller is not important.
+       */
+      clib_memcpy (mp->c,
+                  &ctx->stats[vec_len (ctx->stats) - n_items],
+                  n_items * sizeof (*ctx->stats));
+
+      _vec_len (ctx->stats) = vec_len (ctx->stats) - n_items;
+
+      /*
+       * send to the shm q
+       */
+      svm_queue_lock (q);
+      pause = svm_queue_is_full (q);
+
+      vl_msg_api_send_shmem_nolock (q, (u8 *) & mp);
+      svm_queue_unlock (q);
+      dsunlock (sm);
+
+      if (pause)
+       ip46_fib_stats_delay (sm, 0 /* sec */ ,
+                             STATS_RELEASE_DELAY_NS);
+    }
+}
+
+static void
+do_udp_encap_counters (stats_main_t * sm)
+{
+  udp_encap_stat_t *stat;
+
+  udp_encap_stats_walk_t ctx = {
+    .stats = NULL,
+  };
+
+  dslock (sm, 0 /* release hint */ , 1 /* tag */ );
+  udp_encap_walk (udp_encap_stats_walk_cb, &ctx);
+  dsunlock (sm);
+
+  udp_encap_ship (&ctx);
+}
+
+int
+stats_set_poller_delay (u32 poller_delay_sec)
+{
+  stats_main_t *sm = &stats_main;
+  if (!poller_delay_sec)
+    {
+      return VNET_API_ERROR_INVALID_ARGUMENT;
+    }
+  else
+    {
+      sm->stats_poll_interval_in_seconds = poller_delay_sec;
+      return 0;
+    }
+}
+
+static clib_error_t *
+stats_config (vlib_main_t * vm, unformat_input_t * input)
+{
+  u32 sec;
+
+  while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
+    {
+      if (unformat (input, "interval %u", &sec))
+       {
+         int rv = stats_set_poller_delay (sec);
+         if (rv)
+           {
+             return clib_error_return (0,
+                                       "`stats_set_poller_delay' API call failed, rv=%d:%U",
+                                       (int) rv, format_vnet_api_errno, rv);
+           }
+         return 0;
+       }
+      else
+       {
+         return clib_error_return (0, "unknown input '%U'",
+                                   format_unformat_error, input);
+       }
+    }
+  return 0;
+}
+
+/* stats { ... } configuration. */
+/*?
+ *
+ * @cfgcmd{interval, &lt;seconds&gt;}
+ * Configure stats poller delay to be @c seconds.
+ *
+?*/
+VLIB_CONFIG_FUNCTION (stats_config, "stats");
+
+static void
+  vl_api_stats_get_poller_delay_t_handler
+  (vl_api_stats_get_poller_delay_t * mp)
+{
+  stats_main_t *sm = &stats_main;
+  vl_api_registration_t *reg;
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
+    return;
+  vl_api_stats_get_poller_delay_reply_t *rmp;
+
+  rmp = vl_msg_api_alloc (sizeof (*rmp));
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_PER_INTERFACE_SIMPLE_STATS_REPLY);
+  rmp->context = mp->context;
+  rmp->retval = 0;
+  rmp->delay = clib_host_to_net_u32 (sm->stats_poll_interval_in_seconds);
+
+  vl_api_send_msg (reg, (u8 *) rmp);
+
+}
+
 static void
 stats_thread_fn (void *arg)
 {
@@ -1060,113 +2269,92 @@ stats_thread_fn (void *arg)
 
   while (1)
     {
-      /* 10 second poll interval */
-      ip46_fib_stats_delay (sm, 10 /* secs */ , 0 /* nsec */ );
+      ip46_fib_stats_delay (sm, sm->stats_poll_interval_in_seconds,
+                           0 /* nsec */ );
 
       if (!(sm->enable_poller))
-       continue;
-      do_simple_interface_counters (sm);
-      do_combined_interface_counters (sm);
-      do_ip4_fibs (sm);
-      do_ip6_fibs (sm);
-      do_ip4_nbrs (sm);
-      do_ip6_nbrs (sm);
-    }
-}
+       {
+         continue;
+       }
+      if (pool_elts
+         (sm->stats_registrations[IDX_PER_INTERFACE_COMBINED_COUNTERS]))
+       do_combined_per_interface_counters (sm);
 
-static void
-  vl_api_vnet_interface_simple_counters_t_handler
-  (vl_api_vnet_interface_simple_counters_t * mp)
-{
-  vpe_client_stats_registration_t *reg;
-  stats_main_t *sm = &stats_main;
-  unix_shared_memory_queue_t *q, *q_prev = NULL;
-  vl_api_vnet_interface_simple_counters_t *mp_copy = NULL;
-  u32 mp_size;
-  int i;
+      if (pool_elts
+         (sm->stats_registrations[IDX_PER_INTERFACE_SIMPLE_COUNTERS]))
+       do_simple_per_interface_counters (sm);
 
-  mp_size = sizeof (*mp) + (ntohl (mp->count) * sizeof (u64));
+      if (pool_elts (sm->stats_registrations[IDX_IP4_FIB_COUNTERS]))
+       do_ip4_fib_counters (sm);
 
-  /* *INDENT-OFF* */
-  vec_reset_length(sm->regs);
-  pool_foreach(reg, sm->stats_registrations,
-              ({
-             vec_add1(sm->regs,reg);
-              }));
-  /* *INDENT-ON* */
-  for (i = 0; i < vec_len (sm->regs); i++)
-    {
-      reg = sm->regs[i];
-      if (reg->stats_registrations & INTERFACE_SIMPLE_COUNTERS)
-       {
-         q = vl_api_client_index_to_input_queue (reg->client.client_index);
-         if (q)
-           {
-             if (q_prev && (q_prev->cursize < q_prev->maxsize))
-               {
-                 mp_copy = vl_msg_api_alloc_as_if_client (mp_size);
-                 clib_memcpy (mp_copy, mp, mp_size);
-                 vl_msg_api_send_shmem (q_prev, (u8 *) & mp);
-                 mp = mp_copy;
-               }
-             q_prev = q;
-           }
-       }
-    }
-#if STATS_DEBUG > 0
-  fformat (stdout, "%U\n", format_vnet_simple_counters, mp);
-#endif
+      if (pool_elts (sm->stats_registrations[IDX_IP6_FIB_COUNTERS]))
+       do_ip6_fib_counters (sm);
 
-  if (q_prev && (q_prev->cursize < q_prev->maxsize))
-    {
-      vl_msg_api_send_shmem (q_prev, (u8 *) & mp);
-    }
-  else
-    {
-      vl_msg_api_free (mp);
+      if (pool_elts (sm->stats_registrations[IDX_IP4_MFIB_COUNTERS]))
+       do_ip4_mfib_counters (sm);
+
+      if (pool_elts (sm->stats_registrations[IDX_IP6_MFIB_COUNTERS]))
+       do_ip6_mfib_counters (sm);
+
+      if (pool_elts (sm->stats_registrations[IDX_IP4_NBR_COUNTERS]))
+       do_ip4_nbr_counters (sm);
+
+      if (pool_elts (sm->stats_registrations[IDX_IP6_NBR_COUNTERS]))
+       do_ip6_nbr_counters (sm);
+
+      if (pool_elts (sm->stats_registrations[IDX_UDP_ENCAP_COUNTERS]))
+       do_udp_encap_counters (sm);
     }
 }
 
 static void
-  vl_api_vnet_interface_combined_counters_t_handler
-  (vl_api_vnet_interface_combined_counters_t * mp)
+  vl_api_vnet_interface_simple_counters_t_handler
+  (vl_api_vnet_interface_simple_counters_t * mp)
 {
-  vpe_client_stats_registration_t *reg;
+  vpe_client_registration_t *clients, client;
   stats_main_t *sm = &stats_main;
-  unix_shared_memory_queue_t *q, *q_prev = NULL;
-  vl_api_vnet_interface_combined_counters_t *mp_copy = NULL;
+  vl_api_registration_t *reg, *reg_prev = NULL;
+  vl_api_vnet_interface_simple_counters_t *mp_copy = NULL;
   u32 mp_size;
+  int i;
 
-  mp_size = sizeof (*mp) + (ntohl (mp->count) * sizeof (vlib_counter_t));
+  mp_size = sizeof (*mp) + (ntohl (mp->count) * sizeof (u64));
 
-  /* *INDENT-OFF* */
-  pool_foreach(reg, sm->stats_registrations,
-              ({
-             if (reg->stats_registrations & INTERFACE_COMBINED_COUNTERS)
-               {
-                 q = vl_api_client_index_to_input_queue (reg->client.client_index);
-                 if (q)
-                   {
-                     if (q_prev && (q_prev->cursize < q_prev->maxsize))
-                       {
-                         mp_copy = vl_msg_api_alloc_as_if_client(mp_size);
-                         clib_memcpy(mp_copy, mp, mp_size);
-                         vl_msg_api_send_shmem (q_prev, (u8 *)&mp);
-                         mp = mp_copy;
-                       }
-                     q_prev = q;
-                   }
-               }
-              }));
-  /* *INDENT-ON* */
+  clients =
+    get_clients_for_stat (IDX_PER_INTERFACE_SIMPLE_COUNTERS,
+                         ~0 /*flag for all */ );
+
+  for (i = 0; i < vec_len (clients); i++)
+    {
+      client = clients[i];
+      reg = vl_api_client_index_to_registration (client.client_index);
+      if (reg)
+       {
+         if (reg_prev && vl_api_can_send_msg (reg_prev))
+           {
+             mp_copy = vl_msg_api_alloc_as_if_client (mp_size);
+             clib_memcpy (mp_copy, mp, mp_size);
+             vl_api_send_msg (reg_prev, (u8 *) mp);
+             mp = mp_copy;
+           }
+         reg_prev = reg;
+       }
+      else
+       {
+         sm->enable_poller =
+           clear_client_for_stat (IDX_PER_INTERFACE_SIMPLE_COUNTERS, ~0,
+                                  client.client_index);
+         continue;
+       }
+    }
 
 #if STATS_DEBUG > 0
-  fformat (stdout, "%U\n", format_vnet_combined_counters, mp);
+  fformat (stdout, "%U\n", format_vnet_simple_counters, mp);
 #endif
 
-  if (q_prev && (q_prev->cursize < q_prev->maxsize))
+  if (reg_prev && vl_api_can_send_msg (reg_prev))
     {
-      vl_msg_api_send_shmem (q_prev, (u8 *) & mp);
+      vl_api_send_msg (reg_prev, (u8 *) mp);
     }
   else
     {
@@ -1177,38 +2365,45 @@ static void
 static void
 vl_api_vnet_ip4_fib_counters_t_handler (vl_api_vnet_ip4_fib_counters_t * mp)
 {
-  vpe_client_stats_registration_t *reg;
   stats_main_t *sm = &stats_main;
-  unix_shared_memory_queue_t *q, *q_prev = NULL;
+  vl_api_registration_t *reg, *reg_prev = NULL;
   vl_api_vnet_ip4_fib_counters_t *mp_copy = NULL;
   u32 mp_size;
+  vpe_client_registration_t *clients, client;
+  int i;
 
   mp_size = sizeof (*mp_copy) +
     ntohl (mp->count) * sizeof (vl_api_ip4_fib_counter_t);
 
-  /* *INDENT-OFF* */
-  pool_foreach(reg, sm->stats_registrations,
-  ({
-    if (reg->stats_registrations & IP4_FIB_COUNTERS)
-      {
-        q = vl_api_client_index_to_input_queue (reg->client.client_index);
-        if (q)
-          {
-            if (q_prev && (q_prev->cursize < q_prev->maxsize))
-              {
-                mp_copy = vl_msg_api_alloc_as_if_client(mp_size);
-                clib_memcpy(mp_copy, mp, mp_size);
-                vl_msg_api_send_shmem (q_prev, (u8 *)&mp);
-                mp = mp_copy;
-              }
-            q_prev = q;
-          }
-      }
-  }));
-  /* *INDENT-ON* */
-  if (q_prev && (q_prev->cursize < q_prev->maxsize))
+  clients =
+    get_clients_for_stat (IDX_IP4_FIB_COUNTERS, ~0 /*flag for all */ );
+
+  for (i = 0; i < vec_len (clients); i++)
+    {
+      client = clients[i];
+      reg = vl_api_client_index_to_registration (client.client_index);
+      if (reg)
+       {
+         if (reg_prev && vl_api_can_send_msg (reg_prev))
+           {
+             mp_copy = vl_msg_api_alloc_as_if_client (mp_size);
+             clib_memcpy (mp_copy, mp, mp_size);
+             vl_api_send_msg (reg_prev, (u8 *) mp);
+             mp = mp_copy;
+           }
+         reg_prev = reg;
+       }
+      else
+       {
+         sm->enable_poller = clear_client_for_stat (IDX_IP4_FIB_COUNTERS,
+                                                    ~0, client.client_index);
+         continue;
+       }
+    }
+
+  if (reg_prev && vl_api_can_send_msg (reg_prev))
     {
-      vl_msg_api_send_shmem (q_prev, (u8 *) & mp);
+      vl_api_send_msg (reg_prev, (u8 *) mp);
     }
   else
     {
@@ -1219,38 +2414,46 @@ vl_api_vnet_ip4_fib_counters_t_handler (vl_api_vnet_ip4_fib_counters_t * mp)
 static void
 vl_api_vnet_ip4_nbr_counters_t_handler (vl_api_vnet_ip4_nbr_counters_t * mp)
 {
-  vpe_client_stats_registration_t *reg;
   stats_main_t *sm = &stats_main;
-  unix_shared_memory_queue_t *q, *q_prev = NULL;
+  vl_api_registration_t *reg, *reg_prev = NULL;
   vl_api_vnet_ip4_nbr_counters_t *mp_copy = NULL;
   u32 mp_size;
+  vpe_client_registration_t *clients, client;
+  int i;
 
   mp_size = sizeof (*mp_copy) +
     ntohl (mp->count) * sizeof (vl_api_ip4_nbr_counter_t);
 
-  /* *INDENT-OFF* */
-  pool_foreach(reg, sm->stats_registrations,
-  ({
-    if (reg->stats_registrations & IP4_NBR_COUNTERS)
-      {
-        q = vl_api_client_index_to_input_queue (reg->client.client_index);
-        if (q)
-          {
-            if (q_prev && (q_prev->cursize < q_prev->maxsize))
-              {
-                mp_copy = vl_msg_api_alloc_as_if_client(mp_size);
-                clib_memcpy(mp_copy, mp, mp_size);
-                vl_msg_api_send_shmem (q_prev, (u8 *)&mp);
-                mp = mp_copy;
-              }
-            q_prev = q;
-          }
-      }
-  }));
+  clients =
+    get_clients_for_stat (IDX_IP4_NBR_COUNTERS, ~0 /*flag for all */ );
+
+  for (i = 0; i < vec_len (clients); i++)
+    {
+      client = clients[i];
+      reg = vl_api_client_index_to_registration (client.client_index);
+      if (reg)
+       {
+         if (reg_prev && vl_api_can_send_msg (reg_prev))
+           {
+             mp_copy = vl_msg_api_alloc_as_if_client (mp_size);
+             clib_memcpy (mp_copy, mp, mp_size);
+             vl_api_send_msg (reg_prev, (u8 *) mp);
+             mp = mp_copy;
+           }
+         reg_prev = reg;
+       }
+      else
+       {
+         sm->enable_poller = clear_client_for_stat (IDX_IP4_NBR_COUNTERS,
+                                                    ~0, client.client_index);
+         continue;
+       }
+    }
+
   /* *INDENT-ON* */
-  if (q_prev && (q_prev->cursize < q_prev->maxsize))
+  if (reg_prev && vl_api_can_send_msg (reg_prev))
     {
-      vl_msg_api_send_shmem (q_prev, (u8 *) & mp);
+      vl_api_send_msg (reg_prev, (u8 *) mp);
     }
   else
     {
@@ -1261,38 +2464,45 @@ vl_api_vnet_ip4_nbr_counters_t_handler (vl_api_vnet_ip4_nbr_counters_t * mp)
 static void
 vl_api_vnet_ip6_fib_counters_t_handler (vl_api_vnet_ip6_fib_counters_t * mp)
 {
-  vpe_client_stats_registration_t *reg;
   stats_main_t *sm = &stats_main;
-  unix_shared_memory_queue_t *q, *q_prev = NULL;
+  vl_api_registration_t *reg, *reg_prev = NULL;
   vl_api_vnet_ip6_fib_counters_t *mp_copy = NULL;
   u32 mp_size;
+  vpe_client_registration_t *clients, client;
+  int i;
 
   mp_size = sizeof (*mp_copy) +
     ntohl (mp->count) * sizeof (vl_api_ip6_fib_counter_t);
 
-  /* *INDENT-OFF* */
-  pool_foreach(reg, sm->stats_registrations,
-  ({
-    if (reg->stats_registrations & IP6_FIB_COUNTERS)
-      {
-        q = vl_api_client_index_to_input_queue (reg->client.client_index);
-        if (q)
-          {
-            if (q_prev && (q_prev->cursize < q_prev->maxsize))
-              {
-                mp_copy = vl_msg_api_alloc_as_if_client(mp_size);
-                clib_memcpy(mp_copy, mp, mp_size);
-                vl_msg_api_send_shmem (q_prev, (u8 *)&mp);
-                mp = mp_copy;
-              }
-            q_prev = q;
-          }
-      }
-      }));
+  clients =
+    get_clients_for_stat (IDX_IP6_FIB_COUNTERS, ~0 /*flag for all */ );
+
+  for (i = 0; i < vec_len (clients); i++)
+    {
+      client = clients[i];
+      reg = vl_api_client_index_to_registration (client.client_index);
+      if (reg)
+       {
+         if (reg_prev && vl_api_can_send_msg (reg_prev))
+           {
+             mp_copy = vl_msg_api_alloc_as_if_client (mp_size);
+             clib_memcpy (mp_copy, mp, mp_size);
+             vl_api_send_msg (reg_prev, (u8 *) mp);
+             mp = mp_copy;
+           }
+         reg_prev = reg;
+       }
+      else
+       {
+         sm->enable_poller = clear_client_for_stat (IDX_IP6_FIB_COUNTERS,
+                                                    ~0, client.client_index);
+         continue;
+       }
+    }
   /* *INDENT-ON* */
-  if (q_prev && (q_prev->cursize < q_prev->maxsize))
+  if (reg_prev && vl_api_can_send_msg (reg_prev))
     {
-      vl_msg_api_send_shmem (q_prev, (u8 *) & mp);
+      vl_api_send_msg (reg_prev, (u8 *) mp);
     }
   else
     {
@@ -1303,38 +2513,45 @@ vl_api_vnet_ip6_fib_counters_t_handler (vl_api_vnet_ip6_fib_counters_t * mp)
 static void
 vl_api_vnet_ip6_nbr_counters_t_handler (vl_api_vnet_ip6_nbr_counters_t * mp)
 {
-  vpe_client_stats_registration_t *reg;
   stats_main_t *sm = &stats_main;
-  unix_shared_memory_queue_t *q, *q_prev = NULL;
+  vl_api_registration_t *reg, *reg_prev = NULL;
   vl_api_vnet_ip6_nbr_counters_t *mp_copy = NULL;
   u32 mp_size;
+  vpe_client_registration_t *clients, client;
+  int i;
 
   mp_size = sizeof (*mp_copy) +
     ntohl (mp->count) * sizeof (vl_api_ip6_nbr_counter_t);
 
-  /* *INDENT-OFF* */
-  pool_foreach(reg, sm->stats_registrations,
-  ({
-    if (reg->stats_registrations & IP6_NBR_COUNTERS)
-      {
-        q = vl_api_client_index_to_input_queue (reg->client.client_index);
-        if (q)
-          {
-            if (q_prev && (q_prev->cursize < q_prev->maxsize))
-              {
-                mp_copy = vl_msg_api_alloc_as_if_client(mp_size);
-                clib_memcpy(mp_copy, mp, mp_size);
-                vl_msg_api_send_shmem (q_prev, (u8 *)&mp);
-                mp = mp_copy;
-              }
-            q_prev = q;
-          }
-      }
-  }));
+  clients =
+    get_clients_for_stat (IDX_IP6_NBR_COUNTERS, ~0 /*flag for all */ );
+
+  for (i = 0; i < vec_len (clients); i++)
+    {
+      client = clients[i];
+      reg = vl_api_client_index_to_registration (client.client_index);
+      if (reg)
+       {
+         if (reg_prev && vl_api_can_send_msg (reg_prev))
+           {
+             mp_copy = vl_msg_api_alloc_as_if_client (mp_size);
+             clib_memcpy (mp_copy, mp, mp_size);
+             vl_api_send_msg (reg_prev, (u8 *) mp);
+             mp = mp_copy;
+           }
+         reg_prev = reg;
+       }
+      else
+       {
+         sm->enable_poller = clear_client_for_stat (IDX_IP6_NBR_COUNTERS,
+                                                    ~0, client.client_index);
+         continue;
+       }
+    }
   /* *INDENT-ON* */
-  if (q_prev && (q_prev->cursize < q_prev->maxsize))
+  if (reg_prev && vl_api_can_send_msg (reg_prev))
     {
-      vl_msg_api_send_shmem (q_prev, (u8 *) & mp);
+      vl_api_send_msg (reg_prev, (u8 *) mp);
     }
   else
     {
@@ -1343,382 +2560,264 @@ vl_api_vnet_ip6_nbr_counters_t_handler (vl_api_vnet_ip6_nbr_counters_t * mp)
 }
 
 static void
-vl_api_want_stats_t_handler (vl_api_want_stats_t * mp)
+vl_api_want_udp_encap_stats_t_handler (vl_api_want_udp_encap_stats_t * mp)
 {
   stats_main_t *sm = &stats_main;
-  vpe_client_stats_registration_t *rp;
-  vl_api_want_stats_reply_t *rmp;
+  vpe_client_registration_t rp;
+  vl_api_want_udp_encap_stats_reply_t *rmp;
   uword *p;
   i32 retval = 0;
-  unix_shared_memory_queue_t *q;
+  vl_api_registration_t *reg;
+  u32 fib;
 
-  p = hash_get (sm->stats_registration_hash, mp->client_index);
-  if (p)
-    {
-      if (mp->enable_disable)
-       {
-         clib_warning ("pid %d: already enabled...", mp->pid);
-         retval = -2;
-         goto reply;
-       }
-      else
-       {
-         rp = pool_elt_at_index (sm->stats_registrations, p[0]);
-         pool_put (sm->stats_registrations, rp);
-         hash_unset (sm->stats_registration_hash, mp->client_index);
-         goto reply;
-       }
-    }
-  if (mp->enable_disable == 0)
-    {
-      clib_warning ("pid %d: already disabled...", mp->pid);
-      retval = -3;
-      goto reply;
-    }
-  pool_get (sm->stats_registrations, rp);
-  rp->client.client_index = mp->client_index;
-  rp->client.client_pid = mp->pid;
-  rp->stats_registrations |= INTERFACE_SIMPLE_COUNTERS;
-  rp->stats_registrations |= INTERFACE_COMBINED_COUNTERS;
-  rp->stats_registrations |= IP4_FIB_COUNTERS;
-  rp->stats_registrations |= IP4_NBR_COUNTERS;
-  rp->stats_registrations |= IP6_FIB_COUNTERS;
-  rp->stats_registrations |= IP6_NBR_COUNTERS;
-
-  hash_set (sm->stats_registration_hash, rp->client.client_index,
-           rp - sm->stats_registrations);
+  fib = ~0;                    //Using same mechanism as _per_interface_
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
 
-reply:
-  if (pool_elts (sm->stats_registrations))
-    sm->enable_poller = 1;
-  else
-    sm->enable_poller = 0;
+  handle_client_registration (&rp, IDX_UDP_ENCAP_COUNTERS, fib, mp->enable);
 
-  q = vl_api_client_index_to_input_queue (mp->client_index);
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
 
-  if (!q)
-    return;
+  if (!reg)
+    {
+      sm->enable_poller = clear_client_for_stat (IDX_UDP_ENCAP_COUNTERS,
+                                                fib, mp->client_index);
+      return;
+    }
 
   rmp = vl_msg_api_alloc (sizeof (*rmp));
-  rmp->_vl_msg_id = ntohs (VL_API_WANT_STATS_REPLY);
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_UDP_ENCAP_STATS_REPLY);
   rmp->context = mp->context;
   rmp->retval = retval;
 
-  vl_msg_api_send_shmem (q, (u8 *) & rmp);
+  vl_api_send_msg (reg, (u8 *) rmp);
 }
 
 static void
-  vl_api_want_interface_simple_stats_t_handler
-  (vl_api_want_interface_simple_stats_t * mp)
+vl_api_want_stats_t_handler (vl_api_want_stats_t * mp)
 {
   stats_main_t *sm = &stats_main;
-  vpe_client_stats_registration_t *rp;
-  vl_api_want_interface_simple_stats_reply_t *rmp;
+  vpe_client_registration_t rp;
+  vl_api_want_stats_reply_t *rmp;
   uword *p;
   i32 retval = 0;
-  unix_shared_memory_queue_t *q;
+  u32 item;
+  vl_api_registration_t *reg;
 
-  p = hash_get (sm->stats_registration_hash, mp->client_index);
+  item = ~0;                   //"ALL THE THINGS IN THE THINGS
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
 
-  /* Disable case */
-  if (mp->enable_disable == 0)
-    {
-      if (!p)                  // No client to disable
-       {
-         clib_warning ("pid %d: already disabled for stats...", mp->pid);
-         retval = 0;
-         goto reply;
-       }
+  handle_client_registration (&rp, IDX_PER_INTERFACE_SIMPLE_COUNTERS,
+                             item, mp->enable_disable);
 
-      rp = pool_elt_at_index (sm->stats_registrations, p[0]);
-      if (!rp->stats_registrations & INTERFACE_SIMPLE_COUNTERS)        // Client but doesn't want this.
-       {
-         clib_warning
-           ("pid %d: already disabled for interface simple stats...",
-            mp->pid);
-         retval = 0;
-         goto reply;
-       }
-      else
-       {
-         rp->stats_registrations &= ~(INTERFACE_SIMPLE_COUNTERS);      // Clear flag
-         if (rp->stats_registrations == 0)     // Client isn't listening to anything else
-           {
-             pool_put (sm->stats_registrations, rp);
-             hash_unset (sm->stats_registration_hash, mp->client_index);
-           }
-         goto reply;
-       }
-    }
-  /* Enable case */
-  /* Get client from pool */
-  if (p)
-    rp = pool_elt_at_index (sm->stats_registrations, p[0]);
+  handle_client_registration (&rp, IDX_PER_INTERFACE_COMBINED_COUNTERS,
+                             item, mp->enable_disable);
 
-  if (!p || !rp)               // Doesn't exist, make a new entry
-    {
-      pool_get (sm->stats_registrations, rp);
-      rp->client.client_index = mp->client_index;
-      rp->client.client_pid = mp->pid;
-    }
-  rp->stats_registrations |= INTERFACE_SIMPLE_COUNTERS;
-  hash_set (sm->stats_registration_hash, rp->client.client_index,
-           rp - sm->stats_registrations);
+  handle_client_registration (&rp, IDX_IP4_FIB_COUNTERS,
+                             item, mp->enable_disable);
 
-reply:
-  if (pool_elts (sm->stats_registrations))     // Someone wants something, somewhere so enable globally for now.
-    sm->enable_poller = 1;
-  else
-    sm->enable_poller = 0;
+  handle_client_registration (&rp, IDX_IP4_NBR_COUNTERS,
+                             item, mp->enable_disable);
+
+  handle_client_registration (&rp, IDX_IP6_FIB_COUNTERS,
+                             item, mp->enable_disable);
 
-  q = vl_api_client_index_to_input_queue (mp->client_index);
+  handle_client_registration (&rp, IDX_IP6_NBR_COUNTERS,
+                             item, mp->enable_disable);
 
-  if (!q)
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
     return;
 
   rmp = vl_msg_api_alloc (sizeof (*rmp));
-  rmp->_vl_msg_id = ntohs (VL_API_WANT_INTERFACE_SIMPLE_STATS_REPLY);
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_STATS_REPLY);
   rmp->context = mp->context;
   rmp->retval = retval;
 
-  vl_msg_api_send_shmem (q, (u8 *) & rmp);
+  vl_api_send_msg (reg, (u8 *) rmp);
 }
 
 static void
-  vl_api_want_interface_combined_stats_t_handler
-  (vl_api_want_interface_combined_stats_t * mp)
+  vl_api_want_interface_simple_stats_t_handler
+  (vl_api_want_interface_simple_stats_t * mp)
 {
   stats_main_t *sm = &stats_main;
-  vpe_client_stats_registration_t *rp;
-  vl_api_want_interface_combined_stats_reply_t *rmp;
+  vpe_client_registration_t rp;
+  vl_api_want_interface_simple_stats_reply_t *rmp;
   uword *p;
   i32 retval = 0;
-  unix_shared_memory_queue_t *q;
+  u32 swif;
+  vl_api_registration_t *reg;
 
-  p = hash_get (sm->stats_registration_hash, mp->client_index);
+  swif = ~0;                   //Using same mechanism as _per_interface_
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
 
-  /* Disable case */
-  if (mp->enable_disable == 0)
-    {
-      if (!p)                  // No client to disable
-       {
-         clib_warning ("pid %d: already disabled for stats...", mp->pid);
-         retval = 0;
-         goto reply;
-       }
+  handle_client_registration (&rp, IDX_PER_INTERFACE_SIMPLE_COUNTERS, swif,
+                             mp->enable_disable);
 
-      rp = pool_elt_at_index (sm->stats_registrations, p[0]);
-      if (!(rp->stats_registrations & INTERFACE_COMBINED_COUNTERS))    // Client but doesn't want this.
-       {
-         clib_warning
-           ("pid %d: already disabled for interface COMBINED stats...",
-            mp->pid);
-         retval = 0;
-         goto reply;
-       }
-      else
-       {
-         rp->stats_registrations &= ~(INTERFACE_COMBINED_COUNTERS);    // Clear flag
-         if (rp->stats_registrations == 0)     // Client isn't listening to anything else
-           {
-             pool_put (sm->stats_registrations, rp);
-             hash_unset (sm->stats_registration_hash, mp->client_index);
-           }
-         goto reply;
-       }
-    }
-  /* Enable case */
-  /* Get client from pool */
-  if (p)
-    rp = pool_elt_at_index (sm->stats_registrations, p[0]);
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
 
-  if (!p || !rp)               // Doesn't exist, make a new entry
+  if (!reg)
     {
-      pool_get (sm->stats_registrations, rp);
-      rp->client.client_index = mp->client_index;
-      rp->client.client_pid = mp->pid;
+      sm->enable_poller =
+       clear_client_for_stat (IDX_PER_INTERFACE_SIMPLE_COUNTERS, swif,
+                              mp->client_index);
+      return;
     }
-  rp->stats_registrations |= INTERFACE_COMBINED_COUNTERS;
-  hash_set (sm->stats_registration_hash, rp->client.client_index,
-           rp - sm->stats_registrations);
-
-reply:
-  if (pool_elts (sm->stats_registrations))     // Someone wants something, somewhere so enable globally for now.
-    sm->enable_poller = 1;
-  else
-    sm->enable_poller = 0;
-
-  q = vl_api_client_index_to_input_queue (mp->client_index);
-
-  if (!q)
-    return;
 
   rmp = vl_msg_api_alloc (sizeof (*rmp));
-  rmp->_vl_msg_id = ntohs (VL_API_WANT_INTERFACE_COMBINED_STATS_REPLY);
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_INTERFACE_SIMPLE_STATS_REPLY);
   rmp->context = mp->context;
   rmp->retval = retval;
 
-  vl_msg_api_send_shmem (q, (u8 *) & rmp);
+  vl_api_send_msg (reg, (u8 *) rmp);
 }
 
+
 static void
 vl_api_want_ip4_fib_stats_t_handler (vl_api_want_ip4_fib_stats_t * mp)
 {
   stats_main_t *sm = &stats_main;
-  vpe_client_stats_registration_t *rp;
+  vpe_client_registration_t rp;
   vl_api_want_ip4_fib_stats_reply_t *rmp;
   uword *p;
   i32 retval = 0;
-  unix_shared_memory_queue_t *q;
+  vl_api_registration_t *reg;
+  u32 fib;
 
-  p = hash_get (sm->stats_registration_hash, mp->client_index);
+  fib = ~0;                    //Using same mechanism as _per_interface_
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
 
-  /* Disable case */
-  /*
-     $$$ FIXME: need std return codes. Still undecided if enabling already
-     enabled (and similar for disabled) is really a -'ve error condition or
-     if 0 is sufficient
-   */
-  if (mp->enable_disable == 0)
-    {
-      if (!p)                  // No client to disable
-       {
-         clib_warning ("pid %d: already disabled for stats...", mp->pid);
-         retval = -3;
-         goto reply;
-       }
+  handle_client_registration (&rp, IDX_IP4_FIB_COUNTERS, fib,
+                             mp->enable_disable);
 
-      rp = pool_elt_at_index (sm->stats_registrations, p[0]);
-      if (!(rp->stats_registrations & IP4_FIB_COUNTERS))       // Client but doesn't want this.
-       {
-         clib_warning ("pid %d: already disabled for interface ip4 fib...",
-                       mp->pid);
-         retval = -2;
-         goto reply;
-       }
-      else
-       {
-         rp->stats_registrations &= ~(IP4_FIB_COUNTERS);       // Clear flag
-         if (rp->stats_registrations == 0)     // Client isn't listening to anything else
-           {
-             pool_put (sm->stats_registrations, rp);
-             hash_unset (sm->stats_registration_hash, mp->client_index);
-           }
-         goto reply;
-       }
-    }
-  /* Enable case */
-  /* Get client from pool */
-  if (p)
-    rp = pool_elt_at_index (sm->stats_registrations, p[0]);
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
 
-  if (!p || !rp)               // Doesn't exist, make a new entry
+  if (!reg)
     {
-      pool_get (sm->stats_registrations, rp);
-      rp->client.client_index = mp->client_index;
-      rp->client.client_pid = mp->pid;
+      sm->enable_poller = clear_client_for_stat (IDX_IP4_FIB_COUNTERS,
+                                                fib, mp->client_index);
+      return;
     }
-  rp->stats_registrations |= IP4_FIB_COUNTERS;
-  hash_set (sm->stats_registration_hash, rp->client.client_index,
-           rp - sm->stats_registrations);
 
-reply:
-  if (pool_elts (sm->stats_registrations))     // Someone wants something, somewhere so enable globally for now.
-    sm->enable_poller = 1;
-  else
-    sm->enable_poller = 0;
+  rmp = vl_msg_api_alloc (sizeof (*rmp));
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_IP4_FIB_STATS_REPLY);
+  rmp->context = mp->context;
+  rmp->retval = retval;
 
-  q = vl_api_client_index_to_input_queue (mp->client_index);
+  vl_api_send_msg (reg, (u8 *) rmp);
+}
 
-  if (!q)
-    return;
+static void
+vl_api_want_ip4_mfib_stats_t_handler (vl_api_want_ip4_mfib_stats_t * mp)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_registration_t rp;
+  vl_api_want_ip4_mfib_stats_reply_t *rmp;
+  uword *p;
+  i32 retval = 0;
+  vl_api_registration_t *reg;
+  u32 mfib;
+
+  mfib = ~0;                   //Using same mechanism as _per_interface_
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
+
+  handle_client_registration (&rp, IDX_IP4_MFIB_COUNTERS, mfib,
+                             mp->enable_disable);
+
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
+    {
+      sm->enable_poller = clear_client_for_stat (IDX_IP4_MFIB_COUNTERS,
+                                                mfib, mp->client_index);
+      return;
+    }
 
   rmp = vl_msg_api_alloc (sizeof (*rmp));
-  rmp->_vl_msg_id = ntohs (VL_API_WANT_IP4_FIB_STATS_REPLY);
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_IP4_MFIB_STATS_REPLY);
   rmp->context = mp->context;
   rmp->retval = retval;
 
-  vl_msg_api_send_shmem (q, (u8 *) & rmp);
+  vl_api_send_msg (reg, (u8 *) rmp);
 }
 
 static void
 vl_api_want_ip6_fib_stats_t_handler (vl_api_want_ip6_fib_stats_t * mp)
 {
   stats_main_t *sm = &stats_main;
-  vpe_client_stats_registration_t *rp;
-  vl_api_want_ip6_fib_stats_reply_t *rmp;
+  vpe_client_registration_t rp;
+  vl_api_want_ip4_fib_stats_reply_t *rmp;
   uword *p;
   i32 retval = 0;
-  unix_shared_memory_queue_t *q;
-
-  p = hash_get (sm->stats_registration_hash, mp->client_index);
+  vl_api_registration_t *reg;
+  u32 fib;
 
-  /* Disable case */
-  /*
-     $$$ FIXME: need std return codes. Still undecided if enabling already
-     enabled (and similar for disabled) is really a -'ve error condition or
-     if 0 is sufficient
-   */
-  if (mp->enable_disable == 0)
-    {
-      if (!p)                  // No client to disable
-       {
-         clib_warning ("pid %d: already disabled for stats...", mp->pid);
-         retval = -3;
-         goto reply;
-       }
+  fib = ~0;                    //Using same mechanism as _per_interface_
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
 
-      rp = pool_elt_at_index (sm->stats_registrations, p[0]);
-      if (!(rp->stats_registrations & IP6_FIB_COUNTERS))       // Client but doesn't want this.
-       {
-         clib_warning ("pid %d: already disabled for interface ip6 fib...",
-                       mp->pid);
-         retval = -2;
-         goto reply;
-       }
-      else
-       {
-         rp->stats_registrations &= ~(IP6_FIB_COUNTERS);       // Clear flag
-         if (rp->stats_registrations == 0)     // Client isn't listening to anything else
-           {
-             pool_put (sm->stats_registrations, rp);
-             hash_unset (sm->stats_registration_hash, mp->client_index);
-           }
-         goto reply;
-       }
-    }
-  /* Enable case */
-  /* Get client from pool */
-  if (p)
-    rp = pool_elt_at_index (sm->stats_registrations, p[0]);
+  handle_client_registration (&rp, IDX_IP6_FIB_COUNTERS, fib,
+                             mp->enable_disable);
 
-  if (!p || !rp)               // Doesn't exist, make a new entry
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
     {
-      pool_get (sm->stats_registrations, rp);
-      rp->client.client_index = mp->client_index;
-      rp->client.client_pid = mp->pid;
+      sm->enable_poller = clear_client_for_stat (IDX_IP6_FIB_COUNTERS,
+                                                fib, mp->client_index);
+      return;
     }
-  rp->stats_registrations |= IP6_FIB_COUNTERS;
-  hash_set (sm->stats_registration_hash, rp->client.client_index,
-           rp - sm->stats_registrations);
 
-reply:
-  if (pool_elts (sm->stats_registrations))     // Someone wants something, somewhere so enable globally for now.
-    sm->enable_poller = 1;
-  else
-    sm->enable_poller = 0;
+  rmp = vl_msg_api_alloc (sizeof (*rmp));
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_IP6_FIB_STATS_REPLY);
+  rmp->context = mp->context;
+  rmp->retval = retval;
 
-  q = vl_api_client_index_to_input_queue (mp->client_index);
+  vl_api_send_msg (reg, (u8 *) rmp);
+}
 
-  if (!q)
-    return;
+static void
+vl_api_want_ip6_mfib_stats_t_handler (vl_api_want_ip6_mfib_stats_t * mp)
+{
+  stats_main_t *sm = &stats_main;
+  vpe_client_registration_t rp;
+  vl_api_want_ip4_mfib_stats_reply_t *rmp;
+  uword *p;
+  i32 retval = 0;
+  vl_api_registration_t *reg;
+  u32 mfib;
+
+  mfib = ~0;                   //Using same mechanism as _per_interface_
+  rp.client_index = mp->client_index;
+  rp.client_pid = mp->pid;
+
+  handle_client_registration (&rp, IDX_IP6_MFIB_COUNTERS, mfib,
+                             mp->enable_disable);
+
+reply:
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
+    {
+      sm->enable_poller = clear_client_for_stat (IDX_IP6_MFIB_COUNTERS,
+                                                mfib, mp->client_index);
+      return;
+    }
 
   rmp = vl_msg_api_alloc (sizeof (*rmp));
-  rmp->_vl_msg_id = ntohs (VL_API_WANT_IP6_FIB_STATS_REPLY);
+  rmp->_vl_msg_id = ntohs (VL_API_WANT_IP6_MFIB_STATS_REPLY);
   rmp->context = mp->context;
   rmp->retval = retval;
 
-  vl_msg_api_send_shmem (q, (u8 *) & rmp);
+  vl_api_send_msg (reg, (u8 *) rmp);
 }
 
 /* FIXME - NBR stats broken - this will be fixed in subsequent patch */
@@ -1743,11 +2842,10 @@ vl_api_vnet_get_summary_stats_t_handler (vl_api_vnet_get_summary_stats_t * mp)
   int i, which;
   u64 total_pkts[VLIB_N_RX_TX];
   u64 total_bytes[VLIB_N_RX_TX];
+  vl_api_registration_t *reg;
 
-  unix_shared_memory_queue_t *q =
-    vl_api_client_index_to_input_queue (mp->client_index);
-
-  if (!q)
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
     return;
 
   rmp = vl_msg_api_alloc (sizeof (*rmp));
@@ -1780,7 +2878,7 @@ vl_api_vnet_get_summary_stats_t_handler (vl_api_vnet_get_summary_stats_t * mp)
   rmp->vector_rate =
     clib_host_to_net_u64 (vlib_last_vector_length_per_node (sm->vlib_main));
 
-  vl_msg_api_send_shmem (q, (u8 *) & rmp);
+  vl_api_send_msg (reg, (u8 *) rmp);
 }
 
 int
@@ -1790,13 +2888,14 @@ stats_memclnt_delete_callback (u32 client_index)
   stats_main_t *sm = &stats_main;
   uword *p;
 
-  p = hash_get (sm->stats_registration_hash, client_index);
-  if (p)
-    {
-      rp = pool_elt_at_index (sm->stats_registrations, p[0]);
-      pool_put (sm->stats_registrations, rp);
-      hash_unset (sm->stats_registration_hash, client_index);
-    }
+  // FIXME
+  /* p = hash_get (sm->stats_registration_hash, client_index); */
+  /* if (p) */
+  /*   { */
+  /*     rp = pool_elt_at_index (sm->stats_registrations, p[0]); */
+  /*     pool_put (sm->stats_registrations, rp); */
+  /*     hash_unset (sm->stats_registration_hash, client_index); */
+  /*   } */
 
   return 0;
 }
@@ -1854,6 +2953,14 @@ stats_init (vlib_main_t * vm)
    */
   setup_message_id_table (am);
 
+  vec_validate (sm->stats_registrations, STATS_REG_N_IDX);
+  vec_validate (sm->stats_registration_hash, STATS_REG_N_IDX);
+#define stats_reg(n)                            \
+  sm->stats_registrations[IDX_##n] = 0; \
+  sm->stats_registration_hash[IDX_##n] = 0;
+#include <vpp/stats/stats.reg>
+#undef stats_reg
+
   return 0;
 }