Simon Ford / NetServices

Version of http://mbed.org/cookbook/NetServicesTribute with setting set the same for LPC2368

Dependents:   UDPSocketExample 24LCxx_I2CApp WeatherPlatform_pachube HvZServerLib ... more

drv/at/ATIf.cpp@0:350011bf8be7, 2010-11-23 (annotated)

Committer:
simon
Date:
Tue Nov 23 14:15:36 2010 +0000
Revision:
0:350011bf8be7
Experimental version for testing UDP

Who changed what in which revision?

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