Yasushi TAUCHI / Mbed 2 deprecated temp_WebServer

Dependencies:   MSCUsbHost NetServices RPCInterface TextLCD mbed

NetServices/drv/at/ATIf.cpp@1:f2088fbce73f, 2012-08-22 (annotated)

Committer:
yueee_yt
Date:
Wed Aug 22 05:10:09 2012 +0000
Revision:
1:f2088fbce73f
Parent:
0:fd83f3540b1a 
???????LM35??????WebServer

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yueee_yt 0:fd83f3540b1a 1
yueee_yt 0:fd83f3540b1a 2 /*
yueee_yt 0:fd83f3540b1a 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
yueee_yt 0:fd83f3540b1a 4
yueee_yt 0:fd83f3540b1a 5 Permission is hereby granted, free of charge, to any person obtaining a copy
yueee_yt 0:fd83f3540b1a 6 of this software and associated documentation files (the "Software"), to deal
yueee_yt 0:fd83f3540b1a 7 in the Software without restriction, including without limitation the rights
yueee_yt 0:fd83f3540b1a 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
yueee_yt 0:fd83f3540b1a 9 copies of the Software, and to permit persons to whom the Software is
yueee_yt 0:fd83f3540b1a 10 furnished to do so, subject to the following conditions:
yueee_yt 0:fd83f3540b1a 11
yueee_yt 0:fd83f3540b1a 12 The above copyright notice and this permission notice shall be included in
yueee_yt 0:fd83f3540b1a 13 all copies or substantial portions of the Software.
yueee_yt 0:fd83f3540b1a 14
yueee_yt 0:fd83f3540b1a 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
yueee_yt 0:fd83f3540b1a 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
yueee_yt 0:fd83f3540b1a 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
yueee_yt 0:fd83f3540b1a 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
yueee_yt 0:fd83f3540b1a 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
yueee_yt 0:fd83f3540b1a 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
yueee_yt 0:fd83f3540b1a 21 THE SOFTWARE.
yueee_yt 0:fd83f3540b1a 22 */
yueee_yt 0:fd83f3540b1a 23
yueee_yt 0:fd83f3540b1a 24 #include "ATIf.h"
yueee_yt 0:fd83f3540b1a 25 #include "mbed.h"
yueee_yt 0:fd83f3540b1a 26 #include <cstdarg>
yueee_yt 0:fd83f3540b1a 27
yueee_yt 0:fd83f3540b1a 28 #define READ_TIMEOUT 100
yueee_yt 0:fd83f3540b1a 29 #define TMP_BUF_SIZE 128//512
yueee_yt 0:fd83f3540b1a 30
yueee_yt 0:fd83f3540b1a 31 #define SERIAL_BUF_LEN 512 //Huge buf needed for PPP (esp. when transferring big data chunks, using TCP)
yueee_yt 0:fd83f3540b1a 32
yueee_yt 0:fd83f3540b1a 33 #define BAUDRATE 9600//9600//115200// 19200
yueee_yt 0:fd83f3540b1a 34
yueee_yt 0:fd83f3540b1a 35 #include "netCfg.h"
yueee_yt 0:fd83f3540b1a 36 #if NET_GPRS
yueee_yt 0:fd83f3540b1a 37
yueee_yt 0:fd83f3540b1a 38 //#define __DEBUG
yueee_yt 0:fd83f3540b1a 39 #include "dbg/dbg.h"
yueee_yt 0:fd83f3540b1a 40
yueee_yt 0:fd83f3540b1a 41 ATIf::ATIf() : SerialBuf(SERIAL_BUF_LEN), m_isOpen(false)//, m_signalsEnable(false), m_isOpen(false), m_pCurrentSignal(NULL), m_signals()
yueee_yt 0:fd83f3540b1a 42 {
yueee_yt 0:fd83f3540b1a 43 DBG("New AT If@%p\n", this);
yueee_yt 0:fd83f3540b1a 44
yueee_yt 0:fd83f3540b1a 45 m_readTimeout = READ_TIMEOUT; //default 1s
yueee_yt 0:fd83f3540b1a 46 //tmpBuf = NULL;
yueee_yt 0:fd83f3540b1a 47 m_lineMode = false;
yueee_yt 0:fd83f3540b1a 48 m_tmpBuf = new char[TMP_BUF_SIZE];
yueee_yt 0:fd83f3540b1a 49 }
yueee_yt 0:fd83f3540b1a 50
yueee_yt 0:fd83f3540b1a 51 ATIf::~ATIf()
yueee_yt 0:fd83f3540b1a 52 {
yueee_yt 0:fd83f3540b1a 53 if(m_tmpBuf)
yueee_yt 0:fd83f3540b1a 54 delete[] m_tmpBuf;
yueee_yt 0:fd83f3540b1a 55 }
yueee_yt 0:fd83f3540b1a 56
yueee_yt 0:fd83f3540b1a 57 int ATIf::printf(const char* format, ... )
yueee_yt 0:fd83f3540b1a 58 {
yueee_yt 0:fd83f3540b1a 59
yueee_yt 0:fd83f3540b1a 60 /*if(!m_tmpBuf)
yueee_yt 0:fd83f3540b1a 61 m_tmpBuf = new char[TMP_BUF_SIZE]; //is it really necessary ??*/
yueee_yt 0:fd83f3540b1a 62 *m_tmpBuf=0;
yueee_yt 0:fd83f3540b1a 63
yueee_yt 0:fd83f3540b1a 64 int len = 0;
yueee_yt 0:fd83f3540b1a 65
yueee_yt 0:fd83f3540b1a 66 //
yueee_yt 0:fd83f3540b1a 67 // flushBuffer();
yueee_yt 0:fd83f3540b1a 68 //wait(1);
yueee_yt 0:fd83f3540b1a 69 //
yueee_yt 0:fd83f3540b1a 70
yueee_yt 0:fd83f3540b1a 71 va_list argp;
yueee_yt 0:fd83f3540b1a 72
yueee_yt 0:fd83f3540b1a 73 va_start(argp, format);
yueee_yt 0:fd83f3540b1a 74 len += vsprintf(m_tmpBuf, format, argp);
yueee_yt 0:fd83f3540b1a 75 va_end(argp);
yueee_yt 0:fd83f3540b1a 76
yueee_yt 0:fd83f3540b1a 77 //DBG("\r\nOutBuf is : %s, mode is %d.", m_tmpBuf, m_lineMode);
yueee_yt 0:fd83f3540b1a 78
yueee_yt 0:fd83f3540b1a 79 int err = write( m_tmpBuf, m_lineMode );
yueee_yt 0:fd83f3540b1a 80 if (err<0)
yueee_yt 0:fd83f3540b1a 81 return 0;
yueee_yt 0:fd83f3540b1a 82
yueee_yt 0:fd83f3540b1a 83 return len;
yueee_yt 0:fd83f3540b1a 84
yueee_yt 0:fd83f3540b1a 85 }
yueee_yt 0:fd83f3540b1a 86
yueee_yt 0:fd83f3540b1a 87 int ATIf::scanf(const char* format, ... )
yueee_yt 0:fd83f3540b1a 88 {
yueee_yt 0:fd83f3540b1a 89 /*if(!m_tmpBuf)
yueee_yt 0:fd83f3540b1a 90 m_tmpBuf = new char[TMP_BUF_SIZE];*/
yueee_yt 0:fd83f3540b1a 91 int err = read( m_tmpBuf, TMP_BUF_SIZE - 1, m_readTimeout, m_lineMode, 1/*Ensure at least one char is read*/ );
yueee_yt 0:fd83f3540b1a 92 if (err<0)
yueee_yt 0:fd83f3540b1a 93 return -1;//EOF
yueee_yt 0:fd83f3540b1a 94
yueee_yt 0:fd83f3540b1a 95 DBG("Scanf'ing:\r\n%s\r\n",m_tmpBuf);
yueee_yt 0:fd83f3540b1a 96
yueee_yt 0:fd83f3540b1a 97 int len = 0;
yueee_yt 0:fd83f3540b1a 98
yueee_yt 0:fd83f3540b1a 99 if(strchr(format,'%')) //Ugly, determines wether format string is null or not
yueee_yt 0:fd83f3540b1a 100 {
yueee_yt 0:fd83f3540b1a 101 va_list argp;
yueee_yt 0:fd83f3540b1a 102
yueee_yt 0:fd83f3540b1a 103 va_start(argp, format);
yueee_yt 0:fd83f3540b1a 104 len += vsscanf(m_tmpBuf, format, argp);
yueee_yt 0:fd83f3540b1a 105 va_end(argp);
yueee_yt 0:fd83f3540b1a 106 }
yueee_yt 0:fd83f3540b1a 107 else //No varargs, call strncmp
yueee_yt 0:fd83f3540b1a 108 {
yueee_yt 0:fd83f3540b1a 109 /* if(strlen(m_tmpBuf) == 0 )
yueee_yt 0:fd83f3540b1a 110 return -1;*/
yueee_yt 0:fd83f3540b1a 111 if( !strncmp(m_tmpBuf, format, strlen(format)) )
yueee_yt 0:fd83f3540b1a 112 {
yueee_yt 0:fd83f3540b1a 113 return 0;
yueee_yt 0:fd83f3540b1a 114 }
yueee_yt 0:fd83f3540b1a 115 else
yueee_yt 0:fd83f3540b1a 116 {
yueee_yt 0:fd83f3540b1a 117 return -1;
yueee_yt 0:fd83f3540b1a 118 }
yueee_yt 0:fd83f3540b1a 119 }
yueee_yt 0:fd83f3540b1a 120
yueee_yt 0:fd83f3540b1a 121 return len;
yueee_yt 0:fd83f3540b1a 122
yueee_yt 0:fd83f3540b1a 123 }
yueee_yt 0:fd83f3540b1a 124
yueee_yt 0:fd83f3540b1a 125 void ATIf::setTimeout(int timeout) //used by scanf
yueee_yt 0:fd83f3540b1a 126 {
yueee_yt 0:fd83f3540b1a 127 m_readTimeout = timeout;
yueee_yt 0:fd83f3540b1a 128 }
yueee_yt 0:fd83f3540b1a 129
yueee_yt 0:fd83f3540b1a 130 void ATIf::setLineMode(bool lineMode) //Switch btw line & raw fns
yueee_yt 0:fd83f3540b1a 131 {
yueee_yt 0:fd83f3540b1a 132 m_lineMode = lineMode;
yueee_yt 0:fd83f3540b1a 133 }
yueee_yt 0:fd83f3540b1a 134
yueee_yt 0:fd83f3540b1a 135 #if 0
yueee_yt 0:fd83f3540b1a 136 void ATIf::setSignals(bool signalsEnable)
yueee_yt 0:fd83f3540b1a 137 {
yueee_yt 0:fd83f3540b1a 138 m_signalsEnable=signalsEnable;
yueee_yt 0:fd83f3540b1a 139 }
yueee_yt 0:fd83f3540b1a 140 #endif
yueee_yt 0:fd83f3540b1a 141
yueee_yt 0:fd83f3540b1a 142 #if 0
yueee_yt 0:fd83f3540b1a 143 template<class T>
yueee_yt 0:fd83f3540b1a 144 void ATIf::attachSignal( const char* sigName, T* pItem, bool (T::*pMethod)(ATIf*, bool, bool*) ) //Attach Signal ("Unsollicited response code" in Telit_AT_Reference_Guide.pdf) to an handler fn
yueee_yt 0:fd83f3540b1a 145 {
yueee_yt 0:fd83f3540b1a 146 ATSigHandler sig(sigName, (ATSigHandler::CDummy*)pItem, (bool (ATSigHandler::CDummy::*)(ATIf*, bool, bool*))pMethod);
yueee_yt 0:fd83f3540b1a 147 m_signals.push_back(sig);
yueee_yt 0:fd83f3540b1a 148 }
yueee_yt 0:fd83f3540b1a 149 #endif
yueee_yt 0:fd83f3540b1a 150
yueee_yt 0:fd83f3540b1a 151 #if 0
yueee_yt 0:fd83f3540b1a 152 void ATIf::detachSignal( const char* sigName )
yueee_yt 0:fd83f3540b1a 153 {
yueee_yt 0:fd83f3540b1a 154 list<ATSigHandler>::iterator it;
yueee_yt 0:fd83f3540b1a 155
yueee_yt 0:fd83f3540b1a 156 for ( it = m_signals.begin(); it != m_signals.end(); it++ )
yueee_yt 0:fd83f3540b1a 157 {
yueee_yt 0:fd83f3540b1a 158 if( !strcmp((*it).m_name,sigName) )
yueee_yt 0:fd83f3540b1a 159 {
yueee_yt 0:fd83f3540b1a 160 m_signals.erase(it);
yueee_yt 0:fd83f3540b1a 161 break;
yueee_yt 0:fd83f3540b1a 162 }
yueee_yt 0:fd83f3540b1a 163 }
yueee_yt 0:fd83f3540b1a 164 }
yueee_yt 0:fd83f3540b1a 165 #endif
yueee_yt 0:fd83f3540b1a 166
yueee_yt 0:fd83f3540b1a 167 ATErr ATIf::open(Serial* pSerial) //Deactivate echo, etc
yueee_yt 0:fd83f3540b1a 168 {
yueee_yt 0:fd83f3540b1a 169 DBG("Opening...\n");
yueee_yt 0:fd83f3540b1a 170 m_isOpen = true; //Must be set so that the serial port-related fns work
yueee_yt 0:fd83f3540b1a 171 //Setup options
yueee_yt 0:fd83f3540b1a 172 // pSerial->baud(BAUDRATE); //FIXME
yueee_yt 0:fd83f3540b1a 173 SerialBuf::attach(pSerial);
yueee_yt 0:fd83f3540b1a 174
yueee_yt 0:fd83f3540b1a 175 setReadMode(false); //Discard chars
yueee_yt 0:fd83f3540b1a 176 setTimeout(1000);
yueee_yt 0:fd83f3540b1a 177 setLineMode(true); //Line Mode
yueee_yt 0:fd83f3540b1a 178
yueee_yt 0:fd83f3540b1a 179 DBG("Trmt...\n");
yueee_yt 0:fd83f3540b1a 180 // printf("AT+IPR=%d", BAUDRATE); //FIXME
yueee_yt 0:fd83f3540b1a 181 printf("ATZ"); //Reset
yueee_yt 0:fd83f3540b1a 182 wait(.100);
yueee_yt 0:fd83f3540b1a 183 printf("ATE"); //Deactivate echo
yueee_yt 0:fd83f3540b1a 184 wait(.500);
yueee_yt 0:fd83f3540b1a 185 flushBuffer();
yueee_yt 0:fd83f3540b1a 186
yueee_yt 0:fd83f3540b1a 187 DBG("ATZ ATE...\n");
yueee_yt 0:fd83f3540b1a 188
yueee_yt 0:fd83f3540b1a 189 int len = writeLine("ATV1");
yueee_yt 0:fd83f3540b1a 190 ATErr err = AT_OK;
yueee_yt 0:fd83f3540b1a 191 if(len<0)
yueee_yt 0:fd83f3540b1a 192 err=(ATErr)len;
yueee_yt 0:fd83f3540b1a 193
yueee_yt 0:fd83f3540b1a 194 if(!err)
yueee_yt 0:fd83f3540b1a 195 {
yueee_yt 0:fd83f3540b1a 196 err = checkOK();
yueee_yt 0:fd83f3540b1a 197 if (err) //No ACK from module
yueee_yt 0:fd83f3540b1a 198 {
yueee_yt 0:fd83f3540b1a 199 DBG("\r\nOpening port, error %d.", err);
yueee_yt 0:fd83f3540b1a 200 if(err==AT_TIMEOUT)
yueee_yt 0:fd83f3540b1a 201 err = AT_NOANSWER;
yueee_yt 0:fd83f3540b1a 202 }
yueee_yt 0:fd83f3540b1a 203 }
yueee_yt 0:fd83f3540b1a 204
yueee_yt 0:fd83f3540b1a 205 if(err)
yueee_yt 0:fd83f3540b1a 206 {
yueee_yt 0:fd83f3540b1a 207 SerialBuf::detach();
yueee_yt 0:fd83f3540b1a 208 m_isOpen = false;
yueee_yt 0:fd83f3540b1a 209 return err;
yueee_yt 0:fd83f3540b1a 210 }
yueee_yt 0:fd83f3540b1a 211
yueee_yt 0:fd83f3540b1a 212 DBG("\r\nNo error.");
yueee_yt 0:fd83f3540b1a 213 #if 0//FIXME
yueee_yt 0:fd83f3540b1a 214 m_signalsEnable = true;
yueee_yt 0:fd83f3540b1a 215 #endif
yueee_yt 0:fd83f3540b1a 216 //FIXME:
yueee_yt 0:fd83f3540b1a 217 // m_pSerial->attach<ATIf>(this, &ATIf::onSerialInterrupt);
yueee_yt 0:fd83f3540b1a 218
yueee_yt 0:fd83f3540b1a 219 return AT_OK;
yueee_yt 0:fd83f3540b1a 220 }
yueee_yt 0:fd83f3540b1a 221
yueee_yt 0:fd83f3540b1a 222 #if NET_USB_SERIAL
yueee_yt 0:fd83f3540b1a 223 ATErr ATIf::open(UsbSerial* pUsbSerial) //Deactivate echo, etc
yueee_yt 0:fd83f3540b1a 224 {
yueee_yt 0:fd83f3540b1a 225 DBG("Opening...\n");
yueee_yt 0:fd83f3540b1a 226 m_isOpen = true; //Must be set so that the serial port-related fns work
yueee_yt 0:fd83f3540b1a 227 //Setup options
yueee_yt 0:fd83f3540b1a 228 SerialBuf::attach(pUsbSerial);
yueee_yt 0:fd83f3540b1a 229
yueee_yt 0:fd83f3540b1a 230 setReadMode(false); //Discard chars
yueee_yt 0:fd83f3540b1a 231 setTimeout(1000);
yueee_yt 0:fd83f3540b1a 232 setLineMode(true); //Line Mode
yueee_yt 0:fd83f3540b1a 233
yueee_yt 0:fd83f3540b1a 234 printf("ATZ"); //Reinit
yueee_yt 0:fd83f3540b1a 235 wait(.500);
yueee_yt 0:fd83f3540b1a 236 //flushBuffer();
yueee_yt 0:fd83f3540b1a 237 // printf("ATE0 ^CURC=0"); //Deactivate echo & notif
yueee_yt 0:fd83f3540b1a 238 printf("ATE0"); //Deactivate echo & notif
yueee_yt 0:fd83f3540b1a 239 wait(.500);
yueee_yt 0:fd83f3540b1a 240 flushBuffer();
yueee_yt 0:fd83f3540b1a 241
yueee_yt 0:fd83f3540b1a 242 DBG("ATZ ATE...\n");
yueee_yt 0:fd83f3540b1a 243
yueee_yt 0:fd83f3540b1a 244 int len = writeLine("ATQ0 V1 S0=0 &C1 &D2 +FCLASS=0");//writeLine("ATQ0 V1 S0=0 &C1 &D2 +FCLASS=0");
yueee_yt 0:fd83f3540b1a 245 ATErr err = AT_OK;
yueee_yt 0:fd83f3540b1a 246 if(len<0)
yueee_yt 0:fd83f3540b1a 247 err=(ATErr)len;
yueee_yt 0:fd83f3540b1a 248
yueee_yt 0:fd83f3540b1a 249 if(!err)
yueee_yt 0:fd83f3540b1a 250 {
yueee_yt 0:fd83f3540b1a 251 err = checkOK();
yueee_yt 0:fd83f3540b1a 252 if (err) //No ACK from module
yueee_yt 0:fd83f3540b1a 253 {
yueee_yt 0:fd83f3540b1a 254 DBG("Opening port, error %d.\n", err);
yueee_yt 0:fd83f3540b1a 255 if(err==AT_TIMEOUT)
yueee_yt 0:fd83f3540b1a 256 err = AT_NOANSWER;
yueee_yt 0:fd83f3540b1a 257 }
yueee_yt 0:fd83f3540b1a 258 }
yueee_yt 0:fd83f3540b1a 259
yueee_yt 0:fd83f3540b1a 260 if(err)
yueee_yt 0:fd83f3540b1a 261 {
yueee_yt 0:fd83f3540b1a 262 SerialBuf::detach();
yueee_yt 0:fd83f3540b1a 263 m_isOpen = false;
yueee_yt 0:fd83f3540b1a 264 return err;
yueee_yt 0:fd83f3540b1a 265 }
yueee_yt 0:fd83f3540b1a 266
yueee_yt 0:fd83f3540b1a 267 DBG("No error.\n");
yueee_yt 0:fd83f3540b1a 268 #if 0//FIXME
yueee_yt 0:fd83f3540b1a 269 m_signalsEnable = true;
yueee_yt 0:fd83f3540b1a 270 #endif
yueee_yt 0:fd83f3540b1a 271 //FIXME:
yueee_yt 0:fd83f3540b1a 272 // m_pSerial->attach<ATIf>(this, &ATIf::onSerialInterrupt);
yueee_yt 0:fd83f3540b1a 273
yueee_yt 0:fd83f3540b1a 274 return AT_OK;
yueee_yt 0:fd83f3540b1a 275 }
yueee_yt 0:fd83f3540b1a 276 #endif
yueee_yt 0:fd83f3540b1a 277
yueee_yt 0:fd83f3540b1a 278 ATErr ATIf::close() //Release port
yueee_yt 0:fd83f3540b1a 279 {
yueee_yt 0:fd83f3540b1a 280 SerialBuf::detach(); //Detach serial buf
yueee_yt 0:fd83f3540b1a 281 m_isOpen = false;
yueee_yt 0:fd83f3540b1a 282 //m_signalsEnable = false;
yueee_yt 0:fd83f3540b1a 283 return AT_OK;
yueee_yt 0:fd83f3540b1a 284 }
yueee_yt 0:fd83f3540b1a 285
yueee_yt 0:fd83f3540b1a 286 ATErr ATIf::flushBuffer()
yueee_yt 0:fd83f3540b1a 287 {
yueee_yt 0:fd83f3540b1a 288 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 289 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 290
yueee_yt 0:fd83f3540b1a 291 int len=0;
yueee_yt 0:fd83f3540b1a 292 //char c;
yueee_yt 0:fd83f3540b1a 293 while(readable())
yueee_yt 0:fd83f3540b1a 294 {
yueee_yt 0:fd83f3540b1a 295 //DBG("Readable\n");
yueee_yt 0:fd83f3540b1a 296 /*c =*/ getc();
yueee_yt 0:fd83f3540b1a 297 //DBG("\r\n[%c] discarded.", c);
yueee_yt 0:fd83f3540b1a 298 // wait(0.01);
yueee_yt 0:fd83f3540b1a 299 len++;
yueee_yt 0:fd83f3540b1a 300 }
yueee_yt 0:fd83f3540b1a 301
yueee_yt 0:fd83f3540b1a 302 DBG("\r\n%d chars discarded.", len);
yueee_yt 0:fd83f3540b1a 303
yueee_yt 0:fd83f3540b1a 304 return AT_OK;
yueee_yt 0:fd83f3540b1a 305 }
yueee_yt 0:fd83f3540b1a 306
yueee_yt 0:fd83f3540b1a 307 ATErr ATIf::flushLine(int timeout)
yueee_yt 0:fd83f3540b1a 308 {
yueee_yt 0:fd83f3540b1a 309 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 310 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 311
yueee_yt 0:fd83f3540b1a 312 Timer timer;
yueee_yt 0:fd83f3540b1a 313
yueee_yt 0:fd83f3540b1a 314 timer.start();
yueee_yt 0:fd83f3540b1a 315
yueee_yt 0:fd83f3540b1a 316 int len=0;
yueee_yt 0:fd83f3540b1a 317 char c=0;
yueee_yt 0:fd83f3540b1a 318 while(true)
yueee_yt 0:fd83f3540b1a 319 {
yueee_yt 0:fd83f3540b1a 320 while(!readable())
yueee_yt 0:fd83f3540b1a 321 { if(timer.read_ms()>timeout)
yueee_yt 0:fd83f3540b1a 322 {
yueee_yt 0:fd83f3540b1a 323 // DBG("Timeout!!0");
yueee_yt 0:fd83f3540b1a 324 return AT_TIMEOUT;
yueee_yt 0:fd83f3540b1a 325 }
yueee_yt 0:fd83f3540b1a 326 }
yueee_yt 0:fd83f3540b1a 327 if(c=='\x0D')
yueee_yt 0:fd83f3540b1a 328 {
yueee_yt 0:fd83f3540b1a 329 c = getc();
yueee_yt 0:fd83f3540b1a 330 len++;
yueee_yt 0:fd83f3540b1a 331 if(c=='\x0A')
yueee_yt 0:fd83f3540b1a 332 break;
yueee_yt 0:fd83f3540b1a 333 }
yueee_yt 0:fd83f3540b1a 334 else
yueee_yt 0:fd83f3540b1a 335 {
yueee_yt 0:fd83f3540b1a 336 c = getc();
yueee_yt 0:fd83f3540b1a 337 len++;
yueee_yt 0:fd83f3540b1a 338 }
yueee_yt 0:fd83f3540b1a 339 }
yueee_yt 0:fd83f3540b1a 340
yueee_yt 0:fd83f3540b1a 341 // DBG("\r\n%d chars discarded.", len);
yueee_yt 0:fd83f3540b1a 342
yueee_yt 0:fd83f3540b1a 343 return AT_OK;
yueee_yt 0:fd83f3540b1a 344 }
yueee_yt 0:fd83f3540b1a 345
yueee_yt 0:fd83f3540b1a 346 #if 0
yueee_yt 0:fd83f3540b1a 347 bool ATIf::onRead()
yueee_yt 0:fd83f3540b1a 348 {
yueee_yt 0:fd83f3540b1a 349 if(!m_signalsEnable)
yueee_yt 0:fd83f3540b1a 350 return false;
yueee_yt 0:fd83f3540b1a 351
yueee_yt 0:fd83f3540b1a 352 //Save Usermode params
yueee_yt 0:fd83f3540b1a 353 volatile int u_readTimeout = m_readTimeout;
yueee_yt 0:fd83f3540b1a 354 volatile bool u_lineMode = m_lineMode;
yueee_yt 0:fd83f3540b1a 355 // bool u_isOpen = m_isOpen;
yueee_yt 0:fd83f3540b1a 356 SerialBuf::setReadMode(true);
yueee_yt 0:fd83f3540b1a 357
yueee_yt 0:fd83f3540b1a 358 m_readTimeout = 0; //No timeout in an interrupt fn!
yueee_yt 0:fd83f3540b1a 359
yueee_yt 0:fd83f3540b1a 360 bool handled;
yueee_yt 0:fd83f3540b1a 361 if(!!flushLine(0))
yueee_yt 0:fd83f3540b1a 362 {
yueee_yt 0:fd83f3540b1a 363 SerialBuf::resetRead();
yueee_yt 0:fd83f3540b1a 364 //Not a complete line here, wait...
yueee_yt 0:fd83f3540b1a 365 handled = false;
yueee_yt 0:fd83f3540b1a 366 }
yueee_yt 0:fd83f3540b1a 367 else
yueee_yt 0:fd83f3540b1a 368 {
yueee_yt 0:fd83f3540b1a 369 SerialBuf::resetRead();
yueee_yt 0:fd83f3540b1a 370 handled = true;
yueee_yt 0:fd83f3540b1a 371 if( handleSignal() ) //Was that a signal ?
yueee_yt 0:fd83f3540b1a 372 {
yueee_yt 0:fd83f3540b1a 373 //OK, discard data since it has been processed
yueee_yt 0:fd83f3540b1a 374 SerialBuf::flushRead();
yueee_yt 0:fd83f3540b1a 375 }
yueee_yt 0:fd83f3540b1a 376 else
yueee_yt 0:fd83f3540b1a 377 {
yueee_yt 0:fd83f3540b1a 378 //Keep data since it has not been processed yet
yueee_yt 0:fd83f3540b1a 379 //Have to be processed in usermode
yueee_yt 0:fd83f3540b1a 380 SerialBuf::resetRead();
yueee_yt 0:fd83f3540b1a 381 // handled = false;
yueee_yt 0:fd83f3540b1a 382 }
yueee_yt 0:fd83f3540b1a 383 }
yueee_yt 0:fd83f3540b1a 384 //Restore Usermode params
yueee_yt 0:fd83f3540b1a 385 m_readTimeout = u_readTimeout;
yueee_yt 0:fd83f3540b1a 386 m_lineMode = u_lineMode;
yueee_yt 0:fd83f3540b1a 387 //m_isOpen = u_isOpen;
yueee_yt 0:fd83f3540b1a 388 return handled;
yueee_yt 0:fd83f3540b1a 389 }
yueee_yt 0:fd83f3540b1a 390 #endif
yueee_yt 0:fd83f3540b1a 391
yueee_yt 0:fd83f3540b1a 392 ATErr ATIf::rawOpen(Serial* pSerial, int baudrate) //Simple open function for similar non-conforming protocols
yueee_yt 0:fd83f3540b1a 393 {
yueee_yt 0:fd83f3540b1a 394 DBG("\r\nOpening...");
yueee_yt 0:fd83f3540b1a 395 m_isOpen = true; //Must be set so that the serial port-related fns work
yueee_yt 0:fd83f3540b1a 396 //Setup options
yueee_yt 0:fd83f3540b1a 397 pSerial->baud(baudrate);
yueee_yt 0:fd83f3540b1a 398 SerialBuf::attach(pSerial);
yueee_yt 0:fd83f3540b1a 399
yueee_yt 0:fd83f3540b1a 400 return AT_OK;
yueee_yt 0:fd83f3540b1a 401 }
yueee_yt 0:fd83f3540b1a 402
yueee_yt 0:fd83f3540b1a 403 #if 0
yueee_yt 0:fd83f3540b1a 404 ATErr ATIf::command(const char* cmd, char* result, int resultLen, int timeout) ////WARN/FIXME: result has to be long enough!!!
yueee_yt 0:fd83f3540b1a 405 {
yueee_yt 0:fd83f3540b1a 406 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 407 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 408
yueee_yt 0:fd83f3540b1a 409 flushBuffer();
yueee_yt 0:fd83f3540b1a 410
yueee_yt 0:fd83f3540b1a 411 int err;
yueee_yt 0:fd83f3540b1a 412 err = writeLine(cmd);
yueee_yt 0:fd83f3540b1a 413
yueee_yt 0:fd83f3540b1a 414 if(err<0)
yueee_yt 0:fd83f3540b1a 415 { m_receiveStatus = AT_READY; return (ATErr)err; }
yueee_yt 0:fd83f3540b1a 416
yueee_yt 0:fd83f3540b1a 417 err = readLine(result, resultLen, timeout);
yueee_yt 0:fd83f3540b1a 418
yueee_yt 0:fd83f3540b1a 419 if(err<0)
yueee_yt 0:fd83f3540b1a 420 { m_receiveStatus = AT_READY; return (ATErr)err; }
yueee_yt 0:fd83f3540b1a 421
yueee_yt 0:fd83f3540b1a 422 m_receiveStatus = AT_READY;
yueee_yt 0:fd83f3540b1a 423
yueee_yt 0:fd83f3540b1a 424 return AT_OK;
yueee_yt 0:fd83f3540b1a 425
yueee_yt 0:fd83f3540b1a 426 }
yueee_yt 0:fd83f3540b1a 427 #endif
yueee_yt 0:fd83f3540b1a 428
yueee_yt 0:fd83f3540b1a 429 ATErr ATIf::write(const char* cmd, bool lineMode /*= false*/)
yueee_yt 0:fd83f3540b1a 430 {
yueee_yt 0:fd83f3540b1a 431 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 432 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 433
yueee_yt 0:fd83f3540b1a 434 int err;
yueee_yt 0:fd83f3540b1a 435 err = lineMode ? writeLine(cmd) : writeRaw(cmd);
yueee_yt 0:fd83f3540b1a 436
yueee_yt 0:fd83f3540b1a 437 if(err<0)
yueee_yt 0:fd83f3540b1a 438 return (ATErr)err;
yueee_yt 0:fd83f3540b1a 439
yueee_yt 0:fd83f3540b1a 440 return AT_OK;
yueee_yt 0:fd83f3540b1a 441 }
yueee_yt 0:fd83f3540b1a 442
yueee_yt 0:fd83f3540b1a 443
yueee_yt 0:fd83f3540b1a 444 ATErr ATIf::read(char* result, int resultMaxLen, int timeout, bool lineMode /*= false*/, int resultMinLen/* = 0*/)
yueee_yt 0:fd83f3540b1a 445 {
yueee_yt 0:fd83f3540b1a 446 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 447 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 448
yueee_yt 0:fd83f3540b1a 449 int err;
yueee_yt 0:fd83f3540b1a 450 err = lineMode ? readLine(result, resultMaxLen, timeout) : readRaw(result, resultMaxLen, timeout, resultMinLen);
yueee_yt 0:fd83f3540b1a 451
yueee_yt 0:fd83f3540b1a 452 if(err<0)
yueee_yt 0:fd83f3540b1a 453 return (ATErr)err;
yueee_yt 0:fd83f3540b1a 454
yueee_yt 0:fd83f3540b1a 455 return AT_OK;
yueee_yt 0:fd83f3540b1a 456 }
yueee_yt 0:fd83f3540b1a 457
yueee_yt 0:fd83f3540b1a 458 bool ATIf::isOpen()
yueee_yt 0:fd83f3540b1a 459 {
yueee_yt 0:fd83f3540b1a 460 return m_isOpen;
yueee_yt 0:fd83f3540b1a 461 }
yueee_yt 0:fd83f3540b1a 462
yueee_yt 0:fd83f3540b1a 463 ATErr ATIf::checkOK() //Helper fn to quickly check that OK has been returned
yueee_yt 0:fd83f3540b1a 464 {
yueee_yt 0:fd83f3540b1a 465 char ret[16] = {0};
yueee_yt 0:fd83f3540b1a 466 int err = readLine(ret,16,m_readTimeout);
yueee_yt 0:fd83f3540b1a 467
yueee_yt 0:fd83f3540b1a 468 if(err<0)
yueee_yt 0:fd83f3540b1a 469 {
yueee_yt 0:fd83f3540b1a 470 DBG("\r\nError in check (%s).\r\n", ret);
yueee_yt 0:fd83f3540b1a 471 flushBuffer(); //Discard anything in buf to avoid misparsing in the following calls
yueee_yt 0:fd83f3540b1a 472 return (ATErr)err;
yueee_yt 0:fd83f3540b1a 473 }
yueee_yt 0:fd83f3540b1a 474
yueee_yt 0:fd83f3540b1a 475 if(!!strcmp("OK",ret))
yueee_yt 0:fd83f3540b1a 476 {
yueee_yt 0:fd83f3540b1a 477 DBG("\r\nNot an OK <%s>.\r\n", ret);
yueee_yt 0:fd83f3540b1a 478 flushBuffer();
yueee_yt 0:fd83f3540b1a 479 return AT_ERROR;
yueee_yt 0:fd83f3540b1a 480 }
yueee_yt 0:fd83f3540b1a 481
yueee_yt 0:fd83f3540b1a 482 DBG("\r\nCHECK OK\r\n");
yueee_yt 0:fd83f3540b1a 483
yueee_yt 0:fd83f3540b1a 484 return AT_OK;
yueee_yt 0:fd83f3540b1a 485 }
yueee_yt 0:fd83f3540b1a 486
yueee_yt 0:fd83f3540b1a 487 #if 0
yueee_yt 0:fd83f3540b1a 488 void ATIf::onSerialInterrupt() //Callback from m_pSerial
yueee_yt 0:fd83f3540b1a 489 {
yueee_yt 0:fd83f3540b1a 490 return;//FIXME
yueee_yt 0:fd83f3540b1a 491
yueee_yt 0:fd83f3540b1a 492 if(m_receiveStatus == AT_READING)
yueee_yt 0:fd83f3540b1a 493 return;
yueee_yt 0:fd83f3540b1a 494
yueee_yt 0:fd83f3540b1a 495 if( m_cbObj && m_cbMeth )
yueee_yt 0:fd83f3540b1a 496 return (m_cbObj->*m_cbMeth)();
yueee_yt 0:fd83f3540b1a 497 }
yueee_yt 0:fd83f3540b1a 498 #endif
yueee_yt 0:fd83f3540b1a 499
yueee_yt 0:fd83f3540b1a 500 int ATIf::readLine(char* line, int maxLen, int timeout) //Read a single line from serial port, return length or ATErr(<0)
yueee_yt 0:fd83f3540b1a 501 {
yueee_yt 0:fd83f3540b1a 502 #ifdef OLDREADLINE
yueee_yt 0:fd83f3540b1a 503 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 504 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 505
yueee_yt 0:fd83f3540b1a 506 int len = 0;
yueee_yt 0:fd83f3540b1a 507
yueee_yt 0:fd83f3540b1a 508 Timer timer;
yueee_yt 0:fd83f3540b1a 509
yueee_yt 0:fd83f3540b1a 510 timer.start();
yueee_yt 0:fd83f3540b1a 511 #ifdef __START_CLRF_MANDAT
yueee_yt 0:fd83f3540b1a 512 for( int i=0; i<2; i++ )
yueee_yt 0:fd83f3540b1a 513 {
yueee_yt 0:fd83f3540b1a 514 while(!readable())
yueee_yt 0:fd83f3540b1a 515 {
yueee_yt 0:fd83f3540b1a 516 if(timer.read_ms()>timeout)
yueee_yt 0:fd83f3540b1a 517 {
yueee_yt 0:fd83f3540b1a 518 // DBG("Timeout!!0");
yueee_yt 0:fd83f3540b1a 519 return AT_TIMEOUT;
yueee_yt 0:fd83f3540b1a 520 }
yueee_yt 0:fd83f3540b1a 521 wait_ms(10); //Wait 10ms
yueee_yt 0:fd83f3540b1a 522 }
yueee_yt 0:fd83f3540b1a 523 *line = getc();
yueee_yt 0:fd83f3540b1a 524 // DBG("In readLine(), read : %c", *line);
yueee_yt 0:fd83f3540b1a 525 if( ( (i == 0) && (*line!='\x0D') )
yueee_yt 0:fd83f3540b1a 526 || ( (i == 1) && (*line!='\x0A') ) )
yueee_yt 0:fd83f3540b1a 527 return AT_PARSE;
yueee_yt 0:fd83f3540b1a 528 }
yueee_yt 0:fd83f3540b1a 529 #else
yueee_yt 0:fd83f3540b1a 530
yueee_yt 0:fd83f3540b1a 531 #endif
yueee_yt 0:fd83f3540b1a 532
yueee_yt 0:fd83f3540b1a 533 for( ; len < maxLen ; len++ )
yueee_yt 0:fd83f3540b1a 534 {
yueee_yt 0:fd83f3540b1a 535 timer.reset();
yueee_yt 0:fd83f3540b1a 536 while(!readable())
yueee_yt 0:fd83f3540b1a 537 {
yueee_yt 0:fd83f3540b1a 538 if(timer.read_ms()>timeout)
yueee_yt 0:fd83f3540b1a 539 {
yueee_yt 0:fd83f3540b1a 540 // DBG("Timeout!!1");
yueee_yt 0:fd83f3540b1a 541 return AT_TIMEOUT;
yueee_yt 0:fd83f3540b1a 542 }
yueee_yt 0:fd83f3540b1a 543 wait_ms(10); //Wait 10ms
yueee_yt 0:fd83f3540b1a 544 }
yueee_yt 0:fd83f3540b1a 545 *line = getc();
yueee_yt 0:fd83f3540b1a 546 //DBG("In readLine(), read : %c", *line);
yueee_yt 0:fd83f3540b1a 547
yueee_yt 0:fd83f3540b1a 548 if(*line=='\x0D')
yueee_yt 0:fd83f3540b1a 549 {
yueee_yt 0:fd83f3540b1a 550 timer.reset();
yueee_yt 0:fd83f3540b1a 551 while(!readable())
yueee_yt 0:fd83f3540b1a 552 {
yueee_yt 0:fd83f3540b1a 553 if(timer.read_ms()>timeout)
yueee_yt 0:fd83f3540b1a 554 {
yueee_yt 0:fd83f3540b1a 555 return AT_TIMEOUT;
yueee_yt 0:fd83f3540b1a 556 }
yueee_yt 0:fd83f3540b1a 557 wait_ms(10); //Wait 1ms
yueee_yt 0:fd83f3540b1a 558 }
yueee_yt 0:fd83f3540b1a 559 *line = getc();
yueee_yt 0:fd83f3540b1a 560 // DBG("In readLine(), read : %c", *line);
yueee_yt 0:fd83f3540b1a 561 if(*line=='\x0A')
yueee_yt 0:fd83f3540b1a 562 {
yueee_yt 0:fd83f3540b1a 563 if(len==0)
yueee_yt 0:fd83f3540b1a 564 {
yueee_yt 0:fd83f3540b1a 565 //Start of line
yueee_yt 0:fd83f3540b1a 566 len--;
yueee_yt 0:fd83f3540b1a 567 continue;
yueee_yt 0:fd83f3540b1a 568 }
yueee_yt 0:fd83f3540b1a 569 else
yueee_yt 0:fd83f3540b1a 570 {
yueee_yt 0:fd83f3540b1a 571 *line=0; //End of line
yueee_yt 0:fd83f3540b1a 572 break;
yueee_yt 0:fd83f3540b1a 573 }
yueee_yt 0:fd83f3540b1a 574 }
yueee_yt 0:fd83f3540b1a 575 else
yueee_yt 0:fd83f3540b1a 576 {
yueee_yt 0:fd83f3540b1a 577 //Should not happen, must have lost some bytes somewhere or non AT protocol
yueee_yt 0:fd83f3540b1a 578 return AT_PARSE;
yueee_yt 0:fd83f3540b1a 579 }
yueee_yt 0:fd83f3540b1a 580 }
yueee_yt 0:fd83f3540b1a 581 line++;
yueee_yt 0:fd83f3540b1a 582 }
yueee_yt 0:fd83f3540b1a 583
yueee_yt 0:fd83f3540b1a 584 if(len==maxLen)
yueee_yt 0:fd83f3540b1a 585 return AT_INCOMPLETE; //Buffer full, must call this method again to get end of line
yueee_yt 0:fd83f3540b1a 586
yueee_yt 0:fd83f3540b1a 587 return len;
yueee_yt 0:fd83f3540b1a 588 #else
yueee_yt 0:fd83f3540b1a 589 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 590 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 591
yueee_yt 0:fd83f3540b1a 592 Timer timer;
yueee_yt 0:fd83f3540b1a 593 timer.start();
yueee_yt 0:fd83f3540b1a 594
yueee_yt 0:fd83f3540b1a 595 int len = 0;
yueee_yt 0:fd83f3540b1a 596 while( len < maxLen )
yueee_yt 0:fd83f3540b1a 597 {
yueee_yt 0:fd83f3540b1a 598 timer.reset();
yueee_yt 0:fd83f3540b1a 599 while(!readable())
yueee_yt 0:fd83f3540b1a 600 {
yueee_yt 0:fd83f3540b1a 601 if(timer.read_ms()>timeout)
yueee_yt 0:fd83f3540b1a 602 {
yueee_yt 0:fd83f3540b1a 603 return AT_TIMEOUT;
yueee_yt 0:fd83f3540b1a 604 }
yueee_yt 0:fd83f3540b1a 605 wait_ms(10); //Wait 10ms
yueee_yt 0:fd83f3540b1a 606 }
yueee_yt 0:fd83f3540b1a 607 *line = getc();
yueee_yt 0:fd83f3540b1a 608
yueee_yt 0:fd83f3540b1a 609 if( (*line=='\x0D') || (*line=='\x0A') )
yueee_yt 0:fd83f3540b1a 610 {
yueee_yt 0:fd83f3540b1a 611
yueee_yt 0:fd83f3540b1a 612 if(len==0)
yueee_yt 0:fd83f3540b1a 613 {
yueee_yt 0:fd83f3540b1a 614 //Start of line
yueee_yt 0:fd83f3540b1a 615 continue;
yueee_yt 0:fd83f3540b1a 616 }
yueee_yt 0:fd83f3540b1a 617 else
yueee_yt 0:fd83f3540b1a 618 {
yueee_yt 0:fd83f3540b1a 619 *line=0; //End of line
yueee_yt 0:fd83f3540b1a 620 break;
yueee_yt 0:fd83f3540b1a 621 }
yueee_yt 0:fd83f3540b1a 622 }
yueee_yt 0:fd83f3540b1a 623 len++;
yueee_yt 0:fd83f3540b1a 624 line++;
yueee_yt 0:fd83f3540b1a 625 }
yueee_yt 0:fd83f3540b1a 626
yueee_yt 0:fd83f3540b1a 627 if(len==maxLen)
yueee_yt 0:fd83f3540b1a 628 return AT_INCOMPLETE; //Buffer full, must call this method again to get end of line
yueee_yt 0:fd83f3540b1a 629
yueee_yt 0:fd83f3540b1a 630 return len;
yueee_yt 0:fd83f3540b1a 631 #endif
yueee_yt 0:fd83f3540b1a 632 }
yueee_yt 0:fd83f3540b1a 633
yueee_yt 0:fd83f3540b1a 634 int ATIf::writeLine(const char* line) //Write a single line to serial port
yueee_yt 0:fd83f3540b1a 635 {
yueee_yt 0:fd83f3540b1a 636 // char* line = (char*) _line;
yueee_yt 0:fd83f3540b1a 637 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 638 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 639
yueee_yt 0:fd83f3540b1a 640 // DBG("\n\rIn writeline.");
yueee_yt 0:fd83f3540b1a 641
yueee_yt 0:fd83f3540b1a 642 int len = 0;
yueee_yt 0:fd83f3540b1a 643
yueee_yt 0:fd83f3540b1a 644 while(*line)
yueee_yt 0:fd83f3540b1a 645 {
yueee_yt 0:fd83f3540b1a 646 putc(*line);
yueee_yt 0:fd83f3540b1a 647 line++;
yueee_yt 0:fd83f3540b1a 648 len++;
yueee_yt 0:fd83f3540b1a 649 }
yueee_yt 0:fd83f3540b1a 650
yueee_yt 0:fd83f3540b1a 651 /* putc('\r');
yueee_yt 0:fd83f3540b1a 652
yueee_yt 0:fd83f3540b1a 653 putc('\n');*/
yueee_yt 0:fd83f3540b1a 654
yueee_yt 0:fd83f3540b1a 655 putc('\x0D');
yueee_yt 0:fd83f3540b1a 656 // putc('\x0A');
yueee_yt 0:fd83f3540b1a 657
yueee_yt 0:fd83f3540b1a 658 // DBG("\n\rWritten %d + 1", len);
yueee_yt 0:fd83f3540b1a 659
yueee_yt 0:fd83f3540b1a 660 return len;
yueee_yt 0:fd83f3540b1a 661
yueee_yt 0:fd83f3540b1a 662 }
yueee_yt 0:fd83f3540b1a 663
yueee_yt 0:fd83f3540b1a 664
yueee_yt 0:fd83f3540b1a 665
yueee_yt 0:fd83f3540b1a 666 int ATIf::readRaw(char* str, int maxLen, int timeout /*= 0*/, int minLen /*= 0*/) //Read from serial port in buf
yueee_yt 0:fd83f3540b1a 667 {
yueee_yt 0:fd83f3540b1a 668 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 669 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 670
yueee_yt 0:fd83f3540b1a 671 int len = 0;
yueee_yt 0:fd83f3540b1a 672
yueee_yt 0:fd83f3540b1a 673 Timer timer;
yueee_yt 0:fd83f3540b1a 674
yueee_yt 0:fd83f3540b1a 675 timer.start();
yueee_yt 0:fd83f3540b1a 676
yueee_yt 0:fd83f3540b1a 677 for( ; len < maxLen ; len++ )
yueee_yt 0:fd83f3540b1a 678 {
yueee_yt 0:fd83f3540b1a 679 while( (len < minLen) && !readable())
yueee_yt 0:fd83f3540b1a 680 {
yueee_yt 0:fd83f3540b1a 681 if(timer.read_ms()>timeout)
yueee_yt 0:fd83f3540b1a 682 {
yueee_yt 0:fd83f3540b1a 683 return AT_TIMEOUT;
yueee_yt 0:fd83f3540b1a 684 }
yueee_yt 0:fd83f3540b1a 685 wait(.01); //Wait 10ms
yueee_yt 0:fd83f3540b1a 686 }
yueee_yt 0:fd83f3540b1a 687
yueee_yt 0:fd83f3540b1a 688 if(!readable()) //Buffer read entirely
yueee_yt 0:fd83f3540b1a 689 break;
yueee_yt 0:fd83f3540b1a 690
yueee_yt 0:fd83f3540b1a 691 *str = getc();
yueee_yt 0:fd83f3540b1a 692 str++;
yueee_yt 0:fd83f3540b1a 693 len++;
yueee_yt 0:fd83f3540b1a 694 }
yueee_yt 0:fd83f3540b1a 695
yueee_yt 0:fd83f3540b1a 696 *str = 0; //End char
yueee_yt 0:fd83f3540b1a 697
yueee_yt 0:fd83f3540b1a 698 return len;
yueee_yt 0:fd83f3540b1a 699
yueee_yt 0:fd83f3540b1a 700 }
yueee_yt 0:fd83f3540b1a 701
yueee_yt 0:fd83f3540b1a 702 int ATIf::writeRaw(const char* str) //Write directly to serial port
yueee_yt 0:fd83f3540b1a 703 {
yueee_yt 0:fd83f3540b1a 704 if(!m_isOpen)
yueee_yt 0:fd83f3540b1a 705 return AT_CLOSED;
yueee_yt 0:fd83f3540b1a 706
yueee_yt 0:fd83f3540b1a 707 int len = 0;
yueee_yt 0:fd83f3540b1a 708
yueee_yt 0:fd83f3540b1a 709 while(*str)
yueee_yt 0:fd83f3540b1a 710 {
yueee_yt 0:fd83f3540b1a 711 putc(*str);
yueee_yt 0:fd83f3540b1a 712 str++;
yueee_yt 0:fd83f3540b1a 713 len++;
yueee_yt 0:fd83f3540b1a 714 }
yueee_yt 0:fd83f3540b1a 715
yueee_yt 0:fd83f3540b1a 716 return len;
yueee_yt 0:fd83f3540b1a 717 }
yueee_yt 0:fd83f3540b1a 718
yueee_yt 0:fd83f3540b1a 719 #if 0
yueee_yt 0:fd83f3540b1a 720 bool ATIf::handleSignal()
yueee_yt 0:fd83f3540b1a 721 {
yueee_yt 0:fd83f3540b1a 722 bool beg = false;
yueee_yt 0:fd83f3540b1a 723
yueee_yt 0:fd83f3540b1a 724 // SerialBuf::setReadMode(true); //Keep chars in buf when read
yueee_yt 0:fd83f3540b1a 725 // SerialBuf::resetRead();
yueee_yt 0:fd83f3540b1a 726
yueee_yt 0:fd83f3540b1a 727 //if( !m_pCurrentSignal ) //If no signal asked for this line
yueee_yt 0:fd83f3540b1a 728 if(true) //Check anyway, could have been some parsing error before
yueee_yt 0:fd83f3540b1a 729 {
yueee_yt 0:fd83f3540b1a 730 //Extract Signal Name
yueee_yt 0:fd83f3540b1a 731 char sigName[32]; //Should not be longer than that
yueee_yt 0:fd83f3540b1a 732 setLineMode(true); //Read one line
yueee_yt 0:fd83f3540b1a 733
yueee_yt 0:fd83f3540b1a 734 int len = scanf("%[^:]:%*[^\n]", sigName);
yueee_yt 0:fd83f3540b1a 735 if(len != 1)
yueee_yt 0:fd83f3540b1a 736 return false; //This is not a signal
yueee_yt 0:fd83f3540b1a 737 // DBG("\r\nGot signal %s\r\n", sigName);
yueee_yt 0:fd83f3540b1a 738
yueee_yt 0:fd83f3540b1a 739 list<ATSigHandler>::iterator it;
yueee_yt 0:fd83f3540b1a 740
yueee_yt 0:fd83f3540b1a 741 for ( it = m_signals.begin(); it != m_signals.end(); it++ )
yueee_yt 0:fd83f3540b1a 742 {
yueee_yt 0:fd83f3540b1a 743 if( !strcmp((*it).m_name, sigName) )
yueee_yt 0:fd83f3540b1a 744 {
yueee_yt 0:fd83f3540b1a 745 // DBG("\r\nFound signal %s\r\n", sigName);
yueee_yt 0:fd83f3540b1a 746 m_pCurrentSignal = &(*it);
yueee_yt 0:fd83f3540b1a 747 beg = true;
yueee_yt 0:fd83f3540b1a 748 break;
yueee_yt 0:fd83f3540b1a 749 }
yueee_yt 0:fd83f3540b1a 750 }
yueee_yt 0:fd83f3540b1a 751
yueee_yt 0:fd83f3540b1a 752
yueee_yt 0:fd83f3540b1a 753 }
yueee_yt 0:fd83f3540b1a 754
yueee_yt 0:fd83f3540b1a 755 if( !m_pCurrentSignal )
yueee_yt 0:fd83f3540b1a 756 return false; //This is not a signal or it cannot be handled
yueee_yt 0:fd83f3540b1a 757
yueee_yt 0:fd83f3540b1a 758 bool moreData = false;
yueee_yt 0:fd83f3540b1a 759 //Call signal handling routine
yueee_yt 0:fd83f3540b1a 760 SerialBuf::resetRead(); //Rollback so that the handling fn can call scanf properly
yueee_yt 0:fd83f3540b1a 761 bool result = ((m_pCurrentSignal->m_cbObj)->*(m_pCurrentSignal->m_cbMeth))(this, beg, &moreData);
yueee_yt 0:fd83f3540b1a 762
yueee_yt 0:fd83f3540b1a 763 if( !moreData ) //Processing completed
yueee_yt 0:fd83f3540b1a 764 {
yueee_yt 0:fd83f3540b1a 765 m_pCurrentSignal = NULL;
yueee_yt 0:fd83f3540b1a 766 }
yueee_yt 0:fd83f3540b1a 767
yueee_yt 0:fd83f3540b1a 768 return result;
yueee_yt 0:fd83f3540b1a 769 }
yueee_yt 0:fd83f3540b1a 770 #endif
yueee_yt 0:fd83f3540b1a 771
yueee_yt 0:fd83f3540b1a 772 #endif