Fixed signed comparison warnings
[olsrd.git] / src / build_msg.c
index 029d00d..ac57b4d 100644 (file)
 /*
- * OLSR ad-hoc routing table management protocol
- * Copyright (C) 2004 Andreas T√łnnesen (andreto@ifi.uio.no)
+ * The olsr.org Optimized Link-State Routing daemon(olsrd)
+ * Copyright (c) 2004, Andreas T√łnnesen(andreto@olsr.org)
+ * All rights reserved.
  *
- * This file is part of olsrd-unik.
+ * Redistribution and use in source and binary forms, with or without 
+ * modification, are permitted provided that the following conditions 
+ * are met:
  *
- * UniK olsrd is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
+ * * Redistributions of source code must retain the above copyright 
+ *   notice, this list of conditions and the following disclaimer.
+ * * Redistributions in binary form must reproduce the above copyright 
+ *   notice, this list of conditions and the following disclaimer in 
+ *   the documentation and/or other materials provided with the 
+ *   distribution.
+ * * Neither the name of olsr.org, olsrd nor the names of its 
+ *   contributors may be used to endorse or promote products derived 
+ *   from this software without specific prior written permission.
  *
- * UniK olsrd is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
- * GNU General Public License for more details.
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 
+ * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER 
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 
+ * POSSIBILITY OF SUCH DAMAGE.
  *
- * You should have received a copy of the GNU General Public License
- * along with olsrd-unik; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ * Visit http://www.olsr.org for more information.
  *
+ * If you find this software useful feel free to make a donation
+ * to the project. For more information see the website or contact
+ * the copyright holders.
+ *
+ * $Id: build_msg.c,v 1.29 2005/03/10 20:43:13 kattemat Exp $
  */
 
 
 #include "defs.h"
+#include "olsr.h"
+#include "log.h"
 #include "build_msg.h"
 #include "local_hna_set.h"
-#include "olsr.h"
 
+#define BMSG_DBGLVL 5
 
-/* Begin:
- * Prototypes for internal functions 
- */
+#define OLSR_IPV4_HDRSIZE          12
+#define OLSR_IPV6_HDRSIZE          24
 
-/* IPv4 */
+#define OLSR_HELLO_IPV4_HDRSIZE    (OLSR_IPV4_HDRSIZE + 4)   
+#define OLSR_HELLO_IPV6_HDRSIZE    (OLSR_IPV6_HDRSIZE + 4)
+#define OLSR_TC_IPV4_HDRSIZE       (OLSR_IPV4_HDRSIZE + 4)
+#define OLSR_TC_IPV6_HDRSIZE       (OLSR_IPV6_HDRSIZE + 4)
+#define OLSR_MID_IPV4_HDRSIZE      OLSR_IPV4_HDRSIZE
+#define OLSR_MID_IPV6_HDRSIZE      OLSR_IPV6_HDRSIZE
+#define OLSR_HNA_IPV4_HDRSIZE      OLSR_IPV4_HDRSIZE
+#define OLSR_HNA_IPV6_HDRSIZE      OLSR_IPV6_HDRSIZE
 
-static void
-hello_build4(struct hello_message *, struct interface *);
 
-static void
-tc_build4(struct tc_message *, struct interface *);
+/* All these functions share this buffer */
 
-static int
-mid_build4(struct interface *);
+static char msg_buffer[MAXMESSAGESIZE - OLSR_HEADERSIZE];
 
-static void
-hna_build4(struct interface *);
+/* Prototypes for internal functions */
 
-/* IPv6 */
+/* IPv4 */
 
-static void
-hello_build6(struct hello_message *, struct interface *);
+static olsr_bool
+serialize_hello4(struct hello_message *, struct interface *);
 
-static void
-tc_build6(struct tc_message *, struct interface *);
+static olsr_bool
+serialize_tc4(struct tc_message *, struct interface *);
 
-static int
-mid_build6(struct interface *);
+static olsr_bool
+serialize_mid4(struct interface *);
 
-static void
-hna_build6(struct interface *);
+static olsr_bool
+serialize_hna4(struct interface *);
 
-/* End:
- * Prototypes for internal functions 
- */
+/* IPv6 */
 
+static olsr_bool
+serialize_hello6(struct hello_message *, struct interface *);
 
+static olsr_bool
+serialize_tc6(struct tc_message *, struct interface *);
+
+static olsr_bool
+serialize_mid6(struct interface *);
+
+static olsr_bool
+serialize_hna6(struct interface *);
 
-/*
- * Generic calls
- * These are the functions to call from outside
- */
 
 
 /**
@@ -76,7 +102,7 @@ hna_build6(struct interface *);
  * If this won't fit in one packet, chop it up into several.
  * Send the packet if the size of the data contained in the output buffer
  * reach maxmessagesize. Can generate an empty HELLO packet if the 
- * neighbor table is empty. The parameter messag is not used.
+ * neighbor table is empty. 
  *
  *
  *@param message the hello_message struct containing the info
@@ -86,21 +112,21 @@ hna_build6(struct interface *);
  *@return nada
  */
 
-void
-hello_build(struct hello_message *message, struct interface *ifp)
+olsr_bool
+queue_hello(struct hello_message *message, struct interface *ifp)
 {
-  switch(ipversion)
+#ifdef DEBUG
+  OLSR_PRINTF(BMSG_DBGLVL, "Building HELLO on %s\n-------------------\n", ifp->int_name)
+#endif
+
+  switch(olsr_cnf->ip_version)
     {
     case(AF_INET):
-      hello_build4(message, ifp);
-      break;
+      return serialize_hello4(message, ifp);
     case(AF_INET6):
-      hello_build6(message, ifp);
-      break;
-    default:
-      return;
+      return serialize_hello6(message, ifp);
     }
-  return;
+  return OLSR_FALSE;
 }
 
 
@@ -108,14 +134,7 @@ hello_build(struct hello_message *message, struct interface *ifp)
  * Generate TC packet with the contents of the parameter "message".
  * If this won't fit in one packet, chop it up into several.
  * Send the packet if the size of the data contained in the output buffer
- * reach maxmessagesize. Don't generate an empty TC packet.
- * The parameter messag is not used.
- *
- *If parameter ifp = NULL then this is a TC packet who is to be
- *forwarded. In that case each chump of the packet(if bigger then
- *maxmessagesize the packet has to be split) must be forwarded
- *on each interface(exept the one it came on - if it was a wired interface)
- *and seqnumbers must be taken from the recieved packet.
+ * reach maxmessagesize. 
  *
  *@param message the tc_message struct containing the info
  *to send
@@ -124,21 +143,21 @@ hello_build(struct hello_message *message, struct interface *ifp)
  *@return nada
  */
 
-void
-tc_build(struct tc_message *message, struct interface *ifp)           
+olsr_bool
+queue_tc(struct tc_message *message, struct interface *ifp)           
 {
-  switch(ipversion)
+#ifdef DEBUG
+  OLSR_PRINTF(BMSG_DBGLVL, "Building TC on %s\n-------------------\n", ifp->int_name)
+#endif
+
+  switch(olsr_cnf->ip_version)
     {
     case(AF_INET):
-      tc_build4(message, ifp);
-      break;
+      return serialize_tc4(message, ifp);
     case(AF_INET6):
-      tc_build6(message, ifp);
-      break;
-    default:
-      return;
+      return serialize_tc6(message, ifp);
     }
-  return;
+  return OLSR_FALSE;
 }
 
 
@@ -150,21 +169,21 @@ tc_build(struct tc_message *message, struct interface *ifp)
  *@return 1 on success
  */
 
-int
-mid_build(struct interface *ifn)
+olsr_bool
+queue_mid(struct interface *ifp)
 {
-  switch(ipversion)
+#ifdef DEBUG
+  OLSR_PRINTF(BMSG_DBGLVL, "Building MID on %s\n-------------------\n", ifp->int_name)
+#endif
+
+  switch(olsr_cnf->ip_version)
     {
     case(AF_INET):
-      return mid_build4(ifn);
-      break;
+      return serialize_mid4(ifp);
     case(AF_INET6):
-      return mid_build6(ifn);
-      break;
-    default:
-      return -1;
+      return serialize_mid6(ifp);
     }
-  return -1;
+  return OLSR_FALSE;
 }
 
 
@@ -175,21 +194,21 @@ mid_build(struct interface *ifn)
  *@param ifp the interface to send on
  *@return nada
  */
-void
-hna_build(struct interface *ifp)
+olsr_bool
+queue_hna(struct interface *ifp)
 {
-  switch(ipversion)
+#ifdef DEBUG
+  OLSR_PRINTF(BMSG_DBGLVL, "Building HNA on %s\n-------------------\n", ifp->int_name)
+#endif
+
+  switch(olsr_cnf->ip_version)
     {
     case(AF_INET):
-      hna_build4(ifp);
-      break;
+      return serialize_hna4(ifp);
     case(AF_INET6):
-      hna_build6(ifp);
-      break;
-    default:
-      return;
+      return serialize_hna6(ifp);
     }
-  return;
+  return OLSR_FALSE;
 }
 
 /*
@@ -197,6 +216,16 @@ hna_build(struct interface *ifp)
  */
 
 
+static void
+check_buffspace(int msgsize, int buffsize, char *type)
+{
+  if(msgsize > buffsize)
+    {
+      OLSR_PRINTF(1, "%s build, outputbuffer to small(%d/%d)!\n", type, msgsize, buffsize)
+      olsr_syslog(OLSR_LOG_ERR, "%s build, outputbuffer to small(%d/%d)!\n", type, msgsize, buffsize);
+      olsr_exit(__func__, EXIT_FAILURE);
+    }
+}
 
 
 /**
@@ -209,60 +238,55 @@ hna_build(struct interface *ifp)
  *@return nada
  */
 
-static void
-hello_build4(struct hello_message *message, struct interface *ifp)
+static olsr_bool
+serialize_hello4(struct hello_message *message, struct interface *ifp)
 {
-  int remainsize;
-  struct hello_neighbor *nb, *prev_nb;
+  olsr_u16_t remainsize, curr_size;
+  struct hello_neighbor *nb;
   union olsr_message *m;
   struct hellomsg *h;
   struct hellinfo *hinfo;
   union olsr_ip_addr *haddr;
-  int i, j, sametype;
-  int lastpacket = 0; /* number of neighbors with the same
-                        greater link status in the last packet */
-  if (!message)
-    return;
+  int i, j;
+  olsr_bool first_entry;
+
+  if((!message) || (!ifp) || (olsr_cnf->ip_version != AF_INET))
+    return OLSR_FALSE;
 
-  if(ipversion != AF_INET)
-    return;
+  remainsize = net_outbuffer_bytes_left(ifp);
 
-  remainsize = outputsize - (sizeof(msg->v4.olsr_packlen) + sizeof(msg->v4.olsr_seqno));
+  m = (union olsr_message *)msg_buffer;
 
-  //printf("HELLO build outputsize: %d\n", outputsize);
+  curr_size = OLSR_HELLO_IPV4_HDRSIZE;
 
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v4.olsr_msg + remainsize)
-    : (union olsr_message *) msg->v4.olsr_msg;
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  /* Sanity check */
+  check_buffspace(curr_size, remainsize, "HELLO");
 
   h = &m->v4.message.hello;
   hinfo = h->hell_info;
   haddr = (union olsr_ip_addr *)hinfo->neigh_addr;
   
-  //printf("Neighbor addr: %s\n", olsr_ip_to_string(haddr));fflush(stdout);
-
-  /* Set hopcount and ttl */
+  /* Fill message header */
   m->v4.ttl = message->ttl;
   m->v4.hopcnt = 0;
+  m->v4.olsr_msgtype = HELLO_MESSAGE;
+  /* Set source(main) addr */
+  COPY_IP(&m->v4.originator, &main_addr);
 
-  /* Send pending packet if not room in buffer */
-  if (outputsize > maxmessagesize - (int)sizeof (struct olsrmsg)) 
-    net_output(ifp);
+  m->v4.olsr_vtime = ifp->valtimes.hello;
 
-  /* Set willingness */
+  /* Fill HELLO header */
   h->willingness = message->willingness; 
-
-  if(ifp->is_wireless)
-    h->htime = htime;
-  else
-    h->htime = htime_nw;
-
+  h->htime = ifp->hello_etime;
 
   memset(&h->reserved, 0, sizeof(olsr_u16_t));
   
-  /* Set source(main) addr */
-  
-  COPY_IP(&m->v4.originator, &main_addr);
 
   /*
    *Loops trough all possible neighbor statuses
@@ -272,172 +296,105 @@ hello_build4(struct hello_message *message, struct interface *ifp)
   /* Nighbor statuses */
   for (i = 0; i <= MAX_NEIGH; i++) 
     {
-      /* Link ststuses */
+      /* Link statuses */
       for(j = 0; j <= MAX_LINK; j++)
        {
 
-         /*
-          *HYSTERESIS
-          *Not adding neighbors with link type HIDE
-          */
+         /* HYSTERESIS - Not adding neighbors with link type HIDE */
          
          if(j == HIDE_LINK)
              continue;
 
-         lastpacket = sametype = 0;
-
-         outputsize = (char *)hinfo - packet;
-
-         //printf("Neighbortype %d outputsize %d\n", i, outputsize);
-
-         /*
-          *Only if we're gona chop the packet
-          */
-         if (outputsize > maxmessagesize - (int)sizeof (struct hellinfo)) 
-           {
-             olsr_printf(1, "Chomping HELLO message\n");
-
-             m->v4.olsr_msgtype = HELLO_MESSAGE;
-             if(ifp->is_wireless)
-               m->v4.olsr_vtime = hello_vtime;
-             else
-               m->v4.olsr_vtime = hello_nw_vtime;
-
-             m->v4.olsr_msgsize = (char *)hinfo - (char *)m;
-             m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-             hinfo->size = (char *)haddr - (char *)hinfo;
-             hinfo->size = ntohs(hinfo->size);
-         
-             m->v4.seqno = htons(get_msg_seqno());             
-         
-             net_output(ifp);
-         
-             m = (union olsr_message *)msg->v4.olsr_msg;
-             h = &m->v4.message.hello;
-             hinfo = h->hell_info;
-             haddr = (union olsr_ip_addr *)&hinfo->neigh_addr; 
-           }
+         first_entry = OLSR_TRUE;
 
-         /*
-          *Looping trough neighbors
-          */
+         /* Looping trough neighbors */
          for (nb = message->neighbors; nb != NULL; nb = nb->next) 
-           {
-         
-             outputsize = (char *)haddr - packet;
-         
+           {     
+             if ((nb->status != i) || (nb->link != j))
+               continue;
+
+#ifdef DEBUG
+             OLSR_PRINTF(BMSG_DBGLVL, "\t%s - ", olsr_ip_to_string(&nb->address))
+             OLSR_PRINTF(BMSG_DBGLVL, "L:%d N:%d\n", j, i)
+#endif           
              /*
-              *If we're gonna chop it...again
+              * If there is not enough room left 
+              * for the data in the outputbuffer
+              * we must send a partial HELLO and
+              * continue building the rest of the
+              * data in a new HELLO message
+              *
+              * If this is the first neighbor in 
+              * a group, we must check for an extra
+              * 4 bytes
               */
-             if (outputsize > maxmessagesize - (int)ipsize)
+             if((curr_size + ipsize + (first_entry ? 4 : 0)) > remainsize)
                {
-                 olsr_printf(1, "Chomping HELLO again\n");
-
-                 m->v4.olsr_msgtype = HELLO_MESSAGE;
-                 if(ifp->is_wireless)
-                   m->v4.olsr_vtime = hello_vtime;
-                 else
-                   m->v4.olsr_vtime = hello_nw_vtime;
-
-                 m->v4.olsr_msgsize = (char *)haddr - (char *)m;
-                 m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-                 hinfo->size = (char *)haddr - (char *)hinfo;
-                 hinfo->size = ntohs(hinfo->size);
-             
-                 m->v4.seqno = htons(get_msg_seqno());
-
-                 net_output(ifp);
+                 /* Only send partial HELLO if it contains data */
+                 if(curr_size > OLSR_HELLO_IPV4_HDRSIZE)
+                   {
+#ifdef DEBUG
+                     OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
+#endif
+                     /* Complete the headers */
+                     m->v4.seqno = htons(get_msg_seqno());
+                     m->v4.olsr_msgsize = htons(curr_size);
+                     
+                     hinfo->size = htons((char *)haddr - (char *)hinfo);
+                     
+                     /* Send partial packet */
+                     net_outbuffer_push(ifp, msg_buffer, curr_size);
+                     
+                     curr_size = OLSR_HELLO_IPV4_HDRSIZE;
+                     
+                     h = &m->v4.message.hello;
+                     hinfo = h->hell_info;
+                     haddr = (union olsr_ip_addr *)hinfo->neigh_addr;                    
+                     /* Make sure typeheader is added */
+                     first_entry = OLSR_TRUE;
+                   }
+                 
+                 net_output(ifp);                        
+                 /* Reset size and pointers */
+                 remainsize = net_outbuffer_bytes_left(ifp);
+                 
+                 /* Sanity check */
+                 check_buffspace(curr_size + ipsize + 4, remainsize, "HELLO2");
+               }
              
-                 m = (union olsr_message *)msg->v4.olsr_msg;
-                 h = &m->v4.message.hello;
-                 hinfo = h->hell_info;
-                 haddr = (union olsr_ip_addr *)&hinfo->neigh_addr;
-
+             if (first_entry)
+               {
                  memset(&hinfo->reserved, 0, sizeof(olsr_u8_t));
-                 /* Set link and status */
-                 //hinfo->link_code = j | (i<<2);
+                 /* Set link and status for this group of neighbors (this is the first) */
                  hinfo->link_code = CREATE_LINK_CODE(i, j);
-
-                 //printf("Setting neighbor link status: %x\n", hinfo->link_code);
-
-             
-                 lastpacket = sametype;
+                 curr_size += 4; /* HELLO type section header */
                }
-         
-         
-             if ((nb->status == i) && (nb->link == j))
-               {
-                 sametype++;
-                 if (sametype == 1)
-                   {
-                     memset(&hinfo->reserved, 0, sizeof(olsr_u8_t));
-                     /* Set link and status for this group of neighbors (this is the first) */
-                     hinfo->link_code = CREATE_LINK_CODE(i, j);//j | (i<<2);
-                     //printf("(2)Setting neighbor link status: %x\n", hinfo->link_code);
-                   }
-
-#ifdef DEBUG
-                 olsr_printf(5, "\tLink status of %s: ", olsr_ip_to_string(&nb->address));
-                 olsr_printf(5, "%d\n", nb->link);
-#endif
-
-                 COPY_IP(haddr, &nb->address);
-
-                 //printf("\n\n1: %d\n", (char *)haddr - packet);
-                 /*
-                  *Point to next address
-                  */
-                 haddr = (union olsr_ip_addr *)&haddr->v6.s6_addr[4];
-
-                 //printf("\n2: %d\n\n", (char *)haddr - packet); 
-                 //printf("Ipsize: %d\n", ipsize);
+             
+             COPY_IP(haddr, &nb->address);
+             
+             /* Point to next address */
+             haddr = (union olsr_ip_addr *)&haddr->v6.s6_addr[4];
+             curr_size += ipsize; /* IP address added */
 
-                 //printf("Adding neighbor %s\n", olsr_ip_to_string(&nb->address));
-   
-               }
+             first_entry = OLSR_FALSE;
+           }
     
-           }/* looping trough neighbors */
-           
-
-         if (sametype && sametype > lastpacket)
+         if(!first_entry)
            {
-             hinfo->size = (char *)haddr - (char *)hinfo;
-             hinfo->size = ntohs(hinfo->size);
+             hinfo->size = htons((char *)haddr - (char *)hinfo);
              hinfo = (struct hellinfo *)((char *)haddr);
              haddr = (union olsr_ip_addr *)&hinfo->neigh_addr;
-             
            }
        } /* for j */
     } /* for i*/
      
   m->v4.seqno = htons(get_msg_seqno());
-  m->v4.olsr_msgsize = (char *)hinfo - (char *)m;
-  m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-  m->v4.olsr_msgtype = HELLO_MESSAGE;
-  if(ifp->is_wireless)
-    m->v4.olsr_vtime = hello_vtime;
-  else
-    m->v4.olsr_vtime = hello_nw_vtime;
-
-  outputsize = (char *)hinfo - packet;
+  m->v4.olsr_msgsize = htons(curr_size);
   
-  if (outputsize > maxmessagesize - (int)sizeof (struct olsrmsg)) 
-    net_output(ifp);
-
-
-  /*
-   * Delete the list of neighbor messages.
-   */
-     
-  nb = message->neighbors;
-     
-  while (nb)
-    {
-      prev_nb = nb;
-      nb = nb->next;
-      free(prev_nb);
-    }
+  net_outbuffer_push(ifp, msg_buffer, curr_size);
 
+  /* HELLO will always be generated */
+  return OLSR_TRUE;
 }
 
 
@@ -454,59 +411,52 @@ hello_build4(struct hello_message *message, struct interface *ifp)
  */
 
 
-static void
-hello_build6(struct hello_message *message, struct interface *ifp)
+static olsr_bool
+serialize_hello6(struct hello_message *message, struct interface *ifp)
 {
-  int remainsize;
-  struct hello_neighbor *nb, *prev_nb;
+  olsr_u16_t remainsize, curr_size;
+  struct hello_neighbor *nb;
   union olsr_message *m;
   struct hellomsg6 *h6;
   struct hellinfo6 *hinfo6;
   union olsr_ip_addr *haddr;
+  int i, j;
+  olsr_bool first_entry;
 
-  int i, j, sametype;
-  int lastpacket = 0; /* number of neighbors with the same
-                        greater link status in the last packet */
-  if (!message)
-    return;
+  if((!message) || (!ifp) || (olsr_cnf->ip_version != AF_INET6))
+    return OLSR_FALSE;
 
-  if(ipversion != AF_INET6)
-    return;
+  remainsize = net_outbuffer_bytes_left(ifp);
+  m = (union olsr_message *)msg_buffer;
 
-  remainsize = outputsize - (sizeof(msg->v6.olsr_packlen) + sizeof(msg->v6.olsr_seqno));
+  curr_size = OLSR_HELLO_IPV6_HDRSIZE; /* OLSR message header */
 
-  //printf("HELLO build outputsize: %d\n", outputsize);
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  check_buffspace(curr_size + ipsize + 4, remainsize, "HELLO");
 
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v6.olsr_msg + remainsize)
-    : (union olsr_message *) msg->v6.olsr_msg;
   h6 = &m->v6.message.hello;
   hinfo6 = h6->hell_info;
   haddr = (union olsr_ip_addr *)hinfo6->neigh_addr;
 
 
-  /* Set hopcount and ttl */
+  /* Fill message header */
   m->v6.ttl = message->ttl;
   m->v6.hopcnt = 0;
+  /* Set source(main) addr */
+  COPY_IP(&m->v6.originator, &main_addr);
+  m->v6.olsr_msgtype = HELLO_MESSAGE;
 
-  if (outputsize > maxmessagesize - (int)sizeof (struct olsrmsg)) 
-    net_output(ifp);
+  m->v6.olsr_vtime = ifp->valtimes.hello;
   
-  
-  /* Set willingness */
+  /* Fill packet header */
   h6->willingness = message->willingness; 
-
-  if(ifp->is_wireless)
-    h6->htime = htime;
-  else
-    h6->htime = htime_nw;
-  
+  h6->htime = ifp->hello_etime;
   memset(&h6->reserved, 0, sizeof(olsr_u16_t));
-  
-  
-  /* Set source(main) addr */
-  
-  COPY_IP(&m->v6.originator, &main_addr);
 
   /*
    *Loops trough all possible neighbor statuses
@@ -517,130 +467,87 @@ hello_build6(struct hello_message *message, struct interface *ifp)
     {
       for(j = 0; j <= MAX_LINK; j++)
        {
-         
-         
-         lastpacket = sametype = 0;
-         
-         outputsize = (char *)hinfo6 - packet;
-         
-         //printf("Neighbortype %d outputsize %d\n", i, outputsize);
-         
-         /*
-          *Only if we're gona chop the packet
-          */
-         if (outputsize > maxmessagesize - (int)sizeof (struct hellinfo)) 
-           {
-             olsr_printf(1, "Chomping HELLO message\n");
-             
-             m->v6.olsr_msgtype = HELLO_MESSAGE;
-             if(ifp->is_wireless)
-               m->v6.olsr_vtime = hello_vtime;
-             else
-               m->v6.olsr_vtime = hello_nw_vtime;
-             
-             m->v6.olsr_msgsize = (char *)hinfo6 - (char *)m;
-             m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-             hinfo6->size = (char *)haddr - (char *)hinfo6;
-             hinfo6->size = ntohs(hinfo6->size);
-             
-             m->v6.seqno = htons(get_msg_seqno());             
-             
-             net_output(ifp);
-             
-             m = (union olsr_message *)msg->v6.olsr_msg;
-             h6 = &m->v6.message.hello;
-             hinfo6 = h6->hell_info;
-             haddr = (union olsr_ip_addr *)&hinfo6->neigh_addr;
-             
-           }
-         
+         first_entry = OLSR_TRUE;
+                 
          /*
           *Looping trough neighbors
           */
          for (nb = message->neighbors; nb != NULL; nb = nb->next) 
-           {
-             
-             outputsize = (char *)haddr - packet;
-             
+           {         
+             if ((nb->status != i) || (nb->link != j))
+               continue;
+
+#ifdef DEBUG
+             OLSR_PRINTF(BMSG_DBGLVL, "\t%s - ", olsr_ip_to_string(&nb->address))
+             OLSR_PRINTF(BMSG_DBGLVL, "L:%d N:%d\n", j, i)
+#endif           
+
+
              /*
-              *If we're gonna chop it...again
+              * If there is not enough room left 
+              * for the data in the outputbuffer
+              * we must send a partial HELLO and
+              * continue building the rest of the
+              * data in a new HELLO message
+              *
+              * If this is the first neighbor in 
+              * a group, we must check for an extra
+              * 4 bytes
               */
-             if (outputsize > maxmessagesize - (int)ipsize)
+             if((curr_size + ipsize + (first_entry ? 4 : 0)) > remainsize)
                {
-                 olsr_printf(1, "Chomping HELLO again\n");
-                 
-                 m->v6.olsr_msgtype = HELLO_MESSAGE;
-                 if(ifp->is_wireless)
-                   m->v6.olsr_vtime = hello_vtime;
-                 else
-                   m->v6.olsr_vtime = hello_nw_vtime;
-                 
-                 m->v6.olsr_msgsize = (char *)haddr - (char *)m;
-                 m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-                 hinfo6->size = (char *)haddr - (char *)hinfo6;
-                 hinfo6->size = ntohs(hinfo6->size);
-                 
-                 m->v6.seqno = htons(get_msg_seqno());
-                 
-                 //m->v6.seqno = htons(message->mpr_seq_number);
-                 
-                 net_output(ifp);
-                 
-                 m = (union olsr_message *)msg->v6.olsr_msg;
-                 h6 = &m->v6.message.hello;
-                 hinfo6 = h6->hell_info;
-                 haddr = (union olsr_ip_addr *)&hinfo6->neigh_addr;
-                 
-
-                 memset(&hinfo6->reserved, 0, sizeof(olsr_u8_t));
-                 /* Set link and status */
-                 hinfo6->link_code = CREATE_LINK_CODE(i, j);//j | (i<<2);
-         
-                 //printf("Setting neighbor link status: %d\n", nb->link);
-                 
-                 
-                 lastpacket = sametype;
-               }
-             
-             
-             if ((nb->status == i) && (nb->link == j))
-               {             
-                 sametype++;
-                 if (sametype == 1)
+                 /* Only send partial HELLO if it contains data */
+                 if(curr_size > OLSR_HELLO_IPV6_HDRSIZE)
                    {
-                     memset(&hinfo6->reserved, 0, sizeof(olsr_u8_t));
-                     /* Set link and status for this group of neighbors (this is the first) */
-                     hinfo6->link_code = CREATE_LINK_CODE(i, j);//j | (i<<2);
-                     //printf("(2)Setting neighbor link status: %x\n", hinfo->link_code);
-                   }
-
 #ifdef DEBUG
-                 olsr_printf(5, "\tLink status of %s: ", olsr_ip_to_string(&nb->address));
-                 olsr_printf(5, "%d\n", nb->link);
+                     OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
 #endif
+                     /* Complete the headers */
+                     m->v6.seqno = htons(get_msg_seqno());
+                     m->v6.olsr_msgsize = htons(curr_size);
+                         
+                     hinfo6->size = (char *)haddr - (char *)hinfo6;
+                     hinfo6->size = htons(hinfo6->size);
+                         
+                     /* Send partial packet */
+                     net_outbuffer_push(ifp, msg_buffer, curr_size);
+                     curr_size = OLSR_HELLO_IPV6_HDRSIZE;
+                         
+                     h6 = &m->v6.message.hello;
+                     hinfo6 = h6->hell_info;
+                     haddr = (union olsr_ip_addr *)hinfo6->neigh_addr;
+                     /* Make sure typeheader is added */
+                     first_entry = OLSR_TRUE;
+                   }
+                 net_output(ifp);
+                 /* Reset size and pointers */
+                 remainsize = net_outbuffer_bytes_left(ifp);
 
-                 COPY_IP(haddr, &nb->address);
-                 
-                 //printf("\n\n1: %d\n", (char *)haddr - packet);
-                 /*
-                  *Point to next address
-                  */
-                 haddr++;
+                 check_buffspace(curr_size + ipsize + 4, remainsize, "HELLO2");
+                     
+               }
+
+             if(first_entry)
+               {
+                 memset(&hinfo6->reserved, 0, sizeof(olsr_u8_t));
+                 /* Set link and status for this group of neighbors (this is the first) */
+                 hinfo6->link_code = CREATE_LINK_CODE(i, j);
+                 curr_size += 4; /* HELLO type section header */
+               }
                  
-                 //printf("\n2: %d\n\n", (char *)haddr - packet); 
-                 //printf("Ipsize: %d\n", ipsize);
+             COPY_IP(haddr, &nb->address);
                  
-                 //printf("Adding neighbor %s\n", olsr_ip_to_string(&nb->address));
+             /* Point to next address */
+             haddr++;
+             curr_size += ipsize; /* IP address added */ 
                  
-               }
-             
+             first_entry = OLSR_FALSE;
            }/* looping trough neighbors */
-           
          
-         if (sametype && sametype > lastpacket)
+         
+         if (!first_entry)
            {
-             hinfo6->size = (char *)haddr - (char *)hinfo6;
-             hinfo6->size = ntohs(hinfo6->size);
+             hinfo6->size = htons((char *)haddr - (char *)hinfo6);
              hinfo6 = (struct hellinfo6 *)((char *)haddr);
              haddr = (union olsr_ip_addr *)&hinfo6->neigh_addr;
            }
@@ -649,39 +556,16 @@ hello_build6(struct hello_message *message, struct interface *ifp)
     } /* for i */
 
   m->v6.seqno = htons(get_msg_seqno());
-  m->v6.olsr_msgsize = (char *)hinfo6 - (char *)m;
-  m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-  m->v6.olsr_msgtype = HELLO_MESSAGE;
-  if(ifp->is_wireless)
-    m->v6.olsr_vtime = hello_vtime;
-  else
-    m->v6.olsr_vtime = hello_nw_vtime;
+  m->v6.olsr_msgsize = htons(curr_size);
 
-  outputsize = (char *)hinfo6 - packet;
-
-  if (outputsize > maxmessagesize - (int)sizeof (struct olsrmsg6)) 
-      net_output(ifp);
-
-
-  /*
-   * Delete the list of neighbor messages.
-   */
-     
-  nb = message->neighbors;
-     
-  while (nb)
-    {
-      prev_nb = nb;
-      nb = nb->next;
-      free(prev_nb);
-    }
+  net_outbuffer_push(ifp, msg_buffer, curr_size);
 
+  /* HELLO is always buildt */
+  return OLSR_TRUE;
 }
 
 
 
-
-
 /**
  *IP version 4
  *
@@ -692,138 +576,119 @@ hello_build6(struct hello_message *message, struct interface *ifp)
  *@return nada
  */
 
-static void
-tc_build4(struct tc_message *message, struct interface *ifp)           
+static olsr_bool
+serialize_tc4(struct tc_message *message, struct interface *ifp)           
 {
 
-  int remainsize;
-  struct tc_mpr_addr *mprs, *prev_mprs;
+  olsr_u16_t remainsize, curr_size;
+  struct tc_mpr_addr *mprs;
   union olsr_message *m;
   struct tcmsg *tc;
   struct neigh_info *mprsaddr; 
-  int found = 0;
-  int msgsize;
+  olsr_bool found = OLSR_FALSE, partial_sent = OLSR_FALSE;
 
+  if((!message) || (!ifp) || (olsr_cnf->ip_version != AF_INET))
+    return OLSR_FALSE;
 
-  if (!message)
-    return;
+  remainsize = net_outbuffer_bytes_left(ifp);
 
-  if (!ifp)
-    return;
+  m = (union olsr_message *)msg_buffer;
 
-  if(ipversion != AF_INET)
-    return;
+  tc = &m->v4.message.tc;
 
-  remainsize = outputsize - (sizeof(msg->v4.olsr_packlen) + sizeof(msg->v4.olsr_seqno));
 
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v4.olsr_msg + remainsize)
-    : (union olsr_message *) msg->v4.olsr_msg;
-  tc = &m->v4.message.tc;
   mprsaddr = tc->neigh;
-  msgsize = (int)sizeof(struct olsrmsg);
-  tc->reserved = 0;
+  curr_size = OLSR_TC_IPV4_HDRSIZE;
 
-  if (outputsize > maxmessagesize - msgsize) 
-    net_output(ifp);
-            
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  check_buffspace(curr_size, remainsize, "TC");
+
+  /* Fill header */
+  m->v4.olsr_vtime = ifp->valtimes.tc;
+  m->v4.olsr_msgtype = TC_MESSAGE;
+  m->v4.hopcnt = message->hop_count;
+  m->v4.ttl = message->ttl;
+  COPY_IP(&m->v4.originator, &message->originator);
+
+  /* Fill TC header */
+  tc->ansn = htons(message->ansn);
+  tc->reserved = 0;
+  
 
   /*Looping trough MPR selectors */
   for (mprs = message->multipoint_relay_selector_address; mprs != NULL;mprs = mprs->next) 
     {
-           
-      outputsize = (char *)mprsaddr - packet;
-
       /*If packet is to be chomped */
-      if (outputsize > maxmessagesize - (int)sizeof (mprsaddr))
+      if((curr_size + ipsize) > remainsize)
        {
 
-         olsr_printf(1, "Chomping TC!\n");
+         /* Only add TC message if it contains data */
+         if(curr_size > OLSR_TC_IPV4_HDRSIZE)
+           {
+#ifdef DEBUG
+             OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
+#endif
 
-         m->v4.olsr_vtime = tc_vtime;
-         m->v4.olsr_msgtype = TC_MESSAGE;
-         m->v4.olsr_msgsize = (char *)mprsaddr - (char *)m;
-         m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-         m->v4.seqno = htons(get_msg_seqno());
-         m->v4.hopcnt = message->hop_count;
-         m->v4.ttl = message->ttl;
-         COPY_IP(&m->v4.originator, &message->originator);
+             m->v4.olsr_msgsize = htons(curr_size);
+             m->v4.seqno = htons(get_msg_seqno());
+
+             net_outbuffer_push(ifp, msg_buffer, curr_size);
+             
+             /* Reset stuff */
+             mprsaddr = tc->neigh;
+             curr_size = OLSR_TC_IPV4_HDRSIZE;
+             found = OLSR_FALSE;
+             partial_sent = OLSR_TRUE;
+           }
 
          net_output(ifp);
-               
-         m = (union olsr_message *)msg->v4.olsr_msg;
-         tc = &m->v4.message.tc;
+         remainsize = net_outbuffer_bytes_left(ifp);
+         check_buffspace(curr_size + ipsize, remainsize, "TC2");
 
-         mprsaddr = tc->neigh;
-         found = 0;
        }
-      found = 1;
-           
+      found = OLSR_TRUE;
+#ifdef DEBUG
+         OLSR_PRINTF(BMSG_DBGLVL, "\t%s\n", 
+                     olsr_ip_to_string(&mprs->address))
+#endif 
       COPY_IP(&mprsaddr->addr, &mprs->address);
 
+      curr_size += ipsize;
       mprsaddr++;
     }
 
   if (found)
     {
            
-      outputsize = (char *)mprsaddr - packet;
-
-      m->v4.olsr_msgtype = TC_MESSAGE;
-      m->v4.olsr_msgsize = (char *)mprsaddr - (char *)m;
-      m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-      m->v4.olsr_vtime = tc_vtime;
-      
+      m->v4.olsr_msgsize = htons(curr_size);
       m->v4.seqno = htons(get_msg_seqno());
-      tc->ansn = htons(message->ansn);
       
-      m->v4.hopcnt = message->hop_count;
-      m->v4.ttl = message->ttl;
-
-      COPY_IP(&m->v4.originator, &message->originator);
+      net_outbuffer_push(ifp, msg_buffer, curr_size);
 
     }
   else
     {
-      if(!TIMED_OUT(&send_empty_tc))
+      if((!partial_sent) && (!TIMED_OUT(send_empty_tc)))
        {
-         olsr_printf(1, "TC: Sending empty package\n");
-
-           
-         outputsize = 20;
+         if(!TIMED_OUT(send_empty_tc))
+           OLSR_PRINTF(1, "TC: Sending empty package - (%d/%d/%d/%d)\n", partial_sent, (int)send_empty_tc, (int)now_times, (int)((send_empty_tc) - now_times))
 
-         m->v4.olsr_msgtype = TC_MESSAGE;
-         m->v4.olsr_msgsize = 16;
-         m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-         m->v4.olsr_vtime = tc_vtime;
-         
+         m->v4.olsr_msgsize = htons(curr_size);
          m->v4.seqno = htons(get_msg_seqno());
-         tc->ansn = htons(message->ansn);
-         
-         m->v4.hopcnt = message->hop_count;
-         m->v4.ttl = message->ttl;
-         
-         COPY_IP(&m->v4.originator, &message->originator);
-       }
-    }
 
+         net_outbuffer_push(ifp, msg_buffer, curr_size);
 
-  /*
-   * Delete the list of mprs messages
-   */
-       
-  mprs = message->multipoint_relay_selector_address;
-       
-  while (mprs)
-    {
-      prev_mprs = mprs;
-      mprs = mprs->next;
-      free(prev_mprs);
+         found = OLSR_TRUE;
+       }
     }
-       
-       
-}
 
+  return found;        
+}
 
 
 
@@ -837,141 +702,111 @@ tc_build4(struct tc_message *message, struct interface *ifp)
  *@return nada
  */
 
-static void
-tc_build6(struct tc_message *message, struct interface *ifp)           
+static olsr_bool
+serialize_tc6(struct tc_message *message, struct interface *ifp)           
 {
 
-  int remainsize;
-  struct tc_mpr_addr *mprs, *prev_mprs;
+  olsr_u16_t remainsize, curr_size;
+  struct tc_mpr_addr *mprs;
   union olsr_message *m;
   struct tcmsg6 *tc6;
   struct neigh_info6 *mprsaddr6; 
-  int found = 0;
-  int msgsize;
-
+  olsr_bool found = OLSR_FALSE, partial_sent = OLSR_FALSE;
 
-  if (!message)
-    return;
+  if ((!message) || (!ifp) || (olsr_cnf->ip_version != AF_INET6))
+    return OLSR_FALSE;
 
-  if(!ifp)
-    return;
+  remainsize = net_outbuffer_bytes_left(ifp);
 
-  if(ipversion != AF_INET6)
-    return;
+  m = (union olsr_message *)msg_buffer;
 
-  remainsize = outputsize - (sizeof(msg->v6.olsr_packlen) + sizeof(msg->v6.olsr_seqno));
-
-
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v6.olsr_msg + remainsize)
-    : (union olsr_message *) msg->v6.olsr_msg;
   tc6 = &m->v6.message.tc;
+
   mprsaddr6 = tc6->neigh;
-  msgsize = (int)sizeof(struct olsrmsg6);
-  tc6->reserved = 0;
+  curr_size = OLSR_TC_IPV6_HDRSIZE;
 
-  if (outputsize > maxmessagesize - msgsize) 
-    net_output(ifp);
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  check_buffspace(curr_size, remainsize, "TC");
+
+  /* Fill header */
+  m->v6.olsr_vtime = ifp->valtimes.tc;
+  m->v6.olsr_msgtype = TC_MESSAGE;
+  m->v6.hopcnt = message->hop_count;
+  m->v6.ttl = message->ttl;
+  COPY_IP(&m->v6.originator, &message->originator);
 
+  /* Fill TC header */
+  tc6->ansn = htons(message->ansn);
+  tc6->reserved = 0;
   
 
   /*Looping trough MPR selectors */
   for (mprs = message->multipoint_relay_selector_address; mprs != NULL;mprs = mprs->next) 
     {
            
-      outputsize = (char *)mprsaddr6 - packet;
-
-
       /*If packet is to be chomped */
-      if (outputsize > maxmessagesize - (int)sizeof (mprsaddr6))
+      if((curr_size + ipsize) > remainsize)
        {
-         m->v6.olsr_msgtype = TC_MESSAGE;
-         m->v6.olsr_msgsize = (char *)mprsaddr6 - (char *)m;
-         m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-         m->v6.olsr_vtime = tc_vtime;
-         
-         m->v6.seqno = htons(get_msg_seqno());
-         tc6->ansn = htons(message->ansn);
-         
-         m->v6.hopcnt = message->hop_count;
-         m->v6.ttl = message->ttl;
-
-         COPY_IP(&m->v6.originator, &message->originator);
-
+         /* Only add TC message if it contains data */
+         if(curr_size > OLSR_TC_IPV6_HDRSIZE)
+           {
+#ifdef DEBUG
+             OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
+#endif
+             m->v6.olsr_msgsize = htons(curr_size);
+             m->v6.seqno = htons(get_msg_seqno());
+
+             net_outbuffer_push(ifp, msg_buffer, curr_size);
+             mprsaddr6 = tc6->neigh;
+             curr_size = OLSR_TC_IPV6_HDRSIZE;
+             found = OLSR_FALSE;
+             partial_sent = OLSR_TRUE;
+           }
          net_output(ifp);
-               
-         m = (union olsr_message *)msg->v6.olsr_msg;
-         tc6 = &m->v6.message.tc;
-
-         mprsaddr6 = tc6->neigh;
+         remainsize = net_outbuffer_bytes_left(ifp);
+         check_buffspace(curr_size + ipsize, remainsize, "TC2");
 
-         found = 0;
        }
-      found = 1;
-
-      //printf("mprsaddr6 is %x\n", (char *)mprsaddr6 - packet);
-      //printf("Adding MPR-selector: %s\n", olsr_ip_to_string(&mprs->address));fflush(stdout);     
+      found = OLSR_TRUE;
+#ifdef DEBUG
+         OLSR_PRINTF(BMSG_DBGLVL, "\t%s\n", 
+                     olsr_ip_to_string(&mprs->address))
+#endif
       COPY_IP(&mprsaddr6->addr, &mprs->address);
+      curr_size += ipsize;
 
       mprsaddr6++;
     }
        
   if (found)
     {
-           
-      outputsize = (char *)mprsaddr6 - packet;
-
-      m->v6.olsr_msgtype = TC_MESSAGE;
-      m->v6.olsr_msgsize = (char *)mprsaddr6 - (char *)m;
-      m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-      m->v6.olsr_vtime = tc_vtime;
-
+      m->v6.olsr_msgsize = htons(curr_size);
       m->v6.seqno = htons(get_msg_seqno());
-      tc6->ansn = htons(message->ansn);
-      
-      m->v6.hopcnt = message->hop_count;
-      m->v6.ttl = message->ttl;
 
-      COPY_IP(&m->v6.originator, &message->originator);
+      net_outbuffer_push(ifp, msg_buffer, curr_size);
 
     }
   else
     {
-      if(!TIMED_OUT(&send_empty_tc))
+      if((!partial_sent) && (!TIMED_OUT(send_empty_tc)))
        {
-         olsr_printf(1, "TC: Sending empty package\n");
+         OLSR_PRINTF(1, "TC: Sending empty package\n")
            
-         outputsize = 32;
-
-         m->v6.olsr_msgtype = TC_MESSAGE;
-         m->v6.olsr_msgsize = 28;
-         m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-         m->v6.olsr_vtime = tc_vtime;
-         
+         m->v6.olsr_msgsize = htons(curr_size);
          m->v6.seqno = htons(get_msg_seqno());
-         tc6->ansn = htons(message->ansn);
-         
-         m->v6.hopcnt = message->hop_count;
-         m->v6.ttl = message->ttl;
-         
-         COPY_IP(&m->v6.originator, &message->originator);
+
+         net_outbuffer_push(ifp, msg_buffer, curr_size);
+
+         found = OLSR_TRUE;
        }
     }
 
-  /*
-   * Delete the list of mprs messages
-   */
-       
-  mprs = message->multipoint_relay_selector_address;
-       
-  while (mprs)
-    {
-      prev_mprs = mprs;
-      mprs = mprs->next;
-      free(prev_mprs);
-    }
-       
-       
+  return found;        
 }
 
 
@@ -981,73 +816,94 @@ tc_build6(struct tc_message *message, struct interface *ifp)
  *IP version 4
  *
  *<b>NO INTERNAL BUFFER</b>
- *@param ifn use this interfaces address as main address
+ *@param ifp use this interfaces address as main address
  *@return 1 on success
  */
 
-int
-mid_build4(struct interface *ifn)
+static olsr_bool
+serialize_mid4(struct interface *ifp)
 {
-  int remainsize;
+  olsr_u16_t remainsize, curr_size;
   /* preserve existing data in output buffer */
   union olsr_message *m;
   struct midaddr *addrs;
-  struct midmsg *mmsg;
   struct interface *ifs;  
 
-  if(ipversion != AF_INET)
-    return -1;
+  if((olsr_cnf->ip_version != AF_INET) || (!ifp) || (ifnet == NULL || ifnet->int_next == NULL))
+    return OLSR_FALSE;
 
-  if(nbinterf <= 1)
-    return 0;
 
-  //printf("\t\tGenerating mid on %s\n", ifn->int_name);
+  remainsize = net_outbuffer_bytes_left(ifp);
 
-  remainsize = outputsize - (sizeof(msg->v4.olsr_packlen) 
-                            + sizeof(msg->v4.olsr_seqno));
+  m = (union olsr_message *)msg_buffer;
 
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v4.olsr_msg + remainsize)
-    :(union olsr_message *) msg->v4.olsr_msg;
+  curr_size = OLSR_MID_IPV4_HDRSIZE;
 
-  mmsg = &m->v4.message.mid;
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  check_buffspace(curr_size, remainsize, "MID");
 
+  /* Fill header */
   m->v4.hopcnt = 0;
   m->v4.ttl = MAX_TTL;
-
-  m->v4.seqno = htons(get_msg_seqno());/* seqnumber */
-
-  /* pad - seems we don't need this....*/
-  //memset(mmsg->mid_res, 0, sizeof(mmsg->mid_res));
-  //mmsg->mid_res = 0;
-      
   /* Set main(first) address */
   COPY_IP(&m->v4.originator, &main_addr);
-      
-  addrs = mmsg->mid_addr;
+  m->v4.olsr_msgtype = MID_MESSAGE;
+  m->v4.olsr_vtime = ifp->valtimes.mid;
+  addrs = m->v4.message.mid.mid_addr;
 
   /* Don't add the main address... it's already there */
   for(ifs = ifnet; ifs != NULL; ifs = ifs->int_next)
     {
       if(!COMP_IP(&main_addr, &ifs->ip_addr))
        {
+
+         if((curr_size + ipsize) > remainsize)
+           {
+             /* Only add MID message if it contains data */
+             if(curr_size > OLSR_MID_IPV4_HDRSIZE)
+               {
+#ifdef DEBUG
+                 OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
+#endif
+                 /* set size */
+                 m->v4.olsr_msgsize = htons(curr_size);
+                 m->v4.seqno = htons(get_msg_seqno());/* seqnumber */
+                 
+                 net_outbuffer_push(ifp, msg_buffer, curr_size);
+                 curr_size = OLSR_MID_IPV4_HDRSIZE;
+                 addrs = m->v4.message.mid.mid_addr;
+               }
+             net_output(ifp);
+             remainsize = net_outbuffer_bytes_left(ifp);
+             check_buffspace(curr_size, remainsize, "MID2");
+           }
+#ifdef DEBUG
+         OLSR_PRINTF(BMSG_DBGLVL, "\t%s(%s)\n", 
+                     olsr_ip_to_string(&ifs->ip_addr), 
+                     ifs->int_name)
+#endif
+         
          COPY_IP(&addrs->addr, &ifs->ip_addr);
          addrs++;
+         curr_size += ipsize;
        }
     }
 
-  m->v4.olsr_msgtype = MID_MESSAGE;
-  m->v4.olsr_msgsize = (char*)addrs - (char*)m;
-  m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-
-  m->v4.olsr_vtime = mid_vtime;
 
-  outputsize = (char*)addrs - packet; 
+  m->v4.seqno = htons(get_msg_seqno());/* seqnumber */
+  m->v4.olsr_msgsize = htons(curr_size);
 
   //printf("Sending MID (%d bytes)...\n", outputsize);
+  net_outbuffer_push(ifp, msg_buffer, curr_size);
 
 
-  return 0;
+  return OLSR_TRUE;
 }
 
 
@@ -1056,72 +912,94 @@ mid_build4(struct interface *ifn)
  *IP version 6
  *
  *<b>NO INTERNAL BUFFER</b>
- *@param ifn use this interfaces address as main address
+ *@param ifp use this interfaces address as main address
  *@return 1 on success
  */
 
-int
-mid_build6(struct interface *ifn)
+static olsr_bool
+serialize_mid6(struct interface *ifp)
 {
-  int remainsize;
+  olsr_u16_t remainsize, curr_size;
   /* preserve existing data in output buffer */
   union olsr_message *m;
   struct midaddr6 *addrs6;
-  struct midmsg6 *mmsg6;
   struct interface *ifs;
 
   //printf("\t\tGenerating mid on %s\n", ifn->int_name);
 
 
-  if(ipversion != AF_INET6)
-    return -1;
+  if((olsr_cnf->ip_version != AF_INET6) || (!ifp) || (ifnet == NULL || ifnet->int_next == NULL))
+    return OLSR_FALSE;
 
-  if(nbinterf <= 1)
-    return 0;
+  remainsize = net_outbuffer_bytes_left(ifp);
 
-  remainsize = outputsize - (sizeof(msg->v6.olsr_packlen) 
-                            + sizeof(msg->v6.olsr_seqno));
+  curr_size = OLSR_MID_IPV6_HDRSIZE;
 
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v6.olsr_msg + remainsize)
-    :(union olsr_message *) msg->v6.olsr_msg;
-      
-  mmsg6 = &m->v6.message.mid;
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  check_buffspace(curr_size + ipsize, remainsize, "MID");
 
+  m = (union olsr_message *)msg_buffer;
+    
+  /* Build header */
   m->v6.hopcnt = 0;
-  m->v6.ttl = MAX_TTL;
-
-  m->v6.seqno = htons(get_msg_seqno());/* seqnumber */
-  /* pad - seems we don't need this....*/
-  //memset(mmsg->mid_res, 0, sizeof(mmsg->mid_res));
-  //mmsg->mid_res = 0;
-      
+  m->v6.ttl = MAX_TTL;      
+  m->v6.olsr_msgtype = MID_MESSAGE;
+  m->v6.olsr_vtime = ifp->valtimes.mid;
   /* Set main(first) address */
   COPY_IP(&m->v6.originator, &main_addr);
-      
-  addrs6 = mmsg6->mid_addr;
+   
+
+  addrs6 = m->v6.message.mid.mid_addr;
 
   /* Don't add the main address... it's already there */
   for(ifs = ifnet; ifs != NULL; ifs = ifs->int_next)
     {
       if(!COMP_IP(&main_addr, &ifs->ip_addr))
        {
+         if((curr_size + ipsize) > remainsize)
+           {
+             /* Only add MID message if it contains data */
+             if(curr_size > OLSR_MID_IPV6_HDRSIZE)
+               {
+#ifdef DEBUG
+                 OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
+#endif
+                 /* set size */
+                 m->v6.olsr_msgsize = htons(curr_size);
+                 m->v6.seqno = htons(get_msg_seqno());/* seqnumber */
+                 
+                 net_outbuffer_push(ifp, msg_buffer, curr_size);
+                 curr_size = OLSR_MID_IPV6_HDRSIZE;
+                 addrs6 = m->v6.message.mid.mid_addr;
+               }
+             net_output(ifp);
+             remainsize = net_outbuffer_bytes_left(ifp);
+             check_buffspace(curr_size + ipsize, remainsize, "MID2");
+           }
+#ifdef DEBUG
+                 OLSR_PRINTF(BMSG_DBGLVL, "\t%s(%s)\n", 
+                             olsr_ip_to_string(&ifs->ip_addr), 
+                             ifs->int_name)
+#endif
+
          COPY_IP(&addrs6->addr, &ifs->ip_addr);
          addrs6++;
+         curr_size += ipsize;
        }
     }
 
-  m->v6.olsr_msgtype = MID_MESSAGE;
-  m->v6.olsr_msgsize = (char*)addrs6 - (char*)m;
-  m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-  m->v6.olsr_vtime = mid_vtime;
-
-  outputsize = (char*)addrs6 - packet;
+  m->v6.olsr_msgsize = htons(curr_size);
+  m->v6.seqno = htons(get_msg_seqno());/* seqnumber */
 
   //printf("Sending MID (%d bytes)...\n", outputsize);
+  net_outbuffer_push(ifp, msg_buffer, curr_size);
 
-
-  return 0;
+  return OLSR_TRUE;
 }
 
 
@@ -1133,54 +1011,83 @@ mid_build6(struct interface *ifn)
  *@param ifp the interface to send on
  *@return nada
  */
-static void
-hna_build4(struct interface *ifp)
+static olsr_bool
+serialize_hna4(struct interface *ifp)
 {
-  int remainsize;
+  olsr_u16_t remainsize, curr_size;
   /* preserve existing data in output buffer */
   union olsr_message *m;
   struct hnapair *pair;
-  struct hnamsg *hmsg;
-  struct local_hna_entry *h;
+  struct hna4_entry *h = olsr_cnf->hna4_entries;
 
   /* No hna nets */
-  if (local_hna4_set.next == &local_hna4_set)
-    return;
+  if((olsr_cnf->ip_version != AF_INET) || (!ifp) || h == NULL)
+    return OLSR_FALSE;
     
-  remainsize = outputsize - (sizeof(msg->v4.olsr_packlen) 
-                            + sizeof(msg->v4.olsr_seqno));
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v4.olsr_msg + remainsize)
-    :(union olsr_message *) msg->v4.olsr_msg;
+  remainsize = net_outbuffer_bytes_left(ifp);
+  
+  curr_size = OLSR_HNA_IPV4_HDRSIZE;
+  
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  check_buffspace(curr_size, remainsize, "HNA");
 
-  hmsg = &m->v4.message.hna;
-    
+  m = (union olsr_message *)msg_buffer;
+  
+  
+  /* Fill header */
   COPY_IP(&m->v4.originator, &main_addr);
   m->v4.hopcnt = 0;
   m->v4.ttl = MAX_TTL;
+  m->v4.olsr_msgtype = HNA_MESSAGE;
+  m->v4.olsr_vtime = ifp->valtimes.hna;
+  
 
-  m->v4.seqno = htons(get_msg_seqno());
-
-
-  pair = hmsg->hna_net;
-
-  for(h = local_hna4_set.next;
-      h != &local_hna4_set;
-      h = h->next)
+  pair = m->v4.message.hna.hna_net;
+  
+  while(h)
     {
-      COPY_IP(&pair->addr, &h->A_network_addr);
-      COPY_IP(&pair->netmask, &h->A_netmask);
+      if((curr_size + (2 * ipsize)) > remainsize)
+       {
+         /* Only add HNA message if it contains data */
+         if(curr_size > OLSR_HNA_IPV4_HDRSIZE)
+           {
+#ifdef DEBUG
+             OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
+#endif
+             m->v4.seqno = htons(get_msg_seqno());
+             m->v4.olsr_msgsize = htons(curr_size);
+             net_outbuffer_push(ifp, msg_buffer, curr_size);
+             curr_size = OLSR_HNA_IPV4_HDRSIZE;
+             pair = m->v4.message.hna.hna_net;
+           }
+         net_output(ifp);
+         remainsize = net_outbuffer_bytes_left(ifp);
+         check_buffspace(curr_size + (2 * ipsize), remainsize, "HNA2");
+       }
+#ifdef DEBUG
+      OLSR_PRINTF(BMSG_DBGLVL, "\tNet: %s/%s\n", 
+                 olsr_ip_to_string(&h->net),
+                 olsr_ip_to_string(&h->netmask))
+#endif
+      COPY_IP(&pair->addr, &h->net);
+      COPY_IP(&pair->netmask, &h->netmask);
       pair++;
+      curr_size += (2 * ipsize);
+      h = h->next;
     }
-      
-  m->v4.olsr_msgtype = HNA_MESSAGE;
-  m->v4.olsr_msgsize = (char*)pair - (char*)m;
-  m->v4.olsr_msgsize = htons(m->v4.olsr_msgsize);
-  m->v4.olsr_vtime = hna_vtime;
 
-  outputsize = (char*)pair - packet;
-  //printf("Sending HNA (%d bytes)...\n", outputsize);
+  m->v4.seqno = htons(get_msg_seqno());
+  m->v4.olsr_msgsize = htons(curr_size);
+
+  net_outbuffer_push(ifp, msg_buffer, curr_size);
 
+  //printf("Sending HNA (%d bytes)...\n", outputsize);
+  return OLSR_FALSE;
 }
 
 
@@ -1193,63 +1100,84 @@ hna_build4(struct interface *ifp)
  *@param ifp the interface to send on
  *@return nada
  */
-static void
-hna_build6(struct interface *ifp)
+static olsr_bool
+serialize_hna6(struct interface *ifp)
 {
-  int remainsize;
+  olsr_u16_t remainsize, curr_size;
   /* preserve existing data in output buffer */
   union olsr_message *m;
   struct hnapair6 *pair6;
-  struct hnamsg6 *hmsg6;
   union olsr_ip_addr tmp_netmask;
-  struct local_hna_entry *h;
+  struct hna6_entry *h = olsr_cnf->hna6_entries;
+  
+  /* No hna nets */
+  if((olsr_cnf->ip_version != AF_INET6) || (!ifp) || h == NULL)
+    return OLSR_FALSE;
 
-  if(ipversion != AF_INET6)
-    return;    
+    
+  remainsize = net_outbuffer_bytes_left(ifp);
 
-  /* No hna nets */
-  if (local_hna6_set.next == &local_hna6_set)
-    return;
+  curr_size = OLSR_HNA_IPV6_HDRSIZE;
 
-  remainsize = outputsize - (sizeof(msg->v6.olsr_packlen) 
-                            + sizeof(msg->v6.olsr_seqno));
+  /* Send pending packet if not room in buffer */
+  if(curr_size > remainsize)
+    {
+      net_output(ifp);
+      remainsize = net_outbuffer_bytes_left(ifp);
+    }
+  check_buffspace(curr_size, remainsize, "HNA");
 
-  m = outputsize ? 
-    (union olsr_message *)((char *)msg->v6.olsr_msg + remainsize)
-    :(union olsr_message *) msg->v6.olsr_msg;
+  m = (union olsr_message *)msg_buffer;   
 
-  hmsg6 = &m->v6.message.hna;
-    
+  /* Fill header */
   COPY_IP(&m->v6.originator, &main_addr);
   m->v6.hopcnt = 0;
   m->v6.ttl = MAX_TTL;
+  m->v6.olsr_msgtype = HNA_MESSAGE;
+  m->v6.olsr_vtime = ifp->valtimes.hna;
 
-  m->v6.seqno = htons(get_msg_seqno());
-
-
-  pair6 = hmsg6->hna_net;
+  pair6 = m->v6.message.hna.hna_net;
 
 
-  for(h = local_hna6_set.next;
-      h != &local_hna6_set;
-      h = h->next)
+  while(h)
     {
-      //printf("Adding %s\n", olsr_ip_to_string(&h->hna_net.addr));
-      COPY_IP(&pair6->addr, &h->A_network_addr);
-      olsr_prefix_to_netmask(&tmp_netmask, h->A_netmask.v6);
+      if((curr_size + (2 * ipsize)) > remainsize)
+       {
+         /* Only add HNA message if it contains data */
+         if(curr_size > OLSR_HNA_IPV6_HDRSIZE)
+           {
+#ifdef DEBUG
+             OLSR_PRINTF(BMSG_DBGLVL, "Sending partial(size: %d, buff left:%d)\n", curr_size, remainsize)
+#endif
+             m->v6.seqno = htons(get_msg_seqno());
+             m->v6.olsr_msgsize = htons(curr_size);
+             net_outbuffer_push(ifp, msg_buffer, curr_size);
+             curr_size = OLSR_HNA_IPV6_HDRSIZE;
+             pair6 = m->v6.message.hna.hna_net;
+           }
+         net_output(ifp);
+         remainsize = net_outbuffer_bytes_left(ifp);
+         check_buffspace(curr_size + (2 * ipsize), remainsize, "HNA2");
+       }
+#ifdef DEBUG
+      OLSR_PRINTF(BMSG_DBGLVL, "\tNet: %s/%d\n", 
+                 olsr_ip_to_string(&h->net),
+                 h->prefix_len)
+#endif
+      COPY_IP(&pair6->addr, &h->net);
+      olsr_prefix_to_netmask(&tmp_netmask, h->prefix_len);
       COPY_IP(&pair6->netmask, &tmp_netmask);
       pair6++;
+      curr_size += (2 * ipsize);
+      h = h->next;
     }
   
-  m->v6.olsr_msgtype = HNA_MESSAGE;
-  m->v6.olsr_msgsize = (char*)pair6 - (char*)m;
-  m->v6.olsr_msgsize = htons(m->v6.olsr_msgsize);
-  m->v6.olsr_vtime = hna_vtime;
+  m->v6.olsr_msgsize = htons(curr_size);
+  m->v6.seqno = htons(get_msg_seqno());
   
-  outputsize = (char*)pair6 - packet;
+  net_outbuffer_push(ifp, msg_buffer, curr_size);
   
   //printf("Sending HNA (%d bytes)...\n", outputsize);
-
+  return OLSR_FALSE;
 
 }
-