FBI FRATER / Mbed 2 deprecated InetTest

Library for Bert van Dam's book "ARM MICROCONTROLLERS" For all chapters with internet.

Dependencies:   mbed

NetServices/drv/at/ATIf.cpp@0:4edb816d21e1, 2015-10-16 (annotated)

Committer:
ICTFBI
Date:
Fri Oct 16 14:28:26 2015 +0000
Revision:
0:4edb816d21e1
Pre-update 16-10-15

Who changed what in which revision?

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