<!DOCTYPE HTML PUBLIC "-//W3C//DTD HTML 4.01 Transitional//EN"> <html><head><meta http-equiv="Content-Type" content="text/html;charset=UTF-8"> <title>DTN Reference Implementation: serialsource.c Source File</title> <link href="doxygen.css" rel="stylesheet" type="text/css"> <link href="tabs.css" rel="stylesheet" type="text/css"> </head><body> <!-- Generated by Doxygen 1.5.6 --> <div class="navigation" id="top"> <div class="tabs"> <ul> <li><a href="main.html"><span>Main Page</span></a></li> <li><a href="namespaces.html"><span>Namespaces</span></a></li> <li><a href="annotated.html"><span>Classes</span></a></li> <li class="current"><a href="files.html"><span>Files</span></a></li> </ul> </div> <h1>serialsource.c</h1><a href="serialsource_8c.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"> * Copyright 2005-2006 Intel Corporation</span> <a name="l00003"></a>00003 <span class="comment"> * </span> <a name="l00004"></a>00004 <span class="comment"> * Licensed under the Apache License, Version 2.0 (the "License");</span> <a name="l00005"></a>00005 <span class="comment"> * you may not use this file except in compliance with the License.</span> <a name="l00006"></a>00006 <span class="comment"> * You may obtain a copy of the License at</span> <a name="l00007"></a>00007 <span class="comment"> * </span> <a name="l00008"></a>00008 <span class="comment"> * http://www.apache.org/licenses/LICENSE-2.0</span> <a name="l00009"></a>00009 <span class="comment"> * </span> <a name="l00010"></a>00010 <span class="comment"> * Unless required by applicable law or agreed to in writing, software</span> <a name="l00011"></a>00011 <span class="comment"> * distributed under the License is distributed on an "AS IS" BASIS,</span> <a name="l00012"></a>00012 <span class="comment"> * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.</span> <a name="l00013"></a>00013 <span class="comment"> * See the License for the specific language governing permissions and</span> <a name="l00014"></a>00014 <span class="comment"> * limitations under the License.</span> <a name="l00015"></a>00015 <span class="comment"> */</span> <a name="l00016"></a>00016 <a name="l00017"></a>00017 <span class="preprocessor">#ifdef HAVE_CONFIG_H</span> <a name="l00018"></a>00018 <span class="preprocessor"></span><span class="preprocessor"># include <<a class="code" href="dtn-config_8h.html">dtn-config.h</a>></span> <a name="l00019"></a>00019 <span class="preprocessor">#endif</span> <a name="l00020"></a>00020 <span class="preprocessor"></span> <a name="l00021"></a>00021 <span class="preprocessor">#include <sys/types.h></span> <a name="l00022"></a>00022 <span class="preprocessor">#include <sys/stat.h></span> <a name="l00023"></a>00023 <span class="preprocessor">#include <termios.h></span> <a name="l00024"></a>00024 <span class="preprocessor">#include <unistd.h></span> <a name="l00025"></a>00025 <span class="preprocessor">#include <stdint.h></span> <a name="l00026"></a>00026 <span class="preprocessor">#include <errno.h></span> <a name="l00027"></a>00027 <span class="preprocessor">#include <fcntl.h></span> <a name="l00028"></a>00028 <span class="preprocessor">#include <stdlib.h></span> <a name="l00029"></a>00029 <span class="preprocessor">#include <string.h></span> <a name="l00030"></a>00030 <span class="preprocessor">#include <sys/time.h></span> <a name="l00031"></a>00031 <span class="preprocessor">#include <stdio.h></span> <a name="l00032"></a>00032 <span class="preprocessor">#ifdef __CYGWIN__</span> <a name="l00033"></a>00033 <span class="preprocessor"></span><span class="preprocessor">#include <windows.h></span> <a name="l00034"></a>00034 <span class="preprocessor">#include <io.h></span> <a name="l00035"></a>00035 <span class="preprocessor">#endif</span> <a name="l00036"></a>00036 <span class="preprocessor"></span> <a name="l00037"></a>00037 <span class="comment">/* C implementation of the mote serial protocol. See</span> <a name="l00038"></a>00038 <span class="comment"> net.tinyos.packet.Packetizer for more details */</span> <a name="l00039"></a>00039 <a name="l00040"></a><a class="code" href="serialsource_8c.html#d72dbcf6d0153db1b8d8a58001feed83">00040</a> <span class="preprocessor">#define DEBUG 1</span> <a name="l00041"></a>00041 <span class="preprocessor"></span> <a name="l00042"></a>00042 <span class="preprocessor">#include "<a class="code" href="serialsource_8h.html">serialsource.h</a>"</span> <a name="l00043"></a>00043 <span class="preprocessor">#include "<a class="code" href="OscopeMsg_8h.html">OscopeMsg.h</a>"</span> <a name="l00044"></a>00044 <a name="l00045"></a><a class="code" href="structtos__header.html">00045</a> <span class="keyword">typedef</span> <span class="keyword">struct </span>{ <a name="l00046"></a><a class="code" href="structtos__header.html#f4a485c670c5a36a0f23a704d390dab3">00046</a> uint8_t type; <a name="l00047"></a><a class="code" href="structtos__header.html#44b390d0b8b1c0c71edd31f542440f17">00047</a> uint16_t dest_id; <a name="l00048"></a><a class="code" href="structtos__header.html#7c343e15c3ac8ed495e5a9fbb63226e2">00048</a> uint8_t handler; <a name="l00049"></a><a class="code" href="structtos__header.html#b2fffd69a87b45ebd060da6a02693eb9">00049</a> uint8_t group_id; <a name="l00050"></a><a class="code" href="structtos__header.html#f05404a2fc3ce1d53b5ab3d831c256eb">00050</a> uint8_t length; <a name="l00051"></a>00051 }<a class="code" href="structtos__header.html">tos_header</a>; <a name="l00052"></a>00052 <a name="l00053"></a><a class="code" href="serialsource_8c.html#1062901a7428fdd9c7f180f5e01ea056">00053</a> <span class="keyword">typedef</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#1062901a7428fdd9c7f180f5e01ea056">bool</a>; <a name="l00054"></a>00054 <a name="l00055"></a>00055 <span class="keyword">enum</span> { <a name="l00056"></a>00056 <span class="preprocessor">#ifndef __CYGWIN__</span> <a name="l00057"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a1e095cc966dbecf6a0d8aad75348d1a">00057</a> <span class="preprocessor"></span> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a1e095cc966dbecf6a0d8aad75348d1a">FALSE</a> = 0, <a name="l00058"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a82764c3079aea4e60c80e45befbb839">00058</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a82764c3079aea4e60c80e45befbb839">TRUE</a> = 1, <a name="l00059"></a>00059 <span class="preprocessor">#endif</span> <a name="l00060"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a575b0318f8a2ec7077e296741c78a7407e">00060</a> <span class="preprocessor"></span> <a class="code" href="dtncpd_8c.html#eca034f67218340ecb2261a22c2f3dcd">BUFSIZE</a> = 256, <a name="l00061"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57d700abc3cfb69e46430ab97a3722ac9f">00061</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57d700abc3cfb69e46430ab97a3722ac9f">MTU</a> = 256, <a name="l00062"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ff595877bbd211eb88cad853a13c5a9c">00062</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ff595877bbd211eb88cad853a13c5a9c">ACK_TIMEOUT</a> = 1000000, <span class="comment">/* in us */</span> <a name="l00063"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">00063</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">SYNC_BYTE</a> = 0x7e, <a name="l00064"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ce933af229dd927b9447b6c3b62e1b21">00064</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ce933af229dd927b9447b6c3b62e1b21">ESCAPE_BYTE</a> = 0x7d, <a name="l00065"></a>00065 <a name="l00066"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a574f3b63ddf2a4e18f1e927caea575d19b">00066</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a574f3b63ddf2a4e18f1e927caea575d19b">P_ACK</a> = 64, <a name="l00067"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5708f3333fc70a32f3ae8a949eb56b958b">00067</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5708f3333fc70a32f3ae8a949eb56b958b">P_PACKET_ACK</a> = 65, <a name="l00068"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5772698231a632310fb99f1ee9e8462de3">00068</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5772698231a632310fb99f1ee9e8462de3">P_PACKET_NO_ACK</a> = 66, <a name="l00069"></a><a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a571dc7c13336215d35db9b3b6fa125d615">00069</a> <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a571dc7c13336215d35db9b3b6fa125d615">P_UNKNOWN</a> = 255 <a name="l00070"></a>00070 }; <a name="l00071"></a>00071 <a name="l00072"></a><a class="code" href="structpacket__list.html">00072</a> <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> <a name="l00073"></a>00073 { <a name="l00074"></a><a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">00074</a> uint8_t *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>; <a name="l00075"></a><a class="code" href="structpacket__list.html#cbb06615ddf106f2ce9eea697c516c92">00075</a> <span class="keywordtype">int</span> <a class="code" href="structpacket__list.html#cbb06615ddf106f2ce9eea697c516c92">len</a>; <a name="l00076"></a><a class="code" href="structpacket__list.html#c655be01d600edd7258c0a8a69bc381e">00076</a> <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> *<a class="code" href="structpacket__list.html#c655be01d600edd7258c0a8a69bc381e">next</a>; <a name="l00077"></a>00077 }; <a name="l00078"></a>00078 <a name="l00079"></a><a class="code" href="structserial__source.html">00079</a> <span class="keyword">struct </span><a class="code" href="structserial__source.html">serial_source</a> { <a name="l00080"></a><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">00080</a> <span class="keywordtype">int</span> <a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>; <a name="l00081"></a><a class="code" href="structserial__source.html#d6e9b9bcdf86bed01710561c076f6fed">00081</a> <span class="keywordtype">bool</span> <a class="code" href="structserial__source.html#d6e9b9bcdf86bed01710561c076f6fed">non_blocking</a>; <a name="l00082"></a>00082 void (*<a class="code" href="structserial__source.html#20d390a5b238cb165e9626d6f878e913">message</a>)(<a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640">serial_source_msg</a> problem); <a name="l00083"></a>00083 <a name="l00084"></a>00084 <span class="comment">/* Receive state */</span> <a name="l00085"></a>00085 <span class="keyword">struct </span>{ <a name="l00086"></a><a class="code" href="structserial__source.html#46a5cc21ef737375037d33b8033849dd">00086</a> uint8_t <a class="code" href="structserial__source.html#46a5cc21ef737375037d33b8033849dd">buffer</a>[<a class="code" href="dtncpd_8c.html#eca034f67218340ecb2261a22c2f3dcd">BUFSIZE</a>]; <a name="l00087"></a><a class="code" href="structserial__source.html#b8d6ede76f8534de2d8c644ec65fbd2b">00087</a> <span class="keywordtype">int</span> <a class="code" href="structserial__source.html#69a24323561ddcb2c2b92c64c61f87db">bufpos</a>, <a class="code" href="structserial__source.html#b8d6ede76f8534de2d8c644ec65fbd2b">bufused</a>; <a name="l00088"></a><a class="code" href="structserial__source.html#158912e48a804a855221eb8a3f0c2d3d">00088</a> uint8_t <a class="code" href="structserial__source.html#158912e48a804a855221eb8a3f0c2d3d">packet</a>[<a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57d700abc3cfb69e46430ab97a3722ac9f">MTU</a>]; <a name="l00089"></a><a class="code" href="structserial__source.html#5920c42528e15ab26db30d3c88ccb61a">00089</a> <span class="keywordtype">bool</span> <a class="code" href="structserial__source.html#5920c42528e15ab26db30d3c88ccb61a">in_sync</a>, <a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>; <a name="l00090"></a><a class="code" href="structserial__source.html#9a89edf4a51349f655155785d5113f02">00090</a> <span class="keywordtype">int</span> <a class="code" href="structserial__source.html#9a89edf4a51349f655155785d5113f02">count</a>; <a name="l00091"></a><a class="code" href="structserial__source.html#6f924a3d44c8c574fddd968727067795">00091</a> <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> *<a class="code" href="structserial__source.html#6f924a3d44c8c574fddd968727067795">queue</a>[256]; <span class="comment">// indexed by protocol</span> <a name="l00092"></a>00092 } <a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>; <a name="l00093"></a>00093 <span class="keyword">struct </span>{ <a name="l00094"></a><a class="code" href="structserial__source.html#a98862af52126058f75deb0f5b98ca12">00094</a> uint8_t <a class="code" href="structserial__source.html#a98862af52126058f75deb0f5b98ca12">seqno</a>; <a name="l00095"></a><a class="code" href="structserial__source.html#829f8ffa884b25761a018793691130c7">00095</a> uint8_t *<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>; <a name="l00096"></a><a class="code" href="structserial__source.html#0282f946d115772fa7d13cdd8b0276bd">00096</a> <span class="keywordtype">int</span> <a class="code" href="structserial__source.html#0282f946d115772fa7d13cdd8b0276bd">escapeptr</a>; <a name="l00097"></a><a class="code" href="structserial__source.html#198e4b9a2e8c8a92de6adc41915d45d3">00097</a> uint16_t <a class="code" href="structserial__source.html#198e4b9a2e8c8a92de6adc41915d45d3">crc</a>; <a name="l00098"></a>00098 } <a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>; <a name="l00099"></a>00099 }; <a name="l00100"></a>00100 <a name="l00101"></a><a class="code" href="serialsource_8c.html#1c26e85287863496e21a6d9106e208e0">00101</a> <span class="keyword">static</span> tcflag_t <a class="code" href="serialsource_8c.html#1c26e85287863496e21a6d9106e208e0">parse_baudrate</a>(<span class="keywordtype">int</span> requested) <a name="l00102"></a>00102 { <a name="l00103"></a>00103 <span class="keywordtype">int</span> baudrate; <a name="l00104"></a>00104 <a name="l00105"></a>00105 <span class="keywordflow">switch</span> (requested) <a name="l00106"></a>00106 { <a name="l00107"></a>00107 <span class="preprocessor">#ifdef B50</span> <a name="l00108"></a>00108 <span class="preprocessor"></span> <span class="keywordflow">case</span> 50: baudrate = B50; <span class="keywordflow">break</span>; <a name="l00109"></a>00109 <span class="preprocessor">#endif</span> <a name="l00110"></a>00110 <span class="preprocessor"></span><span class="preprocessor">#ifdef B75</span> <a name="l00111"></a>00111 <span class="preprocessor"></span> <span class="keywordflow">case</span> 75: baudrate = B75; <span class="keywordflow">break</span>; <a name="l00112"></a>00112 <span class="preprocessor">#endif</span> <a name="l00113"></a>00113 <span class="preprocessor"></span><span class="preprocessor">#ifdef B110</span> <a name="l00114"></a>00114 <span class="preprocessor"></span> <span class="keywordflow">case</span> 110: baudrate = B110; <span class="keywordflow">break</span>; <a name="l00115"></a>00115 <span class="preprocessor">#endif</span> <a name="l00116"></a>00116 <span class="preprocessor"></span><span class="preprocessor">#ifdef B134</span> <a name="l00117"></a>00117 <span class="preprocessor"></span> <span class="keywordflow">case</span> 134: baudrate = B134; <span class="keywordflow">break</span>; <a name="l00118"></a>00118 <span class="preprocessor">#endif</span> <a name="l00119"></a>00119 <span class="preprocessor"></span><span class="preprocessor">#ifdef B150</span> <a name="l00120"></a>00120 <span class="preprocessor"></span> <span class="keywordflow">case</span> 150: baudrate = B150; <span class="keywordflow">break</span>; <a name="l00121"></a>00121 <span class="preprocessor">#endif</span> <a name="l00122"></a>00122 <span class="preprocessor"></span><span class="preprocessor">#ifdef B200</span> <a name="l00123"></a>00123 <span class="preprocessor"></span> <span class="keywordflow">case</span> 200: baudrate = B200; <span class="keywordflow">break</span>; <a name="l00124"></a>00124 <span class="preprocessor">#endif</span> <a name="l00125"></a>00125 <span class="preprocessor"></span><span class="preprocessor">#ifdef B300</span> <a name="l00126"></a>00126 <span class="preprocessor"></span> <span class="keywordflow">case</span> 300: baudrate = B300; <span class="keywordflow">break</span>; <a name="l00127"></a>00127 <span class="preprocessor">#endif</span> <a name="l00128"></a>00128 <span class="preprocessor"></span><span class="preprocessor">#ifdef B600</span> <a name="l00129"></a>00129 <span class="preprocessor"></span> <span class="keywordflow">case</span> 600: baudrate = B600; <span class="keywordflow">break</span>; <a name="l00130"></a>00130 <span class="preprocessor">#endif</span> <a name="l00131"></a>00131 <span class="preprocessor"></span><span class="preprocessor">#ifdef B1200</span> <a name="l00132"></a>00132 <span class="preprocessor"></span> <span class="keywordflow">case</span> 1200: baudrate = B1200; <span class="keywordflow">break</span>; <a name="l00133"></a>00133 <span class="preprocessor">#endif</span> <a name="l00134"></a>00134 <span class="preprocessor"></span><span class="preprocessor">#ifdef B1800</span> <a name="l00135"></a>00135 <span class="preprocessor"></span> <span class="keywordflow">case</span> 1800: baudrate = B1800; <span class="keywordflow">break</span>; <a name="l00136"></a>00136 <span class="preprocessor">#endif</span> <a name="l00137"></a>00137 <span class="preprocessor"></span><span class="preprocessor">#ifdef B2400</span> <a name="l00138"></a>00138 <span class="preprocessor"></span> <span class="keywordflow">case</span> 2400: baudrate = B2400; <span class="keywordflow">break</span>; <a name="l00139"></a>00139 <span class="preprocessor">#endif</span> <a name="l00140"></a>00140 <span class="preprocessor"></span><span class="preprocessor">#ifdef B4800</span> <a name="l00141"></a>00141 <span class="preprocessor"></span> <span class="keywordflow">case</span> 4800: baudrate = B4800; <span class="keywordflow">break</span>; <a name="l00142"></a>00142 <span class="preprocessor">#endif</span> <a name="l00143"></a>00143 <span class="preprocessor"></span><span class="preprocessor">#ifdef B9600</span> <a name="l00144"></a>00144 <span class="preprocessor"></span> <span class="keywordflow">case</span> 9600: baudrate = B9600; <span class="keywordflow">break</span>; <a name="l00145"></a>00145 <span class="preprocessor">#endif</span> <a name="l00146"></a>00146 <span class="preprocessor"></span><span class="preprocessor">#ifdef B19200</span> <a name="l00147"></a>00147 <span class="preprocessor"></span> <span class="keywordflow">case</span> 19200: baudrate = B19200; <span class="keywordflow">break</span>; <a name="l00148"></a>00148 <span class="preprocessor">#endif</span> <a name="l00149"></a>00149 <span class="preprocessor"></span><span class="preprocessor">#ifdef B38400</span> <a name="l00150"></a>00150 <span class="preprocessor"></span> <span class="keywordflow">case</span> 38400: baudrate = B38400; <span class="keywordflow">break</span>; <a name="l00151"></a>00151 <span class="preprocessor">#endif</span> <a name="l00152"></a>00152 <span class="preprocessor"></span><span class="preprocessor">#ifdef B57600</span> <a name="l00153"></a>00153 <span class="preprocessor"></span> <span class="keywordflow">case</span> 57600: baudrate = B57600; <span class="keywordflow">break</span>; <a name="l00154"></a>00154 <span class="preprocessor">#endif</span> <a name="l00155"></a>00155 <span class="preprocessor"></span><span class="preprocessor">#ifdef B115200</span> <a name="l00156"></a>00156 <span class="preprocessor"></span> <span class="keywordflow">case</span> 115200: baudrate = B115200; <span class="keywordflow">break</span>; <a name="l00157"></a>00157 <span class="preprocessor">#endif</span> <a name="l00158"></a>00158 <span class="preprocessor"></span><span class="preprocessor">#ifdef B230400</span> <a name="l00159"></a>00159 <span class="preprocessor"></span> <span class="keywordflow">case</span> 230400: baudrate = B230400; <span class="keywordflow">break</span>; <a name="l00160"></a>00160 <span class="preprocessor">#endif</span> <a name="l00161"></a>00161 <span class="preprocessor"></span><span class="preprocessor">#ifdef B460800</span> <a name="l00162"></a>00162 <span class="preprocessor"></span> <span class="keywordflow">case</span> 460800: baudrate = B460800; <span class="keywordflow">break</span>; <a name="l00163"></a>00163 <span class="preprocessor">#endif</span> <a name="l00164"></a>00164 <span class="preprocessor"></span><span class="preprocessor">#ifdef B500000</span> <a name="l00165"></a>00165 <span class="preprocessor"></span> <span class="keywordflow">case</span> 500000: baudrate = B500000; <span class="keywordflow">break</span>; <a name="l00166"></a>00166 <span class="preprocessor">#endif</span> <a name="l00167"></a>00167 <span class="preprocessor"></span><span class="preprocessor">#ifdef B576000</span> <a name="l00168"></a>00168 <span class="preprocessor"></span> <span class="keywordflow">case</span> 576000: baudrate = B576000; <span class="keywordflow">break</span>; <a name="l00169"></a>00169 <span class="preprocessor">#endif</span> <a name="l00170"></a>00170 <span class="preprocessor"></span><span class="preprocessor">#ifdef B921600</span> <a name="l00171"></a>00171 <span class="preprocessor"></span> <span class="keywordflow">case</span> 921600: baudrate = B921600; <span class="keywordflow">break</span>; <a name="l00172"></a>00172 <span class="preprocessor">#endif</span> <a name="l00173"></a>00173 <span class="preprocessor"></span><span class="preprocessor">#ifdef B1000000</span> <a name="l00174"></a>00174 <span class="preprocessor"></span> <span class="keywordflow">case</span> 1000000: baudrate = B1000000; <span class="keywordflow">break</span>; <a name="l00175"></a>00175 <span class="preprocessor">#endif</span> <a name="l00176"></a>00176 <span class="preprocessor"></span><span class="preprocessor">#ifdef B1152000</span> <a name="l00177"></a>00177 <span class="preprocessor"></span> <span class="keywordflow">case</span> 1152000: baudrate = B1152000; <span class="keywordflow">break</span>; <a name="l00178"></a>00178 <span class="preprocessor">#endif</span> <a name="l00179"></a>00179 <span class="preprocessor"></span><span class="preprocessor">#ifdef B1500000</span> <a name="l00180"></a>00180 <span class="preprocessor"></span> <span class="keywordflow">case</span> 1500000: baudrate = B1500000; <span class="keywordflow">break</span>; <a name="l00181"></a>00181 <span class="preprocessor">#endif</span> <a name="l00182"></a>00182 <span class="preprocessor"></span><span class="preprocessor">#ifdef B2000000</span> <a name="l00183"></a>00183 <span class="preprocessor"></span> <span class="keywordflow">case</span> 2000000: baudrate = B2000000; <span class="keywordflow">break</span>; <a name="l00184"></a>00184 <span class="preprocessor">#endif</span> <a name="l00185"></a>00185 <span class="preprocessor"></span><span class="preprocessor">#ifdef B2500000</span> <a name="l00186"></a>00186 <span class="preprocessor"></span> <span class="keywordflow">case</span> 2500000: baudrate = B2500000; <span class="keywordflow">break</span>; <a name="l00187"></a>00187 <span class="preprocessor">#endif</span> <a name="l00188"></a>00188 <span class="preprocessor"></span><span class="preprocessor">#ifdef B3000000</span> <a name="l00189"></a>00189 <span class="preprocessor"></span> <span class="keywordflow">case</span> 3000000: baudrate = B3000000; <span class="keywordflow">break</span>; <a name="l00190"></a>00190 <span class="preprocessor">#endif</span> <a name="l00191"></a>00191 <span class="preprocessor"></span><span class="preprocessor">#ifdef B3500000</span> <a name="l00192"></a>00192 <span class="preprocessor"></span> <span class="keywordflow">case</span> 3500000: baudrate = B3500000; <span class="keywordflow">break</span>; <a name="l00193"></a>00193 <span class="preprocessor">#endif</span> <a name="l00194"></a>00194 <span class="preprocessor"></span><span class="preprocessor">#ifdef B4000000</span> <a name="l00195"></a>00195 <span class="preprocessor"></span> <span class="keywordflow">case</span> 4000000: baudrate = B4000000; <span class="keywordflow">break</span>; <a name="l00196"></a>00196 <span class="preprocessor">#endif</span> <a name="l00197"></a>00197 <span class="preprocessor"></span> <span class="keywordflow">default</span>: <a name="l00198"></a>00198 baudrate = 0; <a name="l00199"></a>00199 } <a name="l00200"></a>00200 <span class="keywordflow">return</span> baudrate; <a name="l00201"></a>00201 } <a name="l00202"></a>00202 <a name="l00203"></a>00203 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00204"></a><a class="code" href="serialsource_8c.html#87b713d53023266d98d45b86312c26aa">00204</a> <span class="preprocessor"></span><span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#87b713d53023266d98d45b86312c26aa">dump</a>(<span class="keyword">const</span> <span class="keywordtype">char</span> *msg, <span class="keyword">const</span> uint8_t *packet, <span class="keywordtype">int</span> <a class="code" href="num2sdnv_8c.html#fed088663f8704004425cdae2120b9b3">len</a>) <a name="l00205"></a>00205 { <a name="l00206"></a>00206 <span class="keywordtype">int</span> i; <a name="l00207"></a>00207 <a name="l00208"></a>00208 printf(<span class="stringliteral">"%s (%d bytes)"</span>, msg, len); <a name="l00209"></a>00209 <span class="keywordflow">for</span> (i = 0; i < len; i++) <a name="l00210"></a>00210 printf(<span class="stringliteral">" %02x"</span>, packet[i]); <a name="l00211"></a>00211 putchar(<span class="charliteral">'\n'</span>); <a name="l00212"></a>00212 } <a name="l00213"></a>00213 <span class="preprocessor">#endif</span> <a name="l00214"></a>00214 <span class="preprocessor"></span> <a name="l00215"></a><a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">00215</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640">serial_source_msg</a> msg) <a name="l00216"></a>00216 { <a name="l00217"></a>00217 <span class="keywordflow">if</span> (src-><a class="code" href="structserial__source.html#20d390a5b238cb165e9626d6f878e913">message</a>) <a name="l00218"></a>00218 src-><a class="code" href="structserial__source.html#20d390a5b238cb165e9626d6f878e913">message</a>(msg); <a name="l00219"></a>00219 } <a name="l00220"></a>00220 <a name="l00221"></a>00221 <span class="comment">/* Work around buggy usb serial driver (returns 0 when no data is</span> <a name="l00222"></a>00222 <span class="comment"> available, independent of the blocking/non-blocking mode) */</span> <a name="l00223"></a><a class="code" href="serialsource_8c.html#68450065c541bc59ea2bd91fd039054a">00223</a> <span class="keyword">static</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#68450065c541bc59ea2bd91fd039054a">buggyread</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <span class="keywordtype">void</span> *buffer, <span class="keywordtype">int</span> n) <a name="l00224"></a>00224 { <a name="l00225"></a>00225 fd_set fds; <a name="l00226"></a>00226 <span class="keywordtype">int</span> cnt; <a name="l00227"></a>00227 <a name="l00228"></a>00228 <span class="keywordflow">if</span> (src-><a class="code" href="structserial__source.html#d6e9b9bcdf86bed01710561c076f6fed">non_blocking</a>) <a name="l00229"></a>00229 { <a name="l00230"></a>00230 cnt = read(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>, buffer, n); <a name="l00231"></a>00231 <span class="keywordflow">if</span> (cnt == 0) <a name="l00232"></a>00232 { <a name="l00233"></a>00233 cnt = -1; <a name="l00234"></a>00234 <a class="code" href="IPDiscovery_8cc.html#d65a8842cc674e3ddf69355898c0ecbf">errno</a> = EAGAIN; <a name="l00235"></a>00235 } <a name="l00236"></a>00236 <span class="keywordflow">return</span> cnt; <a name="l00237"></a>00237 } <a name="l00238"></a>00238 <span class="keywordflow">else</span> <a name="l00239"></a>00239 <span class="keywordflow">for</span> (;;) <a name="l00240"></a>00240 { <a name="l00241"></a>00241 FD_ZERO(&fds); <a name="l00242"></a>00242 FD_SET(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>, &fds); <a name="l00243"></a>00243 cnt = select(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a> + 1, &fds, NULL, NULL, NULL); <a name="l00244"></a>00244 <span class="keywordflow">if</span> (cnt < 0) <a name="l00245"></a>00245 <span class="keywordflow">return</span> -1; <a name="l00246"></a>00246 <a name="l00247"></a>00247 cnt = read(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>, buffer, n); <a name="l00248"></a>00248 <span class="keywordflow">if</span> (cnt != 0) <a name="l00249"></a>00249 <span class="keywordflow">return</span> cnt; <a name="l00250"></a>00250 } <a name="l00251"></a>00251 } <a name="l00252"></a>00252 <a name="l00253"></a><a class="code" href="serialsource_8h.html#1f56b3ed3ca860efcd58d5c212b17066">00253</a> <a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="serialsource_8c.html#1f56b3ed3ca860efcd58d5c212b17066">open_serial_source</a>(<span class="keyword">const</span> <span class="keywordtype">char</span> *device, <span class="keywordtype">int</span> baud_rate, <a name="l00254"></a>00254 <span class="keywordtype">int</span> non_blocking, <a name="l00255"></a>00255 <span class="keywordtype">void</span> (*<a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>)(<a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640">serial_source_msg</a> problem)) <a name="l00256"></a>00256 <span class="comment">/* Effects: opens serial port device at specified baud_rate. If non_blocking</span> <a name="l00257"></a>00257 <span class="comment"> is true, read_serial_packet calls will be non-blocking (writes are</span> <a name="l00258"></a>00258 <span class="comment"> always blocking, for now at least)</span> <a name="l00259"></a>00259 <span class="comment"> Returns: descriptor for serial forwarder at host:port, or</span> <a name="l00260"></a>00260 <span class="comment"> NULL for failure (bad device or bad baud rate)</span> <a name="l00261"></a>00261 <span class="comment"> */</span> <a name="l00262"></a>00262 { <a name="l00263"></a>00263 <span class="keyword">struct </span>termios newtio; <a name="l00264"></a>00264 <span class="keywordtype">int</span> <a class="code" href="dtnperf-client_8c.html#6f8059414f0228f0256115e024eeed4b">fd</a>; <a name="l00265"></a>00265 tcflag_t baudflag = <a class="code" href="serialsource_8c.html#1c26e85287863496e21a6d9106e208e0">parse_baudrate</a>(baud_rate); <a name="l00266"></a>00266 <a name="l00267"></a>00267 <span class="keywordflow">if</span> (!baudflag) <a name="l00268"></a>00268 <span class="keywordflow">return</span> NULL; <a name="l00269"></a>00269 <a name="l00270"></a>00270 fd = open(device, O_RDWR | O_NOCTTY | O_NONBLOCK); <a name="l00271"></a>00271 <span class="keywordflow">if</span> (fd < 0) <a name="l00272"></a>00272 <span class="keywordflow">return</span> NULL; <a name="l00273"></a>00273 <a name="l00274"></a>00274 <span class="preprocessor">#ifdef __CYGWIN__</span> <a name="l00275"></a>00275 <span class="preprocessor"></span> <span class="comment">/* For some very mysterious reason, this incantation is necessary to make</span> <a name="l00276"></a>00276 <span class="comment"> the serial port work under some windows machines */</span> <a name="l00277"></a>00277 HANDLE <a class="code" href="dtncat_8c.html#01daea96255bb21a8979b3b45f5bbb70">handle</a> = (HANDLE)get_osfhandle(fd); <a name="l00278"></a>00278 DCB dcb; <a name="l00279"></a>00279 <span class="keywordflow">if</span> (!(GetCommState(handle, &dcb) && SetCommState(handle, &dcb))) <a name="l00280"></a>00280 { <a name="l00281"></a>00281 close(fd); <a name="l00282"></a>00282 <span class="keywordflow">return</span> NULL; <a name="l00283"></a>00283 } <a name="l00284"></a>00284 <span class="preprocessor">#endif</span> <a name="l00285"></a>00285 <span class="preprocessor"></span> <span class="comment">/* Serial port setting */</span> <a name="l00286"></a>00286 memset(&newtio, 0, <span class="keyword">sizeof</span>(newtio)); <a name="l00287"></a>00287 newtio.c_cflag = CS8 | CLOCAL | CREAD; <a name="l00288"></a>00288 newtio.c_iflag = IGNPAR | IGNBRK; <a name="l00289"></a>00289 cfsetispeed(&newtio, baudflag); <a name="l00290"></a>00290 cfsetospeed(&newtio, baudflag); <a name="l00291"></a>00291 <a name="l00292"></a>00292 <span class="comment">/* Raw output_file */</span> <a name="l00293"></a>00293 newtio.c_oflag = 0; <a name="l00294"></a>00294 <span class="keywordflow">if</span> (tcflush(fd, TCIFLUSH) >= 0 && <a name="l00295"></a>00295 tcsetattr(fd, TCSANOW, &newtio) >= 0) <a name="l00296"></a>00296 { <a name="l00297"></a>00297 <a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a> = malloc(<span class="keyword">sizeof</span> *src); <a name="l00298"></a>00298 <a name="l00299"></a>00299 <span class="keywordflow">if</span> (src) <a name="l00300"></a>00300 { <a name="l00301"></a>00301 memset(src, 0, <span class="keyword">sizeof</span> src); <a name="l00302"></a>00302 src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a> = fd; <a name="l00303"></a>00303 src-><a class="code" href="structserial__source.html#d6e9b9bcdf86bed01710561c076f6fed">non_blocking</a> = non_blocking; <a name="l00304"></a>00304 src-><a class="code" href="structserial__source.html#20d390a5b238cb165e9626d6f878e913">message</a> = <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>; <a name="l00305"></a>00305 src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#a98862af52126058f75deb0f5b98ca12">seqno</a> = 37; <a name="l00306"></a>00306 <a name="l00307"></a>00307 <span class="keywordflow">return</span> src; <a name="l00308"></a>00308 } <a name="l00309"></a>00309 } <a name="l00310"></a>00310 close(fd); <a name="l00311"></a>00311 <a name="l00312"></a>00312 <span class="keywordflow">return</span> NULL; <a name="l00313"></a>00313 } <a name="l00314"></a>00314 <a name="l00315"></a><a class="code" href="serialsource_8h.html#3af9a5741985286f184a3c75f2d4da0f">00315</a> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#3af9a5741985286f184a3c75f2d4da0f">serial_source_fd</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>) <a name="l00316"></a>00316 <span class="comment">/* Returns: the file descriptor used by serial source src (useful when</span> <a name="l00317"></a>00317 <span class="comment"> non-blocking reads were requested)</span> <a name="l00318"></a>00318 <span class="comment">*/</span> <a name="l00319"></a>00319 { <a name="l00320"></a>00320 <span class="keywordflow">return</span> src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>; <a name="l00321"></a>00321 } <a name="l00322"></a>00322 <a name="l00323"></a><a class="code" href="serialsource_8h.html#4bd86ad93ca5b213f3031ce800eca733">00323</a> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#4bd86ad93ca5b213f3031ce800eca733">close_serial_source</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>) <a name="l00324"></a>00324 <span class="comment">/* Effects: closes serial source src</span> <a name="l00325"></a>00325 <span class="comment"> Returns: 0 if successful, -1 if some problem occured (but source is</span> <a name="l00326"></a>00326 <span class="comment"> considered closed anyway)</span> <a name="l00327"></a>00327 <span class="comment"> */</span> <a name="l00328"></a>00328 { <a name="l00329"></a>00329 <span class="keywordtype">int</span> ok = close(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>); <a name="l00330"></a>00330 <a name="l00331"></a>00331 free(src); <a name="l00332"></a>00332 <a name="l00333"></a>00333 <span class="keywordflow">return</span> ok; <a name="l00334"></a>00334 } <a name="l00335"></a>00335 <a name="l00336"></a><a class="code" href="serialsource_8c.html#0c16130ea7050506ac115d1c82a3e782">00336</a> <span class="keyword">static</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#0c16130ea7050506ac115d1c82a3e782">source_wait</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <span class="keyword">struct</span> timeval *deadline) <a name="l00337"></a>00337 <span class="comment">/* Effects: waits until deadline for some data on source. deadline</span> <a name="l00338"></a>00338 <span class="comment"> can be NULL for indefinite waiting.</span> <a name="l00339"></a>00339 <span class="comment"> Returns: 0 if data is available, -1 if the deadline expires</span> <a name="l00340"></a>00340 <span class="comment">*/</span> <a name="l00341"></a>00341 { <a name="l00342"></a>00342 <span class="keyword">struct </span>timeval tv; <a name="l00343"></a>00343 fd_set fds; <a name="l00344"></a>00344 <span class="keywordtype">int</span> cnt; <a name="l00345"></a>00345 <a name="l00346"></a>00346 <span class="keywordflow">if</span> (src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#69a24323561ddcb2c2b92c64c61f87db">bufpos</a> < src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#b8d6ede76f8534de2d8c644ec65fbd2b">bufused</a>) <a name="l00347"></a>00347 <span class="keywordflow">return</span> 0; <a name="l00348"></a>00348 <a name="l00349"></a>00349 <span class="keywordflow">for</span> (;;) <a name="l00350"></a>00350 { <a name="l00351"></a>00351 printf(<span class="stringliteral">"SOURCE WAITING\n"</span>); <a name="l00352"></a>00352 <span class="keywordflow">if</span> (deadline) <a name="l00353"></a>00353 { <a name="l00354"></a>00354 <a class="code" href="namespacedtnsim.html#372b0bd474085f20b38efbbade7ce72a" title="Override gettimeofday to return the simulator time.">gettimeofday</a>(&tv, NULL); <a name="l00355"></a>00355 tv.tv_sec = deadline->tv_sec - tv.tv_sec; <a name="l00356"></a>00356 tv.tv_usec = deadline->tv_usec - tv.tv_usec; <a name="l00357"></a>00357 <span class="keywordflow">if</span> (tv.tv_usec < 0) <a name="l00358"></a>00358 { <a name="l00359"></a>00359 tv.tv_usec += 1000000; <a name="l00360"></a>00360 tv.tv_sec--; <a name="l00361"></a>00361 } <a name="l00362"></a>00362 <span class="keywordflow">if</span> (tv.tv_sec < 0) <a name="l00363"></a>00363 <span class="keywordflow">return</span> -1; <a name="l00364"></a>00364 } <a name="l00365"></a>00365 <a name="l00366"></a>00366 FD_ZERO(&fds); <a name="l00367"></a>00367 FD_SET(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>, &fds); <a name="l00368"></a>00368 cnt = select(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a> + 1, &fds, NULL, NULL, deadline ? &tv : NULL); <a name="l00369"></a>00369 <span class="keywordflow">if</span> (cnt < 0) <a name="l00370"></a>00370 { <a name="l00371"></a>00371 <span class="keywordflow">if</span> (<a class="code" href="IPDiscovery_8cc.html#d65a8842cc674e3ddf69355898c0ecbf">errno</a> == EINTR) <a name="l00372"></a>00372 <span class="keywordflow">continue</span>; <a name="l00373"></a>00373 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640e997903e7fd3c99317e9641835d74422">msg_unix_error</a>); <a name="l00374"></a>00374 <span class="keywordflow">return</span> -1; <a name="l00375"></a>00375 } <a name="l00376"></a>00376 <span class="keywordflow">if</span> (cnt == 0) <a name="l00377"></a>00377 <span class="keywordflow">return</span> -1; <a name="l00378"></a>00378 <span class="keywordflow">return</span> 0; <a name="l00379"></a>00379 } <a name="l00380"></a>00380 } <a name="l00381"></a>00381 <a name="l00382"></a><a class="code" href="serialsource_8c.html#212ca0926806ffe103d4cbd20ac65fcf">00382</a> <span class="keyword">static</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#212ca0926806ffe103d4cbd20ac65fcf">source_write</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <span class="keyword">const</span> <span class="keywordtype">void</span> *buffer, <span class="keywordtype">int</span> <a class="code" href="dtnping_8c.html#d43c3812e6d13e0518d9f8b8f463ffcf">count</a>) <a name="l00383"></a>00383 { <a name="l00384"></a>00384 <span class="keywordtype">int</span> actual = 0; <a name="l00385"></a>00385 <a name="l00386"></a>00386 <span class="keywordflow">if</span> (fcntl(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>, F_SETFL, 0) < 0) <a name="l00387"></a>00387 { <a name="l00388"></a>00388 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640e997903e7fd3c99317e9641835d74422">msg_unix_error</a>); <a name="l00389"></a>00389 <span class="keywordflow">return</span> -1; <a name="l00390"></a>00390 } <a name="l00391"></a>00391 <span class="keywordflow">while</span> (count > 0) <a name="l00392"></a>00392 { <a name="l00393"></a>00393 <span class="keywordtype">int</span> n = write(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>, buffer, count); <a name="l00394"></a>00394 <a name="l00395"></a>00395 <span class="keywordflow">if</span> (n < 0 && <a class="code" href="IPDiscovery_8cc.html#d65a8842cc674e3ddf69355898c0ecbf">errno</a> == EINTR) <a name="l00396"></a>00396 <span class="keywordflow">continue</span>; <a name="l00397"></a>00397 <span class="keywordflow">if</span> (n < 0) <a name="l00398"></a>00398 { <a name="l00399"></a>00399 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640e997903e7fd3c99317e9641835d74422">msg_unix_error</a>); <a name="l00400"></a>00400 actual = -1; <a name="l00401"></a>00401 <span class="keywordflow">break</span>; <a name="l00402"></a>00402 } <a name="l00403"></a>00403 <a name="l00404"></a>00404 count -= n; <a name="l00405"></a>00405 actual += n; <a name="l00406"></a>00406 buffer += n; <a name="l00407"></a>00407 } <a name="l00408"></a>00408 <span class="keywordflow">if</span> (fcntl(src-><a class="code" href="structserial__source.html#c3ed5de83e4ba2efa2cb6b50ab0125d0">fd</a>, F_SETFL, O_NONBLOCK) < 0) <a name="l00409"></a>00409 { <a name="l00410"></a>00410 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640e997903e7fd3c99317e9641835d74422">msg_unix_error</a>); <a name="l00411"></a>00411 <span class="comment">/* We're in trouble, but there's no obvious fix. */</span> <a name="l00412"></a>00412 } <a name="l00413"></a>00413 <span class="keywordflow">return</span> actual; <a name="l00414"></a>00414 } <a name="l00415"></a>00415 <a name="l00416"></a><a class="code" href="serialsource_8c.html#ce5b91440dc716f126412681208add12">00416</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#ce5b91440dc716f126412681208add12">push_protocol_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <a name="l00417"></a>00417 uint8_t type, uint8_t *packet, uint8_t <a class="code" href="num2sdnv_8c.html#fed088663f8704004425cdae2120b9b3">len</a>) <a name="l00418"></a>00418 { <a name="l00419"></a>00419 <span class="comment">/* I'm assuming short queues */</span> <a name="l00420"></a>00420 <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> *entry = malloc(<span class="keyword">sizeof</span> *packet), **last; <a name="l00421"></a>00421 <a name="l00422"></a>00422 <span class="keywordflow">if</span> (!entry) <a name="l00423"></a>00423 { <a name="l00424"></a>00424 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b64043799e5977806a4559729141f049150c">msg_no_memory</a>); <a name="l00425"></a>00425 free(packet); <a name="l00426"></a>00426 <span class="keywordflow">return</span>; <a name="l00427"></a>00427 } <a name="l00428"></a>00428 <a name="l00429"></a>00429 entry-><a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a> = packet; <a name="l00430"></a>00430 entry-><a class="code" href="structpacket__list.html#cbb06615ddf106f2ce9eea697c516c92">len</a> = len; <a name="l00431"></a>00431 entry-><a class="code" href="structpacket__list.html#c655be01d600edd7258c0a8a69bc381e">next</a> = NULL; <a name="l00432"></a>00432 <a name="l00433"></a>00433 last = &src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#6f924a3d44c8c574fddd968727067795">queue</a>[type]; <a name="l00434"></a>00434 <span class="keywordflow">while</span> (*last) <a name="l00435"></a>00435 last = &(*last)-><a class="code" href="structpacket__list.html#c655be01d600edd7258c0a8a69bc381e">next</a>; <a name="l00436"></a>00436 *last = entry; <a name="l00437"></a>00437 } <a name="l00438"></a>00438 <a name="l00439"></a><a class="code" href="serialsource_8c.html#5b8211af1029bd001448033b51b290ae">00439</a> <span class="keyword">static</span> <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> *<a class="code" href="serialsource_8c.html#5b8211af1029bd001448033b51b290ae">pop_protocol_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, uint8_t type) <a name="l00440"></a>00440 { <a name="l00441"></a>00441 <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> *entry = src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#6f924a3d44c8c574fddd968727067795">queue</a>[type]; <a name="l00442"></a>00442 <a name="l00443"></a>00443 <span class="keywordflow">if</span> (entry) <a name="l00444"></a>00444 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#6f924a3d44c8c574fddd968727067795">queue</a>[type] = entry-><a class="code" href="structpacket__list.html#c655be01d600edd7258c0a8a69bc381e">next</a>; <a name="l00445"></a>00445 <a name="l00446"></a>00446 <span class="keywordflow">return</span> entry; <a name="l00447"></a>00447 } <a name="l00448"></a>00448 <a name="l00449"></a><a class="code" href="serialsource_8c.html#76b8b431a93725ffb95905079f012fca">00449</a> <span class="keyword">static</span> <span class="keywordtype">bool</span> <a class="code" href="serialsource_8c.html#76b8b431a93725ffb95905079f012fca">packet_available</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, uint8_t type) <a name="l00450"></a>00450 { <a name="l00451"></a>00451 <span class="keywordflow">return</span> src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#6f924a3d44c8c574fddd968727067795">queue</a>[type] != NULL; <a name="l00452"></a>00452 } <a name="l00453"></a>00453 <a name="l00454"></a><a class="code" href="serialsource_8h.html#1e56d589bd8f636209b2b9704f3ab6e9">00454</a> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#1e56d589bd8f636209b2b9704f3ab6e9">serial_source_empty</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>) <a name="l00455"></a>00455 <span class="comment">/* Returns: true if serial source does not contain any pending data, i.e.,</span> <a name="l00456"></a>00456 <span class="comment"> if the result is true and there is no data available on the source's</span> <a name="l00457"></a>00457 <span class="comment"> file descriptor, then read_serial_packet will:</span> <a name="l00458"></a>00458 <span class="comment"> - return NULL if the source is non-blocking</span> <a name="l00459"></a>00459 <span class="comment"> - block if it is blocking</span> <a name="l00460"></a>00460 <span class="comment"></span> <a name="l00461"></a>00461 <span class="comment"> (Note: the presence of this calls allows the serial_source to do some</span> <a name="l00462"></a>00462 <span class="comment"> internal buffering)</span> <a name="l00463"></a>00463 <span class="comment">*/</span> <a name="l00464"></a>00464 { <a name="l00465"></a>00465 <span class="keywordflow">return</span> src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#69a24323561ddcb2c2b92c64c61f87db">bufpos</a> >= src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#b8d6ede76f8534de2d8c644ec65fbd2b">bufused</a> && <a name="l00466"></a>00466 !<a class="code" href="serialsource_8c.html#76b8b431a93725ffb95905079f012fca">packet_available</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5772698231a632310fb99f1ee9e8462de3">P_PACKET_NO_ACK</a>); <a name="l00467"></a>00467 } <a name="l00468"></a>00468 <a name="l00469"></a>00469 <span class="comment">/* Slow implementation of crc function */</span> <a name="l00470"></a><a class="code" href="serialsource_8c.html#8b3f01398d0cedfec4af06dc2aa8e034">00470</a> <span class="keyword">static</span> uint16_t <a class="code" href="serialsource_8c.html#8b3f01398d0cedfec4af06dc2aa8e034">crc_byte</a>(uint16_t crc, uint8_t b) <a name="l00471"></a>00471 { <a name="l00472"></a>00472 uint8_t i; <a name="l00473"></a>00473 <a name="l00474"></a>00474 crc = crc ^ b << 8; <a name="l00475"></a>00475 i = 8; <a name="l00476"></a>00476 <span class="keywordflow">do</span> <a name="l00477"></a>00477 <span class="keywordflow">if</span> (crc & 0x8000) <a name="l00478"></a>00478 crc = crc << 1 ^ 0x1021; <a name="l00479"></a>00479 <span class="keywordflow">else</span> <a name="l00480"></a>00480 crc = crc << 1; <a name="l00481"></a>00481 <span class="keywordflow">while</span> (--i); <a name="l00482"></a>00482 <a name="l00483"></a>00483 <span class="keywordflow">return</span> crc; <a name="l00484"></a>00484 } <a name="l00485"></a>00485 <a name="l00486"></a><a class="code" href="serialsource_8c.html#8cfd5e2eaf30c88a606c75fe2f577a8f">00486</a> <span class="keyword">static</span> uint16_t <a class="code" href="serialsource_8c.html#8cfd5e2eaf30c88a606c75fe2f577a8f">crc_packet</a>(uint8_t *data, <span class="keywordtype">int</span> <a class="code" href="num2sdnv_8c.html#fed088663f8704004425cdae2120b9b3">len</a>) <a name="l00487"></a>00487 { <a name="l00488"></a>00488 uint16_t crc = 0; <a name="l00489"></a>00489 <a name="l00490"></a>00490 <span class="keywordflow">while</span> (len-- > 0) <a name="l00491"></a>00491 crc = <a class="code" href="serialsource_8c.html#8b3f01398d0cedfec4af06dc2aa8e034">crc_byte</a>(crc, *data++); <a name="l00492"></a>00492 <a name="l00493"></a>00493 <span class="keywordflow">return</span> crc; <a name="l00494"></a>00494 } <a name="l00495"></a>00495 <a name="l00496"></a><a class="code" href="serialsource_8c.html#cf87d6cb4539b2fbc47636ad5746b215">00496</a> <span class="keyword">static</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#cf87d6cb4539b2fbc47636ad5746b215">read_byte</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>) <a name="l00497"></a>00497 <span class="comment">/* Returns: next byte (>= 0), or -1 if no data available and the source</span> <a name="l00498"></a>00498 <span class="comment"> is non-blocking.</span> <a name="l00499"></a>00499 <span class="comment">*/</span> <a name="l00500"></a>00500 { <a name="l00501"></a>00501 <span class="keywordflow">if</span> (src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#69a24323561ddcb2c2b92c64c61f87db">bufpos</a> >= src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#b8d6ede76f8534de2d8c644ec65fbd2b">bufused</a>) <a name="l00502"></a>00502 { <a name="l00503"></a>00503 <span class="keywordflow">for</span> (;;) <a name="l00504"></a>00504 { <a name="l00505"></a>00505 <span class="keywordtype">int</span> n = <a class="code" href="serialsource_8c.html#68450065c541bc59ea2bd91fd039054a">buggyread</a>(src, src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#46a5cc21ef737375037d33b8033849dd">buffer</a>, <span class="keyword">sizeof</span> src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#46a5cc21ef737375037d33b8033849dd">buffer</a>); <a name="l00506"></a>00506 <span class="keywordflow">if</span> (n == 0) <span class="comment">/* Can't occur because of buggyread bug workaround */</span> <a name="l00507"></a>00507 { <a name="l00508"></a>00508 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b6400aef5624e43b2ca76b450011d2c7bd6b">msg_closed</a>); <a name="l00509"></a>00509 <span class="keywordflow">return</span> -1; <a name="l00510"></a>00510 } <a name="l00511"></a>00511 <span class="keywordflow">if</span> (n > 0) <a name="l00512"></a>00512 { <a name="l00513"></a>00513 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00514"></a>00514 <span class="preprocessor"></span> <a class="code" href="serialsource_8c.html#87b713d53023266d98d45b86312c26aa">dump</a>(<span class="stringliteral">"raw"</span>, src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#46a5cc21ef737375037d33b8033849dd">buffer</a>, n); <a name="l00515"></a>00515 <span class="preprocessor">#endif</span> <a name="l00516"></a>00516 <span class="preprocessor"></span> src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#69a24323561ddcb2c2b92c64c61f87db">bufpos</a> = 0; <a name="l00517"></a>00517 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#b8d6ede76f8534de2d8c644ec65fbd2b">bufused</a> = n; <a name="l00518"></a>00518 <span class="keywordflow">break</span>; <a name="l00519"></a>00519 } <a name="l00520"></a>00520 <span class="keywordflow">if</span> (<a class="code" href="IPDiscovery_8cc.html#d65a8842cc674e3ddf69355898c0ecbf">errno</a> == EAGAIN) <a name="l00521"></a>00521 <span class="keywordflow">return</span> -1; <a name="l00522"></a>00522 <span class="keywordflow">if</span> (<a class="code" href="IPDiscovery_8cc.html#d65a8842cc674e3ddf69355898c0ecbf">errno</a> != EINTR) <a name="l00523"></a>00523 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640e997903e7fd3c99317e9641835d74422">msg_unix_error</a>); <a name="l00524"></a>00524 } <a name="l00525"></a>00525 } <a name="l00526"></a>00526 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00527"></a>00527 <span class="preprocessor"></span> <span class="comment">//printf("in %02x\n", src->recv.buffer[src->recv.bufpos]);</span> <a name="l00528"></a>00528 <span class="preprocessor">#endif</span> <a name="l00529"></a>00529 <span class="preprocessor"></span> <span class="keywordflow">return</span> src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#46a5cc21ef737375037d33b8033849dd">buffer</a>[src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#69a24323561ddcb2c2b92c64c61f87db">bufpos</a>++]; <a name="l00530"></a>00530 } <a name="l00531"></a>00531 <a name="l00532"></a>00532 <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#1190e17e5be9e8a765bfec234db812cc">process_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, uint8_t *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>, <span class="keywordtype">int</span> <a class="code" href="num2sdnv_8c.html#fed088663f8704004425cdae2120b9b3">len</a>); <a name="l00533"></a>00533 <span class="keyword">static</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#fa4b3d2f3e7fb675ceab96e7efb2e67a">write_framed_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <a name="l00534"></a>00534 uint8_t packet_type, uint8_t first_byte, <a name="l00535"></a>00535 <span class="keyword">const</span> uint8_t *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>, <span class="keywordtype">int</span> <a class="code" href="dtnping_8c.html#d43c3812e6d13e0518d9f8b8f463ffcf">count</a>); <a name="l00536"></a>00536 <a name="l00537"></a><a class="code" href="serialsource_8c.html#64240c7a122bcd1964e4fbbca6c96808">00537</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#64240c7a122bcd1964e4fbbca6c96808">read_and_process</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>) <a name="l00538"></a>00538 <span class="comment">/* Effects: reads and processes up to one packet.</span> <a name="l00539"></a>00539 <span class="comment">*/</span> <a name="l00540"></a>00540 { <a name="l00541"></a>00541 uint8_t *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a> = src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#158912e48a804a855221eb8a3f0c2d3d">packet</a>; <a name="l00542"></a>00542 <a name="l00543"></a>00543 <span class="keywordflow">for</span> (;;) <a name="l00544"></a>00544 { <a name="l00545"></a>00545 <span class="keywordtype">int</span> byte = <a class="code" href="serialsource_8c.html#cf87d6cb4539b2fbc47636ad5746b215">read_byte</a>(src); <a name="l00546"></a>00546 <a name="l00547"></a>00547 <span class="keywordflow">if</span> (byte < 0) <a name="l00548"></a>00548 <span class="keywordflow">return</span>; <a name="l00549"></a>00549 <a name="l00550"></a>00550 <span class="keywordflow">if</span> (!src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#5920c42528e15ab26db30d3c88ccb61a">in_sync</a>) <a name="l00551"></a>00551 { <a name="l00552"></a>00552 <span class="keywordflow">if</span> (byte == <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">SYNC_BYTE</a>) <a name="l00553"></a>00553 { <a name="l00554"></a>00554 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00555"></a>00555 <span class="preprocessor"></span> printf(<span class="stringliteral">"out of sync: received SYNC_BYTE\n"</span>); <a name="l00556"></a>00556 <span class="preprocessor">#endif</span> <a name="l00557"></a>00557 <span class="preprocessor"></span> src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#5920c42528e15ab26db30d3c88ccb61a">in_sync</a> = <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a82764c3079aea4e60c80e45befbb839">TRUE</a>; <a name="l00558"></a>00558 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640b901edba7e44ef5b3a94da2354ca7f39">msg_sync</a>); <a name="l00559"></a>00559 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#9a89edf4a51349f655155785d5113f02">count</a> = 0; <a name="l00560"></a>00560 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a> = <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a1e095cc966dbecf6a0d8aad75348d1a">FALSE</a>; <a name="l00561"></a>00561 } <a name="l00562"></a>00562 <span class="keywordflow">continue</span>; <a name="l00563"></a>00563 } <a name="l00564"></a>00564 <span class="keywordflow">if</span> (src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#9a89edf4a51349f655155785d5113f02">count</a> >= <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57d700abc3cfb69e46430ab97a3722ac9f">MTU</a>) <a name="l00565"></a>00565 { <a name="l00566"></a>00566 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00567"></a>00567 <span class="preprocessor"></span> printf(<span class="stringliteral">"MTU exceeded\n"</span>); <a name="l00568"></a>00568 <span class="preprocessor">#endif</span> <a name="l00569"></a>00569 <span class="preprocessor"></span> <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640059f9acc718f1249381695305c6318d6">msg_too_long</a>); <a name="l00570"></a>00570 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#5920c42528e15ab26db30d3c88ccb61a">in_sync</a> = <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a1e095cc966dbecf6a0d8aad75348d1a">FALSE</a>; <a name="l00571"></a>00571 <span class="keywordflow">continue</span>; <a name="l00572"></a>00572 } <a name="l00573"></a>00573 <span class="keywordflow">if</span> (src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>) <a name="l00574"></a>00574 { <a name="l00575"></a>00575 <span class="keywordflow">if</span> (byte == <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">SYNC_BYTE</a>) <a name="l00576"></a>00576 { <a name="l00577"></a>00577 <span class="comment">/* sync byte following escape is an error, resync */</span> <a name="l00578"></a>00578 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b6407cf8a46ffe9feae3d810dc97122ca118">msg_bad_sync</a>); <a name="l00579"></a>00579 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#5920c42528e15ab26db30d3c88ccb61a">in_sync</a> = <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a1e095cc966dbecf6a0d8aad75348d1a">FALSE</a>; <a name="l00580"></a>00580 <span class="keywordflow">continue</span>; <a name="l00581"></a>00581 } <a name="l00582"></a>00582 byte ^= 0x20; <a name="l00583"></a>00583 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a> = <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a1e095cc966dbecf6a0d8aad75348d1a">FALSE</a>; <a name="l00584"></a>00584 } <a name="l00585"></a>00585 <span class="keywordflow">else</span> <span class="keywordflow">if</span> (byte == <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ce933af229dd927b9447b6c3b62e1b21">ESCAPE_BYTE</a>) <a name="l00586"></a>00586 { <a name="l00587"></a>00587 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00588"></a>00588 <span class="preprocessor"></span> printf(<span class="stringliteral">"sync'ed: ESCAPE_BYTE\n"</span>); <a name="l00589"></a>00589 <span class="preprocessor">#endif</span> <a name="l00590"></a>00590 <span class="preprocessor"></span> src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a> = <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57a82764c3079aea4e60c80e45befbb839">TRUE</a>; <a name="l00591"></a>00591 <span class="keywordflow">continue</span>; <a name="l00592"></a>00592 } <a name="l00593"></a>00593 <span class="keywordflow">else</span> <span class="keywordflow">if</span> (byte == <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">SYNC_BYTE</a>) <a name="l00594"></a>00594 { <a name="l00595"></a>00595 <span class="keywordtype">int</span> <a class="code" href="dtnping_8c.html#d43c3812e6d13e0518d9f8b8f463ffcf">count</a> = src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#9a89edf4a51349f655155785d5113f02">count</a>; <a name="l00596"></a>00596 uint8_t *received; <a name="l00597"></a>00597 uint16_t read_crc, computed_crc; <a name="l00598"></a>00598 <a name="l00599"></a>00599 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00600"></a>00600 <span class="preprocessor"></span> printf(<span class="stringliteral">"sync'ed: SYNC_BYTE received\n"</span>); <a name="l00601"></a>00601 <span class="preprocessor">#endif</span> <a name="l00602"></a>00602 <span class="preprocessor"></span> <a name="l00603"></a>00603 src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#9a89edf4a51349f655155785d5113f02">count</a> = 0; <span class="comment">/* ready for next packet */</span> <a name="l00604"></a>00604 <a name="l00605"></a>00605 <span class="keywordflow">if</span> (count < 4) <a name="l00606"></a>00606 <span class="comment">/* frames that are too small are ignored */</span> <a name="l00607"></a>00607 <span class="keywordflow">continue</span>; <a name="l00608"></a>00608 <a name="l00609"></a>00609 received = malloc(count - 2); <a name="l00610"></a>00610 <span class="keywordflow">if</span> (!received) <a name="l00611"></a>00611 { <a name="l00612"></a>00612 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b64043799e5977806a4559729141f049150c">msg_no_memory</a>); <a name="l00613"></a>00613 <span class="keywordflow">continue</span>; <a name="l00614"></a>00614 } <a name="l00615"></a>00615 memcpy(received, packet, count - 2); <a name="l00616"></a>00616 <a name="l00617"></a>00617 read_crc = packet[count - 2] | packet[count - 1] << 8; <a name="l00618"></a>00618 computed_crc = <a class="code" href="serialsource_8c.html#8cfd5e2eaf30c88a606c75fe2f577a8f">crc_packet</a>(received, count - 2); <a name="l00619"></a>00619 <a name="l00620"></a>00620 <span class="comment">/* printf("%d: ",count);</span> <a name="l00621"></a>00621 <span class="comment"> int j;</span> <a name="l00622"></a>00622 <span class="comment"> for(j=0;j<count;j++)</span> <a name="l00623"></a>00623 <span class="comment"> printf("%02x ",packet[j]);</span> <a name="l00624"></a>00624 <span class="comment"> putchar('\n');</span> <a name="l00625"></a>00625 <span class="comment">*/</span> <a name="l00626"></a>00626 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00627"></a>00627 <span class="preprocessor"></span> <span class="comment">// dump("received", packet, count);</span> <a name="l00628"></a>00628 printf(<span class="stringliteral">" crc %x comp %x\n"</span>, read_crc, computed_crc); <a name="l00629"></a>00629 <span class="preprocessor">#endif</span> <a name="l00630"></a>00630 <span class="preprocessor"></span> <span class="keywordflow">if</span> (read_crc == computed_crc) <a name="l00631"></a>00631 { <a name="l00632"></a>00632 <a class="code" href="serialsource_8c.html#1190e17e5be9e8a765bfec234db812cc">process_packet</a>(src, received, count - 2); <a name="l00633"></a>00633 <span class="keywordflow">return</span>; <span class="comment">/* give rest of world chance to do something */</span> <a name="l00634"></a>00634 } <a name="l00635"></a>00635 <span class="keywordflow">else</span> <a name="l00636"></a>00636 { <a name="l00637"></a>00637 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b640dd5436d5122a3164349104347834e117">msg_bad_crc</a>); <a name="l00638"></a>00638 <span class="comment">/* We don't lose sync here. If we did, garbage on the line</span> <a name="l00639"></a>00639 <span class="comment"> at startup will cause loss of the first packet. */</span> <a name="l00640"></a>00640 <span class="keywordflow">continue</span>; <a name="l00641"></a>00641 } <a name="l00642"></a>00642 } <a name="l00643"></a>00643 packet[src-><a class="code" href="structserial__source.html#292f94cd16d6dcc1da81db3a586818a1">recv</a>.<a class="code" href="structserial__source.html#9a89edf4a51349f655155785d5113f02">count</a>++] = byte; <a name="l00644"></a>00644 } <a name="l00645"></a>00645 } <a name="l00646"></a>00646 <a name="l00647"></a><a class="code" href="serialsource_8c.html#1190e17e5be9e8a765bfec234db812cc">00647</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#1190e17e5be9e8a765bfec234db812cc">process_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, uint8_t *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>, <span class="keywordtype">int</span> <a class="code" href="num2sdnv_8c.html#fed088663f8704004425cdae2120b9b3">len</a>) <a name="l00648"></a>00648 { <a name="l00649"></a>00649 <span class="keywordtype">int</span> packet_type = packet[0], offset = 1; <a name="l00650"></a>00650 <span class="comment">// the extra cast to void* is needed to circumvent gcc warnings </span> <a name="l00651"></a>00651 <span class="comment">// about unsafe casting</span> <a name="l00652"></a>00652 <a class="code" href="structtos__header.html">tos_header</a> * header = (<a class="code" href="structtos__header.html">tos_header</a> *) ((<span class="keywordtype">void</span>*)packet); <a name="l00653"></a>00653 <a class="code" href="structOscopeMsg.html">OscopeMsg</a> * msg; <a name="l00654"></a>00654 <span class="keywordtype">void</span>* <a class="code" href="num2sdnv_8c.html#a81cdcc7ff6987bc85c073253e32715f">buf</a>; <a name="l00655"></a>00655 <a class="code" href="structtos__header.html">tos_header</a> * buf_header; <a name="l00656"></a>00656 <a class="code" href="structOscopeAck.html">OscopeAck</a> * ack; <a name="l00657"></a>00657 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00658"></a>00658 <span class="preprocessor"></span> <a class="code" href="serialsource_8c.html#87b713d53023266d98d45b86312c26aa">dump</a>(<span class="stringliteral">"process_packet"</span>, packet, len); <a name="l00659"></a>00659 <span class="preprocessor">#endif</span> <a name="l00660"></a>00660 <span class="preprocessor"></span> <a name="l00661"></a>00661 <span class="comment">// ack oscope messages</span> <a name="l00662"></a>00662 <span class="keywordflow">if</span> (header-><a class="code" href="structtos__header.html#7c343e15c3ac8ed495e5a9fbb63226e2">handler</a> == <a class="code" href="OscopeMsg_8h.html#bed82baf7f470b522273a3e37c24c6005b505a6f402f6cb002c38c6f450f703b">AM_OSCOPEMSG</a>) <a name="l00663"></a>00663 { <a name="l00664"></a>00664 msg = (<a class="code" href="structOscopeMsg.html">OscopeMsg</a> *) ((<span class="keywordtype">void</span>*)packet) + <span class="keyword">sizeof</span>(<a class="code" href="structtos__header.html">tos_header</a>); <a name="l00665"></a>00665 <a name="l00666"></a>00666 buf = malloc(<span class="keyword">sizeof</span>( <a class="code" href="structtos__header.html">tos_header</a>) + <span class="keyword">sizeof</span>( <a class="code" href="structOscopeAck.html">OscopeAck</a>)); <a name="l00667"></a>00667 buf_header = (<a class="code" href="structtos__header.html">tos_header</a> *) buf; <a name="l00668"></a>00668 ack = (<a class="code" href="structOscopeAck.html">OscopeAck</a> *) (buf + <span class="keyword">sizeof</span>( <a class="code" href="structtos__header.html">tos_header</a>)); <a name="l00669"></a>00669 buf_header-><a class="code" href="structtos__header.html#44b390d0b8b1c0c71edd31f542440f17">dest_id</a> = ack-><a class="code" href="structOscopeAck.html#53209daa76e46ad97fe20c277e059e02">sourceMoteID</a>; <a name="l00670"></a>00670 buf_header-><a class="code" href="structtos__header.html#7c343e15c3ac8ed495e5a9fbb63226e2">handler</a> = <a class="code" href="OscopeMsg_8h.html#bed82baf7f470b522273a3e37c24c600a227dae3b247a95fec37e45830d172c4">AM_OSCOPEACK</a>; <a name="l00671"></a>00671 buf_header-><a class="code" href="structtos__header.html#b2fffd69a87b45ebd060da6a02693eb9">group_id</a> = header-><a class="code" href="structtos__header.html#b2fffd69a87b45ebd060da6a02693eb9">group_id</a>; <a name="l00672"></a>00672 buf_header-><a class="code" href="structtos__header.html#f05404a2fc3ce1d53b5ab3d831c256eb">length</a> = <span class="keyword">sizeof</span>( <a class="code" href="structtos__header.html">tos_header</a>) + <span class="keyword">sizeof</span>( <a class="code" href="structOscopeAck.html">OscopeAck</a>); <a name="l00673"></a>00673 <a name="l00674"></a>00674 ack-><a class="code" href="structOscopeAck.html#53209daa76e46ad97fe20c277e059e02">sourceMoteID</a> = msg-><a class="code" href="structOscopeMsg.html#221a687096f820994f4a33e19f488b0c">sourceMoteID</a>; <a name="l00675"></a>00675 ack-><a class="code" href="structOscopeAck.html#76c6f2ce388798e558e6ec23516eaf6c">lastSampleNumber</a> = msg-><a class="code" href="structOscopeMsg.html#a515841d75b29179e49f225d5bbaaa3b">lastSampleNumber</a>; <a name="l00676"></a>00676 ack-><a class="code" href="structOscopeAck.html#be664b6347c9e8fb795f010564cb08a6">channel</a> = msg-><a class="code" href="structOscopeMsg.html#fd083da497c94fc3b357bc05100be86d">channel</a>; <a name="l00677"></a>00677 <a name="l00678"></a>00678 <a class="code" href="serialsource_8c.html#eebe330155e6cd027ac65ee6ed73c2db">write_serial_packet</a>(src, buf, buf_header-><a class="code" href="structtos__header.html#f05404a2fc3ce1d53b5ab3d831c256eb">length</a>); <a name="l00679"></a>00679 } <a name="l00680"></a>00680 <a name="l00681"></a>00681 <span class="keywordflow">if</span> (packet_type == <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5708f3333fc70a32f3ae8a949eb56b958b">P_PACKET_ACK</a>) <a name="l00682"></a>00682 { <a name="l00683"></a>00683 <span class="comment">/* send ack */</span> <a name="l00684"></a>00684 <a class="code" href="serialsource_8c.html#fa4b3d2f3e7fb675ceab96e7efb2e67a">write_framed_packet</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a574f3b63ddf2a4e18f1e927caea575d19b">P_ACK</a>, packet[1], NULL, 0); <a name="l00685"></a>00685 <span class="comment">/* And merge with un-acked packets */</span> <a name="l00686"></a>00686 packet_type = <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5772698231a632310fb99f1ee9e8462de3">P_PACKET_NO_ACK</a>; <a name="l00687"></a>00687 offset = 2; <a name="l00688"></a>00688 } <a name="l00689"></a>00689 <a name="l00690"></a>00690 <span class="comment">/* packet must remain a valid pointer to pass to free. So we move the</span> <a name="l00691"></a>00691 <span class="comment"> data rather than pass an internal pointer */</span> <a name="l00692"></a>00692 memmove(packet, packet + offset, len - offset); <a name="l00693"></a>00693 <a class="code" href="serialsource_8c.html#ce5b91440dc716f126412681208add12">push_protocol_packet</a>(src, packet_type, packet, len - offset); <a name="l00694"></a>00694 } <a name="l00695"></a>00695 <a name="l00696"></a><a class="code" href="serialsource_8h.html#ecafeccd1e584af0ad57764d1b05c962">00696</a> <span class="keywordtype">void</span> *<a class="code" href="serialsource_8c.html#ecafeccd1e584af0ad57764d1b05c962">read_serial_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <span class="keywordtype">int</span> *<a class="code" href="num2sdnv_8c.html#fed088663f8704004425cdae2120b9b3">len</a>) <a name="l00697"></a>00697 <span class="comment">/* Effects: Read the serial source src. If a packet is available, return it.</span> <a name="l00698"></a>00698 <span class="comment"> If in blocking mode and no packet is available, wait for one.</span> <a name="l00699"></a>00699 <span class="comment"> Returns: the packet read (in newly allocated memory), with *len is</span> <a name="l00700"></a>00700 <span class="comment"> set to the packet length, or NULL if no packet is yet available and</span> <a name="l00701"></a>00701 <span class="comment"> the serial source is in non-blocking mode</span> <a name="l00702"></a>00702 <span class="comment">*/</span> <a name="l00703"></a>00703 { <a name="l00704"></a>00704 <span class="keywordflow">for</span> (;;) <a name="l00705"></a>00705 { <a name="l00706"></a>00706 <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> *entry; <a name="l00707"></a>00707 <a name="l00708"></a>00708 <a class="code" href="serialsource_8c.html#64240c7a122bcd1964e4fbbca6c96808">read_and_process</a>(src); <a name="l00709"></a>00709 entry = <a class="code" href="serialsource_8c.html#5b8211af1029bd001448033b51b290ae">pop_protocol_packet</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5772698231a632310fb99f1ee9e8462de3">P_PACKET_NO_ACK</a>); <a name="l00710"></a>00710 <span class="keywordflow">if</span> (entry) <a name="l00711"></a>00711 { <a name="l00712"></a>00712 uint8_t *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a> = entry-><a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>; <a name="l00713"></a>00713 <a name="l00714"></a>00714 *len = entry-><a class="code" href="structpacket__list.html#cbb06615ddf106f2ce9eea697c516c92">len</a>; <a name="l00715"></a>00715 free(entry); <a name="l00716"></a>00716 <a name="l00717"></a>00717 <span class="keywordflow">return</span> packet; <a name="l00718"></a>00718 } <a name="l00719"></a>00719 <span class="keywordflow">if</span> (src-><a class="code" href="structserial__source.html#d6e9b9bcdf86bed01710561c076f6fed">non_blocking</a> && <a class="code" href="serialsource_8c.html#1e56d589bd8f636209b2b9704f3ab6e9">serial_source_empty</a>(src)) <a name="l00720"></a>00720 <span class="keywordflow">return</span> NULL; <a name="l00721"></a>00721 <a class="code" href="serialsource_8c.html#0c16130ea7050506ac115d1c82a3e782">source_wait</a>(src, NULL); <a name="l00722"></a>00722 } <a name="l00723"></a>00723 } <a name="l00724"></a>00724 <a name="l00725"></a>00725 <span class="comment">/* The escaper does the sync bytes+escape-like encoding+crc of packets */</span> <a name="l00726"></a>00726 <a name="l00727"></a><a class="code" href="serialsource_8c.html#f7ee4595cfd1d0482a59ff64bf6ee7a8">00727</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#f7ee4595cfd1d0482a59ff64bf6ee7a8">escape_add</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, uint8_t b) <a name="l00728"></a>00728 { <a name="l00729"></a>00729 src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>[src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#0282f946d115772fa7d13cdd8b0276bd">escapeptr</a>++] = b; <a name="l00730"></a>00730 } <a name="l00731"></a>00731 <a name="l00732"></a><a class="code" href="serialsource_8c.html#6250d7b3f9bc084b41f777a106aa70ad">00732</a> <span class="keyword">static</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#6250d7b3f9bc084b41f777a106aa70ad">init_escaper</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <span class="keywordtype">int</span> <a class="code" href="dtnping_8c.html#d43c3812e6d13e0518d9f8b8f463ffcf">count</a>) <a name="l00733"></a>00733 { <a name="l00734"></a>00734 src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a> = malloc(count * 2 + 2); <a name="l00735"></a>00735 <span class="keywordflow">if</span> (!src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>) <a name="l00736"></a>00736 { <a name="l00737"></a>00737 <a class="code" href="serialsource_8c.html#dce261c6a0421cc69b6a6ff86f5be7dd">message</a>(src, <a class="code" href="serialsource_8h.html#606dc90f6ac5ac49f0296e9b7111b64043799e5977806a4559729141f049150c">msg_no_memory</a>); <a name="l00738"></a>00738 <span class="keywordflow">return</span> -1; <a name="l00739"></a>00739 } <a name="l00740"></a>00740 src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#0282f946d115772fa7d13cdd8b0276bd">escapeptr</a> = 0; <a name="l00741"></a>00741 src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#198e4b9a2e8c8a92de6adc41915d45d3">crc</a> = 0; <a name="l00742"></a>00742 <a name="l00743"></a>00743 <a class="code" href="serialsource_8c.html#f7ee4595cfd1d0482a59ff64bf6ee7a8">escape_add</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">SYNC_BYTE</a>); <a name="l00744"></a>00744 <a name="l00745"></a>00745 <span class="keywordflow">return</span> 0; <a name="l00746"></a>00746 } <a name="l00747"></a>00747 <a name="l00748"></a><a class="code" href="serialsource_8c.html#f7cb708918ce7e28db343fe0fb8ed594">00748</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#f7cb708918ce7e28db343fe0fb8ed594">terminate_escaper</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>) <a name="l00749"></a>00749 { <a name="l00750"></a>00750 <a class="code" href="serialsource_8c.html#f7ee4595cfd1d0482a59ff64bf6ee7a8">escape_add</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">SYNC_BYTE</a>); <a name="l00751"></a>00751 } <a name="l00752"></a>00752 <a name="l00753"></a><a class="code" href="serialsource_8c.html#326a16701b15f2247d1899584837a0cc">00753</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#326a16701b15f2247d1899584837a0cc">escape_byte</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, uint8_t b) <a name="l00754"></a>00754 { <a name="l00755"></a>00755 src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#198e4b9a2e8c8a92de6adc41915d45d3">crc</a> = <a class="code" href="serialsource_8c.html#8b3f01398d0cedfec4af06dc2aa8e034">crc_byte</a>(src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#198e4b9a2e8c8a92de6adc41915d45d3">crc</a>, b); <a name="l00756"></a>00756 <span class="keywordflow">if</span> (b == <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57c378ac83d2af71410022932a88887324">SYNC_BYTE</a> || b == <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ce933af229dd927b9447b6c3b62e1b21">ESCAPE_BYTE</a>) <a name="l00757"></a>00757 { <a name="l00758"></a>00758 <a class="code" href="serialsource_8c.html#f7ee4595cfd1d0482a59ff64bf6ee7a8">escape_add</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ce933af229dd927b9447b6c3b62e1b21">ESCAPE_BYTE</a>); <a name="l00759"></a>00759 <a class="code" href="serialsource_8c.html#f7ee4595cfd1d0482a59ff64bf6ee7a8">escape_add</a>(src, b ^ 0x20); <a name="l00760"></a>00760 } <a name="l00761"></a>00761 <span class="keywordflow">else</span> <a name="l00762"></a>00762 <a class="code" href="serialsource_8c.html#f7ee4595cfd1d0482a59ff64bf6ee7a8">escape_add</a>(src, b); <a name="l00763"></a>00763 } <a name="l00764"></a>00764 <a name="l00765"></a><a class="code" href="serialsource_8c.html#d8b29298a5778a1491030623f7bfc0f3">00765</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#d8b29298a5778a1491030623f7bfc0f3">free_escaper</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>) <a name="l00766"></a>00766 { <a name="l00767"></a>00767 free(src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>); <a name="l00768"></a>00768 } <a name="l00769"></a>00769 <a name="l00770"></a>00770 <span class="comment">// Write a packet of type 'packetType', first byte 'firstByte'</span> <a name="l00771"></a>00771 <span class="comment">// and bytes 2..'count'+1 in 'packet'</span> <a name="l00772"></a><a class="code" href="serialsource_8c.html#fa4b3d2f3e7fb675ceab96e7efb2e67a">00772</a> <span class="keyword">static</span> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#fa4b3d2f3e7fb675ceab96e7efb2e67a">write_framed_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <a name="l00773"></a>00773 uint8_t packet_type, uint8_t first_byte, <a name="l00774"></a>00774 <span class="keyword">const</span> uint8_t *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>, <span class="keywordtype">int</span> <a class="code" href="dtnping_8c.html#d43c3812e6d13e0518d9f8b8f463ffcf">count</a>) <a name="l00775"></a>00775 { <a name="l00776"></a>00776 <span class="keywordtype">int</span> i, crc; <a name="l00777"></a>00777 <a name="l00778"></a>00778 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00779"></a>00779 <span class="preprocessor"></span> printf(<span class="stringliteral">"writing %02x %02x"</span>, packet_type, first_byte); <a name="l00780"></a>00780 <a class="code" href="serialsource_8c.html#87b713d53023266d98d45b86312c26aa">dump</a>(<span class="stringliteral">"writing"</span>, packet, count); <a name="l00781"></a>00781 <span class="preprocessor">#endif</span> <a name="l00782"></a>00782 <span class="preprocessor"></span> <a name="l00783"></a>00783 <span class="keywordflow">if</span> (<a class="code" href="serialsource_8c.html#6250d7b3f9bc084b41f777a106aa70ad">init_escaper</a>(src, count + 4) < 0) <a name="l00784"></a>00784 <span class="keywordflow">return</span> -1; <a name="l00785"></a>00785 <a name="l00786"></a>00786 <a class="code" href="serialsource_8c.html#326a16701b15f2247d1899584837a0cc">escape_byte</a>(src, packet_type); <a name="l00787"></a>00787 <a class="code" href="serialsource_8c.html#326a16701b15f2247d1899584837a0cc">escape_byte</a>(src, first_byte); <a name="l00788"></a>00788 <span class="keywordflow">for</span> (i = 0; i < count; i++) <a name="l00789"></a>00789 <a class="code" href="serialsource_8c.html#326a16701b15f2247d1899584837a0cc">escape_byte</a>(src, packet[i]); <a name="l00790"></a>00790 <a name="l00791"></a>00791 crc = src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#198e4b9a2e8c8a92de6adc41915d45d3">crc</a>; <a name="l00792"></a>00792 <a class="code" href="serialsource_8c.html#326a16701b15f2247d1899584837a0cc">escape_byte</a>(src, crc & 0xff); <a name="l00793"></a>00793 <a class="code" href="serialsource_8c.html#326a16701b15f2247d1899584837a0cc">escape_byte</a>(src, crc >> 8); <a name="l00794"></a>00794 <a name="l00795"></a>00795 <a class="code" href="serialsource_8c.html#f7cb708918ce7e28db343fe0fb8ed594">terminate_escaper</a>(src); <a name="l00796"></a>00796 <a name="l00797"></a>00797 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00798"></a>00798 <span class="preprocessor"></span> <a class="code" href="serialsource_8c.html#87b713d53023266d98d45b86312c26aa">dump</a>(<span class="stringliteral">"encoded"</span>, src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>, src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#0282f946d115772fa7d13cdd8b0276bd">escapeptr</a>); <a name="l00799"></a>00799 <span class="preprocessor">#endif</span> <a name="l00800"></a>00800 <span class="preprocessor"></span> <a name="l00801"></a>00801 <span class="keywordflow">if</span> (<a class="code" href="serialsource_8c.html#212ca0926806ffe103d4cbd20ac65fcf">source_write</a>(src, src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#c5cf0c8f1bde65b0243955f5e2e526e6">escaped</a>, src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#0282f946d115772fa7d13cdd8b0276bd">escapeptr</a>) < 0) <a name="l00802"></a>00802 { <a name="l00803"></a>00803 <a class="code" href="serialsource_8c.html#d8b29298a5778a1491030623f7bfc0f3">free_escaper</a>(src); <a name="l00804"></a>00804 <span class="keywordflow">return</span> -1; <a name="l00805"></a>00805 } <a name="l00806"></a>00806 <a class="code" href="serialsource_8c.html#d8b29298a5778a1491030623f7bfc0f3">free_escaper</a>(src); <a name="l00807"></a>00807 <span class="keywordflow">return</span> 0; <a name="l00808"></a>00808 } <a name="l00809"></a>00809 <a name="l00810"></a><a class="code" href="serialsource_8c.html#a26bc69f2db76fd01693c9cec8f146ad">00810</a> <span class="keyword">static</span> <span class="keywordtype">void</span> <a class="code" href="serialsource_8c.html#a26bc69f2db76fd01693c9cec8f146ad">add_timeval</a>(<span class="keyword">struct</span> timeval *tv, <span class="keywordtype">long</span> us) <a name="l00811"></a>00811 <span class="comment">/* Specialised for this app */</span> <a name="l00812"></a>00812 { <a name="l00813"></a>00813 tv->tv_sec += us / 1000000; <a name="l00814"></a>00814 tv->tv_usec += us % 1000000; <a name="l00815"></a>00815 <span class="keywordflow">if</span> (tv->tv_usec > 1000000) <a name="l00816"></a>00816 { <a name="l00817"></a>00817 tv->tv_usec -= 1000000; <a name="l00818"></a>00818 tv->tv_sec++; <a name="l00819"></a>00819 } <a name="l00820"></a>00820 } <a name="l00821"></a>00821 <a name="l00822"></a><a class="code" href="serialsource_8h.html#eebe330155e6cd027ac65ee6ed73c2db">00822</a> <span class="keywordtype">int</span> <a class="code" href="serialsource_8c.html#eebe330155e6cd027ac65ee6ed73c2db">write_serial_packet</a>(<a class="code" href="structserial__source.html">serial_source</a> <a class="code" href="dtnmoteproxy_8c.html#e1ade0f5a1b32f6c8be72f31a99e2a18">src</a>, <span class="keyword">const</span> <span class="keywordtype">void</span> *<a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>, <span class="keywordtype">int</span> <a class="code" href="num2sdnv_8c.html#fed088663f8704004425cdae2120b9b3">len</a>) <a name="l00823"></a>00823 <span class="comment">/* Effects: writes len byte packet to serial source src</span> <a name="l00824"></a>00824 <span class="comment"> Returns: 0 if packet successfully written, 1 if successfully written</span> <a name="l00825"></a>00825 <span class="comment"> but not acknowledged, -1 otherwise</span> <a name="l00826"></a>00826 <span class="comment">*/</span> <a name="l00827"></a>00827 { <a name="l00828"></a>00828 <span class="keyword">struct </span>timeval deadline; <a name="l00829"></a>00829 <a name="l00830"></a>00830 <span class="preprocessor">#ifdef DEBUG</span> <a name="l00831"></a>00831 <span class="preprocessor"></span> <a class="code" href="serialsource_8c.html#87b713d53023266d98d45b86312c26aa">dump</a>(<span class="stringliteral">"write"</span>, packet, len); <a name="l00832"></a>00832 <span class="preprocessor">#endif</span> <a name="l00833"></a>00833 <span class="preprocessor"></span> <a name="l00834"></a>00834 src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#a98862af52126058f75deb0f5b98ca12">seqno</a>++; <a name="l00835"></a>00835 <span class="keywordflow">if</span> (<a class="code" href="serialsource_8c.html#fa4b3d2f3e7fb675ceab96e7efb2e67a">write_framed_packet</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a5708f3333fc70a32f3ae8a949eb56b958b">P_PACKET_ACK</a>, src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#a98862af52126058f75deb0f5b98ca12">seqno</a>, packet, len) < 0) <a name="l00836"></a>00836 <span class="keywordflow">return</span> -1; <a name="l00837"></a>00837 <a name="l00838"></a>00838 <a class="code" href="namespacedtnsim.html#372b0bd474085f20b38efbbade7ce72a" title="Override gettimeofday to return the simulator time.">gettimeofday</a>(&deadline, NULL); <a name="l00839"></a>00839 <a class="code" href="serialsource_8c.html#a26bc69f2db76fd01693c9cec8f146ad">add_timeval</a>(&deadline, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a57ff595877bbd211eb88cad853a13c5a9c">ACK_TIMEOUT</a>); <a name="l00840"></a>00840 <span class="keywordflow">for</span> (;;) <a name="l00841"></a>00841 { <a name="l00842"></a>00842 <span class="keyword">struct </span><a class="code" href="structpacket__list.html">packet_list</a> *entry; <a name="l00843"></a>00843 <a name="l00844"></a>00844 <a class="code" href="serialsource_8c.html#64240c7a122bcd1964e4fbbca6c96808">read_and_process</a>(src); <a name="l00845"></a>00845 entry = <a class="code" href="serialsource_8c.html#5b8211af1029bd001448033b51b290ae">pop_protocol_packet</a>(src, <a class="code" href="serialsource_8c.html#b04a0655cd1e3bcac5e8f48c18df1a574f3b63ddf2a4e18f1e927caea575d19b">P_ACK</a>); <a name="l00846"></a>00846 <span class="keywordflow">if</span> (entry) <a name="l00847"></a>00847 { <a name="l00848"></a>00848 uint8_t acked = entry-><a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>[0]; <a name="l00849"></a>00849 <a name="l00850"></a>00850 free(entry-><a class="code" href="structpacket__list.html#7a20c30fa1a9b96cd9270b6a6b7a016e">packet</a>); <a name="l00851"></a>00851 free(entry); <a name="l00852"></a>00852 <span class="keywordflow">if</span> (acked == src-><a class="code" href="structserial__source.html#ebd7b42167900ad2f3e2d43f3ab49656">send</a>.<a class="code" href="structserial__source.html#a98862af52126058f75deb0f5b98ca12">seqno</a>) <a name="l00853"></a>00853 <span class="keywordflow">return</span> 0; <a name="l00854"></a>00854 } <a name="l00855"></a>00855 <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="serialsource_8c.html#0c16130ea7050506ac115d1c82a3e782">source_wait</a>(src, &deadline) < 0) <a name="l00856"></a>00856 <span class="keywordflow">return</span> 1; <a name="l00857"></a>00857 } <a name="l00858"></a>00858 } </pre></div></div> <hr size="1"><address style="text-align: right;"><small>Generated on Mon Jul 21 14:09:47 2008 for DTN Reference Implementation by <a href="http://www.doxygen.org/index.html"> <img src="doxygen.png" alt="doxygen" align="middle" border="0"></a> 1.5.6 </small></address> </body> </html>