- fixme
[oweals/gnunet.git] / src / mesh / gnunet-service-mesh_peer.c
1 /*
2      This file is part of GNUnet.
3      (C) 2013 Christian Grothoff (and other contributing authors)
4
5      GNUnet is free software; you can redistribute it and/or modify
6      it under the terms of the GNU General Public License as published
7      by the Free Software Foundation; either version 3, or (at your
8      option) any later version.
9
10      GNUnet is distributed in the hope that it will be useful, but
11      WITHOUT ANY WARRANTY; without even the implied warranty of
12      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
13      General Public License for more details.
14
15      You should have received a copy of the GNU General Public License
16      along with GNUnet; see the file COPYING.  If not, write to the
17      Free Software Foundation, Inc., 59 Temple Place - Suite 330,
18      Boston, MA 02111-1307, USA.
19 */
20
21
22 #include "platform.h"
23 #include "gnunet_util_lib.h"
24
25 #include "gnunet_core_service.h"
26 #include "gnunet_statistics_service.h"
27
28 #include "mesh_protocol.h"
29
30 #include "gnunet-service-mesh_peer.h"
31 #include "gnunet-service-mesh_dht.h"
32 #include "gnunet-service-mesh_connection.h"
33 #include "gnunet-service-mesh_tunnel.h"
34 #include "mesh_path.h"
35
36 #define LOG(level, ...) GNUNET_log_from (level,"mesh-p2p",__VA_ARGS__)
37
38 /******************************************************************************/
39 /********************************   STRUCTS  **********************************/
40 /******************************************************************************/
41
42 /**
43  * Struct containing info about a queued transmission to this peer
44  */
45 struct MeshPeerQueue
46 {
47     /**
48       * DLL next
49       */
50   struct MeshPeerQueue *next;
51
52     /**
53       * DLL previous
54       */
55   struct MeshPeerQueue *prev;
56
57     /**
58      * Peer this transmission is directed to.
59      */
60   struct MeshPeer *peer;
61
62     /**
63      * Connection this message belongs to.
64      */
65   struct MeshConnection *c;
66
67     /**
68      * Is FWD in c?
69      */
70   int fwd;
71
72     /**
73      * Pointer to info stucture used as cls.
74      */
75   void *cls;
76
77     /**
78      * Type of message
79      */
80   uint16_t type;
81
82     /**
83      * Size of the message
84      */
85   size_t size;
86
87     /**
88      * Set when this message starts waiting for CORE.
89      */
90   struct GNUNET_TIME_Absolute start_waiting;
91
92     /**
93      * Function to call on sending.
94      */
95   GMP_sent callback;
96
97     /**
98      * Closure for callback.
99      */
100   void *callback_cls;
101 };
102
103 /**
104  * Struct containing all information regarding a given peer
105  */
106 struct MeshPeer
107 {
108     /**
109      * ID of the peer
110      */
111   GNUNET_PEER_Id id;
112
113     /**
114      * Last time we heard from this peer
115      */
116   struct GNUNET_TIME_Absolute last_contact;
117
118     /**
119      * Paths to reach the peer, ordered by ascending hop count
120      */
121   struct MeshPeerPath *path_head;
122
123     /**
124      * Paths to reach the peer, ordered by ascending hop count
125      */
126   struct MeshPeerPath *path_tail;
127
128     /**
129      * Handle to stop the DHT search for paths to this peer
130      */
131   struct GMD_search_handle *search_h;
132
133     /**
134      * Tunnel to this peer, if any.
135      */
136   struct MeshTunnel3 *tunnel;
137
138     /**
139      * Connections that go through this peer, indexed by tid;
140      */
141   struct GNUNET_CONTAINER_MultiHashMap *connections;
142
143     /**
144      * Handle for queued transmissions
145      */
146   struct GNUNET_CORE_TransmitHandle *core_transmit;
147
148   /**
149    * Transmission queue to core DLL head
150    */
151   struct MeshPeerQueue *queue_head;
152
153   /**
154    * Transmission queue to core DLL tail
155    */
156   struct MeshPeerQueue *queue_tail;
157
158   /**
159    * How many messages are in the queue to this peer.
160    */
161   unsigned int queue_n;
162 };
163
164
165 /******************************************************************************/
166 /*******************************   GLOBALS  ***********************************/
167 /******************************************************************************/
168
169 /**
170  * Global handle to the statistics service.
171  */
172 extern struct GNUNET_STATISTICS_Handle *stats;
173
174 /**
175  * Local peer own ID (full value).
176  */
177 extern struct GNUNET_PeerIdentity my_full_id;
178
179 /**
180  * Local peer own ID (short)
181  */
182 extern GNUNET_PEER_Id myid;
183
184 /**
185  * Peers known, indexed by PeerIdentity (MeshPeer).
186  */
187 static struct GNUNET_CONTAINER_MultiPeerMap *peers;
188
189 /**
190  * How many peers do we want to remember?
191  */
192 static unsigned long long max_peers;
193
194 /**
195  * Percentage of messages that will be dropped (for test purposes only).
196  */
197 static unsigned long long drop_percent;
198
199 /**
200  * Handle to communicate with core.
201  */
202 static struct GNUNET_CORE_Handle *core_handle;
203
204
205 /******************************************************************************/
206 /***************************** CORE CALLBACKS *********************************/
207 /******************************************************************************/
208
209
210 /**
211  * Iterator to notify all connections of a broken link. Mark connections
212  * to destroy after all traffic has been sent.
213  *
214  * @param cls Closure (peer disconnected).
215  * @param key Current key code (peer id).
216  * @param value Value in the hash map (connection).
217  *
218  * @return #GNUNET_YES to continue to iterate.
219  */
220 static int
221 notify_broken (void *cls,
222                const struct GNUNET_HashCode *key,
223                void *value)
224 {
225   struct MeshPeer *peer = cls;
226   struct MeshConnection *c = value;
227
228   GMC_notify_broken (c, peer);
229
230   return GNUNET_YES;
231 }
232
233
234 /**
235  * Method called whenever a given peer connects.
236  *
237  * @param cls closure
238  * @param peer peer identity this notification is about
239  */
240 static void
241 core_connect (void *cls, const struct GNUNET_PeerIdentity *peer)
242 {
243   struct MeshPeer *mp;
244   struct MeshPeerPath *path;
245
246   LOG (GNUNET_ERROR_TYPE_DEBUG, "Peer connected\n");
247   LOG (GNUNET_ERROR_TYPE_DEBUG, "     %s\n", GNUNET_i2s (&my_full_id));
248   mp = GMP_get (peer);
249   if (myid == mp->id)
250   {
251     LOG (GNUNET_ERROR_TYPE_DEBUG, "     (self)\n");
252     path = path_new (1);
253   }
254   else
255   {
256     LOG (GNUNET_ERROR_TYPE_DEBUG, "     %s\n", GNUNET_i2s (peer));
257     path = path_new (2);
258     path->peers[1] = mp->id;
259     GNUNET_PEER_change_rc (mp->id, 1);
260     GNUNET_STATISTICS_update (stats, "# peers", 1, GNUNET_NO);
261   }
262   path->peers[0] = myid;
263   GNUNET_PEER_change_rc (myid, 1);
264   GMP_add_path (mp, path, GNUNET_YES);
265
266   mp->connections = GNUNET_CONTAINER_multihashmap_create (32, GNUNET_YES);
267   return;
268 }
269
270
271 /**
272  * Method called whenever a peer disconnects.
273  *
274  * @param cls closure
275  * @param peer peer identity this notification is about
276  */
277 static void
278 core_disconnect (void *cls, const struct GNUNET_PeerIdentity *peer)
279 {
280   struct MeshPeer *p;
281
282   LOG (GNUNET_ERROR_TYPE_DEBUG, "Peer disconnected\n");
283   p = GNUNET_CONTAINER_multipeermap_get (peers, peer);
284   if (NULL == p)
285   {
286     GNUNET_break (0);
287     return;
288   }
289   if (myid == p->id)
290     LOG (GNUNET_ERROR_TYPE_DEBUG, "     (self)\n");
291   else
292     LOG (GNUNET_ERROR_TYPE_DEBUG, "     %s\n", GMP_2s (p));
293
294
295   GNUNET_CONTAINER_multihashmap_iterate (p->connections, &notify_broken, p);
296   GNUNET_CONTAINER_multihashmap_destroy (p->connections);
297   p->connections = NULL;
298   if (NULL != p->core_transmit)
299     {
300       GNUNET_CORE_notify_transmit_ready_cancel (p->core_transmit);
301       p->core_transmit = NULL;
302     }
303   GNUNET_STATISTICS_update (stats, "# peers", -1, GNUNET_NO);
304
305   return;
306 }
307
308
309 /**
310  * Functions to handle messages from core
311  */
312 static struct GNUNET_CORE_MessageHandler core_handlers[] = {
313   {&GMC_handle_create, GNUNET_MESSAGE_TYPE_MESH_CONNECTION_CREATE,
314     0},
315   {&GMC_handle_confirm, GNUNET_MESSAGE_TYPE_MESH_CONNECTION_ACK,
316     sizeof (struct GNUNET_MESH_ConnectionACK)},
317   {&GMC_handle_broken, GNUNET_MESSAGE_TYPE_MESH_CONNECTION_BROKEN,
318     sizeof (struct GNUNET_MESH_ConnectionBroken)},
319   {&GMC_handle_destroy, GNUNET_MESSAGE_TYPE_MESH_CONNECTION_DESTROY,
320     sizeof (struct GNUNET_MESH_ConnectionDestroy)},
321   {&GMC_handle_keepalive, GNUNET_MESSAGE_TYPE_MESH_FWD_KEEPALIVE,
322     sizeof (struct GNUNET_MESH_ConnectionKeepAlive)},
323   {&GMC_handle_keepalive, GNUNET_MESSAGE_TYPE_MESH_BCK_KEEPALIVE,
324     sizeof (struct GNUNET_MESH_ConnectionKeepAlive)},
325   {&GMC_handle_ack, GNUNET_MESSAGE_TYPE_MESH_ACK,
326     sizeof (struct GNUNET_MESH_ACK)},
327   {&GMC_handle_poll, GNUNET_MESSAGE_TYPE_MESH_POLL,
328     sizeof (struct GNUNET_MESH_Poll)},
329   {&GMC_handle_encrypted, GNUNET_MESSAGE_TYPE_MESH_ENCRYPTED, 0},
330   {&GMC_handle_kx, GNUNET_MESSAGE_TYPE_MESH_KX, 0},
331   {NULL, 0, 0}
332 };
333
334
335 /**
336  * To be called on core init/fail.
337  *
338  * @param cls Closure (config)
339  * @param identity the public identity of this peer
340  */
341 static void
342 core_init (void *cls,
343            const struct GNUNET_PeerIdentity *identity)
344 {
345   const struct GNUNET_CONFIGURATION_Handle *c = cls;
346   static int i = 0;
347
348   LOG (GNUNET_ERROR_TYPE_DEBUG, "Core init\n");
349   if (0 != memcmp (identity, &my_full_id, sizeof (my_full_id)))
350   {
351     LOG (GNUNET_ERROR_TYPE_ERROR, _("Wrong CORE service\n"));
352     LOG (GNUNET_ERROR_TYPE_ERROR, " core id %s\n", GNUNET_i2s (identity));
353     LOG (GNUNET_ERROR_TYPE_ERROR, " my id %s\n", GNUNET_i2s (&my_full_id));
354     GNUNET_CORE_disconnect (core_handle);
355     core_handle = GNUNET_CORE_connect (c, /* Main configuration */
356                                        NULL,      /* Closure passed to MESH functions */
357                                        &core_init,        /* Call core_init once connected */
358                                        &core_connect,     /* Handle connects */
359                                        &core_disconnect,  /* remove peers on disconnects */
360                                        NULL,      /* Don't notify about all incoming messages */
361                                        GNUNET_NO, /* For header only in notification */
362                                        NULL,      /* Don't notify about all outbound messages */
363                                        GNUNET_NO, /* For header-only out notification */
364                                        core_handlers);    /* Register these handlers */
365     if (10 < i++)
366       GNUNET_abort();
367   }
368   GML_start ();
369   return;
370 }
371
372 /**
373   * Core callback to write a pre-constructed data packet to core buffer
374   *
375   * @param cls Closure (MeshTransmissionDescriptor with data in "data" member).
376   * @param size Number of bytes available in buf.
377   * @param buf Where the to write the message.
378   *
379   * @return number of bytes written to buf
380   */
381 static size_t
382 send_core_data_raw (void *cls, size_t size, void *buf)
383 {
384   struct GNUNET_MessageHeader *msg = cls;
385   size_t total_size;
386
387   GNUNET_assert (NULL != msg);
388   total_size = ntohs (msg->size);
389
390   if (total_size > size)
391   {
392     GNUNET_break (0);
393     return 0;
394   }
395   memcpy (buf, msg, total_size);
396   GNUNET_free (cls);
397   return total_size;
398 }
399
400
401 /**
402  * Function to send a create connection message to a peer.
403  *
404  * @param c Connection to create.
405  * @param size number of bytes available in buf
406  * @param buf where the callee should write the message
407  * @return number of bytes written to buf
408  */
409 static size_t
410 send_core_connection_create (struct MeshConnection *c, size_t size, void *buf)
411 {
412   struct GNUNET_MESH_ConnectionCreate *msg;
413   struct GNUNET_PeerIdentity *peer_ptr;
414   const struct MeshPeerPath *p = GMC_get_path (c);
415   size_t size_needed;
416   int i;
417
418   LOG (GNUNET_ERROR_TYPE_DEBUG, "Sending CONNECTION CREATE...\n");
419   size_needed =
420       sizeof (struct GNUNET_MESH_ConnectionCreate) +
421       p->length * sizeof (struct GNUNET_PeerIdentity);
422
423   if (size < size_needed || NULL == buf)
424   {
425     GNUNET_break (0);
426     return 0;
427   }
428   msg = (struct GNUNET_MESH_ConnectionCreate *) buf;
429   msg->header.size = htons (size_needed);
430   msg->header.type = htons (GNUNET_MESSAGE_TYPE_MESH_CONNECTION_CREATE);
431   msg->cid = *GMC_get_id (c);
432
433   peer_ptr = (struct GNUNET_PeerIdentity *) &msg[1];
434   for (i = 0; i < p->length; i++)
435   {
436     GNUNET_PEER_resolve (p->peers[i], peer_ptr++);
437   }
438
439   LOG (GNUNET_ERROR_TYPE_DEBUG, 
440        "CONNECTION CREATE (%u bytes long) sent!\n",
441        size_needed);
442   return size_needed;
443 }
444
445
446 /**
447  * Creates a path ack message in buf and frees all unused resources.
448  *
449  * @param c Connection to send an ACK on.
450  * @param size number of bytes available in buf
451  * @param buf where the callee should write the message
452  *
453  * @return number of bytes written to buf
454  */
455 static size_t
456 send_core_connection_ack (struct MeshConnection *c, size_t size, void *buf)
457 {
458   struct GNUNET_MESH_ConnectionACK *msg = buf;
459
460   LOG (GNUNET_ERROR_TYPE_DEBUG, "Sending CONNECTION ACK...\n");
461   if (sizeof (struct GNUNET_MESH_ConnectionACK) > size)
462   {
463     GNUNET_break (0);
464     return 0;
465   }
466   msg->header.size = htons (sizeof (struct GNUNET_MESH_ConnectionACK));
467   msg->header.type = htons (GNUNET_MESSAGE_TYPE_MESH_CONNECTION_ACK);
468   msg->cid = *GMC_get_id (c);
469   msg->reserved = 0;
470
471   /* TODO add signature */
472
473   LOG (GNUNET_ERROR_TYPE_DEBUG, "CONNECTION ACK sent!\n");
474   return sizeof (struct GNUNET_MESH_ConnectionACK);
475 }
476
477
478 /******************************************************************************/
479 /********************************   STATIC  ***********************************/
480 /******************************************************************************/
481
482 /**
483  * Iterator over tunnel hash map entries to destroy the tunnel during shutdown.
484  *
485  * @param cls closure
486  * @param key current key code
487  * @param value value in the hash map
488  * @return #GNUNET_YES if we should continue to iterate,
489  *         #GNUNET_NO if not.
490  */
491 static int
492 shutdown_tunnel (void *cls,
493                  const struct GNUNET_PeerIdentity *key,
494                  void *value)
495 {
496   struct MeshPeer *p = value;
497   struct MeshTunnel3 *t = p->tunnel;
498
499   if (NULL != t)
500     GMT_destroy (t);
501   return GNUNET_YES;
502 }
503
504
505
506 /**
507  * Destroy the peer_info and free any allocated resources linked to it
508  *
509  * @param peer The peer_info to destroy.
510  *
511  * @return GNUNET_OK on success
512  */
513 static int
514 peer_destroy (struct MeshPeer *peer)
515 {
516   struct GNUNET_PeerIdentity id;
517   struct MeshPeerPath *p;
518   struct MeshPeerPath *nextp;
519
520   GNUNET_PEER_resolve (peer->id, &id);
521   GNUNET_PEER_change_rc (peer->id, -1);
522
523   LOG (GNUNET_ERROR_TYPE_WARNING, "destroying peer %s\n", GNUNET_i2s (&id));
524
525   if (GNUNET_YES !=
526     GNUNET_CONTAINER_multipeermap_remove (peers, &id, peer))
527   {
528     GNUNET_break (0);
529     LOG (GNUNET_ERROR_TYPE_WARNING, " not in peermap!!\n");
530   }
531   if (NULL != peer->search_h)
532   {
533     GMD_search_stop (peer->search_h);
534   }
535   p = peer->path_head;
536   while (NULL != p)
537   {
538     nextp = p->next;
539     GNUNET_CONTAINER_DLL_remove (peer->path_head, peer->path_tail, p);
540     path_destroy (p);
541     p = nextp;
542   }
543   GMT_destroy_empty (peer->tunnel);
544   GNUNET_free (peer);
545   return GNUNET_OK;
546 }
547
548
549 /**
550  * Returns if peer is used (has a tunnel or is neighbor).
551  *
552  * @param peer Peer to check.
553  *
554  * @return #GNUNET_YES if peer is in use.
555  */
556 static int
557 peer_is_used (struct MeshPeer *peer)
558 {
559   struct MeshPeerPath *p;
560
561   if (NULL != peer->tunnel)
562     return GNUNET_YES;
563
564   for (p = peer->path_head; NULL != p; p = p->next)
565   {
566     if (p->length < 3)
567       return GNUNET_YES;
568   }
569     return GNUNET_NO;
570 }
571
572
573 /**
574  * Iterator over all the peers to get the oldest timestamp.
575  *
576  * @param cls Closure (unsued).
577  * @param key ID of the peer.
578  * @param value Peer_Info of the peer.
579  */
580 static int
581 peer_get_oldest (void *cls,
582                  const struct GNUNET_PeerIdentity *key,
583                  void *value)
584 {
585   struct MeshPeer *p = value;
586   struct GNUNET_TIME_Absolute *abs = cls;
587
588   /* Don't count active peers */
589   if (GNUNET_YES == peer_is_used (p))
590     return GNUNET_YES;
591
592   if (abs->abs_value_us < p->last_contact.abs_value_us)
593     abs->abs_value_us = p->last_contact.abs_value_us;
594
595   return GNUNET_YES;
596 }
597
598
599 /**
600  * Iterator over all the peers to remove the oldest entry.
601  *
602  * @param cls Closure (unsued).
603  * @param key ID of the peer.
604  * @param value Peer_Info of the peer.
605  */
606 static int
607 peer_timeout (void *cls,
608               const struct GNUNET_PeerIdentity *key,
609               void *value)
610 {
611   struct MeshPeer *p = value;
612   struct GNUNET_TIME_Absolute *abs = cls;
613
614   LOG (GNUNET_ERROR_TYPE_WARNING,
615        "peer %s timeout\n", GNUNET_i2s (key));
616
617   if (p->last_contact.abs_value_us == abs->abs_value_us &&
618       GNUNET_NO == peer_is_used (p))
619   {
620     peer_destroy (p);
621     return GNUNET_NO;
622   }
623     return GNUNET_YES;
624 }
625
626
627 /**
628  * Delete oldest unused peer.
629  */
630 static void
631 peer_delete_oldest (void)
632 {
633   struct GNUNET_TIME_Absolute abs;
634
635   abs = GNUNET_TIME_UNIT_FOREVER_ABS;
636
637   GNUNET_CONTAINER_multipeermap_iterate (peers,
638                                          &peer_get_oldest,
639                                          &abs);
640   GNUNET_CONTAINER_multipeermap_iterate (peers,
641                                          &peer_timeout,
642                                          &abs);
643 }
644
645
646 /**
647  * Choose the best path towards a peer considering the tunnel properties.
648  *
649  * @param peer The destination peer.
650  *
651  * @return Best current known path towards the peer, if any.
652  */
653 static struct MeshPeerPath *
654 peer_get_best_path (const struct MeshPeer *peer)
655 {
656   struct MeshPeerPath *best_p;
657   struct MeshPeerPath *p;
658   unsigned int best_cost;
659   unsigned int cost;
660
661   best_cost = UINT_MAX;
662   best_p = NULL;
663   for (p = peer->path_head; NULL != p; p = p->next)
664   {
665     if (GNUNET_YES == GMT_is_path_used (peer->tunnel, p))
666       continue; /* If path is already in use, skip it. */
667
668     if ((cost = GMT_get_path_cost (peer->tunnel, p)) < best_cost)
669     {
670       best_cost = cost;
671       best_p = p;
672     }
673   }
674   return best_p;
675 }
676
677
678 static int
679 queue_is_sendable (struct MeshPeerQueue *q)
680 {
681   /* Is PID-independent? */
682   switch (q->type)
683   {
684     case GNUNET_MESSAGE_TYPE_MESH_ACK:
685     case GNUNET_MESSAGE_TYPE_MESH_POLL:
686       return GNUNET_YES;
687   }
688
689   if (GMC_is_sendable (q->c, q->fwd))
690     return GNUNET_YES;
691
692   return GNUNET_NO;
693 }
694
695
696 /**
697  * Get first sendable message.
698  *
699  * @param peer The destination peer.
700  *
701  * @return Best current known path towards the peer, if any.
702  */
703 static struct MeshPeerQueue *
704 peer_get_first_message (const struct MeshPeer *peer)
705 {
706   struct MeshPeerQueue *q;
707
708   for (q = peer->queue_head; NULL != q; q = q->next)
709   {
710     if (queue_is_sendable (q))
711       return q;
712   }
713
714   return NULL;
715 }
716
717
718 /**
719  * Function to process paths received for a new peer addition. The recorded
720  * paths form the initial tunnel, which can be optimized later.
721  * Called on each result obtained for the DHT search.
722  *
723  * @param cls closure
724  * @param path
725  */
726 static void
727 search_handler (void *cls, const struct MeshPeerPath *path)
728 {
729   struct MeshPeer *peer = cls;
730   unsigned int connection_count;
731
732   GMP_add_path_to_all (path, GNUNET_NO);
733
734   /* Count connections */
735   connection_count = GMT_count_connections (peer->tunnel);
736
737   /* If we already have 3 (or more (?!)) connections, it's enough */
738   if (3 <= connection_count)
739     return;
740
741   if (MESH_TUNNEL3_SEARCHING == GMT_get_state (peer->tunnel))
742   {
743     LOG (GNUNET_ERROR_TYPE_DEBUG, " ... connect!\n");
744     GMP_connect (peer);
745   }
746   return;
747 }
748
749
750 /**
751  * Core callback to write a queued packet to core buffer
752  *
753  * @param cls Closure (peer info).
754  * @param size Number of bytes available in buf.
755  * @param buf Where the to write the message.
756  *
757  * @return number of bytes written to buf
758  * 
759  * FIXME add GNUNET_MESSAGE_TYPE_MESH_KEEPALIVE
760  */
761 static size_t
762 queue_send (void *cls, size_t size, void *buf)
763 {
764   struct MeshPeer *peer = cls;
765   struct MeshConnection *c;
766   struct MeshPeerQueue *queue;
767   const struct GNUNET_PeerIdentity *dst_id;
768   size_t data_size;
769
770   peer->core_transmit = NULL;
771   LOG (GNUNET_ERROR_TYPE_DEBUG, "* Queue send (max %u)\n", size);
772
773   if (NULL == buf || 0 == size)
774   {
775     LOG (GNUNET_ERROR_TYPE_DEBUG, "* Buffer size 0.\n");
776     return 0;
777   }
778
779   /* Initialize */
780   queue = peer_get_first_message (peer);
781   if (NULL == queue)
782   {
783     GNUNET_break (0); /* Core tmt_rdy should've been canceled */
784     return 0;
785   }
786   c = queue->c;
787
788   dst_id = GNUNET_PEER_resolve2 (peer->id);
789   LOG (GNUNET_ERROR_TYPE_DEBUG, "*   towards %s\n", GNUNET_i2s (dst_id));
790   /* Check if buffer size is enough for the message */
791   if (queue->size > size)
792   {
793       LOG (GNUNET_ERROR_TYPE_DEBUG, "*   not enough room, reissue\n");
794       peer->core_transmit =
795           GNUNET_CORE_notify_transmit_ready (core_handle,
796                                              GNUNET_NO,
797                                              0,
798                                              GNUNET_TIME_UNIT_FOREVER_REL,
799                                              dst_id,
800                                              queue->size,
801                                              &queue_send,
802                                              peer);
803       return 0;
804   }
805   LOG (GNUNET_ERROR_TYPE_DEBUG, "*   size %u ok\n", queue->size);
806
807   /* Fill buf */
808   switch (queue->type)
809   {
810     case GNUNET_MESSAGE_TYPE_MESH_TUNNEL_DESTROY:
811     case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_DESTROY:
812     case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_BROKEN:
813     case GNUNET_MESSAGE_TYPE_MESH_ENCRYPTED:
814     case GNUNET_MESSAGE_TYPE_MESH_KX:
815     case GNUNET_MESSAGE_TYPE_MESH_ACK:
816     case GNUNET_MESSAGE_TYPE_MESH_POLL:
817       LOG (GNUNET_ERROR_TYPE_DEBUG,
818                   "*   raw: %s\n",
819                   GNUNET_MESH_DEBUG_M2S (queue->type));
820       data_size = send_core_data_raw (queue->cls, size, buf);
821       break;
822     case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_CREATE:
823       LOG (GNUNET_ERROR_TYPE_DEBUG, "*   path create\n");
824       if (GMC_is_origin (c, GNUNET_YES))
825         data_size = send_core_connection_create (queue->c, size, buf);
826       else
827         data_size = send_core_data_raw (queue->cls, size, buf);
828       break;
829     case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_ACK:
830       LOG (GNUNET_ERROR_TYPE_DEBUG, "*   path ack\n");
831       if (GMC_is_origin (c, GNUNET_NO) ||
832           GMC_is_origin (c, GNUNET_YES))
833         data_size = send_core_connection_ack (queue->c, size, buf);
834       else
835         data_size = send_core_data_raw (queue->cls, size, buf);
836       break;
837     case GNUNET_MESSAGE_TYPE_MESH_DATA:
838     case GNUNET_MESSAGE_TYPE_MESH_CHANNEL_CREATE:
839     case GNUNET_MESSAGE_TYPE_MESH_CHANNEL_DESTROY:
840       /* This should be encapsulted */
841       GNUNET_break (0);
842       data_size = 0;
843       break;
844     default:
845       GNUNET_break (0);
846       LOG (GNUNET_ERROR_TYPE_WARNING, "*   type unknown: %u\n", queue->type);
847       data_size = 0;
848   }
849
850   if (0 < drop_percent &&
851       GNUNET_CRYPTO_random_u32 (GNUNET_CRYPTO_QUALITY_WEAK, 101) < drop_percent)
852   {
853     LOG (GNUNET_ERROR_TYPE_WARNING,
854                 "Dropping message of type %s\n",
855                 GNUNET_MESH_DEBUG_M2S (queue->type));
856     data_size = 0;
857   }
858
859   /* Free queue, but cls was freed by send_core_* */
860   GMP_queue_destroy (queue, GNUNET_NO);
861
862   /* If more data in queue, send next */
863   queue = peer_get_first_message (peer);
864   if (NULL != queue)
865   {
866     LOG (GNUNET_ERROR_TYPE_DEBUG, "*   more data!\n");
867     if (NULL == peer->core_transmit)
868     {
869       peer->core_transmit =
870           GNUNET_CORE_notify_transmit_ready(core_handle,
871                                             0,
872                                             0,
873                                             GNUNET_TIME_UNIT_FOREVER_REL,
874                                             dst_id,
875                                             queue->size,
876                                             &queue_send,
877                                             peer);
878       queue->start_waiting = GNUNET_TIME_absolute_get ();
879     }
880     else
881     {
882       LOG (GNUNET_ERROR_TYPE_DEBUG,
883                   "*   tmt rdy called somewhere else\n");
884     }
885 //     GMC_start_poll (); FIXME needed?
886   }
887   else
888   {
889 //     GMC_stop_poll(); FIXME needed?
890   }
891
892   LOG (GNUNET_ERROR_TYPE_DEBUG, "*  Return %d\n", data_size);
893   return data_size;
894 }
895
896
897 /******************************************************************************/
898 /********************************    API    ***********************************/
899 /******************************************************************************/
900
901
902 /**
903  * Free a transmission that was already queued with all resources
904  * associated to the request.
905  *
906  * @param queue Queue handler to cancel.
907  * @param clear_cls Is it necessary to free associated cls?
908  */
909 void
910 GMP_queue_destroy (struct MeshPeerQueue *queue, int clear_cls)
911 {
912   struct MeshPeer *peer;
913
914   peer = queue->peer;
915   GNUNET_assert (NULL != queue->c);
916
917   if (GNUNET_YES == clear_cls)
918   {
919     LOG (GNUNET_ERROR_TYPE_DEBUG, "#   queue destroy type %s\n",
920                 GNUNET_MESH_DEBUG_M2S (queue->type));
921     switch (queue->type)
922     {
923       case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_DESTROY:
924       case GNUNET_MESSAGE_TYPE_MESH_TUNNEL_DESTROY:
925         LOG (GNUNET_ERROR_TYPE_INFO, "destroying a DESTROY message\n");
926         /* fall through */
927       case GNUNET_MESSAGE_TYPE_MESH_ENCRYPTED:
928       case GNUNET_MESSAGE_TYPE_MESH_ACK:
929       case GNUNET_MESSAGE_TYPE_MESH_POLL:
930       case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_ACK:
931       case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_CREATE:
932       case GNUNET_MESSAGE_TYPE_MESH_CONNECTION_BROKEN:
933       case GNUNET_MESSAGE_TYPE_MESH_KX:
934         LOG (GNUNET_ERROR_TYPE_DEBUG, "#   prebuilt message\n");;
935         GNUNET_free_non_null (queue->cls);
936         break;
937
938       default:
939         GNUNET_break (0);
940         LOG (GNUNET_ERROR_TYPE_ERROR, "#   type %s unknown!\n",
941                     GNUNET_MESH_DEBUG_M2S (queue->type));
942     }
943   }
944   GNUNET_CONTAINER_DLL_remove (peer->queue_head, peer->queue_tail, queue);
945
946   if (queue->type != GNUNET_MESSAGE_TYPE_MESH_ACK &&
947       queue->type != GNUNET_MESSAGE_TYPE_MESH_POLL)
948   {
949     peer->queue_n--;
950   }
951
952   if (NULL != queue->callback)
953   {
954     LOG (GNUNET_ERROR_TYPE_DEBUG, "#   Calling callback\n");
955     queue->callback (queue->callback_cls,
956                      queue->c, queue->type,
957                      queue->fwd, queue->size,
958                      GNUNET_TIME_absolute_get_duration (queue->start_waiting));
959   }
960
961   GNUNET_free (queue);
962 }
963
964
965 /**
966  * @brief Queue and pass message to core when possible.
967  *
968  * @param peer Peer towards which to queue the message.
969  * @param cls Closure (@c type dependant). It will be used by queue_send to
970  *            build the message to be sent if not already prebuilt.
971  * @param type Type of the message, 0 for a raw message.
972  * @param size Size of the message.
973  * @param c Connection this message belongs to (cannot be NULL).
974  * @param fwd Is this a message going root->dest? (FWD ACK are NOT FWD!)
975  * @param cont Continuation to be called once CORE has taken the message.
976  * @param cont_cls Closure for @c cont.
977  *
978  * @return Handle to cancel the message before it is sent. Once cont is called
979  *         message has been sent and therefore the handle is no longer valid.
980  */
981 struct MeshPeerQueue *
982 GMP_queue_add (struct MeshPeer *peer, void *cls, uint16_t type, size_t size,
983                struct MeshConnection *c, int fwd,
984                GMP_sent cont, void *cont_cls)
985 {
986   struct MeshPeerQueue *queue;
987   int priority;
988   int call_core;
989
990   LOG (GNUNET_ERROR_TYPE_DEBUG,
991        "queue add %s %s towards %s (size %u) on c %p (%s)\n",
992        fwd ? "FWD" : "BCK",  GNUNET_MESH_DEBUG_M2S (type), GMP_2s(peer),
993        size, c, GMC_2s (c));
994   GNUNET_assert (NULL != c);
995
996   if (NULL == peer->connections)
997   {
998     /* We are not connected to this peer, ignore request. */
999     GNUNET_break_op (0);
1000     return NULL;
1001   }
1002
1003   priority = 0;
1004
1005   if (GNUNET_MESSAGE_TYPE_MESH_POLL == type ||
1006       GNUNET_MESSAGE_TYPE_MESH_ACK == type)
1007   {
1008     priority = 100;
1009   }
1010
1011   LOG (GNUNET_ERROR_TYPE_DEBUG, "priority %d\n", priority);
1012
1013   call_core = GMC_is_sendable (c, fwd);
1014   queue = GNUNET_malloc (sizeof (struct MeshPeerQueue));
1015   queue->cls = cls;
1016   queue->type = type;
1017   queue->size = size;
1018   queue->peer = peer;
1019   queue->c = c;
1020   queue->fwd = fwd;
1021   queue->callback = cont;
1022   queue->callback_cls = cont_cls;
1023   if (100 > priority)
1024   {
1025     GNUNET_CONTAINER_DLL_insert_tail (peer->queue_head, peer->queue_tail, queue);
1026     peer->queue_n++;
1027   }
1028   else
1029   {
1030     GNUNET_CONTAINER_DLL_insert (peer->queue_head, peer->queue_tail, queue);
1031     call_core = GNUNET_YES;
1032   }
1033
1034   if (NULL == peer->core_transmit && GNUNET_YES == call_core)
1035   {
1036     LOG (GNUNET_ERROR_TYPE_DEBUG,
1037                 "calling core tmt rdy towards %s for %u bytes\n",
1038                 GMP_2s (peer), size);
1039     peer->core_transmit =
1040         GNUNET_CORE_notify_transmit_ready (core_handle,
1041                                            0,
1042                                            0,
1043                                            GNUNET_TIME_UNIT_FOREVER_REL,
1044                                            GNUNET_PEER_resolve2 (peer->id),
1045                                            size,
1046                                            &queue_send,
1047                                            peer);
1048     queue->start_waiting = GNUNET_TIME_absolute_get ();
1049   }
1050   else
1051   {
1052     LOG (GNUNET_ERROR_TYPE_DEBUG,
1053                 "core tmt rdy towards %s already called\n",
1054                 GMP_2s (peer));
1055
1056   }
1057   return queue;
1058 }
1059
1060
1061 /**
1062  * Cancel all queued messages to a peer that belong to a certain connection.
1063  *
1064  * @param peer Peer towards whom to cancel.
1065  * @param c Connection whose queued messages to cancel. Might be destroyed by
1066  *          the sent continuation call.
1067  */
1068 void
1069 GMP_queue_cancel (struct MeshPeer *peer, struct MeshConnection *c)
1070 {
1071   struct MeshPeerQueue *q;
1072   struct MeshPeerQueue *next;
1073   struct MeshPeerQueue *prev;
1074
1075   for (q = peer->queue_head; NULL != q; q = next)
1076   {
1077     prev = q->prev;
1078     if (q->c == c)
1079     {
1080       LOG (GNUNET_ERROR_TYPE_DEBUG,
1081                   "GMP_cancel_queue %s\n",
1082                   GNUNET_MESH_DEBUG_M2S (q->type));
1083       GMP_queue_destroy (q, GNUNET_YES);
1084
1085       /* Get next from prev, q->next might be already freed:
1086        * queue destroy -> callback -> GMC_destroy -> cancel_queues -> here
1087        */
1088       if (NULL == prev)
1089         next = peer->queue_head;
1090       else
1091         next = prev->next;
1092     }
1093     else
1094     {
1095       next = q->next;
1096     }
1097   }
1098   if (NULL == peer->queue_head)
1099   {
1100     if (NULL != peer->core_transmit)
1101     {
1102       GNUNET_CORE_notify_transmit_ready_cancel (peer->core_transmit);
1103       peer->core_transmit = NULL;
1104     }
1105   }
1106 }
1107
1108
1109 /**
1110  * Get the first transmittable message for a connection.
1111  *
1112  * @param peer Neighboring peer.
1113  * @param c Connection.
1114  *
1115  * @return First transmittable message.
1116  */
1117 static struct MeshPeerQueue *
1118 connection_get_first_message (struct MeshPeer *peer, struct MeshConnection *c)
1119 {
1120   struct MeshPeerQueue *q;
1121
1122   for (q = peer->queue_head; NULL != q; q = q->next)
1123   {
1124     if (q->c != c)
1125       continue;
1126     if (queue_is_sendable (q))
1127     {
1128       LOG (GNUNET_ERROR_TYPE_DEBUG, "  sendable!!\n");
1129       return q;
1130     }
1131     LOG (GNUNET_ERROR_TYPE_DEBUG, "  not sendable\n");
1132   }
1133
1134   return NULL;
1135 }
1136
1137
1138 void
1139 GMP_queue_unlock (struct MeshPeer *peer, struct MeshConnection *c)
1140 {
1141   struct MeshPeerQueue *q;
1142   size_t size;
1143
1144   if (NULL != peer->core_transmit)
1145   {
1146     LOG (GNUNET_ERROR_TYPE_DEBUG, "  already unlocked!\n");
1147     return; /* Already unlocked */
1148   }
1149
1150   q = connection_get_first_message (peer, c);
1151   if (NULL == q)
1152   {
1153     LOG (GNUNET_ERROR_TYPE_DEBUG, "  queue empty!\n");
1154     return; /* Nothing to transmit */
1155   }
1156
1157   size = q->size;
1158   peer->core_transmit =
1159       GNUNET_CORE_notify_transmit_ready (core_handle,
1160                                          GNUNET_NO,
1161                                          0,
1162                                          GNUNET_TIME_UNIT_FOREVER_REL,
1163                                          GNUNET_PEER_resolve2 (peer->id),
1164                                          size,
1165                                          &queue_send,
1166                                          peer);
1167 }
1168
1169
1170 /**
1171  * Initialize the peer subsystem.
1172  *
1173  * @param c Configuration.
1174  */
1175 void
1176 GMP_init (const struct GNUNET_CONFIGURATION_Handle *c)
1177 {
1178   LOG (GNUNET_ERROR_TYPE_DEBUG, "init\n");
1179   peers = GNUNET_CONTAINER_multipeermap_create (128, GNUNET_NO);
1180   if (GNUNET_OK !=
1181       GNUNET_CONFIGURATION_get_value_number (c, "MESH", "MAX_PEERS",
1182                                              &max_peers))
1183   {
1184     GNUNET_log_config_invalid (GNUNET_ERROR_TYPE_WARNING,
1185                                "MESH", "MAX_PEERS", "USING DEFAULT");
1186     max_peers = 1000;
1187   }
1188
1189   if (GNUNET_OK !=
1190       GNUNET_CONFIGURATION_get_value_number (c, "MESH", "DROP_PERCENT",
1191                                              &drop_percent))
1192   {
1193     drop_percent = 0;
1194   }
1195   else
1196   {
1197     LOG (GNUNET_ERROR_TYPE_WARNING,
1198                 "\n***************************************\n"
1199                 "Mesh is running with drop mode enabled.\n"
1200                 "This is NOT a good idea!\n"
1201                 "Remove the DROP_PERCENT option from your configuration.\n"
1202                 "***************************************\n");
1203   }
1204
1205   core_handle = GNUNET_CORE_connect (c, /* Main configuration */
1206                                      NULL,      /* Closure passed to MESH functions */
1207                                      &core_init,        /* Call core_init once connected */
1208                                      &core_connect,     /* Handle connects */
1209                                      &core_disconnect,  /* remove peers on disconnects */
1210                                      NULL,      /* Don't notify about all incoming messages */
1211                                      GNUNET_NO, /* For header only in notification */
1212                                      NULL,      /* Don't notify about all outbound messages */
1213                                      GNUNET_NO, /* For header-only out notification */
1214                                      core_handlers);    /* Register these handlers */
1215   if (NULL == core_handle)
1216   {
1217     GNUNET_break (0);
1218     GNUNET_SCHEDULER_shutdown ();
1219     return;
1220   }
1221 }
1222
1223 /**
1224  * Shut down the peer subsystem.
1225  */
1226 void
1227 GMP_shutdown (void)
1228 {
1229   GNUNET_CONTAINER_multipeermap_iterate (peers, &shutdown_tunnel, NULL);
1230
1231   if (core_handle != NULL)
1232   {
1233     GNUNET_CORE_disconnect (core_handle);
1234     core_handle = NULL;
1235   }
1236   GNUNET_PEER_change_rc (myid, -1);
1237 }
1238
1239 /**
1240  * Retrieve the MeshPeer stucture associated with the peer, create one
1241  * and insert it in the appropriate structures if the peer is not known yet.
1242  *
1243  * @param peer_id Full identity of the peer.
1244  *
1245  * @return Existing or newly created peer structure.
1246  */
1247 struct MeshPeer *
1248 GMP_get (const struct GNUNET_PeerIdentity *peer_id)
1249 {
1250   struct MeshPeer *peer;
1251
1252   peer = GNUNET_CONTAINER_multipeermap_get (peers, peer_id);
1253   if (NULL == peer)
1254   {
1255     peer = GNUNET_new (struct MeshPeer);
1256     if (GNUNET_CONTAINER_multipeermap_size (peers) > max_peers)
1257     {
1258       peer_delete_oldest ();
1259     }
1260         GNUNET_CONTAINER_multipeermap_put (peers, peer_id, peer,
1261                                            GNUNET_CONTAINER_MULTIHASHMAPOPTION_UNIQUE_FAST);
1262         peer->id = GNUNET_PEER_intern (peer_id);
1263   }
1264   peer->last_contact = GNUNET_TIME_absolute_get();
1265
1266   return peer;
1267 }
1268
1269
1270 /**
1271  * Retrieve the MeshPeer stucture associated with the peer, create one
1272  * and insert it in the appropriate structures if the peer is not known yet.
1273  *
1274  * @param peer Short identity of the peer.
1275  *
1276  * @return Existing or newly created peer structure.
1277  */
1278 struct MeshPeer *
1279 GMP_get_short (const GNUNET_PEER_Id peer)
1280 {
1281   return GMP_get (GNUNET_PEER_resolve2 (peer));
1282 }
1283
1284
1285 /**
1286  * Try to establish a new connection to this peer (in its tunnel).
1287  * If the peer doesn't have any path to it yet, try to get one.
1288  * If the peer already has some path, send a CREATE CONNECTION towards it.
1289  *
1290  * @param peer Peer to connect to.
1291  */
1292 void
1293 GMP_connect (struct MeshPeer *peer)
1294 {
1295   struct MeshTunnel3 *t;
1296   struct MeshPeerPath *p;
1297   struct MeshConnection *c;
1298   int rerun_search;
1299
1300   LOG (GNUNET_ERROR_TYPE_DEBUG,
1301               "peer_connect towards %s\n",
1302               GMP_2s (peer));
1303   t = peer->tunnel;
1304   c = NULL;
1305   rerun_search = GNUNET_NO;
1306
1307   if (NULL != peer->path_head)
1308   {
1309     LOG (GNUNET_ERROR_TYPE_DEBUG, "path exists\n");
1310     p = peer_get_best_path (peer);
1311     if (NULL != p)
1312     {
1313       LOG (GNUNET_ERROR_TYPE_DEBUG, "  %u hops\n", p->length);
1314       c = GMT_use_path (t, p);
1315       if (NULL == c)
1316       {
1317         /* This case can happen when the path includes a first hop that is
1318          * not yet known to be connected.
1319          *
1320          * This happens quite often during testing when running mesh
1321          * under valgrind: core connect notifications come very late and the
1322          * DHT result has already come and created a valid path.
1323          * In this case, the peer->connections hashmap will be NULL and
1324          * tunnel_use_path will not be able to create a connection from that
1325          * path.
1326          *
1327          * Re-running the DHT GET should give core time to callback.
1328          */
1329         GNUNET_break(0);
1330                 rerun_search = GNUNET_YES;
1331       }
1332       else
1333       {
1334         GMC_send_create (c);
1335         return;
1336       }
1337     }
1338   }
1339
1340   if (NULL != peer->search_h && GNUNET_YES == rerun_search)
1341   {
1342     GMD_search_stop (peer->search_h);
1343     peer->search_h = NULL;
1344     LOG (GNUNET_ERROR_TYPE_DEBUG, 
1345          "  Stopping DHT GET for peer %s\n",
1346          GMP_2s (peer));
1347   }
1348
1349   if (NULL == peer->search_h)
1350   {
1351     const struct GNUNET_PeerIdentity *id;
1352
1353     id = GNUNET_PEER_resolve2 (peer->id);
1354     LOG (GNUNET_ERROR_TYPE_DEBUG,
1355                 "  Starting DHT GET for peer %s\n", GMP_2s (peer));
1356     peer->search_h = GMD_search (id, &search_handler, peer);
1357     if (MESH_TUNNEL3_NEW == GMT_get_state (t))
1358       GMT_change_state (t, MESH_TUNNEL3_SEARCHING);
1359   }
1360 }
1361
1362
1363 /**
1364  * Set tunnel.
1365  *
1366  * @param peer Peer.
1367  * @param t Tunnel.
1368  */
1369 void
1370 GMP_set_tunnel (struct MeshPeer *peer, struct MeshTunnel3 *t)
1371 {
1372   peer->tunnel = t;
1373 }
1374
1375
1376 /**
1377  * Chech whether there is a direct (core level)  connection to peer.
1378  *
1379  * @param peer Peer to check.
1380  *
1381  * @return #GNUNET_YES if there is a direct connection.
1382  */
1383 int
1384 GMP_is_neighbor (const struct MeshPeer *peer)
1385 {
1386   struct MeshPeerPath *path;
1387
1388   if (NULL == peer->connections)
1389     return GNUNET_NO;
1390
1391   for (path = peer->path_head; NULL != path; path = path->next)
1392   {
1393     if (3 > path->length)
1394       return GNUNET_YES;
1395   }
1396
1397   GNUNET_break (0); /* Is not a neighbor but connections is not NULL */
1398   return GNUNET_NO;
1399 }
1400
1401
1402 /**
1403  * Create and initialize a new tunnel towards a peer, in case it has none.
1404  * In case the peer already has a tunnel, nothing is done.
1405  *
1406  * Does not generate any traffic, just creates the local data structures.
1407  *
1408  * @param peer Peer towards which to create the tunnel.
1409  */
1410 void
1411 GMP_add_tunnel (struct MeshPeer *peer)
1412 {
1413   if (NULL != peer->tunnel)
1414     return;
1415   peer->tunnel = GMT_new (peer);
1416 }
1417
1418
1419 /**
1420  * Add a connection to a neighboring peer.
1421  *
1422  * Store that the peer is the first hop of the connection in one
1423  * direction and that on peer disconnect the connection must be
1424  * notified and destroyed, for it will no longer be valid.
1425  *
1426  * @param peer Peer to add connection to.
1427  * @param c Connection to add.
1428  *
1429  * @return GNUNET_OK on success.
1430  */
1431 int
1432 GMP_add_connection (struct MeshPeer *peer,
1433                     struct MeshConnection *c)
1434 {
1435   if (NULL == peer->connections)
1436   {
1437     GNUNET_break (0);
1438     return GNUNET_SYSERR;
1439   }
1440   return GNUNET_CONTAINER_multihashmap_put (peer->connections,
1441                                             GMC_get_id (c),
1442                                             c,
1443                                             GNUNET_CONTAINER_MULTIHASHMAPOPTION_UNIQUE_FAST);
1444 }
1445
1446
1447 /**
1448  * Add the path to the peer and update the path used to reach it in case this
1449  * is the shortest.
1450  *
1451  * @param peer Destination peer to add the path to.
1452  * @param path New path to add. Last peer must be the peer in arg 1.
1453  *             Path will be either used of freed if already known.
1454  * @param trusted Do we trust that this path is real?
1455  *
1456  * @return path if path was taken, pointer to existing duplicate if exists
1457  *         NULL on error.
1458  */
1459 struct MeshPeerPath *
1460 GMP_add_path (struct MeshPeer *peer, struct MeshPeerPath *path,
1461               int trusted)
1462 {
1463   struct MeshPeerPath *aux;
1464   unsigned int l;
1465   unsigned int l2;
1466
1467   LOG (GNUNET_ERROR_TYPE_DEBUG, "adding path [%u] to peer %s\n",
1468        path->length, GMP_2s (peer));
1469
1470   if ((NULL == peer) || (NULL == path))
1471   {
1472     GNUNET_break (0);
1473     path_destroy (path);
1474     return NULL;
1475   }
1476   if (path->peers[path->length - 1] != peer->id)
1477   {
1478     GNUNET_break (0);
1479     path_destroy (path);
1480     return NULL;
1481   }
1482   if (2 >= path->length && GNUNET_NO == trusted)
1483   {
1484     /* Only allow CORE to tell us about direct paths */
1485     path_destroy (path);
1486     return NULL;
1487   }
1488   for (l = 1; l < path->length; l++)
1489   {
1490     if (path->peers[l] == myid)
1491     {
1492       LOG (GNUNET_ERROR_TYPE_DEBUG, "shortening path by %u\n", l);
1493       for (l2 = 0; l2 < path->length - l; l2++)
1494       {
1495         path->peers[l2] = path->peers[l + l2];
1496       }
1497       path->length -= l;
1498       l = 1;
1499       path->peers = GNUNET_realloc (path->peers,
1500                                     path->length * sizeof (GNUNET_PEER_Id));
1501     }
1502   }
1503
1504   LOG (GNUNET_ERROR_TYPE_DEBUG, "adding path [%u]\n", path->length);
1505
1506   l = path_get_length (path);
1507   if (0 == l)
1508   {
1509     path_destroy (path);
1510     return NULL;
1511   }
1512
1513   GNUNET_assert (peer->id == path->peers[path->length - 1]);
1514   for (aux = peer->path_head; aux != NULL; aux = aux->next)
1515   {
1516     l2 = path_get_length (aux);
1517     if (l2 > l)
1518     {
1519       LOG (GNUNET_ERROR_TYPE_DEBUG, "  added\n");
1520       GNUNET_CONTAINER_DLL_insert_before (peer->path_head,
1521                                           peer->path_tail, aux, path);
1522       return path;
1523     }
1524     else
1525     {
1526       if (l2 == l && memcmp (path->peers, aux->peers, l) == 0)
1527       {
1528         LOG (GNUNET_ERROR_TYPE_DEBUG, "  already known\n");
1529         path_destroy (path);
1530         return aux;
1531       }
1532     }
1533   }
1534   GNUNET_CONTAINER_DLL_insert_tail (peer->path_head, peer->path_tail,
1535                                     path);
1536   LOG (GNUNET_ERROR_TYPE_DEBUG, "  added last\n");
1537   return path;
1538 }
1539
1540
1541 /**
1542  * Add the path to the origin peer and update the path used to reach it in case
1543  * this is the shortest.
1544  * The path is given in peer_info -> destination, therefore we turn the path
1545  * upside down first.
1546  *
1547  * @param peer Peer to add the path to, being the origin of the path.
1548  * @param path New path to add after being inversed.
1549  *             Path will be either used or freed.
1550  * @param trusted Do we trust that this path is real?
1551  *
1552  * @return path if path was taken, pointer to existing duplicate if exists
1553  *         NULL on error.
1554  */
1555 struct MeshPeerPath *
1556 GMP_add_path_to_origin (struct MeshPeer *peer,
1557                         struct MeshPeerPath *path,
1558                         int trusted)
1559 {
1560   if (NULL == path)
1561     return NULL;
1562   path_invert (path);
1563   return GMP_add_path (peer, path, trusted);
1564 }
1565
1566
1567 /**
1568  * Adds a path to the info of all the peers in the path
1569  *
1570  * @param p Path to process.
1571  * @param confirmed Whether we know if the path works or not.
1572  */
1573 void
1574 GMP_add_path_to_all (const struct MeshPeerPath *p, int confirmed)
1575 {
1576   unsigned int i;
1577
1578   /* TODO: invert and add */
1579   for (i = 0; i < p->length && p->peers[i] != myid; i++) /* skip'em */ ;
1580   for (i++; i < p->length; i++)
1581   {
1582     struct MeshPeer *aux;
1583     struct MeshPeerPath *copy;
1584
1585     aux = GMP_get_short (p->peers[i]);
1586     copy = path_duplicate (p);
1587     copy->length = i + 1;
1588     GMP_add_path (aux, copy, p->length < 3 ? GNUNET_NO : confirmed);
1589   }
1590 }
1591
1592
1593 /**
1594  * Remove a connection from a neighboring peer.
1595  *
1596  * @param peer Peer to remove connection from.
1597  * @param c Connection to remove.
1598  *
1599  * @return GNUNET_OK on success.
1600  */
1601 int
1602 GMP_remove_connection (struct MeshPeer *peer,
1603                        const struct MeshConnection *c)
1604 {
1605   if (NULL == peer || NULL == peer->connections)
1606   {
1607     GNUNET_break (0);
1608     LOG (GNUNET_ERROR_TYPE_WARNING,
1609          "Peer %s is not a neighbor!\n",
1610          GMP_2s (peer));
1611     return GNUNET_SYSERR;
1612   }
1613   return GNUNET_CONTAINER_multihashmap_remove (peer->connections,
1614                                                GMC_get_id (c),
1615                                                c);
1616 }
1617
1618 /**
1619  * Start the DHT search for new paths towards the peer: we don't have
1620  * enough good connections.
1621  *
1622  * @param peer Destination peer.
1623  */
1624 void
1625 GMP_start_search (struct MeshPeer *peer)
1626 {
1627   if (NULL != peer->search_h)
1628   {
1629     GNUNET_break (0);
1630     return;
1631   }
1632
1633   peer->search_h = GMD_search (GMP_get_id (peer), &search_handler, peer);
1634 }
1635
1636
1637 /**
1638  * Stop the DHT search for new paths towards the peer: we already have
1639  * enough good connections.
1640  *
1641  * @param peer Destination peer.
1642  */
1643 void
1644 GMP_stop_search (struct MeshPeer *peer)
1645 {
1646   if (NULL == peer->search_h)
1647   {
1648     GNUNET_break (0);
1649     return;
1650   }
1651
1652   GMD_search_stop (peer->search_h);
1653   peer->search_h = NULL;
1654 }
1655
1656
1657 /**
1658  * Get the Full ID of a peer.
1659  *
1660  * @param peer Peer to get from.
1661  *
1662  * @return Full ID of peer.
1663  */
1664 const struct GNUNET_PeerIdentity *
1665 GMP_get_id (const struct MeshPeer *peer)
1666 {
1667   return GNUNET_PEER_resolve2 (peer->id);
1668 }
1669
1670
1671 /**
1672  * Get the Short ID of a peer.
1673  *
1674  * @param peer Peer to get from.
1675  *
1676  * @return Short ID of peer.
1677  */
1678 GNUNET_PEER_Id
1679 GMP_get_short_id (const struct MeshPeer *peer)
1680 {
1681   return peer->id;
1682 }
1683
1684
1685 /**
1686  * Get the tunnel towards a peer.
1687  *
1688  * @param peer Peer to get from.
1689  *
1690  * @return Tunnel towards peer.
1691  */
1692 struct MeshTunnel3 *
1693 GMP_get_tunnel (const struct MeshPeer *peer)
1694 {
1695   return peer->tunnel;
1696 }
1697
1698
1699 /**
1700  * Get the static string for a peer ID.
1701  *
1702  * @param peer Peer.
1703  *
1704  * @return Static string for it's ID.
1705  */
1706 const char *
1707 GMP_2s (const struct MeshPeer *peer)
1708 {
1709   if (NULL == peer)
1710     return "(NULL)";
1711   return GNUNET_i2s (GNUNET_PEER_resolve2 (peer->id));
1712 }