src/rebuild_packet.c

   1 /*
   2  * The olsr.org Optimized Link-State Routing daemon(olsrd)
   3  * Copyright (c) 2004, Andreas Tønnesen(andreto@olsr.org)
   4  * All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  *
  10  * * Redistributions of source code must retain the above copyright
  11  *   notice, this list of conditions and the following disclaimer.
  12  * * Redistributions in binary form must reproduce the above copyright
  13  *   notice, this list of conditions and the following disclaimer in
  14  *   the documentation and/or other materials provided with the
  15  *   distribution.
  16  * * Neither the name of olsr.org, olsrd nor the names of its
  17  *   contributors may be used to endorse or promote products derived
  18  *   from this software without specific prior written permission.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  21  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  22  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  23  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
  24  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  25  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  26  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  27  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  28  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
  30  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  31  * POSSIBILITY OF SUCH DAMAGE.
  32  *
  33  * Visit http://www.olsr.org for more information.
  34  *
  35  * If you find this software useful feel free to make a donation
  36  * to the project. For more information see the website or contact
  37  * the copyright holders.
  38  *
  39  */
  40
  41 #include "rebuild_packet.h"
  42 #include "ipcalc.h"
  43 #include "defs.h"
  44 #include "olsr.h"
  45 #include "mid_set.h"
  46 #include "mantissa.h"
  47 #include "net_olsr.h"
  48
  49 /**
  50  *Process/rebuild MID message. Converts the OLSR
  51  *packet to the internal mid_message format.
  52  *@param mmsg the mid_message struct in wich infomation
  53  *is to be put.
  54  *@param m the entire OLSR message revieved.
  55  *@return negative on error
  56  */
  57
  58 void
  59 mid_chgestruct(struct mid_message *mmsg, const union olsr_message *m)
  60 {
  61   int i;
  62   struct mid_alias *alias, *alias_tmp;
  63   int no_aliases;
  64
  65   /* Checking if everything is ok */
  66   if ((!m) || (m->v4.olsr_msgtype != MID_MESSAGE))
  67     return;
  68
  69   alias = NULL;
  70
  71   if(olsr_cnf->ip_version == AF_INET)
  72     {
  73       /* IPv4 */
  74       const struct midaddr *maddr = m->v4.message.mid.mid_addr;
  75       /*
  76        * How many aliases?
  77        * nextmsg contains size of
  78        * the addresses + 12 bytes(nextmessage, from address and the header)
  79        */
  80       no_aliases =  ((ntohs(m->v4.olsr_msgsize) - 12) / 4);
  81
  82       /*printf("Aliases: %d\n", no_aliases); */
  83       mmsg->mid_origaddr.v4.s_addr = m->v4.originator;
  84       mmsg->addr.v4.s_addr = m->v4.originator;
  85       /*seq number*/
  86       mmsg->mid_seqno = ntohs(m->v4.seqno);
  87       mmsg->mid_addr = NULL;
  88
  89       /* Get vtime */
  90       mmsg->vtime = me_to_reltime(m->v4.olsr_vtime);
  91
  92       /*printf("Sequencenuber of MID from %s is %d\n", ip_to_string(&mmsg->addr), mmsg->mid_seqno); */
  93
  94
  95       for(i = 0; i < no_aliases; i++)
  96         {
  97           alias = olsr_malloc(sizeof(struct mid_alias), "MID chgestruct");
  98
  99           alias->alias_addr.v4.s_addr = maddr->addr;
 100           alias->next = mmsg->mid_addr;
 101           mmsg->mid_addr = alias;
 102           maddr++;
 103         }
 104
 105
 106       if(olsr_cnf->debug_level > 1)
 107         {
 108           struct ipaddr_str buf;
 109           OLSR_PRINTF(3, "Alias list for %s: ", olsr_ip_to_string(&buf, &mmsg->mid_origaddr));
 110           OLSR_PRINTF(3, "%s", olsr_ip_to_string(&buf, &mmsg->addr));
 111           alias_tmp = mmsg->mid_addr;
 112           while(alias_tmp)
 113             {
 114               OLSR_PRINTF(3, " - %s", olsr_ip_to_string(&buf, &alias_tmp->alias_addr));
 115               alias_tmp = alias_tmp->next;
 116             }
 117           OLSR_PRINTF(3, "\n");
 118         }
 119     }
 120   else
 121     {
 122       /* IPv6 */
 123       const struct midaddr6 *maddr6 = m->v6.message.mid.mid_addr;
 124       /*
 125        * How many aliases?
 126        * nextmsg contains size of
 127        * the addresses + 12 bytes(nextmessage, from address and the header)
 128        */
 129       no_aliases =  ((ntohs(m->v6.olsr_msgsize) - 12) / 16); /* NB 16 */
 130
 131       /*printf("Aliases: %d\n", no_aliases); */
 132       mmsg->mid_origaddr.v6 = m->v6.originator;
 133       mmsg->addr.v6 = m->v6.originator;
 134       /*seq number*/
 135       mmsg->mid_seqno = ntohs(m->v6.seqno);
 136       mmsg->mid_addr = NULL;
 137
 138       /* Get vtime */
 139       mmsg->vtime = me_to_reltime(m->v6.olsr_vtime);
 140
 141       /*printf("Sequencenuber of MID from %s is %d\n", ip_to_string(&mmsg->addr), mmsg->mid_seqno); */
 142
 143       for(i = 0; i < no_aliases; i++)
 144         {
 145           alias = olsr_malloc(sizeof(struct mid_alias), "MID chgestruct 2");
 146
 147           /*printf("Adding alias: %s\n", olsr_ip_to_string(&buf, (union olsr_ip_addr *)&maddr6->addr));*/
 148           alias->alias_addr.v6 = maddr6->addr;
 149           alias->next = mmsg->mid_addr;
 150           mmsg->mid_addr = alias;
 151
 152           maddr6++;
 153         }
 154
 155
 156       if(olsr_cnf->debug_level > 1)
 157         {
 158           struct ipaddr_str buf;
 159           OLSR_PRINTF(3, "Alias list for %s", ip6_to_string(&buf, &mmsg->mid_origaddr.v6));
 160           OLSR_PRINTF(3, "%s", ip6_to_string(&buf, &mmsg->addr.v6));
 161
 162           alias_tmp = mmsg->mid_addr;
 163           while(alias_tmp)
 164             {
 165               OLSR_PRINTF(3, " - %s", ip6_to_string(&buf, &alias_tmp->alias_addr.v6));
 166               alias_tmp = alias_tmp->next;
 167             }
 168           OLSR_PRINTF(3, "\n");
 169         }
 170     }
 171
 172 }
 173
 174
 175
 176
 177 /**
 178  *Process/rebuild a message of unknown type. Converts the OLSR
 179  *packet to the internal unknown_message format.
 180  *@param umsg the unknown_message struct in wich infomation
 181  *is to be put.
 182  *@param m the entire OLSR message revieved.
 183  *@return negative on error
 184  */
 185
 186 void
 187 unk_chgestruct(struct unknown_message *umsg, const union olsr_message *m)
 188 {
 189
 190   /* Checking if everything is ok */
 191   if (!m)
 192     return;
 193
 194
 195   if(olsr_cnf->ip_version == AF_INET)
 196     {
 197       /* IPv4 */
 198       /* address */
 199       umsg->originator.v4.s_addr = m->v4.originator;
 200       /*seq number*/
 201       umsg->seqno = ntohs(m->v4.seqno);
 202       /* type */
 203       umsg->type = m->v4.olsr_msgtype;
 204     }
 205   else
 206     {
 207       /* IPv6 */
 208       /* address */
 209       umsg->originator.v6 = m->v6.originator;
 210       /*seq number*/
 211       umsg->seqno = ntohs(m->v6.seqno);
 212       /* type */
 213       umsg->type = m->v4.olsr_msgtype;
 214     }
 215
 216 }