/a00388_source.html
HTML | 1774 lines | 1773 code | 0 blank | 1 comment | 0 complexity | d4e4439c57e129b760ba3668231f1ae0 MD5 | raw file
- <!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
- <html xmlns="http://www.w3.org/1999/xhtml">
- <head>
- <meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
- <title>Contiki 2.5: core/net/sicslowpan.c Source File</title>
- <link href="tabs.css" rel="stylesheet" type="text/css"/>
- <link href="doxygen.css" rel="stylesheet" type="text/css"/>
- </head>
- <body>
- <!-- Generated by Doxygen 1.6.1 -->
- <div class="navigation" id="top">
- <div class="tabs">
- <ul>
- <li><a href="main.html"><span>Main Page</span></a></li>
- <li><a href="pages.html"><span>Related Pages</span></a></li>
- <li><a href="modules.html"><span>Modules</span></a></li>
- <li><a href="annotated.html"><span>Data Structures</span></a></li>
- <li class="current"><a href="files.html"><span>Files</span></a></li>
- <li><a href="dirs.html"><span>Directories</span></a></li>
- <li><a href="examples.html"><span>Examples</span></a></li>
- </ul>
- </div>
- <div class="tabs">
- <ul>
- <li><a href="files.html"><span>File List</span></a></li>
- <li><a href="globals.html"><span>Globals</span></a></li>
- </ul>
- </div>
- <div class="navpath"><a class="el" href="dir_783dcb2b4bcfa12326370fa26c216025.html">core</a> » <a class="el" href="dir_0966c75b31335e5cb5b37dbb7a80da85.html">net</a>
- </div>
- </div>
- <div class="contents">
- <h1>sicslowpan.c</h1><a href="a00388.html">Go to the documentation of this file.</a><div class="fragment"><pre class="fragment"><a name="l00001"></a>00001 <span class="comment">/**</span>
- <a name="l00002"></a>00002 <span class="comment"> * \addtogroup sicslowpan</span>
- <a name="l00003"></a>00003 <span class="comment"> * @{</span>
- <a name="l00004"></a>00004 <span class="comment"> */</span>
- <a name="l00005"></a>00005 <span class="comment">/*</span>
- <a name="l00006"></a>00006 <span class="comment"> * Copyright (c) 2008, Swedish Institute of Computer Science.</span>
- <a name="l00007"></a>00007 <span class="comment"> * All rights reserved.</span>
- <a name="l00008"></a>00008 <span class="comment"> *</span>
- <a name="l00009"></a>00009 <span class="comment"> * Redistribution and use in source and binary forms, with or without</span>
- <a name="l00010"></a>00010 <span class="comment"> * modification, are permitted provided that the following conditions</span>
- <a name="l00011"></a>00011 <span class="comment"> * are met:</span>
- <a name="l00012"></a>00012 <span class="comment"> * 1. Redistributions of source code must retain the above copyright</span>
- <a name="l00013"></a>00013 <span class="comment"> * notice, this list of conditions and the following disclaimer.</span>
- <a name="l00014"></a>00014 <span class="comment"> * 2. Redistributions in binary form must reproduce the above copyright</span>
- <a name="l00015"></a>00015 <span class="comment"> * notice, this list of conditions and the following disclaimer in the</span>
- <a name="l00016"></a>00016 <span class="comment"> * documentation and/or other materials provided with the distribution.</span>
- <a name="l00017"></a>00017 <span class="comment"> * 3. Neither the name of the Institute nor the names of its contributors</span>
- <a name="l00018"></a>00018 <span class="comment"> * may be used to endorse or promote products derived from this software</span>
- <a name="l00019"></a>00019 <span class="comment"> * without specific prior written permission.</span>
- <a name="l00020"></a>00020 <span class="comment"> *</span>
- <a name="l00021"></a>00021 <span class="comment"> * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND</span>
- <a name="l00022"></a>00022 <span class="comment"> * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE</span>
- <a name="l00023"></a>00023 <span class="comment"> * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE</span>
- <a name="l00024"></a>00024 <span class="comment"> * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE</span>
- <a name="l00025"></a>00025 <span class="comment"> * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL</span>
- <a name="l00026"></a>00026 <span class="comment"> * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS</span>
- <a name="l00027"></a>00027 <span class="comment"> * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)</span>
- <a name="l00028"></a>00028 <span class="comment"> * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT</span>
- <a name="l00029"></a>00029 <span class="comment"> * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY</span>
- <a name="l00030"></a>00030 <span class="comment"> * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF</span>
- <a name="l00031"></a>00031 <span class="comment"> * SUCH DAMAGE.</span>
- <a name="l00032"></a>00032 <span class="comment"> *</span>
- <a name="l00033"></a>00033 <span class="comment"> * This file is part of the Contiki operating system.</span>
- <a name="l00034"></a>00034 <span class="comment"> *</span>
- <a name="l00035"></a>00035 <span class="comment"> * $Id: sicslowpan.c,v 1.52 2011/01/04 20:22:21 joxe Exp $</span>
- <a name="l00036"></a>00036 <span class="comment"> */</span><span class="comment"></span>
- <a name="l00037"></a>00037 <span class="comment">/**</span>
- <a name="l00038"></a>00038 <span class="comment"> * \file</span>
- <a name="l00039"></a>00039 <span class="comment"> * 6lowpan implementation (RFC4944 and draft-ietf-6lowpan-hc-06)</span>
- <a name="l00040"></a>00040 <span class="comment"> *</span>
- <a name="l00041"></a>00041 <span class="comment"> * \author Adam Dunkels <adam@sics.se></span>
- <a name="l00042"></a>00042 <span class="comment"> * \author Nicolas Tsiftes <nvt@sics.se></span>
- <a name="l00043"></a>00043 <span class="comment"> * \author Niclas Finne <nfi@sics.se></span>
- <a name="l00044"></a>00044 <span class="comment"> * \author Mathilde Durvy <mdurvy@cisco.com></span>
- <a name="l00045"></a>00045 <span class="comment"> * \author Julien Abeille <jabeille@cisco.com></span>
- <a name="l00046"></a>00046 <span class="comment"> * \author Joakim Eriksson <joakime@sics.se></span>
- <a name="l00047"></a>00047 <span class="comment"> * \author Joel Hoglund <joel@sics.se></span>
- <a name="l00048"></a>00048 <span class="comment"> */</span>
- <a name="l00049"></a>00049 <span class="comment"></span>
- <a name="l00050"></a>00050 <span class="comment">/**</span>
- <a name="l00051"></a>00051 <span class="comment"> * FOR HC-06 COMPLIANCE TODO:</span>
- <a name="l00052"></a>00052 <span class="comment"> * -Add compression options to UDP, currently only supports</span>
- <a name="l00053"></a>00053 <span class="comment"> * both ports compressed or both ports elided</span>
- <a name="l00054"></a>00054 <span class="comment"> * </span>
- <a name="l00055"></a>00055 <span class="comment"> * -Verify TC/FL compression works</span>
- <a name="l00056"></a>00056 <span class="comment"> * </span>
- <a name="l00057"></a>00057 <span class="comment"> * -Add stateless multicast option</span>
- <a name="l00058"></a>00058 <span class="comment"> */</span>
- <a name="l00059"></a>00059
- <a name="l00060"></a>00060 <span class="preprocessor">#include <string.h></span>
- <a name="l00061"></a>00061
- <a name="l00062"></a>00062 <span class="preprocessor">#include "contiki.h"</span>
- <a name="l00063"></a>00063 <span class="preprocessor">#include "dev/watchdog.h"</span>
- <a name="l00064"></a>00064 <span class="preprocessor">#include "<a class="code" href="a00395.html" title="Header for the Contiki/uIP interface.">net/tcpip.h</a>"</span>
- <a name="l00065"></a>00065 <span class="preprocessor">#include "<a class="code" href="a00424.html" title="Header file for the uIP TCP/IP stack.">net/uip.h</a>"</span>
- <a name="l00066"></a>00066 <span class="preprocessor">#include "<a class="code" href="a00404.html" title="Network interface and stateless autoconfiguration (RFC 4862).">net/uip-ds6.h</a>"</span>
- <a name="l00067"></a>00067 <span class="preprocessor">#include "<a class="code" href="a00310.html" title="Header file for the Rime stack.">net/rime.h</a>"</span>
- <a name="l00068"></a>00068 <span class="preprocessor">#include "<a class="code" href="a00389.html" title="Header file for the 6lowpan implementation (RFC4944 and draft-hui-6lowpan-hc-01)...">net/sicslowpan.h</a>"</span>
- <a name="l00069"></a>00069 <span class="preprocessor">#include "<a class="code" href="a00294.html" title="Declarations for the neighbor information module.">net/neighbor-info.h</a>"</span>
- <a name="l00070"></a>00070 <span class="preprocessor">#include "<a class="code" href="a00296.html" title="Include file for the Contiki low-layer network stack (NETSTACK).">net/netstack.h</a>"</span>
- <a name="l00071"></a>00071
- <a name="l00072"></a><a class="code" href="a01680.html#gad72dbcf6d0153db1b8d8a58001feed83">00072</a> <span class="preprocessor">#define DEBUG 0</span>
- <a name="l00073"></a>00073 <span class="preprocessor"></span><span class="preprocessor">#if DEBUG</span>
- <a name="l00074"></a>00074 <span class="preprocessor"></span><span class="comment">/* PRINTFI and PRINTFO are defined for input and output to debug one without changing the timing of the other */</span>
- <a name="l00075"></a>00075 <a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a> p;
- <a name="l00076"></a>00076 <span class="preprocessor">#include <stdio.h></span>
- <a name="l00077"></a>00077 <span class="preprocessor">#define PRINTF(...) printf(__VA_ARGS__)</span>
- <a name="l00078"></a>00078 <span class="preprocessor"></span><span class="preprocessor">#define PRINTFI(...) printf(__VA_ARGS__)</span>
- <a name="l00079"></a>00079 <span class="preprocessor"></span><span class="preprocessor">#define PRINTFO(...) printf(__VA_ARGS__)</span>
- <a name="l00080"></a>00080 <span class="preprocessor"></span><span class="preprocessor">#define PRINT6ADDR(addr) PRINTF(" %02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x ", ((u8_t *)addr)[0], ((u8_t *)addr)[1], ((u8_t *)addr)[2], ((u8_t *)addr)[3], ((u8_t *)addr)[4], ((u8_t *)addr)[5], ((u8_t *)addr)[6], ((u8_t *)addr)[7], ((u8_t *)addr)[8], ((u8_t *)addr)[9], ((u8_t *)addr)[10], ((u8_t *)addr)[11], ((u8_t *)addr)[12], ((u8_t *)addr)[13], ((u8_t *)addr)[14], ((u8_t *)addr)[15])</span>
- <a name="l00081"></a>00081 <span class="preprocessor"></span><span class="preprocessor">#define PRINTLLADDR(lladdr) PRINTF(" %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x ",lladdr->addr[0], lladdr->addr[1], lladdr->addr[2], lladdr->addr[3],lladdr->addr[4], lladdr->addr[5],lladdr->addr[6], lladdr->addr[7])</span>
- <a name="l00082"></a>00082 <span class="preprocessor"></span><span class="preprocessor">#define PRINTPACKETBUF() PRINTF("RIME buffer: "); for(p = 0; p < packetbuf_datalen(); p++){PRINTF("%.2X", *(rime_ptr + p));} PRINTF("\n")</span>
- <a name="l00083"></a>00083 <span class="preprocessor"></span><span class="preprocessor">#define PRINTUIPBUF() PRINTF("UIP buffer: "); for(p = 0; p < uip_len; p++){PRINTF("%.2X", uip_buf[p]);}PRINTF("\n")</span>
- <a name="l00084"></a>00084 <span class="preprocessor"></span><span class="preprocessor">#define PRINTSICSLOWPANBUF() PRINTF("SICSLOWPAN buffer: "); for(p = 0; p < sicslowpan_len; p++){PRINTF("%.2X", sicslowpan_buf[p]);}PRINTF("\n")</span>
- <a name="l00085"></a>00085 <span class="preprocessor"></span><span class="preprocessor">#else</span>
- <a name="l00086"></a>00086 <span class="preprocessor"></span><span class="preprocessor">#define PRINTF(...)</span>
- <a name="l00087"></a>00087 <span class="preprocessor"></span><span class="preprocessor">#define PRINTFI(...)</span>
- <a name="l00088"></a>00088 <span class="preprocessor"></span><span class="preprocessor">#define PRINTFO(...)</span>
- <a name="l00089"></a>00089 <span class="preprocessor"></span><span class="preprocessor">#define PRINT6ADDR(addr)</span>
- <a name="l00090"></a>00090 <span class="preprocessor"></span><span class="preprocessor">#define PRINTLLADDR(lladdr)</span>
- <a name="l00091"></a>00091 <span class="preprocessor"></span><span class="preprocessor">#define PRINTPACKETBUF()</span>
- <a name="l00092"></a>00092 <span class="preprocessor"></span><span class="preprocessor">#define PRINTUIPBUF()</span>
- <a name="l00093"></a>00093 <span class="preprocessor"></span><span class="preprocessor">#define PRINTSICSLOWPANBUF()</span>
- <a name="l00094"></a>00094 <span class="preprocessor"></span><span class="preprocessor">#endif </span><span class="comment">/* DEBUG == 1*/</span>
- <a name="l00095"></a>00095
- <a name="l00096"></a>00096 <span class="preprocessor">#if UIP_LOGGING</span>
- <a name="l00097"></a>00097 <span class="preprocessor"></span><span class="preprocessor">#include <stdio.h></span>
- <a name="l00098"></a>00098 <span class="keywordtype">void</span> <a class="code" href="a01589.html#gab58e1ceb7cb73ca2bcd73146b6c1b4e7" title="Print out a uIP log message.">uip_log</a>(<span class="keywordtype">char</span> *msg);
- <a name="l00099"></a>00099 <span class="preprocessor">#define UIP_LOG(m) uip_log(m)</span>
- <a name="l00100"></a>00100 <span class="preprocessor"></span><span class="preprocessor">#else</span>
- <a name="l00101"></a>00101 <span class="preprocessor"></span><span class="preprocessor">#define UIP_LOG(m)</span>
- <a name="l00102"></a>00102 <span class="preprocessor"></span><span class="preprocessor">#endif </span><span class="comment">/* UIP_LOGGING == 1 */</span>
- <a name="l00103"></a>00103
- <a name="l00104"></a>00104 <span class="preprocessor">#ifdef SICSLOWPAN_CONF_MAX_MAC_TRANSMISSIONS</span>
- <a name="l00105"></a>00105 <span class="preprocessor"></span><span class="preprocessor">#define SICSLOWPAN_MAX_MAC_TRANSMISSIONS SICSLOWPAN_CONF_MAX_MAC_TRANSMISSIONS</span>
- <a name="l00106"></a>00106 <span class="preprocessor"></span><span class="preprocessor">#else</span>
- <a name="l00107"></a>00107 <span class="preprocessor"></span><span class="preprocessor">#define SICSLOWPAN_MAX_MAC_TRANSMISSIONS 4</span>
- <a name="l00108"></a>00108 <span class="preprocessor"></span><span class="preprocessor">#endif</span>
- <a name="l00109"></a>00109 <span class="preprocessor"></span>
- <a name="l00110"></a>00110 <span class="preprocessor">#ifndef SICSLOWPAN_COMPRESSION</span>
- <a name="l00111"></a>00111 <span class="preprocessor"></span><span class="preprocessor">#ifdef SICSLOWPAN_CONF_COMPRESSION</span>
- <a name="l00112"></a>00112 <span class="preprocessor"></span><span class="preprocessor">#define SICSLOWPAN_COMPRESSION SICSLOWPAN_CONF_COMPRESSION</span>
- <a name="l00113"></a>00113 <span class="preprocessor"></span><span class="preprocessor">#else</span>
- <a name="l00114"></a>00114 <span class="preprocessor"></span><span class="preprocessor">#define SICSLOWPAN_COMPRESSION SICSLOWPAN_COMPRESSION_IPV6</span>
- <a name="l00115"></a>00115 <span class="preprocessor"></span><span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_COMPRESSION */</span>
- <a name="l00116"></a>00116 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION */</span>
- <a name="l00117"></a>00117
- <a name="l00118"></a>00118 <span class="preprocessor">#ifndef SICSLOWPAN_CONF_NEIGHBOR_INFO</span>
- <a name="l00119"></a>00119 <span class="preprocessor"></span><span class="comment">/* Default is to use neighbor info updates if using RPL */</span>
- <a name="l00120"></a>00120 <span class="preprocessor">#define SICSLOWPAN_CONF_NEIGHBOR_INFO UIP_CONF_IPV6_RPL</span>
- <a name="l00121"></a>00121 <span class="preprocessor"></span><span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_NEIGHBOR_INFO */</span>
- <a name="l00122"></a>00122
- <a name="l00123"></a>00123 <span class="preprocessor">#define GET16(ptr,index) (((uint16_t)((ptr)[index] << 8)) | ((ptr)[(index) + 1]))</span>
- <a name="l00124"></a>00124 <span class="preprocessor"></span><span class="preprocessor">#define SET16(ptr,index,value) do { \</span>
- <a name="l00125"></a>00125 <span class="preprocessor"> (ptr)[index] = ((value) >> 8) & 0xff; \</span>
- <a name="l00126"></a>00126 <span class="preprocessor"> (ptr)[index + 1] = (value) & 0xff; \</span>
- <a name="l00127"></a>00127 <span class="preprocessor">} while(0)</span>
- <a name="l00128"></a>00128 <span class="preprocessor"></span><span class="comment"></span>
- <a name="l00129"></a>00129 <span class="comment">/** \name Pointers in the rime buffer</span>
- <a name="l00130"></a>00130 <span class="comment"> * @{</span>
- <a name="l00131"></a>00131 <span class="comment"> */</span>
- <a name="l00132"></a>00132 <span class="preprocessor">#define RIME_FRAG_PTR (rime_ptr)</span>
- <a name="l00133"></a>00133 <span class="preprocessor"></span><span class="preprocessor">#define RIME_FRAG_DISPATCH_SIZE 0 </span><span class="comment">/* 16 bit */</span>
- <a name="l00134"></a>00134 <span class="preprocessor">#define RIME_FRAG_TAG 2 </span><span class="comment">/* 16 bit */</span>
- <a name="l00135"></a>00135 <span class="preprocessor">#define RIME_FRAG_OFFSET 4 </span><span class="comment">/* 8 bit */</span>
- <a name="l00136"></a>00136
- <a name="l00137"></a>00137 <span class="comment">/* define the buffer as a byte array */</span>
- <a name="l00138"></a>00138 <span class="preprocessor">#define RIME_IPHC_BUF ((uint8_t *)(rime_ptr + rime_hdr_len))</span>
- <a name="l00139"></a>00139 <span class="preprocessor"></span>
- <a name="l00140"></a>00140 <span class="preprocessor">#define RIME_HC1_PTR (rime_ptr + rime_hdr_len)</span>
- <a name="l00141"></a>00141 <span class="preprocessor"></span><span class="preprocessor">#define RIME_HC1_DISPATCH 0 </span><span class="comment">/* 8 bit */</span>
- <a name="l00142"></a>00142 <span class="preprocessor">#define RIME_HC1_ENCODING 1 </span><span class="comment">/* 8 bit */</span>
- <a name="l00143"></a>00143 <span class="preprocessor">#define RIME_HC1_TTL 2 </span><span class="comment">/* 8 bit */</span>
- <a name="l00144"></a>00144
- <a name="l00145"></a>00145 <span class="preprocessor">#define RIME_HC1_HC_UDP_PTR (rime_ptr + rime_hdr_len)</span>
- <a name="l00146"></a>00146 <span class="preprocessor"></span><span class="preprocessor">#define RIME_HC1_HC_UDP_DISPATCH 0 </span><span class="comment">/* 8 bit */</span>
- <a name="l00147"></a>00147 <span class="preprocessor">#define RIME_HC1_HC_UDP_HC1_ENCODING 1 </span><span class="comment">/* 8 bit */</span>
- <a name="l00148"></a>00148 <span class="preprocessor">#define RIME_HC1_HC_UDP_UDP_ENCODING 2 </span><span class="comment">/* 8 bit */</span>
- <a name="l00149"></a>00149 <span class="preprocessor">#define RIME_HC1_HC_UDP_TTL 3 </span><span class="comment">/* 8 bit */</span>
- <a name="l00150"></a>00150 <span class="preprocessor">#define RIME_HC1_HC_UDP_PORTS 4 </span><span class="comment">/* 8 bit */</span>
- <a name="l00151"></a>00151 <span class="preprocessor">#define RIME_HC1_HC_UDP_CHKSUM 5 </span><span class="comment">/* 16 bit */</span>
- <a name="l00152"></a>00152 <span class="comment"></span>
- <a name="l00153"></a>00153 <span class="comment">/** \name Pointers in the sicslowpan and uip buffer</span>
- <a name="l00154"></a>00154 <span class="comment"> * @{</span>
- <a name="l00155"></a>00155 <span class="comment"> */</span>
- <a name="l00156"></a>00156 <span class="preprocessor">#define SICSLOWPAN_IP_BUF ((struct uip_ip_hdr *)&sicslowpan_buf[UIP_LLH_LEN])</span>
- <a name="l00157"></a>00157 <span class="preprocessor"></span><span class="preprocessor">#define SICSLOWPAN_UDP_BUF ((struct uip_udp_hdr *)&sicslowpan_buf[UIP_LLIPH_LEN])</span>
- <a name="l00158"></a>00158 <span class="preprocessor"></span>
- <a name="l00159"></a>00159 <span class="preprocessor">#define UIP_IP_BUF ((struct uip_ip_hdr *)&uip_buf[UIP_LLH_LEN])</span>
- <a name="l00160"></a>00160 <span class="preprocessor"></span><span class="preprocessor">#define UIP_UDP_BUF ((struct uip_udp_hdr *)&uip_buf[UIP_LLIPH_LEN])</span>
- <a name="l00161"></a>00161 <span class="preprocessor"></span><span class="preprocessor">#define UIP_TCP_BUF ((struct uip_tcp_hdr *)&uip_buf[UIP_LLIPH_LEN])</span>
- <a name="l00162"></a>00162 <span class="preprocessor"></span><span class="comment">/** @} */</span>
- <a name="l00163"></a>00163
- <a name="l00164"></a>00164 <span class="comment"></span>
- <a name="l00165"></a>00165 <span class="comment">/** \brief Size of the 802.15.4 payload (127byte - 25 for MAC header) */</span>
- <a name="l00166"></a><a class="code" href="a01680.html#gaf213c8c71222bb86256fb3e37582242b">00166</a> <span class="preprocessor">#define MAC_MAX_PAYLOAD 102</span>
- <a name="l00167"></a>00167 <span class="preprocessor"></span><span class="comment"></span>
- <a name="l00168"></a>00168 <span class="comment">/** \name General variables</span>
- <a name="l00169"></a>00169 <span class="comment"> * @{</span>
- <a name="l00170"></a>00170 <span class="comment"> */</span><span class="comment"></span>
- <a name="l00171"></a>00171 <span class="comment">/** A pointer to the mac driver */</span>
- <a name="l00172"></a><a class="code" href="a01680.html#ga1a8a1d348eacac5dcc3f01879e94a61d">00172</a> <span class="keyword">const</span> <span class="keyword">struct </span><a class="code" href="a00055.html" title="The structure of a MAC protocol driver in Contiki.">mac_driver</a> *<a class="code" href="a01680.html#ga1a8a1d348eacac5dcc3f01879e94a61d" title="A pointer to the mac driver.">sicslowpan_mac</a>;
- <a name="l00173"></a>00173
- <a name="l00174"></a>00174 <span class="preprocessor">#ifdef SICSLOWPAN_NH_COMPRESSOR</span>
- <a name="l00175"></a>00175 <span class="preprocessor"></span><span class="comment">/** A pointer to the additional compressor */</span>
- <a name="l00176"></a>00176 <span class="keyword">extern</span> <span class="keyword">struct </span><a class="code" href="a00080.html" title="The structure of a next header compressor.">sicslowpan_nh_compressor</a> SICSLOWPAN_NH_COMPRESSOR;
- <a name="l00177"></a>00177 <span class="preprocessor">#endif</span>
- <a name="l00178"></a>00178 <span class="preprocessor"></span><span class="comment"></span>
- <a name="l00179"></a>00179 <span class="comment">/**</span>
- <a name="l00180"></a>00180 <span class="comment"> * A pointer to the rime buffer.</span>
- <a name="l00181"></a>00181 <span class="comment"> * We initialize it to the beginning of the rime buffer, then</span>
- <a name="l00182"></a>00182 <span class="comment"> * access different fields by updating the offset rime_hdr_len.</span>
- <a name="l00183"></a>00183 <span class="comment"> */</span>
- <a name="l00184"></a>00184 <span class="keyword">static</span> <a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a> *rime_ptr;
- <a name="l00185"></a>00185 <span class="comment"></span>
- <a name="l00186"></a>00186 <span class="comment">/**</span>
- <a name="l00187"></a>00187 <span class="comment"> * rime_hdr_len is the total length of (the processed) 6lowpan headers</span>
- <a name="l00188"></a>00188 <span class="comment"> * (fragment headers, IPV6 or HC1, HC2, and HC1 and HC2 non compressed</span>
- <a name="l00189"></a>00189 <span class="comment"> * fields).</span>
- <a name="l00190"></a>00190 <span class="comment"> */</span>
- <a name="l00191"></a>00191 <span class="keyword">static</span> <a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a> rime_hdr_len;
- <a name="l00192"></a>00192 <span class="comment"></span>
- <a name="l00193"></a>00193 <span class="comment">/**</span>
- <a name="l00194"></a>00194 <span class="comment"> * The length of the payload in the Rime buffer.</span>
- <a name="l00195"></a>00195 <span class="comment"> * The payload is what comes after the compressed or uncompressed</span>
- <a name="l00196"></a>00196 <span class="comment"> * headers (can be the IP payload if the IP header only is compressed</span>
- <a name="l00197"></a>00197 <span class="comment"> * or the UDP payload if the UDP header is also compressed)</span>
- <a name="l00198"></a>00198 <span class="comment"> */</span>
- <a name="l00199"></a>00199 <span class="keyword">static</span> <a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a> rime_payload_len;
- <a name="l00200"></a>00200 <span class="comment"></span>
- <a name="l00201"></a>00201 <span class="comment">/**</span>
- <a name="l00202"></a>00202 <span class="comment"> * uncomp_hdr_len is the length of the headers before compression (if HC2</span>
- <a name="l00203"></a>00203 <span class="comment"> * is used this includes the UDP header in addition to the IP header).</span>
- <a name="l00204"></a>00204 <span class="comment"> */</span>
- <a name="l00205"></a>00205 <span class="keyword">static</span> <a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a> uncomp_hdr_len;<span class="comment"></span>
- <a name="l00206"></a>00206 <span class="comment">/** @} */</span>
- <a name="l00207"></a>00207
- <a name="l00208"></a>00208 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l00209"></a>00209 <span class="preprocessor"></span><span class="comment">/** \name Fragmentation related variables</span>
- <a name="l00210"></a>00210 <span class="comment"> * @{</span>
- <a name="l00211"></a>00211 <span class="comment"> */</span>
- <a name="l00212"></a>00212
- <a name="l00213"></a>00213 <span class="keyword">static</span> uint16_t sicslowpan_len;
- <a name="l00214"></a>00214 <span class="comment"></span>
- <a name="l00215"></a>00215 <span class="comment">/**</span>
- <a name="l00216"></a>00216 <span class="comment"> * The buffer used for the 6lowpan reassembly.</span>
- <a name="l00217"></a>00217 <span class="comment"> * This buffer contains only the IPv6 packet (no MAC header, 6lowpan, etc).</span>
- <a name="l00218"></a>00218 <span class="comment"> * It has a fix size as we do not use dynamic memory allocation.</span>
- <a name="l00219"></a>00219 <span class="comment"> */</span>
- <a name="l00220"></a>00220 <span class="keyword">static</span> <a class="code" href="a00091.html" title="The uIP packet buffer.">uip_buf_t</a> sicslowpan_aligned_buf;
- <a name="l00221"></a>00221 <span class="preprocessor">#define sicslowpan_buf (sicslowpan_aligned_buf.u8)</span>
- <a name="l00222"></a>00222 <span class="preprocessor"></span><span class="comment"></span>
- <a name="l00223"></a>00223 <span class="comment">/** The total length of the IPv6 packet in the sicslowpan_buf. */</span>
- <a name="l00224"></a>00224 <span class="comment"></span>
- <a name="l00225"></a>00225 <span class="comment">/**</span>
- <a name="l00226"></a>00226 <span class="comment"> * length of the ip packet already sent / received.</span>
- <a name="l00227"></a>00227 <span class="comment"> * It includes IP and transport headers.</span>
- <a name="l00228"></a>00228 <span class="comment"> */</span>
- <a name="l00229"></a>00229 <span class="keyword">static</span> uint16_t processed_ip_len;
- <a name="l00230"></a>00230 <span class="comment"></span>
- <a name="l00231"></a>00231 <span class="comment">/** Datagram tag to be put in the fragments I send. */</span>
- <a name="l00232"></a>00232 <span class="keyword">static</span> uint16_t my_tag;
- <a name="l00233"></a>00233 <span class="comment"></span>
- <a name="l00234"></a>00234 <span class="comment">/** When reassembling, the tag in the fragments being merged. */</span>
- <a name="l00235"></a>00235 <span class="keyword">static</span> uint16_t reass_tag;
- <a name="l00236"></a>00236 <span class="comment"></span>
- <a name="l00237"></a>00237 <span class="comment">/** When reassembling, the source address of the fragments being merged */</span>
- <a name="l00238"></a>00238 rimeaddr_t frag_sender;
- <a name="l00239"></a>00239 <span class="comment"></span>
- <a name="l00240"></a>00240 <span class="comment">/** Reassembly %process %timer. */</span>
- <a name="l00241"></a>00241 <span class="keyword">static</span> <span class="keyword">struct </span><a class="code" href="a00086.html" title="A timer.">timer</a> reass_timer;
- <a name="l00242"></a>00242 <span class="comment"></span>
- <a name="l00243"></a>00243 <span class="comment">/** @} */</span>
- <a name="l00244"></a>00244 <span class="preprocessor">#else </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l00245"></a>00245 <span class="comment">/** The buffer used for the 6lowpan processing is uip_buf.</span>
- <a name="l00246"></a>00246 <span class="comment"> We do not use any additional buffer.*/</span>
- <a name="l00247"></a><a class="code" href="a01680.html#ga2c312c370c91d9cc20fc0c97fd430fab">00247</a> <span class="preprocessor">#define sicslowpan_buf uip_buf</span>
- <a name="l00248"></a>00248 <span class="preprocessor"></span><span class="preprocessor">#define sicslowpan_len uip_len</span>
- <a name="l00249"></a>00249 <span class="preprocessor"></span><span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l00250"></a>00250
- <a name="l00251"></a>00251 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06</span>
- <a name="l00252"></a>00252 <span class="preprocessor"></span><span class="comment">/** \name HC06 specific variables</span>
- <a name="l00253"></a>00253 <span class="comment"> * @{</span>
- <a name="l00254"></a>00254 <span class="comment"> */</span>
- <a name="l00255"></a>00255 <span class="comment"></span>
- <a name="l00256"></a>00256 <span class="comment">/** Addresses contexts for IPHC. */</span>
- <a name="l00257"></a>00257 <span class="preprocessor">#if SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 0</span>
- <a name="l00258"></a>00258 <span class="preprocessor"></span><span class="keyword">static</span> <span class="keyword">struct </span><a class="code" href="a00079.html" title="The header for fragments.">sicslowpan_addr_context</a>
- <a name="l00259"></a>00259 addr_contexts[<a class="code" href="a01588.html#ga02ead2bfabed920502fe48c0baa0ed3f" title="If we use IPHC compression, how many address contexts do we support.">SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS</a>];
- <a name="l00260"></a>00260 <span class="preprocessor">#endif</span>
- <a name="l00261"></a>00261 <span class="preprocessor"></span><span class="comment"></span>
- <a name="l00262"></a>00262 <span class="comment">/** pointer to an address context. */</span>
- <a name="l00263"></a>00263 <span class="keyword">static</span> <span class="keyword">struct </span><a class="code" href="a00079.html" title="The header for fragments.">sicslowpan_addr_context</a> *context;
- <a name="l00264"></a>00264 <span class="comment"></span>
- <a name="l00265"></a>00265 <span class="comment">/** pointer to the byte where to write next inline field. */</span>
- <a name="l00266"></a>00266 <span class="keyword">static</span> uint8_t *hc06_ptr;
- <a name="l00267"></a>00267
- <a name="l00268"></a>00268 <span class="comment">/* Uncompression of linklocal */</span>
- <a name="l00269"></a>00269 <span class="comment">/* 0 -> 16 bytes from packet */</span>
- <a name="l00270"></a>00270 <span class="comment">/* 1 -> 2 bytes from prefix - bunch of zeroes and 8 from packet */</span>
- <a name="l00271"></a>00271 <span class="comment">/* 2 -> 2 bytes from prefix - 0000::00ff:fe00:XXXX from packet */</span>
- <a name="l00272"></a>00272 <span class="comment">/* 3 -> 2 bytes from prefix - infer 8 bytes from lladdr */</span>
- <a name="l00273"></a>00273 <span class="comment">/* NOTE: => the uncompress function does change 0xf to 0x10 */</span>
- <a name="l00274"></a>00274 <span class="comment">/* NOTE: 0x00 => no-autoconfig => unspecified */</span>
- <a name="l00275"></a>00275 <span class="keyword">const</span> uint8_t unc_llconf[] = {0x0f,0x28,0x22,0x20};
- <a name="l00276"></a>00276
- <a name="l00277"></a>00277 <span class="comment">/* Uncompression of ctx-based */</span>
- <a name="l00278"></a>00278 <span class="comment">/* 0 -> 0 bits from packet [unspecified / reserved] */</span>
- <a name="l00279"></a>00279 <span class="comment">/* 1 -> 8 bytes from prefix - bunch of zeroes and 8 from packet */</span>
- <a name="l00280"></a>00280 <span class="comment">/* 2 -> 8 bytes from prefix - 0000::00ff:fe00:XXXX + 2 from packet */</span>
- <a name="l00281"></a>00281 <span class="comment">/* 3 -> 8 bytes from prefix - infer 8 bytes from lladdr */</span>
- <a name="l00282"></a>00282 <span class="keyword">const</span> uint8_t unc_ctxconf[] = {0x00,0x88,0x82,0x80};
- <a name="l00283"></a>00283
- <a name="l00284"></a>00284 <span class="comment">/* Uncompression of ctx-based */</span>
- <a name="l00285"></a>00285 <span class="comment">/* 0 -> 0 bits from packet */</span>
- <a name="l00286"></a>00286 <span class="comment">/* 1 -> 2 bytes from prefix - bunch of zeroes 5 from packet */</span>
- <a name="l00287"></a>00287 <span class="comment">/* 2 -> 2 bytes from prefix - zeroes + 3 from packet */</span>
- <a name="l00288"></a>00288 <span class="comment">/* 3 -> 2 bytes from prefix - infer 1 bytes from lladdr */</span>
- <a name="l00289"></a>00289 <span class="keyword">const</span> uint8_t unc_mxconf[] = {0x0f, 0x25, 0x23, 0x21};
- <a name="l00290"></a>00290
- <a name="l00291"></a>00291 <span class="comment">/* Link local prefix */</span>
- <a name="l00292"></a>00292 <span class="keyword">const</span> uint8_t llprefix[] = {0xfe, 0x80};
- <a name="l00293"></a>00293
- <a name="l00294"></a>00294 <span class="comment">/* TTL uncompression values */</span>
- <a name="l00295"></a>00295 <span class="keyword">static</span> <span class="keyword">const</span> uint8_t ttl_values[] = {0, 1, 64, 255};
- <a name="l00296"></a>00296
- <a name="l00297"></a>00297 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l00298"></a>00298 <span class="comment">/** \name HC06 related functions</span>
- <a name="l00299"></a>00299 <span class="comment"> * @{ */</span>
- <a name="l00300"></a>00300 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l00301"></a>00301 <span class="comment">/** \brief find the context corresponding to prefix ipaddr */</span>
- <a name="l00302"></a>00302 <span class="keyword">static</span> <span class="keyword">struct </span><a class="code" href="a00079.html" title="The header for fragments.">sicslowpan_addr_context</a>*
- <a name="l00303"></a>00303 addr_context_lookup_by_prefix(<a class="code" href="a00106.html" title="Representation of an IP address.">uip_ipaddr_t</a> *ipaddr)
- <a name="l00304"></a>00304 {
- <a name="l00305"></a>00305 <span class="comment">/* Remove code to avoid warnings and save flash if no context is used */</span>
- <a name="l00306"></a>00306 <span class="preprocessor">#if SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 0</span>
- <a name="l00307"></a>00307 <span class="preprocessor"></span> <span class="keywordtype">int</span> i;
- <a name="l00308"></a>00308 <span class="keywordflow">for</span>(i = 0; i < <a class="code" href="a01588.html#ga02ead2bfabed920502fe48c0baa0ed3f" title="If we use IPHC compression, how many address contexts do we support.">SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS</a>; i++) {
- <a name="l00309"></a>00309 <span class="keywordflow">if</span>((addr_contexts[i].used == 1) &&
- <a name="l00310"></a>00310 uip_ipaddr_prefixcmp(&addr_contexts[i].prefix, ipaddr, 64)) {
- <a name="l00311"></a>00311 <span class="keywordflow">return</span> &addr_contexts[i];
- <a name="l00312"></a>00312 }
- <a name="l00313"></a>00313 }
- <a name="l00314"></a>00314 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 0 */</span>
- <a name="l00315"></a>00315 <span class="keywordflow">return</span> NULL;
- <a name="l00316"></a>00316 }
- <a name="l00317"></a>00317 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l00318"></a>00318 <span class="comment">/** \brief find the context with the given number */</span>
- <a name="l00319"></a>00319 <span class="keyword">static</span> <span class="keyword">struct </span><a class="code" href="a00079.html" title="The header for fragments.">sicslowpan_addr_context</a>*
- <a name="l00320"></a>00320 addr_context_lookup_by_number(<a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a> number)
- <a name="l00321"></a>00321 {
- <a name="l00322"></a>00322 <span class="comment">/* Remove code to avoid warnings and save flash if no context is used */</span>
- <a name="l00323"></a>00323 <span class="preprocessor">#if SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 0</span>
- <a name="l00324"></a>00324 <span class="preprocessor"></span> <span class="keywordtype">int</span> i;
- <a name="l00325"></a>00325 <span class="keywordflow">for</span>(i = 0; i < SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS; i++) {
- <a name="l00326"></a>00326 <span class="keywordflow">if</span>((addr_contexts[i].used == 1) &&
- <a name="l00327"></a>00327 addr_contexts[i].number == number) {
- <a name="l00328"></a>00328 <span class="keywordflow">return</span> &addr_contexts[i];
- <a name="l00329"></a>00329 }
- <a name="l00330"></a>00330 }
- <a name="l00331"></a>00331 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 0 */</span>
- <a name="l00332"></a>00332 <span class="keywordflow">return</span> NULL;
- <a name="l00333"></a>00333 }
- <a name="l00334"></a>00334 <span class="comment">/*--------------------------------------------------------------------*/</span>
- <a name="l00335"></a>00335 <span class="keyword">static</span> uint8_t
- <a name="l00336"></a>00336 compress_addr_64(uint8_t bitpos, <a class="code" href="a00106.html" title="Representation of an IP address.">uip_ipaddr_t</a> *ipaddr, <a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *lladdr)
- <a name="l00337"></a>00337 {
- <a name="l00338"></a>00338 <span class="keywordflow">if</span>(uip_is_addr_mac_addr_based(ipaddr, lladdr)) {
- <a name="l00339"></a>00339 <span class="keywordflow">return</span> 3 << bitpos; <span class="comment">/* 0-bits */</span>
- <a name="l00340"></a>00340 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(<a class="code" href="a01680.html#ga8296cf462962152c3baf7765baf086c8" title="check whether we can compress the IID in address &#39;a&#39; to 16 bits.">sicslowpan_is_iid_16_bit_compressable</a>(ipaddr)) {
- <a name="l00341"></a>00341 <span class="comment">/* compress IID to 16 bits xxxx::0000:00ff:fe00:XXXX */</span>
- <a name="l00342"></a>00342 memcpy(hc06_ptr, &ipaddr->u16[7], 2);
- <a name="l00343"></a>00343 hc06_ptr += 2;
- <a name="l00344"></a>00344 <span class="keywordflow">return</span> 2 << bitpos; <span class="comment">/* 16-bits */</span>
- <a name="l00345"></a>00345 } <span class="keywordflow">else</span> {
- <a name="l00346"></a>00346 <span class="comment">/* do not compress IID => xxxx::IID */</span>
- <a name="l00347"></a>00347 memcpy(hc06_ptr, &ipaddr->u16[4], 8);
- <a name="l00348"></a>00348 hc06_ptr += 8;
- <a name="l00349"></a>00349 <span class="keywordflow">return</span> 1 << bitpos; <span class="comment">/* 64-bits */</span>
- <a name="l00350"></a>00350 }
- <a name="l00351"></a>00351 }
- <a name="l00352"></a>00352
- <a name="l00353"></a>00353 <span class="comment">/*-------------------------------------------------------------------- */</span>
- <a name="l00354"></a>00354 <span class="comment">/* Uncompress addresses based on a prefix and a postfix with zeroes in</span>
- <a name="l00355"></a>00355 <span class="comment"> * between. If the postfix is zero in length it will use the link address</span>
- <a name="l00356"></a>00356 <span class="comment"> * to configure the IP address (autoconf style).</span>
- <a name="l00357"></a>00357 <span class="comment"> * pref_post_count takes a byte where the first nibble specify prefix count</span>
- <a name="l00358"></a>00358 <span class="comment"> * and the second postfix count (NOTE: 15/0xf => 16 bytes copy).</span>
- <a name="l00359"></a>00359 <span class="comment"> */</span>
- <a name="l00360"></a>00360 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l00361"></a>00361 uncompress_addr(<a class="code" href="a00106.html" title="Representation of an IP address.">uip_ipaddr_t</a> *ipaddr, uint8_t <span class="keyword">const</span> prefix[],
- <a name="l00362"></a>00362 uint8_t pref_post_count, <a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *lladdr)
- <a name="l00363"></a>00363 {
- <a name="l00364"></a>00364 uint8_t prefcount = pref_post_count >> 4;
- <a name="l00365"></a>00365 uint8_t postcount = pref_post_count & 0x0f;
- <a name="l00366"></a>00366 <span class="comment">/* full nibble 15 => 16 */</span>
- <a name="l00367"></a>00367 prefcount = prefcount == 15 ? 16 : prefcount;
- <a name="l00368"></a>00368 postcount = postcount == 15 ? 16 : postcount;
- <a name="l00369"></a>00369
- <a name="l00370"></a>00370 PRINTF(<span class="stringliteral">"Uncompressing %d + %d => "</span>, prefcount, postcount);
- <a name="l00371"></a>00371
- <a name="l00372"></a>00372 <span class="keywordflow">if</span>(prefcount > 0) {
- <a name="l00373"></a>00373 memcpy(ipaddr, prefix, prefcount);
- <a name="l00374"></a>00374 }
- <a name="l00375"></a>00375 <span class="keywordflow">if</span>(prefcount + postcount < 16) {
- <a name="l00376"></a>00376 memset(&ipaddr->u8[prefcount], 0, 16 - (prefcount + postcount));
- <a name="l00377"></a>00377 }
- <a name="l00378"></a>00378 <span class="keywordflow">if</span>(postcount > 0) {
- <a name="l00379"></a>00379 memcpy(&ipaddr->u8[16 - postcount], hc06_ptr, postcount);
- <a name="l00380"></a>00380 <span class="keywordflow">if</span>(postcount == 2 && prefcount < 11) {
- <a name="l00381"></a>00381 <span class="comment">/* 16 bits uncompression => 0000:00ff:fe00:XXXX */</span>
- <a name="l00382"></a>00382 ipaddr->u8[11] = 0xff;
- <a name="l00383"></a>00383 ipaddr->u8[12] = 0xfe;
- <a name="l00384"></a>00384 }
- <a name="l00385"></a>00385 hc06_ptr += postcount;
- <a name="l00386"></a>00386 } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (prefcount > 0) {
- <a name="l00387"></a>00387 <span class="comment">/* no IID based configuration if no prefix and no data => unspec */</span>
- <a name="l00388"></a>00388 <a class="code" href="a01685.html#gabbe961bbeaea80289fddf448a542fea9" title="set the last 64 bits of an IP address based on the MAC address">uip_ds6_set_addr_iid</a>(ipaddr, lladdr);
- <a name="l00389"></a>00389 }
- <a name="l00390"></a>00390
- <a name="l00391"></a>00391 PRINT6ADDR(ipaddr);
- <a name="l00392"></a>00392 PRINTF(<span class="stringliteral">"\n"</span>);
- <a name="l00393"></a>00393 }
- <a name="l00394"></a>00394
- <a name="l00395"></a>00395 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l00396"></a>00396 <span class="comment">/**</span>
- <a name="l00397"></a>00397 <span class="comment"> * \brief Compress IP/UDP header</span>
- <a name="l00398"></a>00398 <span class="comment"> *</span>
- <a name="l00399"></a>00399 <span class="comment"> * This function is called by the 6lowpan code to create a compressed</span>
- <a name="l00400"></a>00400 <span class="comment"> * 6lowpan packet in the packetbuf buffer from a full IPv6 packet in the</span>
- <a name="l00401"></a>00401 <span class="comment"> * uip_buf buffer.</span>
- <a name="l00402"></a>00402 <span class="comment"> *</span>
- <a name="l00403"></a>00403 <span class="comment"> *</span>
- <a name="l00404"></a>00404 <span class="comment"> * HC-06 (draft-ietf-6lowpan-hc, version 6)\n</span>
- <a name="l00405"></a>00405 <span class="comment"> * http://tools.ietf.org/html/draft-ietf-6lowpan-hc-06</span>
- <a name="l00406"></a>00406 <span class="comment"> *</span>
- <a name="l00407"></a>00407 <span class="comment"> * \note We do not support ISA100_UDP header compression</span>
- <a name="l00408"></a>00408 <span class="comment"> *</span>
- <a name="l00409"></a>00409 <span class="comment"> * For LOWPAN_UDP compression, we either compress both ports or none.</span>
- <a name="l00410"></a>00410 <span class="comment"> * General format with LOWPAN_UDP compression is</span>
- <a name="l00411"></a>00411 <span class="comment"> * \verbatim</span>
- <a name="l00412"></a>00412 <span class="comment"> * 1 2 3</span>
- <a name="l00413"></a>00413 <span class="comment"> * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1</span>
- <a name="l00414"></a>00414 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00415"></a>00415 <span class="comment"> * |0|1|1|TF |N|HLI|C|S|SAM|M|D|DAM| SCI | DCI | comp. IPv6 hdr|</span>
- <a name="l00416"></a>00416 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00417"></a>00417 <span class="comment"> * | compressed IPv6 fields ..... |</span>
- <a name="l00418"></a>00418 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00419"></a>00419 <span class="comment"> * | LOWPAN_UDP | non compressed UDP fields ... |</span>
- <a name="l00420"></a>00420 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00421"></a>00421 <span class="comment"> * | L4 data ... |</span>
- <a name="l00422"></a>00422 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00423"></a>00423 <span class="comment"> * \endverbatim</span>
- <a name="l00424"></a>00424 <span class="comment"> * \note The context number 00 is reserved for the link local prefix.</span>
- <a name="l00425"></a>00425 <span class="comment"> * For unicast addresses, if we cannot compress the prefix, we neither</span>
- <a name="l00426"></a>00426 <span class="comment"> * compress the IID.</span>
- <a name="l00427"></a>00427 <span class="comment"> * \param rime_destaddr L2 destination address, needed to compress IP</span>
- <a name="l00428"></a>00428 <span class="comment"> * dest</span>
- <a name="l00429"></a>00429 <span class="comment"> */</span>
- <a name="l00430"></a>00430 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l00431"></a>00431 compress_hdr_hc06(rimeaddr_t *rime_destaddr)
- <a name="l00432"></a>00432 {
- <a name="l00433"></a>00433 uint8_t tmp, iphc0, iphc1;
- <a name="l00434"></a>00434 <span class="preprocessor">#if DEBUG</span>
- <a name="l00435"></a>00435 <span class="preprocessor"></span> PRINTF(<span class="stringliteral">"before compression: "</span>);
- <a name="l00436"></a>00436 <span class="keywordflow">for</span> (tmp = 0; tmp < <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->len[1] + 40; tmp++) {
- <a name="l00437"></a>00437 uint8_t data = ((uint8_t *) (<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>))[tmp];
- <a name="l00438"></a>00438 PRINTF(<span class="stringliteral">"%02x"</span>, data);
- <a name="l00439"></a>00439 }
- <a name="l00440"></a>00440 PRINTF(<span class="stringliteral">"\n"</span>);
- <a name="l00441"></a>00441 <span class="preprocessor">#endif</span>
- <a name="l00442"></a>00442 <span class="preprocessor"></span>
- <a name="l00443"></a>00443 hc06_ptr = rime_ptr + 2;
- <a name="l00444"></a>00444 <span class="comment">/*</span>
- <a name="l00445"></a>00445 <span class="comment"> * As we copy some bit-length fields, in the IPHC encoding bytes,</span>
- <a name="l00446"></a>00446 <span class="comment"> * we sometimes use |=</span>
- <a name="l00447"></a>00447 <span class="comment"> * If the field is 0, and the current bit value in memory is 1,</span>
- <a name="l00448"></a>00448 <span class="comment"> * this does not work. We therefore reset the IPHC encoding here</span>
- <a name="l00449"></a>00449 <span class="comment"> */</span>
- <a name="l00450"></a>00450
- <a name="l00451"></a>00451 iphc0 = SICSLOWPAN_DISPATCH_IPHC;
- <a name="l00452"></a>00452 iphc1 = 0;
- <a name="l00453"></a>00453 RIME_IPHC_BUF[2] = 0; <span class="comment">/* might not be used - but needs to be cleared */</span>
- <a name="l00454"></a>00454
- <a name="l00455"></a>00455 <span class="comment">/*</span>
- <a name="l00456"></a>00456 <span class="comment"> * Address handling needs to be made first since it might</span>
- <a name="l00457"></a>00457 <span class="comment"> * cause an extra byte with [ SCI | DCI ]</span>
- <a name="l00458"></a>00458 <span class="comment"> *</span>
- <a name="l00459"></a>00459 <span class="comment"> */</span>
- <a name="l00460"></a>00460
- <a name="l00461"></a>00461
- <a name="l00462"></a>00462 <span class="comment">/* check if dest context exists (for allocating third byte) */</span>
- <a name="l00463"></a>00463 <span class="comment">/* TODO: fix this so that it remembers the looked up values for</span>
- <a name="l00464"></a>00464 <span class="comment"> avoiding two lookups - or set the lookup values immediately */</span>
- <a name="l00465"></a>00465 <span class="keywordflow">if</span>(addr_context_lookup_by_prefix(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr) != NULL ||
- <a name="l00466"></a>00466 addr_context_lookup_by_prefix(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr) != NULL) {
- <a name="l00467"></a>00467 <span class="comment">/* set context flag and increase hc06_ptr */</span>
- <a name="l00468"></a>00468 PRINTF(<span class="stringliteral">"IPHC: compressing dest or src ipaddr - setting CID\n"</span>);
- <a name="l00469"></a>00469 iphc1 |= SICSLOWPAN_IPHC_CID;
- <a name="l00470"></a>00470 hc06_ptr++;
- <a name="l00471"></a>00471 }
- <a name="l00472"></a>00472
- <a name="l00473"></a>00473 <span class="comment">/*</span>
- <a name="l00474"></a>00474 <span class="comment"> * Traffic class, flow label</span>
- <a name="l00475"></a>00475 <span class="comment"> * If flow label is 0, compress it. If traffic class is 0, compress it</span>
- <a name="l00476"></a>00476 <span class="comment"> * We have to process both in the same time as the offset of traffic class</span>
- <a name="l00477"></a>00477 <span class="comment"> * depends on the presence of version and flow label</span>
- <a name="l00478"></a>00478 <span class="comment"> */</span>
- <a name="l00479"></a>00479
- <a name="l00480"></a>00480 <span class="comment">/* hc06 format of tc is ECN | DSCP , original is DSCP | ECN */</span>
- <a name="l00481"></a>00481 tmp = (<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->vtc << 4) | (<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->tcflow >> 4);
- <a name="l00482"></a>00482 tmp = ((tmp & 0x03) << 6) | (tmp >> 2);
- <a name="l00483"></a>00483
- <a name="l00484"></a>00484 <span class="keywordflow">if</span>(((<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->tcflow & 0x0F) == 0) &&
- <a name="l00485"></a>00485 (<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->flow == 0)) {
- <a name="l00486"></a>00486 <span class="comment">/* flow label can be compressed */</span>
- <a name="l00487"></a>00487 iphc0 |= SICSLOWPAN_IPHC_FL_C;
- <a name="l00488"></a>00488 <span class="keywordflow">if</span>(((<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->vtc & 0x0F) == 0) &&
- <a name="l00489"></a>00489 ((<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->tcflow & 0xF0) == 0)) {
- <a name="l00490"></a>00490 <span class="comment">/* compress (elide) all */</span>
- <a name="l00491"></a>00491 iphc0 |= SICSLOWPAN_IPHC_TC_C;
- <a name="l00492"></a>00492 } <span class="keywordflow">else</span> {
- <a name="l00493"></a>00493 <span class="comment">/* compress only the flow label */</span>
- <a name="l00494"></a>00494 *hc06_ptr = tmp;
- <a name="l00495"></a>00495 hc06_ptr += 1;
- <a name="l00496"></a>00496 }
- <a name="l00497"></a>00497 } <span class="keywordflow">else</span> {
- <a name="l00498"></a>00498 <span class="comment">/* Flow label cannot be compressed */</span>
- <a name="l00499"></a>00499 <span class="keywordflow">if</span>(((<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->vtc & 0x0F) == 0) &&
- <a name="l00500"></a>00500 ((<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->tcflow & 0xF0) == 0)) {
- <a name="l00501"></a>00501 <span class="comment">/* compress only traffic class */</span>
- <a name="l00502"></a>00502 iphc0 |= SICSLOWPAN_IPHC_TC_C;
- <a name="l00503"></a>00503 *hc06_ptr = (tmp & 0xc0) |
- <a name="l00504"></a>00504 (<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->tcflow & 0x0F);
- <a name="l00505"></a>00505 memcpy(hc06_ptr + 1, &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->flow, 2);
- <a name="l00506"></a>00506 hc06_ptr += 3;
- <a name="l00507"></a>00507 } <span class="keywordflow">else</span> {
- <a name="l00508"></a>00508 <span class="comment">/* compress nothing */</span>
- <a name="l00509"></a>00509 memcpy(hc06_ptr, &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->vtc, 4);
- <a name="l00510"></a>00510 <span class="comment">/* but replace the top byte with the new ECN | DSCP format*/</span>
- <a name="l00511"></a>00511 *hc06_ptr = tmp;
- <a name="l00512"></a>00512 hc06_ptr += 4;
- <a name="l00513"></a>00513 }
- <a name="l00514"></a>00514 }
- <a name="l00515"></a>00515
- <a name="l00516"></a>00516 <span class="comment">/* Note that the payload length is always compressed */</span>
- <a name="l00517"></a>00517
- <a name="l00518"></a>00518 <span class="comment">/* Next header. We compress it if UDP */</span>
- <a name="l00519"></a>00519 <span class="preprocessor">#if UIP_CONF_UDP</span>
- <a name="l00520"></a>00520 <span class="preprocessor"></span> <span class="keywordflow">if</span>(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto == UIP_PROTO_UDP) {
- <a name="l00521"></a>00521 iphc0 |= SICSLOWPAN_IPHC_NH_C;
- <a name="l00522"></a>00522 }
- <a name="l00523"></a>00523 <span class="preprocessor">#endif </span><span class="comment">/*UIP_CONF_UDP*/</span>
- <a name="l00524"></a>00524 <span class="preprocessor">#ifdef SICSLOWPAN_NH_COMPRESSOR </span>
- <a name="l00525"></a>00525 <span class="preprocessor"></span> <span class="keywordflow">if</span>(SICSLOWPAN_NH_COMPRESSOR.is_compressable(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto)) {
- <a name="l00526"></a>00526 iphc0 |= SICSLOWPAN_IPHC_NH_C;
- <a name="l00527"></a>00527 }
- <a name="l00528"></a>00528 <span class="preprocessor">#endif</span>
- <a name="l00529"></a>00529 <span class="preprocessor"></span> <span class="keywordflow">if</span> ((iphc0 & SICSLOWPAN_IPHC_NH_C) == 0) {
- <a name="l00530"></a>00530 *hc06_ptr = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto;
- <a name="l00531"></a>00531 hc06_ptr += 1;
- <a name="l00532"></a>00532 }
- <a name="l00533"></a>00533
- <a name="l00534"></a>00534 <span class="comment">/*</span>
- <a name="l00535"></a>00535 <span class="comment"> * Hop limit</span>
- <a name="l00536"></a>00536 <span class="comment"> * if 1: compress, encoding is 01</span>
- <a name="l00537"></a>00537 <span class="comment"> * if 64: compress, encoding is 10</span>
- <a name="l00538"></a>00538 <span class="comment"> * if 255: compress, encoding is 11</span>
- <a name="l00539"></a>00539 <span class="comment"> * else do not compress</span>
- <a name="l00540"></a>00540 <span class="comment"> */</span>
- <a name="l00541"></a>00541 <span class="keywordflow">switch</span>(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->ttl) {
- <a name="l00542"></a>00542 <span class="keywordflow">case</span> 1:
- <a name="l00543"></a>00543 iphc0 |= SICSLOWPAN_IPHC_TTL_1;
- <a name="l00544"></a>00544 <span class="keywordflow">break</span>;
- <a name="l00545"></a>00545 <span class="keywordflow">case</span> 64:
- <a name="l00546"></a>00546 iphc0 |= SICSLOWPAN_IPHC_TTL_64;
- <a name="l00547"></a>00547 <span class="keywordflow">break</span>;
- <a name="l00548"></a>00548 <span class="keywordflow">case</span> 255:
- <a name="l00549"></a>00549 iphc0 |= SICSLOWPAN_IPHC_TTL_255;
- <a name="l00550"></a>00550 <span class="keywordflow">break</span>;
- <a name="l00551"></a>00551 <span class="keywordflow">default</span>:
- <a name="l00552"></a>00552 *hc06_ptr = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->ttl;
- <a name="l00553"></a>00553 hc06_ptr += 1;
- <a name="l00554"></a>00554 <span class="keywordflow">break</span>;
- <a name="l00555"></a>00555 }
- <a name="l00556"></a>00556
- <a name="l00557"></a>00557 <span class="comment">/* source address - cannot be multicast */</span>
- <a name="l00558"></a>00558 <span class="keywordflow">if</span>(uip_is_addr_unspecified(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr)) {
- <a name="l00559"></a>00559 PRINTF(<span class="stringliteral">"IPHC: compressing unspecified - setting SAC\n"</span>);
- <a name="l00560"></a>00560 iphc1 |= SICSLOWPAN_IPHC_SAC;
- <a name="l00561"></a>00561 iphc1 |= SICSLOWPAN_IPHC_SAM_00;
- <a name="l00562"></a>00562 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>((context = addr_context_lookup_by_prefix(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr))
- <a name="l00563"></a>00563 != NULL) {
- <a name="l00564"></a>00564 <span class="comment">/* elide the prefix - indicate by CID and set context + SAC */</span>
- <a name="l00565"></a>00565 PRINTF(<span class="stringliteral">"IPHC: compressing src with context - setting CID & SAC ctx: %d\n"</span>,
- <a name="l00566"></a>00566 context->number);
- <a name="l00567"></a>00567 iphc1 |= SICSLOWPAN_IPHC_CID | SICSLOWPAN_IPHC_SAC;
- <a name="l00568"></a>00568 RIME_IPHC_BUF[2] |= context->number << 4;
- <a name="l00569"></a>00569 <span class="comment">/* compession compare with this nodes address (source) */</span>
- <a name="l00570"></a>00570
- <a name="l00571"></a>00571 iphc1 |= compress_addr_64(SICSLOWPAN_IPHC_SAM_BIT,
- <a name="l00572"></a>00572 &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr, &<a class="code" href="a01684.html#ga89bf167a9f1014d2d78754742eb7e06d" title="Host L2 address.">uip_lladdr</a>);
- <a name="l00573"></a>00573 <span class="comment">/* No context found for this address */</span>
- <a name="l00574"></a>00574 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(uip_is_addr_link_local(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr) &&
- <a name="l00575"></a>00575 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u16[1] == 0 &&
- <a name="l00576"></a>00576 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u16[2] == 0 &&
- <a name="l00577"></a>00577 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u16[3] == 0) {
- <a name="l00578"></a>00578 iphc1 |= compress_addr_64(SICSLOWPAN_IPHC_SAM_BIT,
- <a name="l00579"></a>00579 &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr, &<a class="code" href="a01684.html#ga89bf167a9f1014d2d78754742eb7e06d" title="Host L2 address.">uip_lladdr</a>);
- <a name="l00580"></a>00580 } <span class="keywordflow">else</span> {
- <a name="l00581"></a>00581 <span class="comment">/* send the full address => SAC = 0, SAM = 00 */</span>
- <a name="l00582"></a>00582 iphc1 |= SICSLOWPAN_IPHC_SAM_00; <span class="comment">/* 128-bits */</span>
- <a name="l00583"></a>00583 memcpy(hc06_ptr, &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr.u16[0], 16);
- <a name="l00584"></a>00584 hc06_ptr += 16;
- <a name="l00585"></a>00585 }
- <a name="l00586"></a>00586
- <a name="l00587"></a>00587 <span class="comment">/* dest address*/</span>
- <a name="l00588"></a>00588 <span class="keywordflow">if</span>(uip_is_addr_mcast(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr)) {
- <a name="l00589"></a>00589 <span class="comment">/* Address is multicast, try to compress */</span>
- <a name="l00590"></a>00590 iphc1 |= SICSLOWPAN_IPHC_M;
- <a name="l00591"></a>00591 <span class="keywordflow">if</span>(sicslowpan_is_mcast_addr_compressable8(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr)) {
- <a name="l00592"></a>00592 iphc1 |= SICSLOWPAN_IPHC_DAM_11;
- <a name="l00593"></a>00593 <span class="comment">/* use last byte */</span>
- <a name="l00594"></a>00594 *hc06_ptr = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u8[15];
- <a name="l00595"></a>00595 hc06_ptr += 1;
- <a name="l00596"></a>00596 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(sicslowpan_is_mcast_addr_compressable32(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr)) {
- <a name="l00597"></a>00597 iphc1 |= SICSLOWPAN_IPHC_DAM_10;
- <a name="l00598"></a>00598 <span class="comment">/* second byte + the last three */</span>
- <a name="l00599"></a>00599 *hc06_ptr = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u8[1];
- <a name="l00600"></a>00600 memcpy(hc06_ptr + 1, &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u8[13], 3);
- <a name="l00601"></a>00601 hc06_ptr += 4;
- <a name="l00602"></a>00602 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(sicslowpan_is_mcast_addr_compressable48(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr)) {
- <a name="l00603"></a>00603 iphc1 |= SICSLOWPAN_IPHC_DAM_01;
- <a name="l00604"></a>00604 <span class="comment">/* second byte + the last five */</span>
- <a name="l00605"></a>00605 *hc06_ptr = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u8[1];
- <a name="l00606"></a>00606 memcpy(hc06_ptr + 1, &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u8[11], 5);
- <a name="l00607"></a>00607 hc06_ptr += 6;
- <a name="l00608"></a>00608 } <span class="keywordflow">else</span> {
- <a name="l00609"></a>00609 iphc1 |= SICSLOWPAN_IPHC_DAM_00;
- <a name="l00610"></a>00610 <span class="comment">/* full address */</span>
- <a name="l00611"></a>00611 memcpy(hc06_ptr, &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u8[0], 16);
- <a name="l00612"></a>00612 hc06_ptr += 16;
- <a name="l00613"></a>00613 }
- <a name="l00614"></a>00614 } <span class="keywordflow">else</span> {
- <a name="l00615"></a>00615 <span class="comment">/* Address is unicast, try to compress */</span>
- <a name="l00616"></a>00616 <span class="keywordflow">if</span>((context = addr_context_lookup_by_prefix(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr)) != NULL) {
- <a name="l00617"></a>00617 <span class="comment">/* elide the prefix */</span>
- <a name="l00618"></a>00618 iphc1 |= SICSLOWPAN_IPHC_DAC;
- <a name="l00619"></a>00619 RIME_IPHC_BUF[2] |= context->number;
- <a name="l00620"></a>00620 <span class="comment">/* compession compare with link adress (destination) */</span>
- <a name="l00621"></a>00621
- <a name="l00622"></a>00622 iphc1 |= compress_addr_64(SICSLOWPAN_IPHC_DAM_BIT,
- <a name="l00623"></a>00623 &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr, (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)rime_destaddr);
- <a name="l00624"></a>00624 <span class="comment">/* No context found for this address */</span>
- <a name="l00625"></a>00625 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(uip_is_addr_link_local(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr) &&
- <a name="l00626"></a>00626 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u16[1] == 0 &&
- <a name="l00627"></a>00627 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u16[2] == 0 &&
- <a name="l00628"></a>00628 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u16[3] == 0) {
- <a name="l00629"></a>00629 iphc1 |= compress_addr_64(SICSLOWPAN_IPHC_DAM_BIT,
- <a name="l00630"></a>00630 &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr, (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)rime_destaddr);
- <a name="l00631"></a>00631 } <span class="keywordflow">else</span> {
- <a name="l00632"></a>00632 <span class="comment">/* send the full address */</span>
- <a name="l00633"></a>00633 iphc1 |= SICSLOWPAN_IPHC_DAM_00; <span class="comment">/* 128-bits */</span>
- <a name="l00634"></a>00634 memcpy(hc06_ptr, &<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr.u16[0], 16);
- <a name="l00635"></a>00635 hc06_ptr += 16;
- <a name="l00636"></a>00636 }
- <a name="l00637"></a>00637 }
- <a name="l00638"></a>00638
- <a name="l00639"></a>00639 uncomp_hdr_len = UIP_IPH_LEN;
- <a name="l00640"></a>00640
- <a name="l00641"></a>00641 <span class="preprocessor">#if UIP_CONF_UDP</span>
- <a name="l00642"></a>00642 <span class="preprocessor"></span> <span class="comment">/* UDP header compression */</span>
- <a name="l00643"></a>00643 <span class="keywordflow">if</span>(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto == UIP_PROTO_UDP) {
- <a name="l00644"></a>00644 PRINTF(<span class="stringliteral">"IPHC: Uncompressed UDP ports on send side: %x, %x\n"</span>,
- <a name="l00645"></a>00645 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport), <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport));
- <a name="l00646"></a>00646 <span class="comment">/* Mask out the last 4 bits can be used as a mask */</span>
- <a name="l00647"></a>00647 <span class="keywordflow">if</span>(((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport) & 0xfff0) == SICSLOWPAN_UDP_4_BIT_PORT_MIN) &&
- <a name="l00648"></a>00648 ((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport) & 0xfff0) == SICSLOWPAN_UDP_4_BIT_PORT_MIN)) {
- <a name="l00649"></a>00649 <span class="comment">/* we can compress 12 bits of both source and dest */</span>
- <a name="l00650"></a>00650 *hc06_ptr = SICSLOWPAN_NHC_UDP_CS_P_11;
- <a name="l00651"></a>00651 PRINTF(<span class="stringliteral">"IPHC: remove 12 b of both source & dest with prefix 0xFOB\n"</span>);
- <a name="l00652"></a>00652 *(hc06_ptr + 1) =
- <a name="l00653"></a>00653 (<a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a>)((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport) -
- <a name="l00654"></a>00654 SICSLOWPAN_UDP_4_BIT_PORT_MIN) << 4) +
- <a name="l00655"></a>00655 (<a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a>)((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport) -
- <a name="l00656"></a>00656 SICSLOWPAN_UDP_4_BIT_PORT_MIN));
- <a name="l00657"></a>00657 hc06_ptr += 2;
- <a name="l00658"></a>00658 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport) & 0xff00) == SICSLOWPAN_UDP_8_BIT_PORT_MIN) {
- <a name="l00659"></a>00659 <span class="comment">/* we can compress 8 bits of dest, leave source. */</span>
- <a name="l00660"></a>00660 *hc06_ptr = SICSLOWPAN_NHC_UDP_CS_P_01;
- <a name="l00661"></a>00661 PRINTF(<span class="stringliteral">"IPHC: leave source, remove 8 bits of dest with prefix 0xF0\n"</span>);
- <a name="l00662"></a>00662 memcpy(hc06_ptr + 1, &UIP_UDP_BUF->srcport, 2);
- <a name="l00663"></a>00663 *(hc06_ptr + 3) =
- <a name="l00664"></a>00664 (<a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a>)((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport) -
- <a name="l00665"></a>00665 SICSLOWPAN_UDP_8_BIT_PORT_MIN));
- <a name="l00666"></a>00666 hc06_ptr += 4;
- <a name="l00667"></a>00667 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport) & 0xff00) == SICSLOWPAN_UDP_8_BIT_PORT_MIN) {
- <a name="l00668"></a>00668 <span class="comment">/* we can compress 8 bits of src, leave dest. Copy compressed port */</span>
- <a name="l00669"></a>00669 *hc06_ptr = SICSLOWPAN_NHC_UDP_CS_P_10;
- <a name="l00670"></a>00670 PRINTF(<span class="stringliteral">"IPHC: remove 8 bits of source with prefix 0xF0, leave dest. hch: %i\n"</span>, *hc06_ptr);
- <a name="l00671"></a>00671 *(hc06_ptr + 1) =
- <a name="l00672"></a>00672 (<a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a>)((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport) -
- <a name="l00673"></a>00673 SICSLOWPAN_UDP_8_BIT_PORT_MIN));
- <a name="l00674"></a>00674 memcpy(hc06_ptr + 2, &UIP_UDP_BUF->destport, 2);
- <a name="l00675"></a>00675 hc06_ptr += 4;
- <a name="l00676"></a>00676 } <span class="keywordflow">else</span> {
- <a name="l00677"></a>00677 <span class="comment">/* we cannot compress. Copy uncompressed ports, full checksum */</span>
- <a name="l00678"></a>00678 *hc06_ptr = SICSLOWPAN_NHC_UDP_CS_P_00;
- <a name="l00679"></a>00679 PRINTF(<span class="stringliteral">"IPHC: cannot compress headers\n"</span>);
- <a name="l00680"></a>00680 memcpy(hc06_ptr + 1, &UIP_UDP_BUF->srcport, 4);
- <a name="l00681"></a>00681 hc06_ptr += 5;
- <a name="l00682"></a>00682 }
- <a name="l00683"></a>00683 <span class="comment">/* always inline the checksum */</span>
- <a name="l00684"></a>00684 <span class="keywordflow">if</span>(1) {
- <a name="l00685"></a>00685 memcpy(hc06_ptr, &UIP_UDP_BUF->udpchksum, 2);
- <a name="l00686"></a>00686 hc06_ptr += 2;
- <a name="l00687"></a>00687 }
- <a name="l00688"></a>00688 uncomp_hdr_len += UIP_UDPH_LEN;
- <a name="l00689"></a>00689 }
- <a name="l00690"></a>00690 <span class="preprocessor">#endif </span><span class="comment">/*UIP_CONF_UDP*/</span>
- <a name="l00691"></a>00691
- <a name="l00692"></a>00692 <span class="preprocessor">#ifdef SICSLOWPAN_NH_COMPRESSOR</span>
- <a name="l00693"></a>00693 <span class="preprocessor"></span> <span class="comment">/* if nothing to compress just return zero */</span>
- <a name="l00694"></a>00694 hc06_ptr += SICSLOWPAN_NH_COMPRESSOR.compress(hc06_ptr, &uncomp_hdr_len);
- <a name="l00695"></a>00695 <span class="preprocessor">#endif</span>
- <a name="l00696"></a>00696 <span class="preprocessor"></span>
- <a name="l00697"></a>00697 <span class="comment">/* before the rime_hdr_len operation */</span>
- <a name="l00698"></a>00698 RIME_IPHC_BUF[0] = iphc0;
- <a name="l00699"></a>00699 RIME_IPHC_BUF[1] = iphc1;
- <a name="l00700"></a>00700
- <a name="l00701"></a>00701 rime_hdr_len = hc06_ptr - rime_ptr;
- <a name="l00702"></a>00702 <span class="keywordflow">return</span>;
- <a name="l00703"></a>00703 }
- <a name="l00704"></a>00704
- <a name="l00705"></a>00705 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l00706"></a>00706 <span class="comment">/**</span>
- <a name="l00707"></a>00707 <span class="comment"> * \brief Uncompress HC06 (i.e., IPHC and LOWPAN_UDP) headers and put</span>
- <a name="l00708"></a>00708 <span class="comment"> * them in sicslowpan_buf</span>
- <a name="l00709"></a>00709 <span class="comment"> *</span>
- <a name="l00710"></a>00710 <span class="comment"> * This function is called by the input function when the dispatch is</span>
- <a name="l00711"></a>00711 <span class="comment"> * HC06.</span>
- <a name="l00712"></a>00712 <span class="comment"> * We %process the packet in the rime buffer, uncompress the header</span>
- <a name="l00713"></a>00713 <span class="comment"> * fields, and copy the result in the sicslowpan buffer.</span>
- <a name="l00714"></a>00714 <span class="comment"> * At the end of the decompression, rime_hdr_len and uncompressed_hdr_len</span>
- <a name="l00715"></a>00715 <span class="comment"> * are set to the appropriate values</span>
- <a name="l00716"></a>00716 <span class="comment"> *</span>
- <a name="l00717"></a>00717 <span class="comment"> * \param ip_len Equal to 0 if the packet is not a fragment (IP length</span>
- <a name="l00718"></a>00718 <span class="comment"> * is then inferred from the L2 length), non 0 if the packet is a 1st</span>
- <a name="l00719"></a>00719 <span class="comment"> * fragment.</span>
- <a name="l00720"></a>00720 <span class="comment"> */</span>
- <a name="l00721"></a>00721 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l00722"></a>00722 uncompress_hdr_hc06(uint16_t ip_len)
- <a name="l00723"></a>00723 {
- <a name="l00724"></a>00724 uint8_t tmp, iphc0, iphc1;
- <a name="l00725"></a>00725 <span class="comment">/* at least two byte will be used for the encoding */</span>
- <a name="l00726"></a>00726 hc06_ptr = rime_ptr + rime_hdr_len + 2;
- <a name="l00727"></a>00727
- <a name="l00728"></a>00728 iphc0 = RIME_IPHC_BUF[0];
- <a name="l00729"></a>00729 iphc1 = RIME_IPHC_BUF[1];
- <a name="l00730"></a>00730
- <a name="l00731"></a>00731 <span class="comment">/* another if the CID flag is set */</span>
- <a name="l00732"></a>00732 <span class="keywordflow">if</span>(iphc1 & SICSLOWPAN_IPHC_CID) {
- <a name="l00733"></a>00733 PRINTF(<span class="stringliteral">"IPHC: CID flag set - increase header with one\n"</span>);
- <a name="l00734"></a>00734 hc06_ptr++;
- <a name="l00735"></a>00735 }
- <a name="l00736"></a>00736
- <a name="l00737"></a>00737 <span class="comment">/* Traffic class and flow label */</span>
- <a name="l00738"></a>00738 <span class="keywordflow">if</span>((iphc0 & SICSLOWPAN_IPHC_FL_C) == 0) {
- <a name="l00739"></a>00739 <span class="comment">/* Flow label are carried inline */</span>
- <a name="l00740"></a>00740 <span class="keywordflow">if</span>((iphc0 & SICSLOWPAN_IPHC_TC_C) == 0) {
- <a name="l00741"></a>00741 <span class="comment">/* Traffic class is carried inline */</span>
- <a name="l00742"></a>00742 memcpy(&SICSLOWPAN_IP_BUF->tcflow, hc06_ptr + 1, 3);
- <a name="l00743"></a>00743 tmp = *hc06_ptr;
- <a name="l00744"></a>00744 hc06_ptr += 4;
- <a name="l00745"></a>00745 <span class="comment">/* hc06 format of tc is ECN | DSCP , original is DSCP | ECN */</span>
- <a name="l00746"></a>00746 <span class="comment">/* set version, pick highest DSCP bits and set in vtc */</span>
- <a name="l00747"></a>00747 SICSLOWPAN_IP_BUF->vtc = 0x60 | ((tmp >> 2) & 0x0f);
- <a name="l00748"></a>00748 <span class="comment">/* ECN rolled down two steps + lowest DSCP bits at top two bits */</span>
- <a name="l00749"></a>00749 SICSLOWPAN_IP_BUF->tcflow = ((tmp >> 2) & 0x30) | (tmp << 6) |
- <a name="l00750"></a>00750 (SICSLOWPAN_IP_BUF->tcflow & 0x0f);
- <a name="l00751"></a>00751 } <span class="keywordflow">else</span> {
- <a name="l00752"></a>00752 <span class="comment">/* Traffic class is compressed (set version and no TC)*/</span>
- <a name="l00753"></a>00753 SICSLOWPAN_IP_BUF->vtc = 0x60;
- <a name="l00754"></a>00754 <span class="comment">/* highest flow label bits + ECN bits */</span>
- <a name="l00755"></a>00755 SICSLOWPAN_IP_BUF->tcflow = (*hc06_ptr & 0x0F) |
- <a name="l00756"></a>00756 ((*hc06_ptr >> 2) & 0x30);
- <a name="l00757"></a>00757 memcpy(&SICSLOWPAN_IP_BUF->flow, hc06_ptr + 1, 2);
- <a name="l00758"></a>00758 hc06_ptr += 3;
- <a name="l00759"></a>00759 }
- <a name="l00760"></a>00760 } <span class="keywordflow">else</span> {
- <a name="l00761"></a>00761 <span class="comment">/* Version is always 6! */</span>
- <a name="l00762"></a>00762 <span class="comment">/* Version and flow label are compressed */</span>
- <a name="l00763"></a>00763 <span class="keywordflow">if</span>((iphc0 & SICSLOWPAN_IPHC_TC_C) == 0) {
- <a name="l00764"></a>00764 <span class="comment">/* Traffic class is inline */</span>
- <a name="l00765"></a>00765 SICSLOWPAN_IP_BUF->vtc = 0x60 | ((*hc06_ptr >> 2) & 0x0f);
- <a name="l00766"></a>00766 SICSLOWPAN_IP_BUF->tcflow = ((*hc06_ptr << 6) & 0xC0) | ((*hc06_ptr >> 2) & 0x30);
- <a name="l00767"></a>00767 SICSLOWPAN_IP_BUF->flow = 0;
- <a name="l00768"></a>00768 hc06_ptr += 3;
- <a name="l00769"></a>00769 } <span class="keywordflow">else</span> {
- <a name="l00770"></a>00770 <span class="comment">/* Traffic class is compressed */</span>
- <a name="l00771"></a>00771 SICSLOWPAN_IP_BUF->vtc = 0x60;
- <a name="l00772"></a>00772 SICSLOWPAN_IP_BUF->tcflow = 0;
- <a name="l00773"></a>00773 SICSLOWPAN_IP_BUF->flow = 0;
- <a name="l00774"></a>00774 }
- <a name="l00775"></a>00775 }
- <a name="l00776"></a>00776
- <a name="l00777"></a>00777 <span class="comment">/* Next Header */</span>
- <a name="l00778"></a>00778 <span class="keywordflow">if</span>((iphc0 & SICSLOWPAN_IPHC_NH_C) == 0) {
- <a name="l00779"></a>00779 <span class="comment">/* Next header is carried inline */</span>
- <a name="l00780"></a>00780 SICSLOWPAN_IP_BUF->proto = *hc06_ptr;
- <a name="l00781"></a>00781 PRINTF(<span class="stringliteral">"IPHC: next header inline: %d\n"</span>, SICSLOWPAN_IP_BUF->proto);
- <a name="l00782"></a>00782 hc06_ptr += 1;
- <a name="l00783"></a>00783 }
- <a name="l00784"></a>00784
- <a name="l00785"></a>00785 <span class="comment">/* Hop limit */</span>
- <a name="l00786"></a>00786 <span class="keywordflow">if</span>((iphc0 & 0x03) != SICSLOWPAN_IPHC_TTL_I) {
- <a name="l00787"></a>00787 SICSLOWPAN_IP_BUF->ttl = ttl_values[iphc0 & 0x03];
- <a name="l00788"></a>00788 } <span class="keywordflow">else</span> {
- <a name="l00789"></a>00789 SICSLOWPAN_IP_BUF->ttl = *hc06_ptr;
- <a name="l00790"></a>00790 hc06_ptr += 1;
- <a name="l00791"></a>00791 }
- <a name="l00792"></a>00792
- <a name="l00793"></a>00793 <span class="comment">/* put the source address compression mode SAM in the tmp var */</span>
- <a name="l00794"></a>00794 tmp = ((iphc1 & SICSLOWPAN_IPHC_SAM_11) >> SICSLOWPAN_IPHC_SAM_BIT) & 0x03;
- <a name="l00795"></a>00795
- <a name="l00796"></a>00796 <span class="comment">/* context based compression */</span>
- <a name="l00797"></a>00797 <span class="keywordflow">if</span>(iphc1 & SICSLOWPAN_IPHC_SAC) {
- <a name="l00798"></a>00798 uint8_t sci = (iphc1 & SICSLOWPAN_IPHC_CID) ?
- <a name="l00799"></a>00799 RIME_IPHC_BUF[2] >> 4 : 0;
- <a name="l00800"></a>00800
- <a name="l00801"></a>00801 <span class="comment">/* Source address - check context != NULL only if SAM bits are != 0*/</span>
- <a name="l00802"></a>00802 <span class="keywordflow">if</span> (tmp != 0) {
- <a name="l00803"></a>00803 context = addr_context_lookup_by_number(sci);
- <a name="l00804"></a>00804 <span class="keywordflow">if</span>(context == NULL) {
- <a name="l00805"></a>00805 PRINTF(<span class="stringliteral">"sicslowpan uncompress_hdr: error context not found\n"</span>);
- <a name="l00806"></a>00806 <span class="keywordflow">return</span>;
- <a name="l00807"></a>00807 }
- <a name="l00808"></a>00808 }
- <a name="l00809"></a>00809 <span class="comment">/* if tmp == 0 we do not have a context and therefore no prefix */</span>
- <a name="l00810"></a>00810 uncompress_addr(&SICSLOWPAN_IP_BUF->srcipaddr,
- <a name="l00811"></a>00811 tmp != 0 ? context->prefix : NULL, unc_ctxconf[tmp],
- <a name="l00812"></a>00812 (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)packetbuf_addr(PACKETBUF_ADDR_SENDER));
- <a name="l00813"></a>00813 } <span class="keywordflow">else</span> {
- <a name="l00814"></a>00814 <span class="comment">/* no compression and link local */</span>
- <a name="l00815"></a>00815 uncompress_addr(&SICSLOWPAN_IP_BUF->srcipaddr, llprefix, unc_llconf[tmp],
- <a name="l00816"></a>00816 (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)packetbuf_addr(PACKETBUF_ADDR_SENDER));
- <a name="l00817"></a>00817 }
- <a name="l00818"></a>00818
- <a name="l00819"></a>00819 <span class="comment">/* Destination address */</span>
- <a name="l00820"></a>00820 <span class="comment">/* put the destination address compression mode into tmp */</span>
- <a name="l00821"></a>00821 tmp = ((iphc1 & SICSLOWPAN_IPHC_DAM_11) >> SICSLOWPAN_IPHC_DAM_BIT) & 0x03;
- <a name="l00822"></a>00822
- <a name="l00823"></a>00823 <span class="comment">/* multicast compression */</span>
- <a name="l00824"></a>00824 <span class="keywordflow">if</span>(iphc1 & SICSLOWPAN_IPHC_M) {
- <a name="l00825"></a>00825 <span class="comment">/* context based multicast compression */</span>
- <a name="l00826"></a>00826 <span class="keywordflow">if</span>(iphc1 & SICSLOWPAN_IPHC_DAC) {
- <a name="l00827"></a>00827 <span class="comment">/* TODO: implement this */</span>
- <a name="l00828"></a>00828 } <span class="keywordflow">else</span> {
- <a name="l00829"></a>00829 <span class="comment">/* non-context based multicast compression - */</span>
- <a name="l00830"></a>00830 <span class="comment">/* DAM_00: 128 bits */</span>
- <a name="l00831"></a>00831 <span class="comment">/* DAM_01: 48 bits FFXX::00XX:XXXX:XXXX */</span>
- <a name="l00832"></a>00832 <span class="comment">/* DAM_10: 32 bits FFXX::00XX:XXXX */</span>
- <a name="l00833"></a>00833 <span class="comment">/* DAM_11: 8 bits FF02::00XX */</span>
- <a name="l00834"></a>00834 uint8_t prefix[] = {0xff, 0x02};
- <a name="l00835"></a>00835 <span class="keywordflow">if</span>(tmp > 0 && tmp < 3) {
- <a name="l00836"></a>00836 prefix[1] = *hc06_ptr;
- <a name="l00837"></a>00837 hc06_ptr++;
- <a name="l00838"></a>00838 }
- <a name="l00839"></a>00839
- <a name="l00840"></a>00840 uncompress_addr(&SICSLOWPAN_IP_BUF->destipaddr, prefix,
- <a name="l00841"></a>00841 unc_mxconf[tmp], NULL);
- <a name="l00842"></a>00842 }
- <a name="l00843"></a>00843 } <span class="keywordflow">else</span> {
- <a name="l00844"></a>00844 <span class="comment">/* no multicast */</span>
- <a name="l00845"></a>00845 <span class="comment">/* Context based */</span>
- <a name="l00846"></a>00846 <span class="keywordflow">if</span>(iphc1 & SICSLOWPAN_IPHC_DAC) {
- <a name="l00847"></a>00847 uint8_t dci = (iphc1 & SICSLOWPAN_IPHC_CID) ?
- <a name="l00848"></a>00848 RIME_IPHC_BUF[2] & 0x0f : 0;
- <a name="l00849"></a>00849 context = addr_context_lookup_by_number(dci);
- <a name="l00850"></a>00850
- <a name="l00851"></a>00851 <span class="comment">/* all valid cases below need the context! */</span>
- <a name="l00852"></a>00852 <span class="keywordflow">if</span>(context == NULL) {
- <a name="l00853"></a>00853 PRINTF(<span class="stringliteral">"sicslowpan uncompress_hdr: error context not found\n"</span>);
- <a name="l00854"></a>00854 <span class="keywordflow">return</span>;
- <a name="l00855"></a>00855 }
- <a name="l00856"></a>00856 uncompress_addr(&SICSLOWPAN_IP_BUF->destipaddr, context->prefix,
- <a name="l00857"></a>00857 unc_ctxconf[tmp],
- <a name="l00858"></a>00858 (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)packetbuf_addr(PACKETBUF_ADDR_RECEIVER));
- <a name="l00859"></a>00859 } <span class="keywordflow">else</span> {
- <a name="l00860"></a>00860 <span class="comment">/* not context based => link local M = 0, DAC = 0 - same as SAC */</span>
- <a name="l00861"></a>00861 uncompress_addr(&SICSLOWPAN_IP_BUF->destipaddr, llprefix,
- <a name="l00862"></a>00862 unc_llconf[tmp],
- <a name="l00863"></a>00863 (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)packetbuf_addr(PACKETBUF_ADDR_RECEIVER));
- <a name="l00864"></a>00864 }
- <a name="l00865"></a>00865 }
- <a name="l00866"></a>00866 uncomp_hdr_len += UIP_IPH_LEN;
- <a name="l00867"></a>00867
- <a name="l00868"></a>00868 <span class="comment">/* Next header processing - continued */</span>
- <a name="l00869"></a>00869 <span class="keywordflow">if</span>((iphc0 & SICSLOWPAN_IPHC_NH_C)) {
- <a name="l00870"></a>00870 <span class="comment">/* The next header is compressed, NHC is following */</span>
- <a name="l00871"></a>00871 <span class="keywordflow">if</span>((*hc06_ptr & SICSLOWPAN_NHC_UDP_MASK) == SICSLOWPAN_NHC_UDP_ID) {
- <a name="l00872"></a>00872 uint8_t checksum_compressed;
- <a name="l00873"></a>00873 SICSLOWPAN_IP_BUF->proto = UIP_PROTO_UDP;
- <a name="l00874"></a>00874 checksum_compressed = *hc06_ptr & SICSLOWPAN_NHC_UDP_CHECKSUMC;
- <a name="l00875"></a>00875 PRINTF(<span class="stringliteral">"IPHC: Incoming header value: %i\n"</span>, *hc06_ptr);
- <a name="l00876"></a>00876 <span class="keywordflow">switch</span>(*hc06_ptr & SICSLOWPAN_NHC_UDP_CS_P_11) {
- <a name="l00877"></a>00877 <span class="keywordflow">case</span> SICSLOWPAN_NHC_UDP_CS_P_00:
- <a name="l00878"></a>00878 <span class="comment">/* 1 byte for NHC, 4 byte for ports, 2 bytes chksum */</span>
- <a name="l00879"></a>00879 memcpy(&SICSLOWPAN_UDP_BUF->srcport, hc06_ptr + 1, 2);
- <a name="l00880"></a>00880 memcpy(&SICSLOWPAN_UDP_BUF->destport, hc06_ptr + 3, 2);
- <a name="l00881"></a>00881 PRINTF(<span class="stringliteral">"IPHC: Uncompressed UDP ports (ptr+5): %x, %x\n"</span>,
- <a name="l00882"></a>00882 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->srcport), <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->destport));
- <a name="l00883"></a>00883 hc06_ptr += 5;
- <a name="l00884"></a>00884 <span class="keywordflow">break</span>;
- <a name="l00885"></a>00885
- <a name="l00886"></a>00886 <span class="keywordflow">case</span> SICSLOWPAN_NHC_UDP_CS_P_01:
- <a name="l00887"></a>00887 <span class="comment">/* 1 byte for NHC + source 16bit inline, dest = 0xF0 + 8 bit inline */</span>
- <a name="l00888"></a>00888 PRINTF(<span class="stringliteral">"IPHC: Decompressing destination\n"</span>);
- <a name="l00889"></a>00889 memcpy(&SICSLOWPAN_UDP_BUF->srcport, hc06_ptr + 1, 2);
- <a name="l00890"></a>00890 SICSLOWPAN_UDP_BUF->destport = <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_8_BIT_PORT_MIN + (*(hc06_ptr + 3)));
- <a name="l00891"></a>00891 PRINTF(<span class="stringliteral">"IPHC: Uncompressed UDP ports (ptr+4): %x, %x\n"</span>,
- <a name="l00892"></a>00892 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->srcport), <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->destport));
- <a name="l00893"></a>00893 hc06_ptr += 4;
- <a name="l00894"></a>00894 <span class="keywordflow">break</span>;
- <a name="l00895"></a>00895
- <a name="l00896"></a>00896 <span class="keywordflow">case</span> SICSLOWPAN_NHC_UDP_CS_P_10:
- <a name="l00897"></a>00897 <span class="comment">/* 1 byte for NHC + source = 0xF0 + 8bit inline, dest = 16 bit inline*/</span>
- <a name="l00898"></a>00898 PRINTF(<span class="stringliteral">"IPHC: Decompressing source\n"</span>);
- <a name="l00899"></a>00899 SICSLOWPAN_UDP_BUF->srcport = <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_8_BIT_PORT_MIN +
- <a name="l00900"></a>00900 (*(hc06_ptr + 1)));
- <a name="l00901"></a>00901 memcpy(&SICSLOWPAN_UDP_BUF->destport, hc06_ptr + 2, 2);
- <a name="l00902"></a>00902 PRINTF(<span class="stringliteral">"IPHC: Uncompressed UDP ports (ptr+4): %x, %x\n"</span>,
- <a name="l00903"></a>00903 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->srcport), <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->destport));
- <a name="l00904"></a>00904 hc06_ptr += 4;
- <a name="l00905"></a>00905 <span class="keywordflow">break</span>;
- <a name="l00906"></a>00906
- <a name="l00907"></a>00907 <span class="keywordflow">case</span> SICSLOWPAN_NHC_UDP_CS_P_11:
- <a name="l00908"></a>00908 <span class="comment">/* 1 byte for NHC, 1 byte for ports */</span>
- <a name="l00909"></a>00909 SICSLOWPAN_UDP_BUF->srcport = <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_4_BIT_PORT_MIN +
- <a name="l00910"></a>00910 (*(hc06_ptr + 1) >> 4));
- <a name="l00911"></a>00911 SICSLOWPAN_UDP_BUF->destport = <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_4_BIT_PORT_MIN +
- <a name="l00912"></a>00912 ((*(hc06_ptr + 1)) & 0x0F));
- <a name="l00913"></a>00913 PRINTF(<span class="stringliteral">"IPHC: Uncompressed UDP ports (ptr+2): %x, %x\n"</span>,
- <a name="l00914"></a>00914 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->srcport), <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_BUF->destport));
- <a name="l00915"></a>00915 hc06_ptr += 2;
- <a name="l00916"></a>00916 <span class="keywordflow">break</span>;
- <a name="l00917"></a>00917
- <a name="l00918"></a>00918 <span class="keywordflow">default</span>:
- <a name="l00919"></a>00919 PRINTF(<span class="stringliteral">"sicslowpan uncompress_hdr: error unsupported UDP compression\n"</span>);
- <a name="l00920"></a>00920 <span class="keywordflow">return</span>;
- <a name="l00921"></a>00921 }
- <a name="l00922"></a>00922 <span class="keywordflow">if</span>(!checksum_compressed) { <span class="comment">/* has_checksum, default */</span>
- <a name="l00923"></a>00923 memcpy(&SICSLOWPAN_UDP_BUF->udpchksum, hc06_ptr, 2);
- <a name="l00924"></a>00924 hc06_ptr += 2;
- <a name="l00925"></a>00925 PRINTF(<span class="stringliteral">"IPHC: sicslowpan uncompress_hdr: checksum included\n"</span>);
- <a name="l00926"></a>00926 } <span class="keywordflow">else</span> {
- <a name="l00927"></a>00927 PRINTF(<span class="stringliteral">"IPHC: sicslowpan uncompress_hdr: checksum *NOT* included\n"</span>);
- <a name="l00928"></a>00928 }
- <a name="l00929"></a>00929 uncomp_hdr_len += UIP_UDPH_LEN;
- <a name="l00930"></a>00930 }
- <a name="l00931"></a>00931 <span class="preprocessor">#ifdef SICSLOWPAN_NH_COMPRESSOR</span>
- <a name="l00932"></a>00932 <span class="preprocessor"></span> <span class="keywordflow">else</span> {
- <a name="l00933"></a>00933 hc06_ptr += SICSLOWPAN_NH_COMPRESSOR.uncompress(hc06_ptr, <a class="code" href="a01680.html#ga2c312c370c91d9cc20fc0c97fd430fab" title="The buffer used for the 6lowpan processing is uip_buf.">sicslowpan_buf</a>, &uncomp_hdr_len);
- <a name="l00934"></a>00934 }
- <a name="l00935"></a>00935 <span class="preprocessor">#endif</span>
- <a name="l00936"></a>00936 <span class="preprocessor"></span> }
- <a name="l00937"></a>00937
- <a name="l00938"></a>00938 rime_hdr_len = hc06_ptr - rime_ptr;
- <a name="l00939"></a>00939
- <a name="l00940"></a>00940 <span class="comment">/* IP length field. */</span>
- <a name="l00941"></a>00941 <span class="keywordflow">if</span>(ip_len == 0) {
- <a name="l00942"></a>00942 <span class="comment">/* This is not a fragmented packet */</span>
- <a name="l00943"></a>00943 SICSLOWPAN_IP_BUF->len[0] = 0;
- <a name="l00944"></a>00944 SICSLOWPAN_IP_BUF->len[1] = <a class="code" href="a01563.html#ga4a1157b882c15f5ea05d64f81d37115d" title="Get the length of the data in the packetbuf.">packetbuf_datalen</a>() - rime_hdr_len + uncomp_hdr_len - UIP_IPH_LEN;
- <a name="l00945"></a>00945 } <span class="keywordflow">else</span> {
- <a name="l00946"></a>00946 <span class="comment">/* This is a 1st fragment */</span>
- <a name="l00947"></a>00947 SICSLOWPAN_IP_BUF->len[0] = (ip_len - UIP_IPH_LEN) >> 8;
- <a name="l00948"></a>00948 SICSLOWPAN_IP_BUF->len[1] = (ip_len - UIP_IPH_LEN) & 0x00FF;
- <a name="l00949"></a>00949 }
- <a name="l00950"></a>00950
- <a name="l00951"></a>00951 <span class="comment">/* length field in UDP header */</span>
- <a name="l00952"></a>00952 <span class="keywordflow">if</span>(SICSLOWPAN_IP_BUF->proto == UIP_PROTO_UDP) {
- <a name="l00953"></a>00953 memcpy(&SICSLOWPAN_UDP_BUF->udplen, &SICSLOWPAN_IP_BUF->len[0], 2);
- <a name="l00954"></a>00954 }
- <a name="l00955"></a>00955
- <a name="l00956"></a>00956 <span class="keywordflow">return</span>;
- <a name="l00957"></a>00957 }<span class="comment"></span>
- <a name="l00958"></a>00958 <span class="comment">/** @} */</span>
- <a name="l00959"></a>00959 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06 */</span>
- <a name="l00960"></a>00960
- <a name="l00961"></a>00961
- <a name="l00962"></a>00962 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC1</span>
- <a name="l00963"></a>00963 <span class="preprocessor"></span><span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l00964"></a>00964 <span class="comment">/** \name HC1 compression and uncompression functions</span>
- <a name="l00965"></a>00965 <span class="comment"> * @{ */</span>
- <a name="l00966"></a>00966 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l00967"></a>00967 <span class="comment">/**</span>
- <a name="l00968"></a>00968 <span class="comment"> * \brief Compress IP/UDP header using HC1 and HC_UDP</span>
- <a name="l00969"></a>00969 <span class="comment"> *</span>
- <a name="l00970"></a>00970 <span class="comment"> * This function is called by the 6lowpan code to create a compressed</span>
- <a name="l00971"></a>00971 <span class="comment"> * 6lowpan packet in the packetbuf buffer from a full IPv6 packet in the</span>
- <a name="l00972"></a>00972 <span class="comment"> * uip_buf buffer.</span>
- <a name="l00973"></a>00973 <span class="comment"> *</span>
- <a name="l00974"></a>00974 <span class="comment"> *</span>
- <a name="l00975"></a>00975 <span class="comment"> * If we can compress everything, we use HC1 dispatch, if not we use</span>
- <a name="l00976"></a>00976 <span class="comment"> * IPv6 dispatch.\n</span>
- <a name="l00977"></a>00977 <span class="comment"> * We can compress everything if:</span>
- <a name="l00978"></a>00978 <span class="comment"> * - IP version is</span>
- <a name="l00979"></a>00979 <span class="comment"> * - Flow label and traffic class are 0</span>
- <a name="l00980"></a>00980 <span class="comment"> * - Both src and dest ip addresses are link local</span>
- <a name="l00981"></a>00981 <span class="comment"> * - Both src and dest interface ID are recoverable from lower layer</span>
- <a name="l00982"></a>00982 <span class="comment"> * header</span>
- <a name="l00983"></a>00983 <span class="comment"> * - Next header is either ICMP, UDP or TCP</span>
- <a name="l00984"></a>00984 <span class="comment"> * Moreover, if next header is UDP, we try to compress it using HC_UDP.</span>
- <a name="l00985"></a>00985 <span class="comment"> * This is feasible is both ports are between F0B0 and F0B0 + 15\n\n</span>
- <a name="l00986"></a>00986 <span class="comment"> *</span>
- <a name="l00987"></a>00987 <span class="comment"> * Resulting header structure:</span>
- <a name="l00988"></a>00988 <span class="comment"> * - For ICMP, TCP, non compressed UDP\n</span>
- <a name="l00989"></a>00989 <span class="comment"> * HC1 encoding = 11111010 (UDP) 11111110 (TCP) 11111100 (ICMP)\n</span>
- <a name="l00990"></a>00990 <span class="comment"> * \verbatim</span>
- <a name="l00991"></a>00991 <span class="comment"> * 1 2 3</span>
- <a name="l00992"></a>00992 <span class="comment"> * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1</span>
- <a name="l00993"></a>00993 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00994"></a>00994 <span class="comment"> * | LoWPAN HC1 Dsp | HC1 encoding | IPv6 Hop limit| L4 hdr + data|</span>
- <a name="l00995"></a>00995 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00996"></a>00996 <span class="comment"> * | ...</span>
- <a name="l00997"></a>00997 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l00998"></a>00998 <span class="comment"> * \endverbatim</span>
- <a name="l00999"></a>00999 <span class="comment"> *</span>
- <a name="l01000"></a>01000 <span class="comment"> * - For compressed UDP</span>
- <a name="l01001"></a>01001 <span class="comment"> * HC1 encoding = 11111011, HC_UDP encoding = 11100000\n</span>
- <a name="l01002"></a>01002 <span class="comment"> * \verbatim</span>
- <a name="l01003"></a>01003 <span class="comment"> * 1 2 3</span>
- <a name="l01004"></a>01004 <span class="comment"> * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1</span>
- <a name="l01005"></a>01005 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l01006"></a>01006 <span class="comment"> * | LoWPAN HC1 Dsp| HC1 encoding | HC_UDP encod.| IPv6 Hop limit|</span>
- <a name="l01007"></a>01007 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l01008"></a>01008 <span class="comment"> * | src p.| dst p.| UDP checksum | L4 data...</span>
- <a name="l01009"></a>01009 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l01010"></a>01010 <span class="comment"> * \endverbatim</span>
- <a name="l01011"></a>01011 <span class="comment"> *</span>
- <a name="l01012"></a>01012 <span class="comment"> * \param rime_destaddr L2 destination address, needed to compress the</span>
- <a name="l01013"></a>01013 <span class="comment"> * IP destination field</span>
- <a name="l01014"></a>01014 <span class="comment"> */</span>
- <a name="l01015"></a>01015 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l01016"></a>01016 compress_hdr_hc1(rimeaddr_t *rime_destaddr)
- <a name="l01017"></a>01017 {
- <a name="l01018"></a>01018 <span class="comment">/*</span>
- <a name="l01019"></a>01019 <span class="comment"> * Check if all the assumptions for full compression</span>
- <a name="l01020"></a>01020 <span class="comment"> * are valid :</span>
- <a name="l01021"></a>01021 <span class="comment"> */</span>
- <a name="l01022"></a>01022 <span class="keywordflow">if</span>(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->vtc != 0x60 ||
- <a name="l01023"></a>01023 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->tcflow != 0 ||
- <a name="l01024"></a>01024 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->flow != 0 ||
- <a name="l01025"></a>01025 !uip_is_addr_link_local(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr) ||
- <a name="l01026"></a>01026 !uip_is_addr_mac_addr_based(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->srcipaddr, &<a class="code" href="a01684.html#ga89bf167a9f1014d2d78754742eb7e06d" title="Host L2 address.">uip_lladdr</a>) ||
- <a name="l01027"></a>01027 !uip_is_addr_link_local(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr) ||
- <a name="l01028"></a>01028 !uip_is_addr_mac_addr_based(&<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->destipaddr,
- <a name="l01029"></a>01029 (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)rime_destaddr) ||
- <a name="l01030"></a>01030 (<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto != UIP_PROTO_ICMP6 &&
- <a name="l01031"></a>01031 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto != UIP_PROTO_UDP &&
- <a name="l01032"></a>01032 <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto != UIP_PROTO_TCP))
- <a name="l01033"></a>01033 {
- <a name="l01034"></a>01034 <span class="comment">/*</span>
- <a name="l01035"></a>01035 <span class="comment"> * IPV6 DISPATCH</span>
- <a name="l01036"></a>01036 <span class="comment"> * Something cannot be compressed, use IPV6 DISPATCH,</span>
- <a name="l01037"></a>01037 <span class="comment"> * compress nothing, copy IPv6 header in rime buffer</span>
- <a name="l01038"></a>01038 <span class="comment"> */</span>
- <a name="l01039"></a>01039 *rime_ptr = SICSLOWPAN_DISPATCH_IPV6;
- <a name="l01040"></a>01040 rime_hdr_len += SICSLOWPAN_IPV6_HDR_LEN;
- <a name="l01041"></a>01041 memcpy(rime_ptr + rime_hdr_len, <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>, UIP_IPH_LEN);
- <a name="l01042"></a>01042 rime_hdr_len += UIP_IPH_LEN;
- <a name="l01043"></a>01043 uncomp_hdr_len += UIP_IPH_LEN;
- <a name="l01044"></a>01044 } <span class="keywordflow">else</span> {
- <a name="l01045"></a>01045 <span class="comment">/*</span>
- <a name="l01046"></a>01046 <span class="comment"> * HC1 DISPATCH</span>
- <a name="l01047"></a>01047 <span class="comment"> * maximum compresssion:</span>
- <a name="l01048"></a>01048 <span class="comment"> * All fields in the IP header but Hop Limit are elided</span>
- <a name="l01049"></a>01049 <span class="comment"> * If next header is UDP, we compress UDP header using HC2</span>
- <a name="l01050"></a>01050 <span class="comment"> */</span>
- <a name="l01051"></a>01051 RIME_HC1_PTR[RIME_HC1_DISPATCH] = SICSLOWPAN_DISPATCH_HC1;
- <a name="l01052"></a>01052 uncomp_hdr_len += UIP_IPH_LEN;
- <a name="l01053"></a>01053 <span class="keywordflow">switch</span>(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto) {
- <a name="l01054"></a>01054 <span class="keywordflow">case</span> UIP_PROTO_ICMP6:
- <a name="l01055"></a>01055 <span class="comment">/* HC1 encoding and ttl */</span>
- <a name="l01056"></a>01056 RIME_HC1_PTR[RIME_HC1_ENCODING] = 0xFC;
- <a name="l01057"></a>01057 RIME_HC1_PTR[RIME_HC1_TTL] = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->ttl;
- <a name="l01058"></a>01058 rime_hdr_len += SICSLOWPAN_HC1_HDR_LEN;
- <a name="l01059"></a>01059 <span class="keywordflow">break</span>;
- <a name="l01060"></a>01060 <span class="preprocessor">#if UIP_CONF_TCP</span>
- <a name="l01061"></a>01061 <span class="preprocessor"></span> <span class="keywordflow">case</span> UIP_PROTO_TCP:
- <a name="l01062"></a>01062 <span class="comment">/* HC1 encoding and ttl */</span>
- <a name="l01063"></a>01063 RIME_HC1_PTR[RIME_HC1_ENCODING] = 0xFE;
- <a name="l01064"></a>01064 RIME_HC1_PTR[RIME_HC1_TTL] = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->ttl;
- <a name="l01065"></a>01065 rime_hdr_len += SICSLOWPAN_HC1_HDR_LEN;
- <a name="l01066"></a>01066 <span class="keywordflow">break</span>;
- <a name="l01067"></a>01067 <span class="preprocessor">#endif </span><span class="comment">/* UIP_CONF_TCP */</span>
- <a name="l01068"></a>01068 <span class="preprocessor">#if UIP_CONF_UDP</span>
- <a name="l01069"></a>01069 <span class="preprocessor"></span> <span class="keywordflow">case</span> UIP_PROTO_UDP:
- <a name="l01070"></a>01070 <span class="comment">/*</span>
- <a name="l01071"></a>01071 <span class="comment"> * try to compress UDP header (we do only full compression).</span>
- <a name="l01072"></a>01072 <span class="comment"> * This is feasible if both src and dest ports are between</span>
- <a name="l01073"></a>01073 <span class="comment"> * SICSLOWPAN_UDP_PORT_MIN and SICSLOWPAN_UDP_PORT_MIN + 15</span>
- <a name="l01074"></a>01074 <span class="comment"> */</span>
- <a name="l01075"></a>01075 PRINTF(<span class="stringliteral">"local/remote port %u/%u\n"</span>,UIP_UDP_BUF->srcport,UIP_UDP_BUF->destport);
- <a name="l01076"></a>01076 <span class="keywordflow">if</span>(<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport) >= SICSLOWPAN_UDP_PORT_MIN &&
- <a name="l01077"></a>01077 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport) < SICSLOWPAN_UDP_PORT_MAX &&
- <a name="l01078"></a>01078 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport) >= SICSLOWPAN_UDP_PORT_MIN &&
- <a name="l01079"></a>01079 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport) < SICSLOWPAN_UDP_PORT_MAX) {
- <a name="l01080"></a>01080 <span class="comment">/* HC1 encoding */</span>
- <a name="l01081"></a>01081 RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_HC1_ENCODING] = 0xFB;
- <a name="l01082"></a>01082
- <a name="l01083"></a>01083 <span class="comment">/* HC_UDP encoding, ttl, src and dest ports, checksum */</span>
- <a name="l01084"></a>01084 RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_UDP_ENCODING] = 0xE0;
- <a name="l01085"></a>01085 RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_TTL] = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->ttl;
- <a name="l01086"></a>01086
- <a name="l01087"></a>01087 RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_PORTS] =
- <a name="l01088"></a>01088 (<a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a>)((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->srcport) -
- <a name="l01089"></a>01089 SICSLOWPAN_UDP_PORT_MIN) << 4) +
- <a name="l01090"></a>01090 (<a class="code" href="a01668.html#ga4caecabca98b43919dd11be1c0d4cd8e" title="The 8-bit unsigned data type.">u8_t</a>)((<a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(UIP_UDP_BUF->destport) - SICSLOWPAN_UDP_PORT_MIN));
- <a name="l01091"></a>01091 memcpy(&RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_CHKSUM], &UIP_UDP_BUF->udpchksum, 2);
- <a name="l01092"></a>01092 rime_hdr_len += SICSLOWPAN_HC1_HC_UDP_HDR_LEN;
- <a name="l01093"></a>01093 uncomp_hdr_len += UIP_UDPH_LEN;
- <a name="l01094"></a>01094 } <span class="keywordflow">else</span> {
- <a name="l01095"></a>01095 <span class="comment">/* HC1 encoding and ttl */</span>
- <a name="l01096"></a>01096 RIME_HC1_PTR[RIME_HC1_ENCODING] = 0xFA;
- <a name="l01097"></a>01097 RIME_HC1_PTR[RIME_HC1_TTL] = <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->ttl;
- <a name="l01098"></a>01098 rime_hdr_len += SICSLOWPAN_HC1_HDR_LEN;
- <a name="l01099"></a>01099 }
- <a name="l01100"></a>01100 <span class="keywordflow">break</span>;
- <a name="l01101"></a>01101 <span class="preprocessor">#endif </span><span class="comment">/*UIP_CONF_UDP*/</span>
- <a name="l01102"></a>01102 }
- <a name="l01103"></a>01103 }
- <a name="l01104"></a>01104 <span class="keywordflow">return</span>;
- <a name="l01105"></a>01105 }
- <a name="l01106"></a>01106
- <a name="l01107"></a>01107 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l01108"></a>01108 <span class="comment">/**</span>
- <a name="l01109"></a>01109 <span class="comment"> * \brief Uncompress HC1 (and HC_UDP) headers and put them in</span>
- <a name="l01110"></a>01110 <span class="comment"> * sicslowpan_buf</span>
- <a name="l01111"></a>01111 <span class="comment"> *</span>
- <a name="l01112"></a>01112 <span class="comment"> * This function is called by the input function when the dispatch is</span>
- <a name="l01113"></a>01113 <span class="comment"> * HC1.</span>
- <a name="l01114"></a>01114 <span class="comment"> * We %process the packet in the rime buffer, uncompress the header</span>
- <a name="l01115"></a>01115 <span class="comment"> * fields, and copy the result in the sicslowpan buffer.</span>
- <a name="l01116"></a>01116 <span class="comment"> * At the end of the decompression, rime_hdr_len and uncompressed_hdr_len</span>
- <a name="l01117"></a>01117 <span class="comment"> * are set to the appropriate values</span>
- <a name="l01118"></a>01118 <span class="comment"> *</span>
- <a name="l01119"></a>01119 <span class="comment"> * \param ip_len Equal to 0 if the packet is not a fragment (IP length</span>
- <a name="l01120"></a>01120 <span class="comment"> * is then inferred from the L2 length), non 0 if the packet is a 1st</span>
- <a name="l01121"></a>01121 <span class="comment"> * fragment.</span>
- <a name="l01122"></a>01122 <span class="comment"> */</span>
- <a name="l01123"></a>01123 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l01124"></a>01124 uncompress_hdr_hc1(uint16_t ip_len)
- <a name="l01125"></a>01125 {
- <a name="l01126"></a>01126 <span class="comment">/* version, traffic class, flow label */</span>
- <a name="l01127"></a>01127 SICSLOWPAN_IP_BUF->vtc = 0x60;
- <a name="l01128"></a>01128 SICSLOWPAN_IP_BUF->tcflow = 0;
- <a name="l01129"></a>01129 SICSLOWPAN_IP_BUF->flow = 0;
- <a name="l01130"></a>01130
- <a name="l01131"></a>01131 <span class="comment">/* src and dest ip addresses */</span>
- <a name="l01132"></a>01132 <a class="code" href="a01576.html#ga53fbda0e8c31d4882294c8dc3cb5f487" title="Construct an IPv6 address from eight 16-bit words.">uip_ip6addr</a>(&SICSLOWPAN_IP_BUF->srcipaddr, 0xfe80, 0, 0, 0, 0, 0, 0, 0);
- <a name="l01133"></a>01133 uip_sd6_set_addr_iid(&SICSLOWPAN_IP_BUF->srcipaddr,
- <a name="l01134"></a>01134 (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)packetbuf_addr(PACKETBUF_ADDR_SENDER));
- <a name="l01135"></a>01135 <a class="code" href="a01576.html#ga53fbda0e8c31d4882294c8dc3cb5f487" title="Construct an IPv6 address from eight 16-bit words.">uip_ip6addr</a>(&SICSLOWPAN_IP_BUF->destipaddr, 0xfe80, 0, 0, 0, 0, 0, 0, 0);
- <a name="l01136"></a>01136 uip_sd6_set_addr_iid(&SICSLOWPAN_IP_BUF->destipaddr,
- <a name="l01137"></a>01137 (<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *)packetbuf_addr(PACKETBUF_ADDR_RECEIVER));
- <a name="l01138"></a>01138
- <a name="l01139"></a>01139 uncomp_hdr_len += UIP_IPH_LEN;
- <a name="l01140"></a>01140
- <a name="l01141"></a>01141 <span class="comment">/* Next header field */</span>
- <a name="l01142"></a>01142 <span class="keywordflow">switch</span>(RIME_HC1_PTR[RIME_HC1_ENCODING] & 0x06) {
- <a name="l01143"></a>01143 <span class="keywordflow">case</span> SICSLOWPAN_HC1_NH_ICMP6:
- <a name="l01144"></a>01144 SICSLOWPAN_IP_BUF->proto = UIP_PROTO_ICMP6;
- <a name="l01145"></a>01145 SICSLOWPAN_IP_BUF->ttl = RIME_HC1_PTR[RIME_HC1_TTL];
- <a name="l01146"></a>01146 rime_hdr_len += SICSLOWPAN_HC1_HDR_LEN;
- <a name="l01147"></a>01147 <span class="keywordflow">break</span>;
- <a name="l01148"></a>01148 <span class="preprocessor">#if UIP_CONF_TCP</span>
- <a name="l01149"></a>01149 <span class="preprocessor"></span> <span class="keywordflow">case</span> SICSLOWPAN_HC1_NH_TCP:
- <a name="l01150"></a>01150 SICSLOWPAN_IP_BUF->proto = UIP_PROTO_TCP;
- <a name="l01151"></a>01151 SICSLOWPAN_IP_BUF->ttl = RIME_HC1_PTR[RIME_HC1_TTL];
- <a name="l01152"></a>01152 rime_hdr_len += SICSLOWPAN_HC1_HDR_LEN;
- <a name="l01153"></a>01153 <span class="keywordflow">break</span>;
- <a name="l01154"></a>01154 <span class="preprocessor">#endif</span><span class="comment">/* UIP_CONF_TCP */</span>
- <a name="l01155"></a>01155 <span class="preprocessor">#if UIP_CONF_UDP</span>
- <a name="l01156"></a>01156 <span class="preprocessor"></span> <span class="keywordflow">case</span> SICSLOWPAN_HC1_NH_UDP:
- <a name="l01157"></a>01157 SICSLOWPAN_IP_BUF->proto = UIP_PROTO_UDP;
- <a name="l01158"></a>01158 <span class="keywordflow">if</span>(RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_HC1_ENCODING] & 0x01) {
- <a name="l01159"></a>01159 <span class="comment">/* UDP header is compressed with HC_UDP */</span>
- <a name="l01160"></a>01160 <span class="keywordflow">if</span>(RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_UDP_ENCODING] !=
- <a name="l01161"></a>01161 SICSLOWPAN_HC_UDP_ALL_C) {
- <a name="l01162"></a>01162 PRINTF(<span class="stringliteral">"sicslowpan (uncompress_hdr), packet not supported"</span>);
- <a name="l01163"></a>01163 <span class="keywordflow">return</span>;
- <a name="l01164"></a>01164 }
- <a name="l01165"></a>01165 <span class="comment">/* IP TTL */</span>
- <a name="l01166"></a>01166 SICSLOWPAN_IP_BUF->ttl = RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_TTL];
- <a name="l01167"></a>01167 <span class="comment">/* UDP ports, len, checksum */</span>
- <a name="l01168"></a>01168 SICSLOWPAN_UDP_BUF->srcport =
- <a name="l01169"></a>01169 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_PORT_MIN +
- <a name="l01170"></a>01170 (RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_PORTS] >> 4));
- <a name="l01171"></a>01171 SICSLOWPAN_UDP_BUF->destport =
- <a name="l01172"></a>01172 <a class="code" href="a01576.html#ga703ee949a28cb00b5f8ee54bfe664e8d" title="Convert 16-bit quantity from host byte order to network byte order.">UIP_HTONS</a>(SICSLOWPAN_UDP_PORT_MIN +
- <a name="l01173"></a>01173 (RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_PORTS] & 0x0F));
- <a name="l01174"></a>01174 memcpy(&SICSLOWPAN_UDP_BUF->udpchksum, &RIME_HC1_HC_UDP_PTR[RIME_HC1_HC_UDP_CHKSUM], 2);
- <a name="l01175"></a>01175 uncomp_hdr_len += UIP_UDPH_LEN;
- <a name="l01176"></a>01176 rime_hdr_len += SICSLOWPAN_HC1_HC_UDP_HDR_LEN;
- <a name="l01177"></a>01177 } <span class="keywordflow">else</span> {
- <a name="l01178"></a>01178 rime_hdr_len += SICSLOWPAN_HC1_HDR_LEN;
- <a name="l01179"></a>01179 }
- <a name="l01180"></a>01180 <span class="keywordflow">break</span>;
- <a name="l01181"></a>01181 <span class="preprocessor">#endif</span><span class="comment">/* UIP_CONF_UDP */</span>
- <a name="l01182"></a>01182 <span class="keywordflow">default</span>:
- <a name="l01183"></a>01183 <span class="comment">/* this shouldn't happen, drop */</span>
- <a name="l01184"></a>01184 <span class="keywordflow">return</span>;
- <a name="l01185"></a>01185 }
- <a name="l01186"></a>01186
- <a name="l01187"></a>01187 <span class="comment">/* IP length field. */</span>
- <a name="l01188"></a>01188 <span class="keywordflow">if</span>(ip_len == 0) {
- <a name="l01189"></a>01189 <span class="comment">/* This is not a fragmented packet */</span>
- <a name="l01190"></a>01190 SICSLOWPAN_IP_BUF->len[0] = 0;
- <a name="l01191"></a>01191 SICSLOWPAN_IP_BUF->len[1] = <a class="code" href="a01563.html#ga4a1157b882c15f5ea05d64f81d37115d" title="Get the length of the data in the packetbuf.">packetbuf_datalen</a>() - rime_hdr_len + uncomp_hdr_len - UIP_IPH_LEN;
- <a name="l01192"></a>01192 } <span class="keywordflow">else</span> {
- <a name="l01193"></a>01193 <span class="comment">/* This is a 1st fragment */</span>
- <a name="l01194"></a>01194 SICSLOWPAN_IP_BUF->len[0] = (ip_len - UIP_IPH_LEN) >> 8;
- <a name="l01195"></a>01195 SICSLOWPAN_IP_BUF->len[1] = (ip_len - UIP_IPH_LEN) & 0x00FF;
- <a name="l01196"></a>01196 }
- <a name="l01197"></a>01197 <span class="comment">/* length field in UDP header */</span>
- <a name="l01198"></a>01198 <span class="keywordflow">if</span>(SICSLOWPAN_IP_BUF->proto == UIP_PROTO_UDP) {
- <a name="l01199"></a>01199 memcpy(&SICSLOWPAN_UDP_BUF->udplen, &SICSLOWPAN_IP_BUF->len[0], 2);
- <a name="l01200"></a>01200 }
- <a name="l01201"></a>01201 <span class="keywordflow">return</span>;
- <a name="l01202"></a>01202 }<span class="comment"></span>
- <a name="l01203"></a>01203 <span class="comment">/** @} */</span>
- <a name="l01204"></a>01204 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC1 */</span>
- <a name="l01205"></a>01205
- <a name="l01206"></a>01206
- <a name="l01207"></a>01207 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_IPV6</span>
- <a name="l01208"></a>01208 <span class="preprocessor"></span><span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l01209"></a>01209 <span class="comment">/** \name IPv6 dispatch "compression" function</span>
- <a name="l01210"></a>01210 <span class="comment"> * @{ */</span>
- <a name="l01211"></a>01211 <span class="comment">/*--------------------------------------------------------------------*/</span>
- <a name="l01212"></a>01212 <span class="comment">/* \brief Packets "Compression" when only IPv6 dispatch is used</span>
- <a name="l01213"></a>01213 <span class="comment"> *</span>
- <a name="l01214"></a>01214 <span class="comment"> * There is no compression in this case, all fields are sent</span>
- <a name="l01215"></a>01215 <span class="comment"> * inline. We just add the IPv6 dispatch byte before the packet.</span>
- <a name="l01216"></a>01216 <span class="comment"> * \verbatim</span>
- <a name="l01217"></a>01217 <span class="comment"> * 0 1 2 3</span>
- <a name="l01218"></a>01218 <span class="comment"> * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1</span>
- <a name="l01219"></a>01219 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l01220"></a>01220 <span class="comment"> * | IPv6 Dsp | IPv6 header and payload ...</span>
- <a name="l01221"></a>01221 <span class="comment"> * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+</span>
- <a name="l01222"></a>01222 <span class="comment"> * \endverbatim</span>
- <a name="l01223"></a>01223 <span class="comment"> */</span>
- <a name="l01224"></a>01224 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l01225"></a>01225 compress_hdr_ipv6(rimeaddr_t *rime_destaddr)
- <a name="l01226"></a>01226 {
- <a name="l01227"></a>01227 *rime_ptr = SICSLOWPAN_DISPATCH_IPV6;
- <a name="l01228"></a>01228 rime_hdr_len += SICSLOWPAN_IPV6_HDR_LEN;
- <a name="l01229"></a>01229 memcpy(rime_ptr + rime_hdr_len, <a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>, UIP_IPH_LEN);
- <a name="l01230"></a>01230 rime_hdr_len += UIP_IPH_LEN;
- <a name="l01231"></a>01231 uncomp_hdr_len += UIP_IPH_LEN;
- <a name="l01232"></a>01232 <span class="keywordflow">return</span>;
- <a name="l01233"></a>01233 }<span class="comment"></span>
- <a name="l01234"></a>01234 <span class="comment">/** @} */</span>
- <a name="l01235"></a>01235 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_IPV6 */</span>
- <a name="l01236"></a>01236
- <a name="l01237"></a>01237
- <a name="l01238"></a>01238
- <a name="l01239"></a>01239 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l01240"></a>01240 <span class="comment">/** \name Input/output functions common to all compression schemes</span>
- <a name="l01241"></a>01241 <span class="comment"> * @{ */</span>
- <a name="l01242"></a>01242 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l01243"></a>01243 <span class="comment">/**</span>
- <a name="l01244"></a>01244 <span class="comment"> * Callback function for the MAC packet sent callback</span>
- <a name="l01245"></a>01245 <span class="comment"> */</span>
- <a name="l01246"></a>01246 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l01247"></a>01247 packet_sent(<span class="keywordtype">void</span> *ptr, <span class="keywordtype">int</span> status, <span class="keywordtype">int</span> transmissions)
- <a name="l01248"></a>01248 {
- <a name="l01249"></a>01249 <span class="preprocessor">#if SICSLOWPAN_CONF_NEIGHBOR_INFO</span>
- <a name="l01250"></a>01250 <span class="preprocessor"></span> <a class="code" href="a00293.html#afd67eb7e489b2c252a968a77d6e6a857" title="Notify the neighbor information module about the status of a packet transmission...">neighbor_info_packet_sent</a>(status, transmissions);
- <a name="l01251"></a>01251 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_NEIGHBOR_INFO */</span>
- <a name="l01252"></a>01252 }
- <a name="l01253"></a>01253 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l01254"></a>01254 <span class="comment">/**</span>
- <a name="l01255"></a>01255 <span class="comment"> * \brief This function is called by the 6lowpan code to send out a</span>
- <a name="l01256"></a>01256 <span class="comment"> * packet.</span>
- <a name="l01257"></a>01257 <span class="comment"> * \param dest the link layer destination address of the packet</span>
- <a name="l01258"></a>01258 <span class="comment"> */</span>
- <a name="l01259"></a>01259 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l01260"></a>01260 send_packet(rimeaddr_t *dest)
- <a name="l01261"></a>01261 {
- <a name="l01262"></a>01262
- <a name="l01263"></a>01263 <span class="comment">/* Set the link layer destination address for the packet as a</span>
- <a name="l01264"></a>01264 <span class="comment"> * packetbuf attribute. The MAC layer can access the destination</span>
- <a name="l01265"></a>01265 <span class="comment"> * address with the function packetbuf_addr(PACKETBUF_ADDR_RECEIVER).</span>
- <a name="l01266"></a>01266 <span class="comment"> */</span>
- <a name="l01267"></a>01267 packetbuf_set_addr(PACKETBUF_ADDR_RECEIVER, dest);
- <a name="l01268"></a>01268
- <a name="l01269"></a>01269 <span class="comment">/* Force acknowledge from sender (test hardware autoacks) */</span>
- <a name="l01270"></a>01270 <span class="preprocessor">#if SICSLOWPAN_CONF_ACK_ALL</span>
- <a name="l01271"></a>01271 <span class="preprocessor"></span> packetbuf_set_attr(PACKETBUF_ATTR_RELIABLE, 1);
- <a name="l01272"></a>01272 <span class="preprocessor">#endif</span>
- <a name="l01273"></a>01273 <span class="preprocessor"></span>
- <a name="l01274"></a>01274 <span class="comment">/* Provide a callback function to receive the result of</span>
- <a name="l01275"></a>01275 <span class="comment"> a packet transmission. */</span>
- <a name="l01276"></a>01276 NETSTACK_MAC.send(&packet_sent, NULL);
- <a name="l01277"></a>01277
- <a name="l01278"></a>01278 <span class="comment">/* If we are sending multiple packets in a row, we need to let the</span>
- <a name="l01279"></a>01279 <span class="comment"> watchdog know that we are still alive. */</span>
- <a name="l01280"></a>01280 watchdog_periodic();
- <a name="l01281"></a>01281 }
- <a name="l01282"></a>01282 <span class="comment"></span>
- <a name="l01283"></a>01283 <span class="comment">/** \brief Take an IP packet and format it to be sent on an 802.15.4</span>
- <a name="l01284"></a>01284 <span class="comment"> * network using 6lowpan.</span>
- <a name="l01285"></a>01285 <span class="comment"> * \param localdest The MAC address of the destination</span>
- <a name="l01286"></a>01286 <span class="comment"> *</span>
- <a name="l01287"></a>01287 <span class="comment"> * The IP packet is initially in uip_buf. Its header is compressed</span>
- <a name="l01288"></a>01288 <span class="comment"> * and if necessary it is fragmented. The resulting</span>
- <a name="l01289"></a>01289 <span class="comment"> * packet/fragments are put in packetbuf and delivered to the 802.15.4</span>
- <a name="l01290"></a>01290 <span class="comment"> * MAC.</span>
- <a name="l01291"></a>01291 <span class="comment"> */</span>
- <a name="l01292"></a>01292 <span class="keyword">static</span> uint8_t
- <a name="l01293"></a>01293 output(<a class="code" href="a00102.html" title="802.3 address">uip_lladdr_t</a> *localdest)
- <a name="l01294"></a>01294 {
- <a name="l01295"></a>01295 <span class="comment">/* The MAC address of the destination of the packet */</span>
- <a name="l01296"></a>01296 rimeaddr_t dest;
- <a name="l01297"></a>01297
- <a name="l01298"></a>01298
- <a name="l01299"></a>01299 <span class="comment">/* init */</span>
- <a name="l01300"></a>01300 uncomp_hdr_len = 0;
- <a name="l01301"></a>01301 rime_hdr_len = 0;
- <a name="l01302"></a>01302
- <a name="l01303"></a>01303 <span class="comment">/* reset rime buffer */</span>
- <a name="l01304"></a>01304 <a class="code" href="a01563.html#gaa540c9abf0db13d27881b616f7794824" title="Clear and reset the packetbuf.">packetbuf_clear</a>();
- <a name="l01305"></a>01305 rime_ptr = <a class="code" href="a01563.html#ga29a6f3f230b55e6bc2f017879c27113a" title="Get a pointer to the data in the packetbuf.">packetbuf_dataptr</a>();
- <a name="l01306"></a>01306
- <a name="l01307"></a>01307 packetbuf_set_attr(PACKETBUF_ATTR_MAX_MAC_TRANSMISSIONS,
- <a name="l01308"></a>01308 SICSLOWPAN_MAX_MAC_TRANSMISSIONS);
- <a name="l01309"></a>01309
- <a name="l01310"></a>01310 <span class="preprocessor">#define TCP_FIN 0x01</span>
- <a name="l01311"></a>01311 <span class="preprocessor"></span><span class="preprocessor">#define TCP_ACK 0x10</span>
- <a name="l01312"></a>01312 <span class="preprocessor"></span><span class="preprocessor">#define TCP_CTL 0x3f</span>
- <a name="l01313"></a>01313 <span class="preprocessor"></span> <span class="comment">/* Set stream mode for all TCP packets, except FIN packets. */</span>
- <a name="l01314"></a>01314 <span class="keywordflow">if</span>(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto == UIP_PROTO_TCP &&
- <a name="l01315"></a>01315 (UIP_TCP_BUF->flags & TCP_FIN) == 0 &&
- <a name="l01316"></a>01316 (UIP_TCP_BUF->flags & TCP_CTL) != TCP_ACK) {
- <a name="l01317"></a>01317 packetbuf_set_attr(PACKETBUF_ATTR_PACKET_TYPE,
- <a name="l01318"></a>01318 PACKETBUF_ATTR_PACKET_TYPE_STREAM);
- <a name="l01319"></a>01319 } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>->proto == UIP_PROTO_TCP &&
- <a name="l01320"></a>01320 (UIP_TCP_BUF->flags & TCP_FIN) == TCP_FIN) {
- <a name="l01321"></a>01321 packetbuf_set_attr(PACKETBUF_ATTR_PACKET_TYPE,
- <a name="l01322"></a>01322 PACKETBUF_ATTR_PACKET_TYPE_STREAM_END);
- <a name="l01323"></a>01323 }
- <a name="l01324"></a>01324
- <a name="l01325"></a>01325 <span class="comment">/*</span>
- <a name="l01326"></a>01326 <span class="comment"> * The destination address will be tagged to each outbound</span>
- <a name="l01327"></a>01327 <span class="comment"> * packet. If the argument localdest is NULL, we are sending a</span>
- <a name="l01328"></a>01328 <span class="comment"> * broadcast packet.</span>
- <a name="l01329"></a>01329 <span class="comment"> */</span>
- <a name="l01330"></a>01330 <span class="keywordflow">if</span>(localdest == NULL) {
- <a name="l01331"></a>01331 <a class="code" href="a01606.html#gacd6a22e93c7a4eb02d901743c958c2b2" title="Copy a Rime address.">rimeaddr_copy</a>(&dest, &<a class="code" href="a01606.html#gaa96ae7849482147440e77751444faa6d" title="The null Rime address.">rimeaddr_null</a>);
- <a name="l01332"></a>01332 } <span class="keywordflow">else</span> {
- <a name="l01333"></a>01333 <a class="code" href="a01606.html#gacd6a22e93c7a4eb02d901743c958c2b2" title="Copy a Rime address.">rimeaddr_copy</a>(&dest, (<span class="keyword">const</span> rimeaddr_t *)localdest);
- <a name="l01334"></a>01334 }
- <a name="l01335"></a>01335
- <a name="l01336"></a>01336 PRINTFO(<span class="stringliteral">"sicslowpan output: sending packet len %d\n"</span>, <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a>);
- <a name="l01337"></a>01337
- <a name="l01338"></a>01338 <span class="comment">/* Try to compress the headers */</span>
- <a name="l01339"></a>01339 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC1</span>
- <a name="l01340"></a>01340 <span class="preprocessor"></span> compress_hdr_hc1(&dest);
- <a name="l01341"></a>01341 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC1 */</span>
- <a name="l01342"></a>01342 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_IPV6</span>
- <a name="l01343"></a>01343 <span class="preprocessor"></span> compress_hdr_ipv6(&dest);
- <a name="l01344"></a>01344 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_IPV6 */</span>
- <a name="l01345"></a>01345 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06</span>
- <a name="l01346"></a>01346 <span class="preprocessor"></span> compress_hdr_hc06(&dest);
- <a name="l01347"></a>01347 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06 */</span>
- <a name="l01348"></a>01348 PRINTFO(<span class="stringliteral">"sicslowpan output: header of len %d\n"</span>, rime_hdr_len);
- <a name="l01349"></a>01349
- <a name="l01350"></a>01350 <span class="keywordflow">if</span>(<a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a> - uncomp_hdr_len > <a class="code" href="a01680.html#gaf213c8c71222bb86256fb3e37582242b" title="Size of the 802.15.4 payload (127byte - 25 for MAC header).">MAC_MAX_PAYLOAD</a> - rime_hdr_len) {
- <a name="l01351"></a>01351 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l01352"></a>01352 <span class="preprocessor"></span> <span class="keyword">struct </span>queuebuf *q;
- <a name="l01353"></a>01353 <span class="comment">/*</span>
- <a name="l01354"></a>01354 <span class="comment"> * The outbound IPv6 packet is too large to fit into a single 15.4</span>
- <a name="l01355"></a>01355 <span class="comment"> * packet, so we fragment it into multiple packets and send them.</span>
- <a name="l01356"></a>01356 <span class="comment"> * The first fragment contains frag1 dispatch, then</span>
- <a name="l01357"></a>01357 <span class="comment"> * IPv6/HC1/HC06/HC_UDP dispatchs/headers.</span>
- <a name="l01358"></a>01358 <span class="comment"> * The following fragments contain only the fragn dispatch.</span>
- <a name="l01359"></a>01359 <span class="comment"> */</span>
- <a name="l01360"></a>01360
- <a name="l01361"></a>01361
- <a name="l01362"></a>01362 PRINTFO(<span class="stringliteral">"Fragmentation sending packet len %d\n"</span>, <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a>);
- <a name="l01363"></a>01363
- <a name="l01364"></a>01364 <span class="comment">/* Create 1st Fragment */</span>
- <a name="l01365"></a>01365 PRINTFO(<span class="stringliteral">"sicslowpan output: 1rst fragment "</span>);
- <a name="l01366"></a>01366
- <a name="l01367"></a>01367 <span class="comment">/* move HC1/HC06/IPv6 header */</span>
- <a name="l01368"></a>01368 memmove(rime_ptr + SICSLOWPAN_FRAG1_HDR_LEN, rime_ptr, rime_hdr_len);
- <a name="l01369"></a>01369
- <a name="l01370"></a>01370 <span class="comment">/*</span>
- <a name="l01371"></a>01371 <span class="comment"> * FRAG1 dispatch + header</span>
- <a name="l01372"></a>01372 <span class="comment"> * Note that the length is in units of 8 bytes</span>
- <a name="l01373"></a>01373 <span class="comment"> */</span>
- <a name="l01374"></a>01374 <span class="comment">/* RIME_FRAG_BUF->dispatch_size = */</span>
- <a name="l01375"></a>01375 <span class="comment">/* uip_htons((SICSLOWPAN_DISPATCH_FRAG1 << 8) | uip_len); */</span>
- <a name="l01376"></a>01376 SET16(RIME_FRAG_PTR, RIME_FRAG_DISPATCH_SIZE,
- <a name="l01377"></a>01377 ((SICSLOWPAN_DISPATCH_FRAG1 << 8) | <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a>));
- <a name="l01378"></a>01378 <span class="comment">/* RIME_FRAG_BUF->tag = uip_htons(my_tag); */</span>
- <a name="l01379"></a>01379 SET16(RIME_FRAG_PTR, RIME_FRAG_TAG, my_tag);
- <a name="l01380"></a>01380
- <a name="l01381"></a>01381 <span class="comment">/* Copy payload and send */</span>
- <a name="l01382"></a>01382 rime_hdr_len += SICSLOWPAN_FRAG1_HDR_LEN;
- <a name="l01383"></a>01383 rime_payload_len = (<a class="code" href="a01680.html#gaf213c8c71222bb86256fb3e37582242b" title="Size of the 802.15.4 payload (127byte - 25 for MAC header).">MAC_MAX_PAYLOAD</a> - rime_hdr_len) & 0xf8;
- <a name="l01384"></a>01384 PRINTFO(<span class="stringliteral">"(len %d, tag %d)\n"</span>, rime_payload_len, my_tag);
- <a name="l01385"></a>01385 memcpy(rime_ptr + rime_hdr_len,
- <a name="l01386"></a>01386 (uint8_t *)<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a> + uncomp_hdr_len, rime_payload_len);
- <a name="l01387"></a>01387 <a class="code" href="a01563.html#ga236b0d557fe119c39796432484c94b26" title="Set the length of the data in the packetbuf.">packetbuf_set_datalen</a>(rime_payload_len + rime_hdr_len);
- <a name="l01388"></a>01388 q = queuebuf_new_from_packetbuf();
- <a name="l01389"></a>01389 <span class="keywordflow">if</span>(q == NULL) {
- <a name="l01390"></a>01390 PRINTFO(<span class="stringliteral">"could not allocate queuebuf for first fragment, dropping packet\n"</span>);
- <a name="l01391"></a>01391 <span class="keywordflow">return</span> 0;
- <a name="l01392"></a>01392 }
- <a name="l01393"></a>01393 send_packet(&dest);
- <a name="l01394"></a>01394 queuebuf_to_packetbuf(q);
- <a name="l01395"></a>01395 queuebuf_free(q);
- <a name="l01396"></a>01396 q = NULL;
- <a name="l01397"></a>01397
- <a name="l01398"></a>01398 <span class="comment">/* set processed_ip_len to what we already sent from the IP payload*/</span>
- <a name="l01399"></a>01399 processed_ip_len = rime_payload_len + uncomp_hdr_len;
- <a name="l01400"></a>01400
- <a name="l01401"></a>01401 <span class="comment">/*</span>
- <a name="l01402"></a>01402 <span class="comment"> * Create following fragments</span>
- <a name="l01403"></a>01403 <span class="comment"> * Datagram tag is already in the buffer, we need to set the</span>
- <a name="l01404"></a>01404 <span class="comment"> * FRAGN dispatch and for each fragment, the offset</span>
- <a name="l01405"></a>01405 <span class="comment"> */</span>
- <a name="l01406"></a>01406 rime_hdr_len = SICSLOWPAN_FRAGN_HDR_LEN;
- <a name="l01407"></a>01407 <span class="comment">/* RIME_FRAG_BUF->dispatch_size = */</span>
- <a name="l01408"></a>01408 <span class="comment">/* uip_htons((SICSLOWPAN_DISPATCH_FRAGN << 8) | uip_len); */</span>
- <a name="l01409"></a>01409 SET16(RIME_FRAG_PTR, RIME_FRAG_DISPATCH_SIZE,
- <a name="l01410"></a>01410 ((SICSLOWPAN_DISPATCH_FRAGN << 8) | <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a>));
- <a name="l01411"></a>01411 rime_payload_len = (<a class="code" href="a01680.html#gaf213c8c71222bb86256fb3e37582242b" title="Size of the 802.15.4 payload (127byte - 25 for MAC header).">MAC_MAX_PAYLOAD</a> - rime_hdr_len) & 0xf8;
- <a name="l01412"></a>01412 <span class="keywordflow">while</span>(processed_ip_len < <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a>) {
- <a name="l01413"></a>01413 PRINTFO(<span class="stringliteral">"sicslowpan output: fragment "</span>);
- <a name="l01414"></a>01414 RIME_FRAG_PTR[RIME_FRAG_OFFSET] = processed_ip_len >> 3;
- <a name="l01415"></a>01415
- <a name="l01416"></a>01416 <span class="comment">/* Copy payload and send */</span>
- <a name="l01417"></a>01417 <span class="keywordflow">if</span>(<a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a> - processed_ip_len < rime_payload_len) {
- <a name="l01418"></a>01418 <span class="comment">/* last fragment */</span>
- <a name="l01419"></a>01419 rime_payload_len = <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a> - processed_ip_len;
- <a name="l01420"></a>01420 }
- <a name="l01421"></a>01421 PRINTFO(<span class="stringliteral">"(offset %d, len %d, tag %d)\n"</span>,
- <a name="l01422"></a>01422 processed_ip_len >> 3, rime_payload_len, my_tag);
- <a name="l01423"></a>01423 memcpy(rime_ptr + rime_hdr_len,
- <a name="l01424"></a>01424 (uint8_t *)<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a> + processed_ip_len, rime_payload_len);
- <a name="l01425"></a>01425 <a class="code" href="a01563.html#ga236b0d557fe119c39796432484c94b26" title="Set the length of the data in the packetbuf.">packetbuf_set_datalen</a>(rime_payload_len + rime_hdr_len);
- <a name="l01426"></a>01426 q = queuebuf_new_from_packetbuf();
- <a name="l01427"></a>01427 <span class="keywordflow">if</span>(q == NULL) {
- <a name="l01428"></a>01428 PRINTFO(<span class="stringliteral">"could not allocate queuebuf, dropping fragment\n"</span>);
- <a name="l01429"></a>01429 <span class="keywordflow">return</span> 0;
- <a name="l01430"></a>01430 }
- <a name="l01431"></a>01431 send_packet(&dest);
- <a name="l01432"></a>01432 queuebuf_to_packetbuf(q);
- <a name="l01433"></a>01433 queuebuf_free(q);
- <a name="l01434"></a>01434 q = NULL;
- <a name="l01435"></a>01435 processed_ip_len += rime_payload_len;
- <a name="l01436"></a>01436 }
- <a name="l01437"></a>01437
- <a name="l01438"></a>01438 <span class="comment">/* end: reset global variables */</span>
- <a name="l01439"></a>01439 my_tag++;
- <a name="l01440"></a>01440 processed_ip_len = 0;
- <a name="l01441"></a>01441 <span class="preprocessor">#else </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l01442"></a>01442 PRINTFO(<span class="stringliteral">"sicslowpan output: Packet too large to be sent without fragmentation support; dropping packet\n"</span>);
- <a name="l01443"></a>01443 <span class="keywordflow">return</span> 0;
- <a name="l01444"></a>01444 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l01445"></a>01445 } <span class="keywordflow">else</span> {
- <a name="l01446"></a>01446 <span class="comment">/*</span>
- <a name="l01447"></a>01447 <span class="comment"> * The packet does not need to be fragmented</span>
- <a name="l01448"></a>01448 <span class="comment"> * copy "payload" and send</span>
- <a name="l01449"></a>01449 <span class="comment"> */</span>
- <a name="l01450"></a>01450 memcpy(rime_ptr + rime_hdr_len, (uint8_t *)<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a> + uncomp_hdr_len,
- <a name="l01451"></a>01451 <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a> - uncomp_hdr_len);
- <a name="l01452"></a>01452 <a class="code" href="a01563.html#ga236b0d557fe119c39796432484c94b26" title="Set the length of the data in the packetbuf.">packetbuf_set_datalen</a>(<a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a> - uncomp_hdr_len + rime_hdr_len);
- <a name="l01453"></a>01453 send_packet(&dest);
- <a name="l01454"></a>01454 }
- <a name="l01455"></a>01455 <span class="keywordflow">return</span> 1;
- <a name="l01456"></a>01456 }
- <a name="l01457"></a>01457
- <a name="l01458"></a>01458 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l01459"></a>01459 <span class="comment">/** \brief Process a received 6lowpan packet.</span>
- <a name="l01460"></a>01460 <span class="comment"> * \param r The MAC layer</span>
- <a name="l01461"></a>01461 <span class="comment"> *</span>
- <a name="l01462"></a>01462 <span class="comment"> * The 6lowpan packet is put in packetbuf by the MAC. If its a frag1 or</span>
- <a name="l01463"></a>01463 <span class="comment"> * a non-fragmented packet we first uncompress the IP header. The</span>
- <a name="l01464"></a>01464 <span class="comment"> * 6lowpan payload and possibly the uncompressed IP header are then</span>
- <a name="l01465"></a>01465 <span class="comment"> * copied in siclowpan_buf. If the IP packet is complete it is copied</span>
- <a name="l01466"></a>01466 <span class="comment"> * to uip_buf and the IP layer is called.</span>
- <a name="l01467"></a>01467 <span class="comment"> *</span>
- <a name="l01468"></a>01468 <span class="comment"> * \note We do not check for overlapping sicslowpan fragments</span>
- <a name="l01469"></a>01469 <span class="comment"> * (it is a SHALL in the RFC 4944 and should never happen)</span>
- <a name="l01470"></a>01470 <span class="comment"> */</span>
- <a name="l01471"></a>01471 <span class="keyword">static</span> <span class="keywordtype">void</span>
- <a name="l01472"></a>01472 input(<span class="keywordtype">void</span>)
- <a name="l01473"></a>01473 {
- <a name="l01474"></a>01474 <span class="comment">/* size of the IP packet (read from fragment) */</span>
- <a name="l01475"></a>01475 uint16_t frag_size = 0;
- <a name="l01476"></a>01476 <span class="comment">/* offset of the fragment in the IP packet */</span>
- <a name="l01477"></a>01477 uint8_t frag_offset = 0;
- <a name="l01478"></a>01478 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l01479"></a>01479 <span class="preprocessor"></span> <span class="comment">/* tag of the fragment */</span>
- <a name="l01480"></a>01480 uint16_t frag_tag = 0;
- <a name="l01481"></a>01481 uint8_t first_fragment = 0;
- <a name="l01482"></a>01482 <span class="preprocessor">#endif </span><span class="comment">/*SICSLOWPAN_CONF_FRAG*/</span>
- <a name="l01483"></a>01483
- <a name="l01484"></a>01484 <span class="comment">/* init */</span>
- <a name="l01485"></a>01485 uncomp_hdr_len = 0;
- <a name="l01486"></a>01486 rime_hdr_len = 0;
- <a name="l01487"></a>01487
- <a name="l01488"></a>01488 <span class="comment">/* The MAC puts the 15.4 payload inside the RIME data buffer */</span>
- <a name="l01489"></a>01489 rime_ptr = <a class="code" href="a01563.html#ga29a6f3f230b55e6bc2f017879c27113a" title="Get a pointer to the data in the packetbuf.">packetbuf_dataptr</a>();
- <a name="l01490"></a>01490
- <a name="l01491"></a>01491 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l01492"></a>01492 <span class="preprocessor"></span> <span class="comment">/* if reassembly timed out, cancel it */</span>
- <a name="l01493"></a>01493 <span class="keywordflow">if</span>(<a class="code" href="a01632.html#ga6d71dececfce707c668e6257aad5906e" title="Check if a timer has expired.">timer_expired</a>(&reass_timer)) {
- <a name="l01494"></a>01494 sicslowpan_len = 0;
- <a name="l01495"></a>01495 processed_ip_len = 0;
- <a name="l01496"></a>01496 }
- <a name="l01497"></a>01497 <span class="comment">/*</span>
- <a name="l01498"></a>01498 <span class="comment"> * Since we don't support the mesh and broadcast header, the first header</span>
- <a name="l01499"></a>01499 <span class="comment"> * we look for is the fragmentation header</span>
- <a name="l01500"></a>01500 <span class="comment"> */</span>
- <a name="l01501"></a>01501 <span class="keywordflow">switch</span>((GET16(RIME_FRAG_PTR, RIME_FRAG_DISPATCH_SIZE) & 0xf800) >> 8) {
- <a name="l01502"></a>01502 <span class="keywordflow">case</span> SICSLOWPAN_DISPATCH_FRAG1:
- <a name="l01503"></a>01503 PRINTFI(<span class="stringliteral">"sicslowpan input: FRAG1 "</span>);
- <a name="l01504"></a>01504 frag_offset = 0;
- <a name="l01505"></a>01505 <span class="comment">/* frag_size = (uip_ntohs(RIME_FRAG_BUF->dispatch_size) & 0x07ff); */</span>
- <a name="l01506"></a>01506 frag_size = GET16(RIME_FRAG_PTR, RIME_FRAG_DISPATCH_SIZE) & 0x07ff;
- <a name="l01507"></a>01507 <span class="comment">/* frag_tag = uip_ntohs(RIME_FRAG_BUF->tag); */</span>
- <a name="l01508"></a>01508 frag_tag = GET16(RIME_FRAG_PTR, RIME_FRAG_TAG);
- <a name="l01509"></a>01509 PRINTFI(<span class="stringliteral">"size %d, tag %d, offset %d)\n"</span>,
- <a name="l01510"></a>01510 frag_size, frag_tag, frag_offset);
- <a name="l01511"></a>01511 rime_hdr_len += SICSLOWPAN_FRAG1_HDR_LEN;
- <a name="l01512"></a>01512 <span class="comment">/* printf("frag1 %d %d\n", reass_tag, frag_tag);*/</span>
- <a name="l01513"></a>01513 first_fragment = 1;
- <a name="l01514"></a>01514 <span class="keywordflow">break</span>;
- <a name="l01515"></a>01515 <span class="keywordflow">case</span> SICSLOWPAN_DISPATCH_FRAGN:
- <a name="l01516"></a>01516 <span class="comment">/*</span>
- <a name="l01517"></a>01517 <span class="comment"> * set offset, tag, size</span>
- <a name="l01518"></a>01518 <span class="comment"> * Offset is in units of 8 bytes</span>
- <a name="l01519"></a>01519 <span class="comment"> */</span>
- <a name="l01520"></a>01520 PRINTFI(<span class="stringliteral">"sicslowpan input: FRAGN "</span>);
- <a name="l01521"></a>01521 frag_offset = RIME_FRAG_PTR[RIME_FRAG_OFFSET];
- <a name="l01522"></a>01522 frag_tag = GET16(RIME_FRAG_PTR, RIME_FRAG_TAG);
- <a name="l01523"></a>01523 frag_size = GET16(RIME_FRAG_PTR, RIME_FRAG_DISPATCH_SIZE) & 0x07ff;
- <a name="l01524"></a>01524 PRINTFI(<span class="stringliteral">"size %d, tag %d, offset %d)\n"</span>,
- <a name="l01525"></a>01525 frag_size, frag_tag, frag_offset);
- <a name="l01526"></a>01526 rime_hdr_len += SICSLOWPAN_FRAGN_HDR_LEN;
- <a name="l01527"></a>01527 <span class="keywordflow">break</span>;
- <a name="l01528"></a>01528 <span class="keywordflow">default</span>:
- <a name="l01529"></a>01529 <span class="keywordflow">break</span>;
- <a name="l01530"></a>01530 }
- <a name="l01531"></a>01531
- <a name="l01532"></a>01532 <span class="keywordflow">if</span>(processed_ip_len > 0) {
- <a name="l01533"></a>01533 <span class="comment">/* reassembly is ongoing */</span>
- <a name="l01534"></a>01534 <span class="comment">/* printf("frag %d %d\n", reass_tag, frag_tag);*/</span>
- <a name="l01535"></a>01535 <span class="keywordflow">if</span>((frag_size > 0 &&
- <a name="l01536"></a>01536 (frag_size != sicslowpan_len ||
- <a name="l01537"></a>01537 reass_tag != frag_tag ||
- <a name="l01538"></a>01538 !<a class="code" href="a01606.html#gaed118d3d8fe7e7ac9d6d00988268357e" title="Compare two Rime addresses.">rimeaddr_cmp</a>(&frag_sender, packetbuf_addr(PACKETBUF_ADDR_SENDER)))) ||
- <a name="l01539"></a>01539 frag_size == 0) {
- <a name="l01540"></a>01540 <span class="comment">/*</span>
- <a name="l01541"></a>01541 <span class="comment"> * the packet is a fragment that does not belong to the packet</span>
- <a name="l01542"></a>01542 <span class="comment"> * being reassembled or the packet is not a fragment.</span>
- <a name="l01543"></a>01543 <span class="comment"> */</span>
- <a name="l01544"></a>01544 PRINTFI(<span class="stringliteral">"sicslowpan input: Dropping 6lowpan packet that is not a fragment of the packet currently being reassembled\n"</span>);
- <a name="l01545"></a>01545 <span class="keywordflow">return</span>;
- <a name="l01546"></a>01546 }
- <a name="l01547"></a>01547 } <span class="keywordflow">else</span> {
- <a name="l01548"></a>01548 <span class="comment">/*</span>
- <a name="l01549"></a>01549 <span class="comment"> * reassembly is off</span>
- <a name="l01550"></a>01550 <span class="comment"> * start it if we received a fragment</span>
- <a name="l01551"></a>01551 <span class="comment"> */</span>
- <a name="l01552"></a>01552 <span class="keywordflow">if</span>(frag_size > 0) {
- <a name="l01553"></a>01553 sicslowpan_len = frag_size;
- <a name="l01554"></a>01554 reass_tag = frag_tag;
- <a name="l01555"></a>01555 <a class="code" href="a01632.html#ga6614d96fdfcd95c95ec6e6f63071ff51" title="Set a timer.">timer_set</a>(&reass_timer, <a class="code" href="a01588.html#ga8b3cd5de59637a38a881b27b867370f0" title="Timeout for packet reassembly at the 6lowpan layer (should be &lt; 60s).">SICSLOWPAN_REASS_MAXAGE</a>*<a class="code" href="a01620.html#gae3ced0551b26c9b99cb45a86f34d100a" title="A second, measured in system clock time.">CLOCK_SECOND</a>);
- <a name="l01556"></a>01556 PRINTFI(<span class="stringliteral">"sicslowpan input: INIT FRAGMENTATION (len %d, tag %d)\n"</span>,
- <a name="l01557"></a>01557 sicslowpan_len, reass_tag);
- <a name="l01558"></a>01558 <a class="code" href="a01606.html#gacd6a22e93c7a4eb02d901743c958c2b2" title="Copy a Rime address.">rimeaddr_copy</a>(&frag_sender, packetbuf_addr(PACKETBUF_ADDR_SENDER));
- <a name="l01559"></a>01559 }
- <a name="l01560"></a>01560 }
- <a name="l01561"></a>01561
- <a name="l01562"></a>01562 <span class="keywordflow">if</span>(rime_hdr_len == SICSLOWPAN_FRAGN_HDR_LEN) {
- <a name="l01563"></a>01563 <span class="comment">/* this is a FRAGN, skip the header compression dispatch section */</span>
- <a name="l01564"></a>01564 <span class="keywordflow">goto</span> copypayload;
- <a name="l01565"></a>01565 }
- <a name="l01566"></a>01566 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l01567"></a>01567
- <a name="l01568"></a>01568 <span class="comment">/* Process next dispatch and headers */</span>
- <a name="l01569"></a>01569 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06</span>
- <a name="l01570"></a>01570 <span class="preprocessor"></span> <span class="keywordflow">if</span>((RIME_HC1_PTR[RIME_HC1_DISPATCH] & 0xe0) == SICSLOWPAN_DISPATCH_IPHC) {
- <a name="l01571"></a>01571 PRINTFI(<span class="stringliteral">"sicslowpan input: IPHC\n"</span>);
- <a name="l01572"></a>01572 uncompress_hdr_hc06(frag_size);
- <a name="l01573"></a>01573 } <span class="keywordflow">else</span>
- <a name="l01574"></a>01574 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06 */</span>
- <a name="l01575"></a>01575 <span class="keywordflow">switch</span>(RIME_HC1_PTR[RIME_HC1_DISPATCH]) {
- <a name="l01576"></a>01576 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC1</span>
- <a name="l01577"></a>01577 <span class="preprocessor"></span> <span class="keywordflow">case</span> SICSLOWPAN_DISPATCH_HC1:
- <a name="l01578"></a>01578 PRINTFI(<span class="stringliteral">"sicslowpan input: HC1\n"</span>);
- <a name="l01579"></a>01579 uncompress_hdr_hc1(frag_size);
- <a name="l01580"></a>01580 <span class="keywordflow">break</span>;
- <a name="l01581"></a>01581 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC1 */</span>
- <a name="l01582"></a>01582 <span class="keywordflow">case</span> SICSLOWPAN_DISPATCH_IPV6:
- <a name="l01583"></a>01583 PRINTFI(<span class="stringliteral">"sicslowpan input: IPV6\n"</span>);
- <a name="l01584"></a>01584 rime_hdr_len += SICSLOWPAN_IPV6_HDR_LEN;
- <a name="l01585"></a>01585
- <a name="l01586"></a>01586 <span class="comment">/* Put uncompressed IP header in sicslowpan_buf. */</span>
- <a name="l01587"></a>01587 memcpy(SICSLOWPAN_IP_BUF, rime_ptr + rime_hdr_len, UIP_IPH_LEN);
- <a name="l01588"></a>01588
- <a name="l01589"></a>01589 <span class="comment">/* Update uncomp_hdr_len and rime_hdr_len. */</span>
- <a name="l01590"></a>01590 rime_hdr_len += UIP_IPH_LEN;
- <a name="l01591"></a>01591 uncomp_hdr_len += UIP_IPH_LEN;
- <a name="l01592"></a>01592 <span class="keywordflow">break</span>;
- <a name="l01593"></a>01593 <span class="keywordflow">default</span>:
- <a name="l01594"></a>01594 <span class="comment">/* unknown header */</span>
- <a name="l01595"></a>01595 PRINTFI(<span class="stringliteral">"sicslowpan input: unknown dispatch: %u\n"</span>,
- <a name="l01596"></a>01596 RIME_HC1_PTR[RIME_HC1_DISPATCH]);
- <a name="l01597"></a>01597 <span class="keywordflow">return</span>;
- <a name="l01598"></a>01598 }
- <a name="l01599"></a>01599
- <a name="l01600"></a>01600
- <a name="l01601"></a>01601 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l01602"></a>01602 <span class="preprocessor"></span> copypayload:
- <a name="l01603"></a>01603 <span class="preprocessor">#endif </span><span class="comment">/*SICSLOWPAN_CONF_FRAG*/</span>
- <a name="l01604"></a>01604 <span class="comment">/*</span>
- <a name="l01605"></a>01605 <span class="comment"> * copy "payload" from the rime buffer to the sicslowpan_buf</span>
- <a name="l01606"></a>01606 <span class="comment"> * if this is a first fragment or not fragmented packet,</span>
- <a name="l01607"></a>01607 <span class="comment"> * we have already copied the compressed headers, uncomp_hdr_len</span>
- <a name="l01608"></a>01608 <span class="comment"> * and rime_hdr_len are non 0, frag_offset is.</span>
- <a name="l01609"></a>01609 <span class="comment"> * If this is a subsequent fragment, this is the contrary.</span>
- <a name="l01610"></a>01610 <span class="comment"> */</span>
- <a name="l01611"></a>01611 <span class="keywordflow">if</span>(<a class="code" href="a01563.html#ga4a1157b882c15f5ea05d64f81d37115d" title="Get the length of the data in the packetbuf.">packetbuf_datalen</a>() < rime_hdr_len) {
- <a name="l01612"></a>01612 PRINTF(<span class="stringliteral">"SICSLOWPAN: packet dropped due to header > total packet\n"</span>);
- <a name="l01613"></a>01613 <span class="keywordflow">return</span>;
- <a name="l01614"></a>01614 }
- <a name="l01615"></a>01615 rime_payload_len = <a class="code" href="a01563.html#ga4a1157b882c15f5ea05d64f81d37115d" title="Get the length of the data in the packetbuf.">packetbuf_datalen</a>() - rime_hdr_len;
- <a name="l01616"></a>01616 memcpy((uint8_t *)SICSLOWPAN_IP_BUF + uncomp_hdr_len + (uint16_t)(frag_offset << 3), rime_ptr + rime_hdr_len, rime_payload_len);
- <a name="l01617"></a>01617
- <a name="l01618"></a>01618 <span class="comment">/* update processed_ip_len if fragment, sicslowpan_len otherwise */</span>
- <a name="l01619"></a>01619
- <a name="l01620"></a>01620 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l01621"></a>01621 <span class="preprocessor"></span> <span class="keywordflow">if</span>(frag_size > 0) {
- <a name="l01622"></a>01622 <span class="comment">/* Add the size of the header only for the first fragment. */</span>
- <a name="l01623"></a>01623 <span class="keywordflow">if</span>(first_fragment != 0) {
- <a name="l01624"></a>01624 processed_ip_len += uncomp_hdr_len;
- <a name="l01625"></a>01625 }
- <a name="l01626"></a>01626 processed_ip_len += rime_payload_len;
- <a name="l01627"></a>01627 } <span class="keywordflow">else</span> {
- <a name="l01628"></a>01628 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l01629"></a>01629 sicslowpan_len = rime_payload_len + uncomp_hdr_len;
- <a name="l01630"></a>01630 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l01631"></a>01631 <span class="preprocessor"></span> }
- <a name="l01632"></a>01632
- <a name="l01633"></a>01633 <span class="comment">/*</span>
- <a name="l01634"></a>01634 <span class="comment"> * If we have a full IP packet in sicslowpan_buf, deliver it to</span>
- <a name="l01635"></a>01635 <span class="comment"> * the IP stack</span>
- <a name="l01636"></a>01636 <span class="comment"> */</span>
- <a name="l01637"></a>01637 <span class="keywordflow">if</span>(processed_ip_len == 0 || (processed_ip_len == sicslowpan_len)) {
- <a name="l01638"></a>01638 PRINTFI(<span class="stringliteral">"sicslowpan input: IP packet ready (length %d)\n"</span>,
- <a name="l01639"></a>01639 sicslowpan_len);
- <a name="l01640"></a>01640 memcpy((uint8_t *)<a class="code" href="a01685.html#gaf966537cf73ee5973da59bba6b21b731" title="Pointer to IP header.">UIP_IP_BUF</a>, (uint8_t *)SICSLOWPAN_IP_BUF, sicslowpan_len);
- <a name="l01641"></a>01641 <a class="code" href="a01684.html#ga12a33f0c09711167bdf3dd7d7cf8c5a1" title="The length of the packet in the uip_buf buffer.">uip_len</a> = sicslowpan_len;
- <a name="l01642"></a>01642 sicslowpan_len = 0;
- <a name="l01643"></a>01643 processed_ip_len = 0;
- <a name="l01644"></a>01644 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l01645"></a>01645
- <a name="l01646"></a>01646 <span class="preprocessor">#if DEBUG</span>
- <a name="l01647"></a>01647 <span class="preprocessor"></span> {
- <a name="l01648"></a>01648 uint8_t tmp;
- <a name="l01649"></a>01649 PRINTF(<span class="stringliteral">"after decompression: "</span>);
- <a name="l01650"></a>01650 <span class="keywordflow">for</span> (tmp = 0; tmp < SICSLOWPAN_IP_BUF->len[1] + 40; tmp++) {
- <a name="l01651"></a>01651 uint8_t data = ((uint8_t *) (SICSLOWPAN_IP_BUF))[tmp];
- <a name="l01652"></a>01652 PRINTF(<span class="stringliteral">"%02x"</span>, data);
- <a name="l01653"></a>01653 }
- <a name="l01654"></a>01654 PRINTF(<span class="stringliteral">"\n"</span>);
- <a name="l01655"></a>01655 }
- <a name="l01656"></a>01656 <span class="preprocessor">#endif</span>
- <a name="l01657"></a>01657 <span class="preprocessor"></span>
- <a name="l01658"></a>01658 <span class="preprocessor">#if SICSLOWPAN_CONF_NEIGHBOR_INFO</span>
- <a name="l01659"></a>01659 <span class="preprocessor"></span> <a class="code" href="a00293.html#a9e62c566b5f95c8f6bdb040f56437fd1" title="Notify the neighbor information module that a packet was received.">neighbor_info_packet_received</a>();
- <a name="l01660"></a>01660 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_NEIGHBOR_INFO */</span>
- <a name="l01661"></a>01661
- <a name="l01662"></a>01662 <a class="code" href="a01569.html#ga0d5e21d13844dbebd703fb8ed6b058d0" title="Deliver an incoming packet to the TCP/IP stack.">tcpip_input</a>();
- <a name="l01663"></a>01663 <span class="preprocessor">#if SICSLOWPAN_CONF_FRAG</span>
- <a name="l01664"></a>01664 <span class="preprocessor"></span> }
- <a name="l01665"></a>01665 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_FRAG */</span>
- <a name="l01666"></a>01666 }<span class="comment"></span>
- <a name="l01667"></a>01667 <span class="comment">/** @} */</span>
- <a name="l01668"></a>01668
- <a name="l01669"></a>01669 <span class="comment">/*--------------------------------------------------------------------*/</span>
- <a name="l01670"></a>01670 <span class="comment">/* \brief 6lowpan init function (called by the MAC layer) */</span>
- <a name="l01671"></a>01671 <span class="comment">/*--------------------------------------------------------------------*/</span>
- <a name="l01672"></a>01672 <span class="keywordtype">void</span>
- <a name="l01673"></a>01673 sicslowpan_init(<span class="keywordtype">void</span>)
- <a name="l01674"></a>01674 {
- <a name="l01675"></a>01675 <span class="comment">/* remember the mac driver */</span>
- <a name="l01676"></a>01676 sicslowpan_mac = &NETSTACK_MAC;
- <a name="l01677"></a>01677
- <a name="l01678"></a>01678 <span class="comment">/*</span>
- <a name="l01679"></a>01679 <span class="comment"> * Set out output function as the function to be called from uIP to</span>
- <a name="l01680"></a>01680 <span class="comment"> * send a packet.</span>
- <a name="l01681"></a>01681 <span class="comment"> */</span>
- <a name="l01682"></a>01682 tcpip_set_outputfunc(output);
- <a name="l01683"></a>01683
- <a name="l01684"></a>01684 <span class="preprocessor">#if SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06</span>
- <a name="l01685"></a>01685 <span class="preprocessor"></span><span class="comment">/* Preinitialize any address contexts for better header compression</span>
- <a name="l01686"></a>01686 <span class="comment"> * (Saves up to 13 bytes per 6lowpan packet)</span>
- <a name="l01687"></a>01687 <span class="comment"> * The platform contiki-conf.h file can override this using e.g.</span>
- <a name="l01688"></a>01688 <span class="comment"> * #define SICSLOWPAN_CONF_ADDR_CONTEXT_0 {addr_contexts[0].prefix[0]=0xbb;addr_contexts[0].prefix[1]=0xbb;}</span>
- <a name="l01689"></a>01689 <span class="comment"> */</span>
- <a name="l01690"></a>01690 <span class="preprocessor">#if SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 0 </span>
- <a name="l01691"></a>01691 <span class="preprocessor"></span> addr_contexts[0].used = 1;
- <a name="l01692"></a>01692 addr_contexts[0].number = 0;
- <a name="l01693"></a>01693 <span class="preprocessor">#ifdef SICSLOWPAN_CONF_ADDR_CONTEXT_0</span>
- <a name="l01694"></a>01694 <span class="preprocessor"></span> SICSLOWPAN_CONF_ADDR_CONTEXT_0;
- <a name="l01695"></a>01695 <span class="preprocessor">#else</span>
- <a name="l01696"></a>01696 <span class="preprocessor"></span> addr_contexts[0].prefix[0] = 0xaa;
- <a name="l01697"></a>01697 addr_contexts[0].prefix[1] = 0xaa;
- <a name="l01698"></a>01698 <span class="preprocessor">#endif</span>
- <a name="l01699"></a>01699 <span class="preprocessor"></span><span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 0 */</span>
- <a name="l01700"></a>01700
- <a name="l01701"></a>01701 <span class="preprocessor">#if SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 1</span>
- <a name="l01702"></a>01702 <span class="preprocessor"></span> {
- <a name="l01703"></a>01703 <span class="keywordtype">int</span> i;
- <a name="l01704"></a>01704 <span class="keywordflow">for</span>(i = 1; i < SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS; i++) {
- <a name="l01705"></a>01705 <span class="preprocessor">#ifdef SICSLOWPAN_CONF_ADDR_CONTEXT_1</span>
- <a name="l01706"></a>01706 <span class="preprocessor"></span> <span class="keywordflow">if</span> (i==1) {
- <a name="l01707"></a>01707 addr_contexts[1].used = 1;
- <a name="l01708"></a>01708 addr_contexts[1].number = 1;
- <a name="l01709"></a>01709 SICSLOWPAN_CONF_ADDR_CONTEXT_1;
- <a name="l01710"></a>01710 <span class="preprocessor">#ifdef SICSLOWPAN_CONF_ADDR_CONTEXT_2</span>
- <a name="l01711"></a>01711 <span class="preprocessor"></span> } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (i==2) {
- <a name="l01712"></a>01712 addr_contexts[2].used = 1;
- <a name="l01713"></a>01713 addr_contexts[2].number = 2;
- <a name="l01714"></a>01714 SICSLOWPAN_CONF_ADDR_CONTEXT_2;
- <a name="l01715"></a>01715 <span class="preprocessor">#endif</span>
- <a name="l01716"></a>01716 <span class="preprocessor"></span> } <span class="keywordflow">else</span> {
- <a name="l01717"></a>01717 addr_contexts[i].used = 0;
- <a name="l01718"></a>01718 }
- <a name="l01719"></a>01719 <span class="preprocessor">#else</span>
- <a name="l01720"></a>01720 <span class="preprocessor"></span> addr_contexts[i].used = 0;
- <a name="l01721"></a>01721 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_ADDR_CONTEXT_1 */</span>
- <a name="l01722"></a>01722
- <a name="l01723"></a>01723 }
- <a name="l01724"></a>01724 }
- <a name="l01725"></a>01725 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_CONF_MAX_ADDR_CONTEXTS > 1 */</span>
- <a name="l01726"></a>01726
- <a name="l01727"></a>01727 <span class="preprocessor">#endif </span><span class="comment">/* SICSLOWPAN_COMPRESSION == SICSLOWPAN_COMPRESSION_HC06 */</span>
- <a name="l01728"></a>01728 }
- <a name="l01729"></a>01729 <span class="comment">/*--------------------------------------------------------------------*/</span>
- <a name="l01730"></a>01730 <span class="keyword">const</span> <span class="keyword">struct </span><a class="code" href="a00060.html" title="The structure of a network driver in Contiki.">network_driver</a> sicslowpan_driver = {
- <a name="l01731"></a>01731 <span class="stringliteral">"sicslowpan"</span>,
- <a name="l01732"></a>01732 sicslowpan_init,
- <a name="l01733"></a>01733 <a class="code" href="a00060.html#ab731b9526416dfdc094f45df8363030c" title="Callback for getting notified of incoming packet.">input</a>
- <a name="l01734"></a>01734 };
- <a name="l01735"></a>01735 <span class="comment">/*--------------------------------------------------------------------*/</span><span class="comment"></span>
- <a name="l01736"></a>01736 <span class="comment">/** @} */</span>
- </pre></div></div>
- <hr size="1"/><address style="text-align: right;"><small>Generated on Mon Apr 11 14:23:31 2011 for Contiki 2.5 by
- <a href="http://www.doxygen.org/index.html">
- <img class="footer" src="doxygen.png" alt="doxygen"/></a> 1.6.1 </small></address>
- </body>
- </html>