Richard Blimmel / Mbed 2 deprecated CIG_HTTPClient

HTTPClient using static IP

Dependencies:   mbed

NetServices/drv/at/ATIf.cpp@0:d8f2f7d5f31b, 2011-05-30 (annotated)

Committer:
mr_q
Date:
Mon May 30 11:53:37 2011 +0000
Revision:
0:d8f2f7d5f31b
v0.01 Draft

Who changed what in which revision?

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