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