phs fan / a3gs

3G Shield library, port for mbed. (from http://3gsa.org/ ) see: https://developer.mbed.org/users/phsfan/notebook/phsshield/

Dependents:   PHSShield_test PHSShield_connectTCP PHSShield_Twitter PHSShield_httpGET

a3gs.cpp@0:ca471c239d5f, 2015-03-10 (annotated)

Committer:
phsfan
Date:
Tue Mar 10 01:12:17 2015 +0000
Revision:
0:ca471c239d5f
1st port for mbed

Who changed what in which revision?

UserRevisionLine numberNew contents of line
phsfan 0:ca471c239d5f 1 //***********************************************************
phsfan 0:ca471c239d5f 2 // a3gs.cpp -- IEM 3G Sheild for Arduino Control Library
phsfan 0:ca471c239d5f 3 //
phsfan 0:ca471c239d5f 4 // History:
phsfan 0:ca471c239d5f 5 // R1.0 2012/10/06 1st Release for IEM 3G Shiled(Ver1.0)
phsfan 0:ca471c239d5f 6 // R1.1 2012/10/14 2nd Release(Operate by few memories)
phsfan 0:ca471c239d5f 7 // (modify sendSMS(),onSMSReceived(),httpGET(),httpPOST(),tweet(),connectTCP())
phsfan 0:ca471c239d5f 8 // R1.2 2012/10/28 Bug fix (httpGET(), httpPOST(), tweet(), availableSMS() and redSMS())
phsfan 0:ca471c239d5f 9 // R1.3 2013/01/01 Support "https" in httpGET() and httpPost() [if gw3g version is above 1.1]
phsfan 0:ca471c239d5f 10 // R1.4 2013/04/16 Bug fix (discardUntil() has never return)
phsfan 0:ca471c239d5f 11 // R2.0 2013/07/12 Change interface of TCP/IP and discardUntil()
phsfan 0:ca471c239d5f 12 // some bugs fix(httpPOST, httpGET, read and getResult)
phsfan 0:ca471c239d5f 13 // R2.1 2013/08/17 Buf fix (discardUntil() has never return)
phsfan 0:ca471c239d5f 14 // R2.2 2013/10/27 Bug fix (read(res, reslength))
phsfan 0:ca471c239d5f 15 // R2.3 2014/07/06 Support binary data in read() and add new version read() function, bug fix write()
phsfan 0:ca471c239d5f 16 // R3.0 2014/08/30 Support for gw3g R2.0 and add follow functions:
phsfan 0:ca471c239d5f 17 // setAirplaneMode(), put(), get()
phsfan 0:ca471c239d5f 18 //
phsfan 0:ca471c239d5f 19 // Author:
phsfan 0:ca471c239d5f 20 // 3G Shield Alliance and Atushi Daikoku
phsfan 0:ca471c239d5f 21 //
phsfan 0:ca471c239d5f 22 // Notes:
phsfan 0:ca471c239d5f 23 // Lower compatible with Arduino GSM/GPRS Shield library.
phsfan 0:ca471c239d5f 24 // Notices as bellow:
phsfan 0:ca471c239d5f 25 // - Use SoftwareSerial library (RxD is D4, TxD is D5).
phsfan 0:ca471c239d5f 26 // - Use Interrupt 0(D2) for SMS arrival notification.
phsfan 0:ca471c239d5f 27 // - Use D6 and D7 are used for Power control.
phsfan 0:ca471c239d5f 28 // If You use Leonard, Mega or ADK(Mega2560) then you must change IEM_RXD_PIN and IEM_TXD_PIN for suitable.
phsfan 0:ca471c239d5f 29 //***********************************************************
phsfan 0:ca471c239d5f 30 /* Modified by 2015 phsfan
phsfan 0:ca471c239d5f 31 * for ABIT PHS Shield on mbed
phsfan 0:ca471c239d5f 32 */
phsfan 0:ca471c239d5f 33
phsfan 0:ca471c239d5f 34 //#define DEBUG 1 // Define if you want to debug
phsfan 0:ca471c239d5f 35
phsfan 0:ca471c239d5f 36 #include "mbed.h"
phsfan 0:ca471c239d5f 37 #include "a3gs.h"
phsfan 0:ca471c239d5f 38
phsfan 0:ca471c239d5f 39 // Macros
phsfan 0:ca471c239d5f 40 #ifdef DEBUG
phsfan 0:ca471c239d5f 41 # define DEBUG_PRINT(m,v) { printf("%s:%s\r\n", m, v); }
phsfan 0:ca471c239d5f 42 # define DEBUG_PRINT_NUM(m,v) { printf("%s:%d\r\n", m, v); }
phsfan 0:ca471c239d5f 43 # define DBG(...) printf("" __VA_ARGS__);
phsfan 0:ca471c239d5f 44 #else
phsfan 0:ca471c239d5f 45 # define DEBUG_PRINT(m,v) // do nothing
phsfan 0:ca471c239d5f 46 # define DEBUG_PRINT_NUM(m,v) // do nothing
phsfan 0:ca471c239d5f 47 # define DBG(...)
phsfan 0:ca471c239d5f 48 #endif
phsfan 0:ca471c239d5f 49 // Constants for pins
phsfan 0:ca471c239d5f 50 #define IEM_INT_PIN 2 // D2(INT0)
phsfan 0:ca471c239d5f 51 #define IEM_RXD_PIN 4 // D4(For example,If you use Leonardo or Mega etc. then change to D10..)
phsfan 0:ca471c239d5f 52 #define IEM_TXD_PIN 5 // D5(For example,If you use Leonardo or Mega etc. then change to D11..)
phsfan 0:ca471c239d5f 53 #define IEM_POWER_PIN 6 // D6
phsfan 0:ca471c239d5f 54 #define IEM_REGULATOR_PIN 7 // D7
phsfan 0:ca471c239d5f 55 // Constants for getTime2()
phsfan 0:ca471c239d5f 56 #define SECS_PER_MIN (60UL)
phsfan 0:ca471c239d5f 57 #define SECS_PER_HOUR (3600UL)
phsfan 0:ca471c239d5f 58 #define SECS_PER_DAY (SECS_PER_HOUR * 24UL)
phsfan 0:ca471c239d5f 59 #define DAYS_PER_WEEK (7UL)
phsfan 0:ca471c239d5f 60 #define SECS_YR_2000 (946684800UL) // the time at the start of y2k
phsfan 0:ca471c239d5f 61 // Leap year calulator expects year argument as years offset from 1970
phsfan 0:ca471c239d5f 62 #define LEAP_YEAR(Y) (((1970+Y)>0) && !((1970+Y)%4) && (((1970+Y)%100) || !((1970+Y)%400)))
phsfan 0:ca471c239d5f 63 // Command execution timeout values
phsfan 0:ca471c239d5f 64 #define TIMEOUT_LOCAL 5000 // Timeout value of local functions [mS]
phsfan 0:ca471c239d5f 65 #define TIMEOUT_NETWORK 35000 // Timeout value of communication functions [mS]
phsfan 0:ca471c239d5f 66 #define TIMEOUT_GPS 180000 // Timeout value og GPS locationing [mS]
phsfan 0:ca471c239d5f 67 // Misc.
phsfan 0:ca471c239d5f 68 #define ISDIGIT(c) ((c) >= '0' && (c) <= '9')
phsfan 0:ca471c239d5f 69 // Interrupt number for SMS
phsfan 0:ca471c239d5f 70 #define INTNO_SMS 0 // Use INT0
phsfan 0:ca471c239d5f 71 // IEM Version
phsfan 0:ca471c239d5f 72 #define MIN_IEM_VERSION 2.0 // A necessary minimum IEM version of this library
phsfan 0:ca471c239d5f 73
phsfan 0:ca471c239d5f 74 // Global variables
phsfan 0:ca471c239d5f 75 static char gWorkBuffer[256]; // Buffer for working(Mega..)
phsfan 0:ca471c239d5f 76 static void (*SMShandler)(void); // ISR for SMS Notification
phsfan 0:ca471c239d5f 77
phsfan 0:ca471c239d5f 78
phsfan 0:ca471c239d5f 79 A3GS::A3GS(PinName tx, PinName rx, PinName intin, PinName power, PinName reg, int baud) :
phsfan 0:ca471c239d5f 80 iemSerial(tx, rx), _intin(intin), _power(power), _reg(reg)
phsfan 0:ca471c239d5f 81 {
phsfan 0:ca471c239d5f 82 iemSerial.baud(baud);
phsfan 0:ca471c239d5f 83 _intin.mode(PullDown);
phsfan 0:ca471c239d5f 84 _power = 0;
phsfan 0:ca471c239d5f 85 _reg = 0;
phsfan 0:ca471c239d5f 86 }
phsfan 0:ca471c239d5f 87
phsfan 0:ca471c239d5f 88 //***************************
phsfan 0:ca471c239d5f 89 // begin()
phsfan 0:ca471c239d5f 90 //
phsfan 0:ca471c239d5f 91 // @description
phsfan 0:ca471c239d5f 92 // Begin to use 3G shield function
phsfan 0:ca471c239d5f 93 // @return value
phsfan 0:ca471c239d5f 94 // 0 .. OK(at least, Packet Switch or Circuit Switch is availabled)
phsfan 0:ca471c239d5f 95 // otherwise .. NG
phsfan 0:ca471c239d5f 96 // @param
phsfan 0:ca471c239d5f 97 // pin : Not used
phsfan 0:ca471c239d5f 98 // @note
phsfan 0:ca471c239d5f 99 //
phsfan 0:ca471c239d5f 100 //***************************
phsfan 0:ca471c239d5f 101 int A3GS::begin(char* pin)
phsfan 0:ca471c239d5f 102 {
phsfan 0:ca471c239d5f 103 char version[a3gsMAX_VERSION_LENGTH+1];
phsfan 0:ca471c239d5f 104 //--
phsfan 0:ca471c239d5f 105 DEBUG_PRINT(">begin()", "default");
phsfan 0:ca471c239d5f 106
phsfan 0:ca471c239d5f 107 // Initilalize global variables and detach INT0
phsfan 0:ca471c239d5f 108 _status = IDLE;
phsfan 0:ca471c239d5f 109 SMShandler = NULL;
phsfan 0:ca471c239d5f 110 _intin.fall(NULL);
phsfan 0:ca471c239d5f 111
phsfan 0:ca471c239d5f 112 // Get iem version and check it
phsfan 0:ca471c239d5f 113 if (getVersion(version) != 0)
phsfan 0:ca471c239d5f 114 return 1; // NG -- Can't get version
phsfan 0:ca471c239d5f 115
phsfan 0:ca471c239d5f 116 if (atof(version) < MIN_IEM_VERSION) {
phsfan 0:ca471c239d5f 117 DEBUG_PRINT(">getVersion()", "IEM version is old");
phsfan 0:ca471c239d5f 118 return 2; // NG -- IEM Version is old
phsfan 0:ca471c239d5f 119 }
phsfan 0:ca471c239d5f 120
phsfan 0:ca471c239d5f 121 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 122 }
phsfan 0:ca471c239d5f 123
phsfan 0:ca471c239d5f 124 //***************************
phsfan 0:ca471c239d5f 125 // begin()
phsfan 0:ca471c239d5f 126 //
phsfan 0:ca471c239d5f 127 // @description
phsfan 0:ca471c239d5f 128 // Begin to use 3G shield function
phsfan 0:ca471c239d5f 129 // @return value
phsfan 0:ca471c239d5f 130 // 0 .. OK(at least, Packet Switch or Circuit Switch is availabled)
phsfan 0:ca471c239d5f 131 // otherwise .. NG
phsfan 0:ca471c239d5f 132 // @param
phsfan 0:ca471c239d5f 133 // pin : Not used
phsfan 0:ca471c239d5f 134 // baudrate : baudrate to begin (2400/4800/9600/19200/38400/57600/115200)
phsfan 0:ca471c239d5f 135 // @note
phsfan 0:ca471c239d5f 136 // This function use to specify non-default baudrate.
phsfan 0:ca471c239d5f 137 //***************************
phsfan 0:ca471c239d5f 138 int A3GS::begin(char* pin, uint32_t baudrate)
phsfan 0:ca471c239d5f 139 {
phsfan 0:ca471c239d5f 140 char version[a3gsMAX_VERSION_LENGTH+1];
phsfan 0:ca471c239d5f 141 //--
phsfan 0:ca471c239d5f 142 DEBUG_PRINT_NUM(">begin()", baudrate);
phsfan 0:ca471c239d5f 143
phsfan 0:ca471c239d5f 144 iemSerial.baud(baudrate);
phsfan 0:ca471c239d5f 145
phsfan 0:ca471c239d5f 146 // Initilalize global variables and detach INT0
phsfan 0:ca471c239d5f 147 _status = IDLE;
phsfan 0:ca471c239d5f 148 SMShandler = NULL;
phsfan 0:ca471c239d5f 149 _intin.fall(NULL);
phsfan 0:ca471c239d5f 150
phsfan 0:ca471c239d5f 151 // Get iem version and check it
phsfan 0:ca471c239d5f 152 if (getVersion(version) != 0)
phsfan 0:ca471c239d5f 153 return 1; // NG -- Can't get version
phsfan 0:ca471c239d5f 154
phsfan 0:ca471c239d5f 155 if (atof(version) < MIN_IEM_VERSION) {
phsfan 0:ca471c239d5f 156 DEBUG_PRINT(">getVersion()", "IEM version is old");
phsfan 0:ca471c239d5f 157 return 2; // NG -- IEM Version is old
phsfan 0:ca471c239d5f 158 }
phsfan 0:ca471c239d5f 159
phsfan 0:ca471c239d5f 160 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 161 }
phsfan 0:ca471c239d5f 162
phsfan 0:ca471c239d5f 163 //***************************
phsfan 0:ca471c239d5f 164 // end()
phsfan 0:ca471c239d5f 165 //
phsfan 0:ca471c239d5f 166 // @description
phsfan 0:ca471c239d5f 167 // End to use 3G shield function
phsfan 0:ca471c239d5f 168 // @return value
phsfan 0:ca471c239d5f 169 // 0 .. always
phsfan 0:ca471c239d5f 170 // @param
phsfan 0:ca471c239d5f 171 // none
phsfan 0:ca471c239d5f 172 // @note
phsfan 0:ca471c239d5f 173 // re-enable serial communication, call a3gs.begin()
phsfan 0:ca471c239d5f 174 //***************************
phsfan 0:ca471c239d5f 175 int A3GS::end(void)
phsfan 0:ca471c239d5f 176 {
phsfan 0:ca471c239d5f 177 // Clear interrupt handler
phsfan 0:ca471c239d5f 178 if (SMShandler != NULL) {
phsfan 0:ca471c239d5f 179 _intin.fall(NULL);
phsfan 0:ca471c239d5f 180 SMShandler = NULL;
phsfan 0:ca471c239d5f 181 }
phsfan 0:ca471c239d5f 182
phsfan 0:ca471c239d5f 183 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 184 }
phsfan 0:ca471c239d5f 185
phsfan 0:ca471c239d5f 186 //***************************
phsfan 0:ca471c239d5f 187 // restart()
phsfan 0:ca471c239d5f 188 //
phsfan 0:ca471c239d5f 189 // @description
phsfan 0:ca471c239d5f 190 // Restart 3G shield and clear SMS handler
phsfan 0:ca471c239d5f 191 // @return value
phsfan 0:ca471c239d5f 192 // 0 .. always
phsfan 0:ca471c239d5f 193 // @param
phsfan 0:ca471c239d5f 194 // pin : Not used
phsfan 0:ca471c239d5f 195 // @note
phsfan 0:ca471c239d5f 196 // Reboot time is about 40 Sec.
phsfan 0:ca471c239d5f 197 //***************************
phsfan 0:ca471c239d5f 198 int A3GS::restart(char* pin)
phsfan 0:ca471c239d5f 199 {
phsfan 0:ca471c239d5f 200 // Clear interrupt handler
phsfan 0:ca471c239d5f 201 if (SMShandler != NULL) {
phsfan 0:ca471c239d5f 202 _intin.fall(NULL);
phsfan 0:ca471c239d5f 203 SMShandler = NULL;
phsfan 0:ca471c239d5f 204 }
phsfan 0:ca471c239d5f 205
phsfan 0:ca471c239d5f 206 sendCommand("$YE"); // Send "Reset IEM" Command
phsfan 0:ca471c239d5f 207
phsfan 0:ca471c239d5f 208 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 209 }
phsfan 0:ca471c239d5f 210
phsfan 0:ca471c239d5f 211 //***************************
phsfan 0:ca471c239d5f 212 // start()
phsfan 0:ca471c239d5f 213 //
phsfan 0:ca471c239d5f 214 // @description
phsfan 0:ca471c239d5f 215 // Power on 3G shield and wait for ready to use
phsfan 0:ca471c239d5f 216 // @return value
phsfan 0:ca471c239d5f 217 // 0 .. always
phsfan 0:ca471c239d5f 218 // @param
phsfan 0:ca471c239d5f 219 // pin : Not used
phsfan 0:ca471c239d5f 220 // @note
phsfan 0:ca471c239d5f 221 // Start up time is about 40 Sec.
phsfan 0:ca471c239d5f 222 //***************************
phsfan 0:ca471c239d5f 223 int A3GS::start(char* pin)
phsfan 0:ca471c239d5f 224 {
phsfan 0:ca471c239d5f 225 _reg = 1; // Regulator turn on
phsfan 0:ca471c239d5f 226 wait_ms(1000); // Wait a moment
phsfan 0:ca471c239d5f 227 _power = 0;
phsfan 0:ca471c239d5f 228 wait_ms(2000); // Make low STATUS_PB_WALK -> Turn on IEM
phsfan 0:ca471c239d5f 229 _power = 1;
phsfan 0:ca471c239d5f 230
phsfan 0:ca471c239d5f 231 DEBUG_PRINT(">start()", "Turn on and wait for a moment..");
phsfan 0:ca471c239d5f 232
phsfan 0:ca471c239d5f 233 wait_ms(35000); // Wait for ready IEM
phsfan 0:ca471c239d5f 234 // wait_ms(1000); // Wait for ready IEM
phsfan 0:ca471c239d5f 235
phsfan 0:ca471c239d5f 236 DEBUG_PRINT(">start()", "IEM is available now.");
phsfan 0:ca471c239d5f 237
phsfan 0:ca471c239d5f 238 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 239 }
phsfan 0:ca471c239d5f 240
phsfan 0:ca471c239d5f 241 //***************************
phsfan 0:ca471c239d5f 242 // shutdown()
phsfan 0:ca471c239d5f 243 //
phsfan 0:ca471c239d5f 244 // @description
phsfan 0:ca471c239d5f 245 // Power off 3G shield
phsfan 0:ca471c239d5f 246 // @return value
phsfan 0:ca471c239d5f 247 // 0 .. always
phsfan 0:ca471c239d5f 248 // @param
phsfan 0:ca471c239d5f 249 // none
phsfan 0:ca471c239d5f 250 // @note
phsfan 0:ca471c239d5f 251 // Shutdown time is about 15 Sec.
phsfan 0:ca471c239d5f 252 //***************************
phsfan 0:ca471c239d5f 253 int A3GS::shutdown(void)
phsfan 0:ca471c239d5f 254 {
phsfan 0:ca471c239d5f 255 sendCommand("$YE"); // Send "Reset IEM" Command
phsfan 0:ca471c239d5f 256
phsfan 0:ca471c239d5f 257 wait_ms(15000); // Wait a moment
phsfan 0:ca471c239d5f 258
phsfan 0:ca471c239d5f 259 _reg = 0; // Regulator turn off
phsfan 0:ca471c239d5f 260
phsfan 0:ca471c239d5f 261 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 262 }
phsfan 0:ca471c239d5f 263
phsfan 0:ca471c239d5f 264 //***************************
phsfan 0:ca471c239d5f 265 // getService
phsfan 0:ca471c239d5f 266 //
phsfan 0:ca471c239d5f 267 // @description
phsfan 0:ca471c239d5f 268 // Get network service status
phsfan 0:ca471c239d5f 269 // @return value
phsfan 0:ca471c239d5f 270 // 0 .. Succeeded, otherwise .. Failed
phsfan 0:ca471c239d5f 271 // @param
phsfan 0:ca471c239d5f 272 // status .. [OUT] SRV* (see a3gs.h)
phsfan 0:ca471c239d5f 273 // @note
phsfan 0:ca471c239d5f 274 //
phsfan 0:ca471c239d5f 275 //***************************
phsfan 0:ca471c239d5f 276 int A3GS::getServices(int& status)
phsfan 0:ca471c239d5f 277 {
phsfan 0:ca471c239d5f 278 char responses[12]; // Format "$YS=OK 9" or "$YS=NG errno"
phsfan 0:ca471c239d5f 279 int length = sizeof(responses);
phsfan 0:ca471c239d5f 280 //--
phsfan 0:ca471c239d5f 281 sendCommand("$YS"); // Send "Get Services" command
phsfan 0:ca471c239d5f 282
phsfan 0:ca471c239d5f 283 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 284 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 285
phsfan 0:ca471c239d5f 286 DEBUG_PRINT(">getServices()", responses);
phsfan 0:ca471c239d5f 287
phsfan 0:ca471c239d5f 288 // parse response
phsfan 0:ca471c239d5f 289 switch (responses[7]) {
phsfan 0:ca471c239d5f 290 case '0' : // NO_SRV
phsfan 0:ca471c239d5f 291 status = a3gsSRV_NO;
phsfan 0:ca471c239d5f 292 break;
phsfan 0:ca471c239d5f 293 case '1' : // PS_ONLY
phsfan 0:ca471c239d5f 294 status = a3gsSRV_PS;
phsfan 0:ca471c239d5f 295 break;
phsfan 0:ca471c239d5f 296 case '2' : // CS_ONLY
phsfan 0:ca471c239d5f 297 status = a3gsSRV_CS;
phsfan 0:ca471c239d5f 298 break;
phsfan 0:ca471c239d5f 299 case '3' : // BOTH
phsfan 0:ca471c239d5f 300 status = a3gsSRV_BOTH;
phsfan 0:ca471c239d5f 301 break;
phsfan 0:ca471c239d5f 302 default : // bug
phsfan 0:ca471c239d5f 303 return 1; // NG -- Can't get service
phsfan 0:ca471c239d5f 304 }
phsfan 0:ca471c239d5f 305
phsfan 0:ca471c239d5f 306 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 307 }
phsfan 0:ca471c239d5f 308
phsfan 0:ca471c239d5f 309 //***************************
phsfan 0:ca471c239d5f 310 // getIMEI()
phsfan 0:ca471c239d5f 311 //
phsfan 0:ca471c239d5f 312 // @description
phsfan 0:ca471c239d5f 313 // Get IEM's IMEI
phsfan 0:ca471c239d5f 314 // @return value
phsfan 0:ca471c239d5f 315 // 0 .. Succeeded
phsfan 0:ca471c239d5f 316 // otherwise .. Failed
phsfan 0:ca471c239d5f 317 // @param
phsfan 0:ca471c239d5f 318 // imei : [OUT] IMEI (a3gsIMEI_SIZE bytes space requred)
phsfan 0:ca471c239d5f 319 // @note
phsfan 0:ca471c239d5f 320 //
phsfan 0:ca471c239d5f 321 //***************************
phsfan 0:ca471c239d5f 322 int A3GS::getIMEI(char* imei)
phsfan 0:ca471c239d5f 323 {
phsfan 0:ca471c239d5f 324 char responses[a3gsIMEI_SIZE+10]; // Format "$YI=OK 99..99" or "$YI=NG errno"
phsfan 0:ca471c239d5f 325 int length = sizeof(responses);
phsfan 0:ca471c239d5f 326 //--
phsfan 0:ca471c239d5f 327 sendCommand("$YI"); // Send "Get IMEI" command
phsfan 0:ca471c239d5f 328
phsfan 0:ca471c239d5f 329 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 330 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 331
phsfan 0:ca471c239d5f 332 DEBUG_PRINT(">getIMEI()", responses);
phsfan 0:ca471c239d5f 333
phsfan 0:ca471c239d5f 334 // parse response
phsfan 0:ca471c239d5f 335 if (strncmp(responses, "$YI=OK", 6))
phsfan 0:ca471c239d5f 336 return 1; // NG -- Can't get IMEI
phsfan 0:ca471c239d5f 337
phsfan 0:ca471c239d5f 338 strncpy(imei, responses+7, a3gsIMEI_SIZE);
phsfan 0:ca471c239d5f 339 imei[a3gsIMEI_SIZE] = '\0';
phsfan 0:ca471c239d5f 340
phsfan 0:ca471c239d5f 341 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 342 }
phsfan 0:ca471c239d5f 343
phsfan 0:ca471c239d5f 344 //***************************
phsfan 0:ca471c239d5f 345 // setBaudrate
phsfan 0:ca471c239d5f 346 //
phsfan 0:ca471c239d5f 347 // @description
phsfan 0:ca471c239d5f 348 // Set UART baudrate
phsfan 0:ca471c239d5f 349 // @return value
phsfan 0:ca471c239d5f 350 // 0 .. OK
phsfan 0:ca471c239d5f 351 // 1 .. NG
phsfan 0:ca471c239d5f 352 // @param
phsfan 0:ca471c239d5f 353 // baudrate : baudrate to set (2400/4800/9600/19200/38400/57600/115200)
phsfan 0:ca471c239d5f 354 // @note
phsfan 0:ca471c239d5f 355 // New baudrate will be validated after reset IEM
phsfan 0:ca471c239d5f 356 //***************************
phsfan 0:ca471c239d5f 357 int A3GS::setBaudrate(uint32_t baudrate)
phsfan 0:ca471c239d5f 358 {
phsfan 0:ca471c239d5f 359 char command[13];
phsfan 0:ca471c239d5f 360 char responses[12]; // Format "$YB=OK" or "$YB=NG errno"
phsfan 0:ca471c239d5f 361 int length = sizeof(responses);
phsfan 0:ca471c239d5f 362 //--
phsfan 0:ca471c239d5f 363 switch (baudrate) {
phsfan 0:ca471c239d5f 364 case 2400 :
phsfan 0:ca471c239d5f 365 case 4800 :
phsfan 0:ca471c239d5f 366 case 9600 :
phsfan 0:ca471c239d5f 367 case 19200 :
phsfan 0:ca471c239d5f 368 case 38400 :
phsfan 0:ca471c239d5f 369 case 57600 :
phsfan 0:ca471c239d5f 370 case 115200 :
phsfan 0:ca471c239d5f 371 break;
phsfan 0:ca471c239d5f 372 default :
phsfan 0:ca471c239d5f 373 return 1; // NG -- Bad parameter
phsfan 0:ca471c239d5f 374 }
phsfan 0:ca471c239d5f 375
phsfan 0:ca471c239d5f 376 // Make command and send it
phsfan 0:ca471c239d5f 377 sprintf(command, "$YB %lu", baudrate);
phsfan 0:ca471c239d5f 378 sendCommand(command); // Send "Set Baudrate" command
phsfan 0:ca471c239d5f 379
phsfan 0:ca471c239d5f 380 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 381 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 382
phsfan 0:ca471c239d5f 383 DEBUG_PRINT(">setBaudrate()", responses);
phsfan 0:ca471c239d5f 384
phsfan 0:ca471c239d5f 385 // parse response
phsfan 0:ca471c239d5f 386 if (strncmp(responses, "$YB=OK", 6))
phsfan 0:ca471c239d5f 387 return 1; // NG -- Can't set baudrate
phsfan 0:ca471c239d5f 388
phsfan 0:ca471c239d5f 389 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 390 }
phsfan 0:ca471c239d5f 391
phsfan 0:ca471c239d5f 392 //***************************
phsfan 0:ca471c239d5f 393 // setLED
phsfan 0:ca471c239d5f 394 //
phsfan 0:ca471c239d5f 395 // @description
phsfan 0:ca471c239d5f 396 // Set LED On/Off
phsfan 0:ca471c239d5f 397 // @return value
phsfan 0:ca471c239d5f 398 // 0 .. OK
phsfan 0:ca471c239d5f 399 // 1 .. NG
phsfan 0:ca471c239d5f 400 // @param
phsfan 0:ca471c239d5f 401 // sw : true is On, false is Off
phsfan 0:ca471c239d5f 402 // @note
phsfan 0:ca471c239d5f 403 // There is LED on 3G shield board(named LED1)
phsfan 0:ca471c239d5f 404 //***************************
phsfan 0:ca471c239d5f 405 int A3GS::setLED(bool sw)
phsfan 0:ca471c239d5f 406 {
phsfan 0:ca471c239d5f 407 char command[10];
phsfan 0:ca471c239d5f 408 char responses[12]; // Format "$YL=OK" or "$YL=NG errno"
phsfan 0:ca471c239d5f 409 int length = sizeof(responses);
phsfan 0:ca471c239d5f 410 //--
phsfan 0:ca471c239d5f 411 // Make command and send it
phsfan 0:ca471c239d5f 412 sprintf(command, "$YL %d", (sw ? 1 : 0));
phsfan 0:ca471c239d5f 413 sendCommand(command); // Send "Set LED" command
phsfan 0:ca471c239d5f 414
phsfan 0:ca471c239d5f 415 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 416 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 417
phsfan 0:ca471c239d5f 418 DEBUG_PRINT(">setLED()", responses);
phsfan 0:ca471c239d5f 419
phsfan 0:ca471c239d5f 420 // parse response
phsfan 0:ca471c239d5f 421 if (strncmp(responses, "$YL=OK", 6))
phsfan 0:ca471c239d5f 422 return 1; // NG -- Can't set led
phsfan 0:ca471c239d5f 423
phsfan 0:ca471c239d5f 424 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 425 }
phsfan 0:ca471c239d5f 426
phsfan 0:ca471c239d5f 427 //***************************
phsfan 0:ca471c239d5f 428 // setAirplaneMode
phsfan 0:ca471c239d5f 429 //
phsfan 0:ca471c239d5f 430 // @description
phsfan 0:ca471c239d5f 431 // Set airplane mode
phsfan 0:ca471c239d5f 432 // @return value
phsfan 0:ca471c239d5f 433 // 0 .. OK
phsfan 0:ca471c239d5f 434 // 1 .. NG
phsfan 0:ca471c239d5f 435 // @param
phsfan 0:ca471c239d5f 436 // sw : true is On(Airplane mode), false is Off(Normal mode)
phsfan 0:ca471c239d5f 437 // @note
phsfan 0:ca471c239d5f 438 // R3.0 add
phsfan 0:ca471c239d5f 439 //***************************
phsfan 0:ca471c239d5f 440 int A3GS::setAirplaneMode(bool sw)
phsfan 0:ca471c239d5f 441 {
phsfan 0:ca471c239d5f 442 char command[10];
phsfan 0:ca471c239d5f 443 char responses[12]; // Format "$YP=OK" or "$YP=NG errno"
phsfan 0:ca471c239d5f 444 int length = sizeof(responses);
phsfan 0:ca471c239d5f 445 //--
phsfan 0:ca471c239d5f 446 // Make command and send it
phsfan 0:ca471c239d5f 447 sprintf(command, "$YP %d", (sw ? 1 : 0));
phsfan 0:ca471c239d5f 448 sendCommand(command); // Send "Set Airplane mode" command
phsfan 0:ca471c239d5f 449
phsfan 0:ca471c239d5f 450 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 451 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 452
phsfan 0:ca471c239d5f 453 DEBUG_PRINT(">setAirplaneMode()", responses);
phsfan 0:ca471c239d5f 454
phsfan 0:ca471c239d5f 455 // parse response
phsfan 0:ca471c239d5f 456 if (strncmp(responses, "$YP=OK", 6))
phsfan 0:ca471c239d5f 457 return 1; // NG -- Can't set airplane mode
phsfan 0:ca471c239d5f 458
phsfan 0:ca471c239d5f 459 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 460 }
phsfan 0:ca471c239d5f 461
phsfan 0:ca471c239d5f 462 //***************************
phsfan 0:ca471c239d5f 463 // sendSMS
phsfan 0:ca471c239d5f 464 //
phsfan 0:ca471c239d5f 465 // @description
phsfan 0:ca471c239d5f 466 // send SMS
phsfan 0:ca471c239d5f 467 // @return value
phsfan 0:ca471c239d5f 468 // 0 .. OK
phsfan 0:ca471c239d5f 469 // otherwise .. NG
phsfan 0:ca471c239d5f 470 // @param
phsfan 0:ca471c239d5f 471 // to : MSN(10 digits)
phsfan 0:ca471c239d5f 472 // msg : message string(ASCII or UNICODE)
phsfan 0:ca471c239d5f 473 // encode : message's char set(default is ASCII)
phsfan 0:ca471c239d5f 474 //***************************
phsfan 0:ca471c239d5f 475 int A3GS::sendSMS(const char* to, const char* msg, int encode)
phsfan 0:ca471c239d5f 476 {
phsfan 0:ca471c239d5f 477 char responses[20]; // FORMAT: "$SS=OK" or "$SS=NG errno"
phsfan 0:ca471c239d5f 478 int length = sizeof(responses);
phsfan 0:ca471c239d5f 479 //--
phsfan 0:ca471c239d5f 480 // Check parameter sizes
phsfan 0:ca471c239d5f 481 if (strlen(msg) > a3gsMAX_SMS_LENGTH)
phsfan 0:ca471c239d5f 482 return 1; // NG - too long message
phsfan 0:ca471c239d5f 483 if (strlen(to) > a3gsMAX_MSN_LENGTH)
phsfan 0:ca471c239d5f 484 return 1; // NG - too long msn
phsfan 0:ca471c239d5f 485
phsfan 0:ca471c239d5f 486 // Send comamnd little by little
phsfan 0:ca471c239d5f 487 sendData("$SS ");
phsfan 0:ca471c239d5f 488 sendData(to);
phsfan 0:ca471c239d5f 489 sendData(" \"");
phsfan 0:ca471c239d5f 490 sendData(msg);
phsfan 0:ca471c239d5f 491 sendData("\" ");
phsfan 0:ca471c239d5f 492 if (encode == a3gsCS_UNICODE)
phsfan 0:ca471c239d5f 493 sendCommand("UNICODE");
phsfan 0:ca471c239d5f 494 else
phsfan 0:ca471c239d5f 495 sendCommand("ASCII");
phsfan 0:ca471c239d5f 496
phsfan 0:ca471c239d5f 497 DEBUG_PRINT(">sendSMS", to);
phsfan 0:ca471c239d5f 498
phsfan 0:ca471c239d5f 499 if (getResult(responses, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 500 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 501
phsfan 0:ca471c239d5f 502 DEBUG_PRINT(">sendSMS()", responses);
phsfan 0:ca471c239d5f 503
phsfan 0:ca471c239d5f 504 if (strncmp(responses, "$SS=OK", 6))
phsfan 0:ca471c239d5f 505 return 1; // NG -- send error
phsfan 0:ca471c239d5f 506
phsfan 0:ca471c239d5f 507 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 508 }
phsfan 0:ca471c239d5f 509
phsfan 0:ca471c239d5f 510 //***************************
phsfan 0:ca471c239d5f 511 // availableSMS
phsfan 0:ca471c239d5f 512 //
phsfan 0:ca471c239d5f 513 // @description
phsfan 0:ca471c239d5f 514 // Check SMS is available or not
phsfan 0:ca471c239d5f 515 // @return value
phsfan 0:ca471c239d5f 516 // true .. Available
phsfan 0:ca471c239d5f 517 // false .. Not Available
phsfan 0:ca471c239d5f 518 // @param
phsfan 0:ca471c239d5f 519 // none
phsfan 0:ca471c239d5f 520 // @note
phsfan 0:ca471c239d5f 521 //
phsfan 0:ca471c239d5f 522 //***************************
phsfan 0:ca471c239d5f 523 bool A3GS::availableSMS()
phsfan 0:ca471c239d5f 524 {
phsfan 0:ca471c239d5f 525 char responses[20]; // FORMAT: "$SC=OK n" or "$SC=NG errno"
phsfan 0:ca471c239d5f 526 int length = sizeof(responses);
phsfan 0:ca471c239d5f 527 //--
phsfan 0:ca471c239d5f 528 sendCommand("$SC"); // Send "Check SMS" command
phsfan 0:ca471c239d5f 529
phsfan 0:ca471c239d5f 530 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 531 return false; // NG -- maybe timeout
phsfan 0:ca471c239d5f 532
phsfan 0:ca471c239d5f 533 DEBUG_PRINT(">availableSMS()", responses);
phsfan 0:ca471c239d5f 534
phsfan 0:ca471c239d5f 535 if (strncmp(responses, "$SC=OK 1", 8))
phsfan 0:ca471c239d5f 536 return false; // Not available
phsfan 0:ca471c239d5f 537
phsfan 0:ca471c239d5f 538 return true; // Available
phsfan 0:ca471c239d5f 539 }
phsfan 0:ca471c239d5f 540
phsfan 0:ca471c239d5f 541 //***************************
phsfan 0:ca471c239d5f 542 // readSMS
phsfan 0:ca471c239d5f 543 //
phsfan 0:ca471c239d5f 544 // @description
phsfan 0:ca471c239d5f 545 // Read received SMS
phsfan 0:ca471c239d5f 546 // @return value
phsfan 0:ca471c239d5f 547 // 0 .. OK
phsfan 0:ca471c239d5f 548 // otherwise .. NG
phsfan 0:ca471c239d5f 549 // @param
phsfan 0:ca471c239d5f 550 // msg : [OUT] read message string
phsfan 0:ca471c239d5f 551 // msglength : msg length(max a3gsMAX_SMS_LENGTH)
phsfan 0:ca471c239d5f 552 // number : [OUT] MSN
phsfan 0:ca471c239d5f 553 // nlength : MSN length(max a3gsMAX_MSN_LENGTH)
phsfan 0:ca471c239d5f 554 // @note
phsfan 0:ca471c239d5f 555 // Use gWorkBuffer and destory it
phsfan 0:ca471c239d5f 556 //***************************
phsfan 0:ca471c239d5f 557 int A3GS::readSMS(char* msg, int msglength, char* number, int nlength)
phsfan 0:ca471c239d5f 558 {
phsfan 0:ca471c239d5f 559 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 560 char *cp;
phsfan 0:ca471c239d5f 561 //--
phsfan 0:ca471c239d5f 562 sendCommand("$SR"); // Send "Read SMS" command
phsfan 0:ca471c239d5f 563
phsfan 0:ca471c239d5f 564 if (getResult(gWorkBuffer, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 565 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 566
phsfan 0:ca471c239d5f 567 if (! strncmp(gWorkBuffer, "$SR=NG", 6))
phsfan 0:ca471c239d5f 568 return 1; // NG -- No SMS
phsfan 0:ca471c239d5f 569
phsfan 0:ca471c239d5f 570 // Parse number(msn)
phsfan 0:ca471c239d5f 571 for (cp = gWorkBuffer+7; *cp != '\0'; cp++) {
phsfan 0:ca471c239d5f 572 while (ISDIGIT(*cp) && nlength-- > 1)
phsfan 0:ca471c239d5f 573 *number++ = *cp++;
phsfan 0:ca471c239d5f 574 *number = '\0';
phsfan 0:ca471c239d5f 575 DEBUG_PRINT(">readSMS() msn", number);
phsfan 0:ca471c239d5f 576 break;
phsfan 0:ca471c239d5f 577 }
phsfan 0:ca471c239d5f 578
phsfan 0:ca471c239d5f 579 // Parse message
phsfan 0:ca471c239d5f 580 for ( ; *cp != '\0'; cp++) {
phsfan 0:ca471c239d5f 581 if (*cp != '\"')
phsfan 0:ca471c239d5f 582 continue; // Skip until "
phsfan 0:ca471c239d5f 583 cp++; // skip "
phsfan 0:ca471c239d5f 584 while (*cp != '\0' && *cp != '\"' && msglength-- > 1)
phsfan 0:ca471c239d5f 585 *msg++ = *cp++;
phsfan 0:ca471c239d5f 586 *msg = '\0';
phsfan 0:ca471c239d5f 587 DEBUG_PRINT(">readSMS() msg", msg);
phsfan 0:ca471c239d5f 588 break;
phsfan 0:ca471c239d5f 589 }
phsfan 0:ca471c239d5f 590
phsfan 0:ca471c239d5f 591 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 592 }
phsfan 0:ca471c239d5f 593
phsfan 0:ca471c239d5f 594 //***************************
phsfan 0:ca471c239d5f 595 // onSMSReceived
phsfan 0:ca471c239d5f 596 //
phsfan 0:ca471c239d5f 597 // @description
phsfan 0:ca471c239d5f 598 // Set call back function when SMS was receieved
phsfan 0:ca471c239d5f 599 // @return value
phsfan 0:ca471c239d5f 600 // 0 .. OK(always)
phsfan 0:ca471c239d5f 601 // @param
phsfan 0:ca471c239d5f 602 // handler : Call back function(Set) or NULL(Cancel)
phsfan 0:ca471c239d5f 603 // @note
phsfan 0:ca471c239d5f 604 // This function use attachInterrupt() and detachInterrupt() with interrupt number 0(D2).
phsfan 0:ca471c239d5f 605 // Interrupt mode is "LOW".
phsfan 0:ca471c239d5f 606 // It is necessary to call onSMSReceived() each time and to set up handler to use continuously.
phsfan 0:ca471c239d5f 607 //***************************
phsfan 0:ca471c239d5f 608 int A3GS::onSMSReceived(void (*handler)(void))
phsfan 0:ca471c239d5f 609 {
phsfan 0:ca471c239d5f 610 if (handler == NULL)
phsfan 0:ca471c239d5f 611 _intin.fall(NULL);
phsfan 0:ca471c239d5f 612 else
phsfan 0:ca471c239d5f 613 _intin.fall(this, &A3GS::handleINT0);
phsfan 0:ca471c239d5f 614
phsfan 0:ca471c239d5f 615 SMShandler = handler;
phsfan 0:ca471c239d5f 616
phsfan 0:ca471c239d5f 617 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 618 }
phsfan 0:ca471c239d5f 619
phsfan 0:ca471c239d5f 620 //***************************
phsfan 0:ca471c239d5f 621 // httpGET
phsfan 0:ca471c239d5f 622 //
phsfan 0:ca471c239d5f 623 // @description
phsfan 0:ca471c239d5f 624 // Request HTTP/GET to server and port
phsfan 0:ca471c239d5f 625 //
phsfan 0:ca471c239d5f 626 // @return value
phsfan 0:ca471c239d5f 627 // 0 .. OK
phsfan 0:ca471c239d5f 628 // otherwise .. NG
phsfan 0:ca471c239d5f 629 // @param
phsfan 0:ca471c239d5f 630 // server : server name(ex. "www,google.com")
phsfan 0:ca471c239d5f 631 // port : port number(ex. 80)
phsfan 0:ca471c239d5f 632 // path : path(ex. service/index.html)
phsfan 0:ca471c239d5f 633 // result : [OUT] responce raw data(no escaped, '\0' terminated)
phsfan 0:ca471c239d5f 634 // resultlength ; "result" size(max MAX_RESULT_LENGTH)
phsfan 0:ca471c239d5f 635 // ssled : if true then use https(SSL), otherwise use http
phsfan 0:ca471c239d5f 636 // @note
phsfan 0:ca471c239d5f 637 // This function is synchronized.
phsfan 0:ca471c239d5f 638 // Support optional parameter "header" since @R3.0
phsfan 0:ca471c239d5f 639 //***************************
phsfan 0:ca471c239d5f 640 int A3GS::httpGET(const char* server, uint16_t port, const char* path, char* result, int resultlength, bool ssled, const char* header)
phsfan 0:ca471c239d5f 641 {
phsfan 0:ca471c239d5f 642 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 643 int nbytes;
phsfan 0:ca471c239d5f 644 int c; //@R2.0 Change
phsfan 0:ca471c239d5f 645 //--
phsfan 0:ca471c239d5f 646 // Send command line little by little
phsfan 0:ca471c239d5f 647 if (ssled) {
phsfan 0:ca471c239d5f 648 if (strlen(server) + strlen(path) + 8 > a3gsMAX_URL_LENGTH)
phsfan 0:ca471c239d5f 649 return 1; // NG -- Too long url
phsfan 0:ca471c239d5f 650
phsfan 0:ca471c239d5f 651 sendData("$WG https://");
phsfan 0:ca471c239d5f 652 sendData(server);
phsfan 0:ca471c239d5f 653 if (port != a3gsDEFAULT_PORT) {
phsfan 0:ca471c239d5f 654 char ports[6];
phsfan 0:ca471c239d5f 655 sendData(":");
phsfan 0:ca471c239d5f 656 sprintf(ports, "%u", port);
phsfan 0:ca471c239d5f 657 sendData(ports);
phsfan 0:ca471c239d5f 658 }
phsfan 0:ca471c239d5f 659 }
phsfan 0:ca471c239d5f 660 else {
phsfan 0:ca471c239d5f 661 if (strlen(server) + strlen(path) + 7 > a3gsMAX_URL_LENGTH)
phsfan 0:ca471c239d5f 662 return 1; // NG -- Too long url
phsfan 0:ca471c239d5f 663
phsfan 0:ca471c239d5f 664 sendData("$WG http://");
phsfan 0:ca471c239d5f 665 sendData(server);
phsfan 0:ca471c239d5f 666 if (port != a3gsDEFAULT_PORT) {
phsfan 0:ca471c239d5f 667 char ports[6];
phsfan 0:ca471c239d5f 668 sendData(":");
phsfan 0:ca471c239d5f 669 sprintf(ports, "%u", port);
phsfan 0:ca471c239d5f 670 sendData(ports);
phsfan 0:ca471c239d5f 671 }
phsfan 0:ca471c239d5f 672 }
phsfan 0:ca471c239d5f 673
phsfan 0:ca471c239d5f 674 sendData(path);
phsfan 0:ca471c239d5f 675
phsfan 0:ca471c239d5f 676 // Request with extra header --@R3.0 add
phsfan 0:ca471c239d5f 677 if (header != NULL) {
phsfan 0:ca471c239d5f 678 sendData(" \"");
phsfan 0:ca471c239d5f 679 sendData(header);
phsfan 0:ca471c239d5f 680 sendData("\"");
phsfan 0:ca471c239d5f 681 }
phsfan 0:ca471c239d5f 682
phsfan 0:ca471c239d5f 683 sendCommand(""); // Go HTTP/GET request
phsfan 0:ca471c239d5f 684
phsfan 0:ca471c239d5f 685 DEBUG_PRINT(">httpGET()", "REQ");
phsfan 0:ca471c239d5f 686
phsfan 0:ca471c239d5f 687 if (getResult(gWorkBuffer, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 688 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 689
phsfan 0:ca471c239d5f 690 DEBUG_PRINT(">httpGET()", gWorkBuffer);
phsfan 0:ca471c239d5f 691 // result's format: $WG=OK nbytes "response"
phsfan 0:ca471c239d5f 692
phsfan 0:ca471c239d5f 693 // Parse response
phsfan 0:ca471c239d5f 694 if (strncmp(gWorkBuffer, "$WG=OK", 6))
phsfan 0:ca471c239d5f 695 return 1; // NG -- Can't get response
phsfan 0:ca471c239d5f 696
phsfan 0:ca471c239d5f 697 nbytes = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 698 DEBUG_PRINT_NUM(">httpGET() nbytes", nbytes);
phsfan 0:ca471c239d5f 699
phsfan 0:ca471c239d5f 700 // Copy response body into "result" and set "resultlength"
phsfan 0:ca471c239d5f 701 Timer millis;
phsfan 0:ca471c239d5f 702 millis.start();
phsfan 0:ca471c239d5f 703 for (int n = 0; n < nbytes; n++) {
phsfan 0:ca471c239d5f 704 while (!iemSerial.readable()) {
phsfan 0:ca471c239d5f 705 // Wait until valid response
phsfan 0:ca471c239d5f 706 if (millis.read_ms() >= TIMEOUT_NETWORK)
phsfan 0:ca471c239d5f 707 return 2; // NG -- Timeout
phsfan 0:ca471c239d5f 708 }
phsfan 0:ca471c239d5f 709 c = iemSerial.getc();
phsfan 0:ca471c239d5f 710 if (n < resultlength - 1)
phsfan 0:ca471c239d5f 711 result[n] = c;
phsfan 0:ca471c239d5f 712 }
phsfan 0:ca471c239d5f 713 discardUntil('\n'); // discard last '\n' -- @R2.0 Change
phsfan 0:ca471c239d5f 714 if (nbytes > resultlength - 1) //@R2.0 Change
phsfan 0:ca471c239d5f 715 result[resultlength - 1] = '\0';
phsfan 0:ca471c239d5f 716 else
phsfan 0:ca471c239d5f 717 result[nbytes] = '\0';
phsfan 0:ca471c239d5f 718
phsfan 0:ca471c239d5f 719 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 720 }
phsfan 0:ca471c239d5f 721
phsfan 0:ca471c239d5f 722 //***************************
phsfan 0:ca471c239d5f 723 // httpPOST
phsfan 0:ca471c239d5f 724 //
phsfan 0:ca471c239d5f 725 // @discription
phsfan 0:ca471c239d5f 726 // Request HTTP/POST to server and port
phsfan 0:ca471c239d5f 727 //
phsfan 0:ca471c239d5f 728 // @return value
phsfan 0:ca471c239d5f 729 // 0 .. OK
phsfan 0:ca471c239d5f 730 // otherwise .. NG
phsfan 0:ca471c239d5f 731 // @param
phsfan 0:ca471c239d5f 732 // server : server name(ex. "www,google.com")
phsfan 0:ca471c239d5f 733 // port : port number(ex. 80)
phsfan 0:ca471c239d5f 734 // path : path(ex. service/index.html)
phsfan 0:ca471c239d5f 735 // header : header(without Content-Length, nul terminate, max MAX_HEADER_LENGTH)
phsfan 0:ca471c239d5f 736 // body : request body(nul terminate, max MAX_BODY_LENGTH)
phsfan 0:ca471c239d5f 737 // result : [OUT] responce raw data(no escaped)
phsfan 0:ca471c239d5f 738 // resultlength ; [OUT] "result" size(max MAX_RESULT_LENGTH)
phsfan 0:ca471c239d5f 739 // ssled : if true then use https(SSL), otherwise use http
phsfan 0:ca471c239d5f 740 // @note
phsfan 0:ca471c239d5f 741 // This function is synchronized.
phsfan 0:ca471c239d5f 742 //***************************
phsfan 0:ca471c239d5f 743 int A3GS::httpPOST(const char* server, uint16_t port, const char* path, const char *header, const char *body, char* result, int* resultlength, bool ssled)
phsfan 0:ca471c239d5f 744 {
phsfan 0:ca471c239d5f 745 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 746 int nbytes;
phsfan 0:ca471c239d5f 747 int c; //@R2.0 Change
phsfan 0:ca471c239d5f 748 //--
phsfan 0:ca471c239d5f 749 if (strlen(body) > a3gsMAX_BODY_LENGTH)
phsfan 0:ca471c239d5f 750 return 1; // NG -- too long body
phsfan 0:ca471c239d5f 751 if (header != NULL && strlen(header) > a3gsMAX_HEADER_LENGTH)
phsfan 0:ca471c239d5f 752 return 1; // NG -- too long header
phsfan 0:ca471c239d5f 753
phsfan 0:ca471c239d5f 754 // Send command line little by little
phsfan 0:ca471c239d5f 755 if (ssled) {
phsfan 0:ca471c239d5f 756 if (strlen(server) + strlen(path) + 8 > a3gsMAX_URL_LENGTH)
phsfan 0:ca471c239d5f 757 return 1; // NG -- Too long url
phsfan 0:ca471c239d5f 758
phsfan 0:ca471c239d5f 759 sendData("$WP https://");
phsfan 0:ca471c239d5f 760 sendData(server);
phsfan 0:ca471c239d5f 761 if (port != a3gsDEFAULT_PORT) {
phsfan 0:ca471c239d5f 762 char ports[6];
phsfan 0:ca471c239d5f 763 sendData(":");
phsfan 0:ca471c239d5f 764 sprintf(ports, "%u", port);
phsfan 0:ca471c239d5f 765 sendData(ports);
phsfan 0:ca471c239d5f 766 }
phsfan 0:ca471c239d5f 767 }
phsfan 0:ca471c239d5f 768 else {
phsfan 0:ca471c239d5f 769 if (strlen(server) + strlen(path) + 7 > a3gsMAX_URL_LENGTH)
phsfan 0:ca471c239d5f 770 return 1; // NG -- Too long url
phsfan 0:ca471c239d5f 771
phsfan 0:ca471c239d5f 772 sendData("$WP http://");
phsfan 0:ca471c239d5f 773 sendData(server);
phsfan 0:ca471c239d5f 774 if (port != a3gsDEFAULT_PORT) {
phsfan 0:ca471c239d5f 775 char ports[6];
phsfan 0:ca471c239d5f 776 sendData(":");
phsfan 0:ca471c239d5f 777 sprintf(ports, "%u", port);
phsfan 0:ca471c239d5f 778 sendData(ports);
phsfan 0:ca471c239d5f 779 }
phsfan 0:ca471c239d5f 780 }
phsfan 0:ca471c239d5f 781
phsfan 0:ca471c239d5f 782 if (path[0] != '/')
phsfan 0:ca471c239d5f 783 sendData("/"); // for compatiblity old version
phsfan 0:ca471c239d5f 784 sendData(path);
phsfan 0:ca471c239d5f 785
phsfan 0:ca471c239d5f 786 sendData(" \"");
phsfan 0:ca471c239d5f 787
phsfan 0:ca471c239d5f 788 sendData(body);
phsfan 0:ca471c239d5f 789
phsfan 0:ca471c239d5f 790 if (header != NULL && *header != '\0') {
phsfan 0:ca471c239d5f 791 sendData("\" \"");
phsfan 0:ca471c239d5f 792 sendData(header);
phsfan 0:ca471c239d5f 793 }
phsfan 0:ca471c239d5f 794
phsfan 0:ca471c239d5f 795 sendCommand("\""); // Go command
phsfan 0:ca471c239d5f 796
phsfan 0:ca471c239d5f 797 DEBUG_PRINT(">httpPOST()", "REQ");
phsfan 0:ca471c239d5f 798
phsfan 0:ca471c239d5f 799 if (getResult(gWorkBuffer, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 800 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 801
phsfan 0:ca471c239d5f 802 DEBUG_PRINT(">httpPOST()", gWorkBuffer);
phsfan 0:ca471c239d5f 803 // result's format: $WP=OK nbytes or $WP=NG errno
phsfan 0:ca471c239d5f 804
phsfan 0:ca471c239d5f 805 // Parse response
phsfan 0:ca471c239d5f 806 if (strncmp(gWorkBuffer, "$WP=OK", 6))
phsfan 0:ca471c239d5f 807 return 1; // NG -- Can't post or get response
phsfan 0:ca471c239d5f 808
phsfan 0:ca471c239d5f 809 nbytes = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 810 DEBUG_PRINT_NUM(">httpPOST() nbytes", nbytes);
phsfan 0:ca471c239d5f 811
phsfan 0:ca471c239d5f 812 // Copy response body into "result" and set "resultlength"
phsfan 0:ca471c239d5f 813 Timer millis;
phsfan 0:ca471c239d5f 814 millis.start();
phsfan 0:ca471c239d5f 815 for (int n = 0; n < nbytes; n++) {
phsfan 0:ca471c239d5f 816 while (!iemSerial.readable()) {
phsfan 0:ca471c239d5f 817 // Wait until valid response
phsfan 0:ca471c239d5f 818 if (millis.read_ms() >= TIMEOUT_NETWORK)
phsfan 0:ca471c239d5f 819 return 2; // NG -- Timeout
phsfan 0:ca471c239d5f 820 }
phsfan 0:ca471c239d5f 821 c = iemSerial.getc();
phsfan 0:ca471c239d5f 822 if (n < *resultlength - 1)
phsfan 0:ca471c239d5f 823 result[n] = c;
phsfan 0:ca471c239d5f 824 }
phsfan 0:ca471c239d5f 825 discardUntil('\n'); // discard last '\n' -- @R2.0 Change
phsfan 0:ca471c239d5f 826 if (nbytes > *resultlength - 1) //@R2.0 Change
phsfan 0:ca471c239d5f 827 result[*resultlength - 1] = '\0';
phsfan 0:ca471c239d5f 828 else {
phsfan 0:ca471c239d5f 829 result[nbytes] = '\0';
phsfan 0:ca471c239d5f 830 *resultlength = nbytes;
phsfan 0:ca471c239d5f 831 }
phsfan 0:ca471c239d5f 832
phsfan 0:ca471c239d5f 833 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 834 }
phsfan 0:ca471c239d5f 835
phsfan 0:ca471c239d5f 836 //***************************
phsfan 0:ca471c239d5f 837 // tweet
phsfan 0:ca471c239d5f 838 //
phsfan 0:ca471c239d5f 839 // @description
phsfan 0:ca471c239d5f 840 // Tweet a message
phsfan 0:ca471c239d5f 841 //
phsfan 0:ca471c239d5f 842 // @return value
phsfan 0:ca471c239d5f 843 // 0 .. OK
phsfan 0:ca471c239d5f 844 // otherwise .. NG
phsfan 0:ca471c239d5f 845 // @param
phsfan 0:ca471c239d5f 846 // token .. token from http://arduino-tweet.appspot.com/
phsfan 0:ca471c239d5f 847 // msg .. message to tweet(in UTF-8)
phsfan 0:ca471c239d5f 848 // @note
phsfan 0:ca471c239d5f 849 // This function use cloud service on "arduino-tweet.appspot.com".
phsfan 0:ca471c239d5f 850 // Notice from this service:
phsfan 0:ca471c239d5f 851 // - The library uses this site as a proxy server for OAuth stuff. Your tweet may not be applied during maintenance of this site.
phsfan 0:ca471c239d5f 852 // - Please avoid sending more than 1 request per minute not to overload the server.
phsfan 0:ca471c239d5f 853 // - Twitter seems to reject repeated tweets with the same contenet (returns error 403).
phsfan 0:ca471c239d5f 854 // Use gWorkBuffer and destory it
phsfan 0:ca471c239d5f 855
phsfan 0:ca471c239d5f 856 //***************************
phsfan 0:ca471c239d5f 857 int A3GS::tweet(const char* token, const char* msg)
phsfan 0:ca471c239d5f 858 {
phsfan 0:ca471c239d5f 859 int resultlength = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 860 //--
phsfan 0:ca471c239d5f 861 if (strlen(msg) > a3gsMAX_TWEET_LENGTH)
phsfan 0:ca471c239d5f 862 return 8; // Too long message. (@@ check by number of characters, not bytes)
phsfan 0:ca471c239d5f 863
phsfan 0:ca471c239d5f 864 sprintf(gWorkBuffer, "token=%s&status=%s", token, msg);
phsfan 0:ca471c239d5f 865
phsfan 0:ca471c239d5f 866 // request POST to http://arduino-tweet.appspot.com
phsfan 0:ca471c239d5f 867 return httpPOST("arduino-tweet.appspot.com", 80, "update", NULL, gWorkBuffer, gWorkBuffer, &resultlength);
phsfan 0:ca471c239d5f 868 }
phsfan 0:ca471c239d5f 869
phsfan 0:ca471c239d5f 870 //***************************
phsfan 0:ca471c239d5f 871 // getTime
phsfan 0:ca471c239d5f 872 //
phsfan 0:ca471c239d5f 873 // @description
phsfan 0:ca471c239d5f 874 // Get current date and time
phsfan 0:ca471c239d5f 875 // @return value
phsfan 0:ca471c239d5f 876 // 0 .. OK
phsfan 0:ca471c239d5f 877 // otherwise .. NG
phsfan 0:ca471c239d5f 878 // @param
phsfan 0:ca471c239d5f 879 // date : [OUT] current date(JST) ("YYYY/MM/DD" format)
phsfan 0:ca471c239d5f 880 // time : [OUT] current time(JST) ("HH:MM:SS" format)
phsfan 0:ca471c239d5f 881 // @note
phsfan 0:ca471c239d5f 882 //
phsfan 0:ca471c239d5f 883 //***************************
phsfan 0:ca471c239d5f 884 int A3GS::getTime(char date[], char time[])
phsfan 0:ca471c239d5f 885 {
phsfan 0:ca471c239d5f 886 char responses[28]; // Format "$YT=OK 2012/03/18 13:28:25"
phsfan 0:ca471c239d5f 887 int length = sizeof(responses);
phsfan 0:ca471c239d5f 888 //--
phsfan 0:ca471c239d5f 889 sendCommand("$YT"); // Send "Get Time" command
phsfan 0:ca471c239d5f 890
phsfan 0:ca471c239d5f 891 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 892 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 893
phsfan 0:ca471c239d5f 894 DEBUG_PRINT(">getTime()", responses);
phsfan 0:ca471c239d5f 895
phsfan 0:ca471c239d5f 896 if (strncmp(responses, "$YT=OK", 6))
phsfan 0:ca471c239d5f 897 return 1; // NG -- Can't get time
phsfan 0:ca471c239d5f 898
phsfan 0:ca471c239d5f 899 // Parse response
phsfan 0:ca471c239d5f 900 strncpy(date, responses + 7, 10);
phsfan 0:ca471c239d5f 901 date[10] = '\0';
phsfan 0:ca471c239d5f 902
phsfan 0:ca471c239d5f 903 strncpy(time, responses + 18, 8);
phsfan 0:ca471c239d5f 904 time[8] = '\0';
phsfan 0:ca471c239d5f 905
phsfan 0:ca471c239d5f 906 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 907 }
phsfan 0:ca471c239d5f 908
phsfan 0:ca471c239d5f 909 //***************************
phsfan 0:ca471c239d5f 910 // getTime2
phsfan 0:ca471c239d5f 911 //
phsfan 0:ca471c239d5f 912 // @description
phsfan 0:ca471c239d5f 913 // Get the current time as seconds since Jan 1 1970
phsfan 0:ca471c239d5f 914 // @return value
phsfan 0:ca471c239d5f 915 // 0 .. OK
phsfan 0:ca471c239d5f 916 // otherwise .. NG
phsfan 0:ca471c239d5f 917 // @param
phsfan 0:ca471c239d5f 918 // seconds : [OUT] Current seconds since Jan 1 1970(JST)
phsfan 0:ca471c239d5f 919 // @noyte
phsfan 0:ca471c239d5f 920 //
phsfan 0:ca471c239d5f 921 //***************************
phsfan 0:ca471c239d5f 922 int A3GS::getTime2(uint32_t& seconds)
phsfan 0:ca471c239d5f 923 {
phsfan 0:ca471c239d5f 924 static const uint8_t monthDays[] = { 31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31 };
phsfan 0:ca471c239d5f 925 char date[a3gsDATE_SIZE];
phsfan 0:ca471c239d5f 926 char time[a3gsTIME_SIZE];
phsfan 0:ca471c239d5f 927 uint8_t year, month, day, hour, minute, second;
phsfan 0:ca471c239d5f 928 uint32_t t; // total seconds from 1970/01/01 00:00:00
phsfan 0:ca471c239d5f 929 //--
phsfan 0:ca471c239d5f 930 // Get Current Time
phsfan 0:ca471c239d5f 931 if (getTime(date, time) != 0)
phsfan 0:ca471c239d5f 932 return 1; // NG -- can't get time, Failed.
phsfan 0:ca471c239d5f 933
phsfan 0:ca471c239d5f 934 year = atoi(date) - 1970;
phsfan 0:ca471c239d5f 935 month = atoi(date+5);
phsfan 0:ca471c239d5f 936 day = atoi(date+8);
phsfan 0:ca471c239d5f 937 hour = atoi(time);
phsfan 0:ca471c239d5f 938 minute = atoi(time+3);
phsfan 0:ca471c239d5f 939 second = atoi(time+6);
phsfan 0:ca471c239d5f 940
phsfan 0:ca471c239d5f 941 // Seconds from 1970 till 1 jan 00:00:00 of the given year
phsfan 0:ca471c239d5f 942 t = year * (SECS_PER_DAY * 365);
phsfan 0:ca471c239d5f 943 for (int y = 0; y < year; y++) {
phsfan 0:ca471c239d5f 944 if (LEAP_YEAR(y))
phsfan 0:ca471c239d5f 945 t += SECS_PER_DAY; // add extra days for leap years
phsfan 0:ca471c239d5f 946 }
phsfan 0:ca471c239d5f 947
phsfan 0:ca471c239d5f 948 // Add days for this year, months start from 1
phsfan 0:ca471c239d5f 949 for (int m = 1; m < month; m++) {
phsfan 0:ca471c239d5f 950 if ((m == 2) && LEAP_YEAR(year))
phsfan 0:ca471c239d5f 951 t += SECS_PER_DAY * 29;
phsfan 0:ca471c239d5f 952 else
phsfan 0:ca471c239d5f 953 t += SECS_PER_DAY * monthDays[m-1]; //monthDay array starts from 0
phsfan 0:ca471c239d5f 954 }
phsfan 0:ca471c239d5f 955 t += (day - 1) * SECS_PER_DAY;
phsfan 0:ca471c239d5f 956 t += hour * SECS_PER_HOUR;
phsfan 0:ca471c239d5f 957 t += minute * SECS_PER_MIN;
phsfan 0:ca471c239d5f 958 t += second;
phsfan 0:ca471c239d5f 959
phsfan 0:ca471c239d5f 960 seconds = t;
phsfan 0:ca471c239d5f 961
phsfan 0:ca471c239d5f 962 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 963 }
phsfan 0:ca471c239d5f 964
phsfan 0:ca471c239d5f 965 //***************************
phsfan 0:ca471c239d5f 966 // getRSSI
phsfan 0:ca471c239d5f 967 //
phsfan 0:ca471c239d5f 968 // @description
phsfan 0:ca471c239d5f 969 // Get 3G RSSI
phsfan 0:ca471c239d5f 970 // @return value
phsfan 0:ca471c239d5f 971 // 0 .. OK
phsfan 0:ca471c239d5f 972 // 1 .. NG
phsfan 0:ca471c239d5f 973 // @param
phsfan 0:ca471c239d5f 974 // rssi : [OUT] rssi (dBm)
phsfan 0:ca471c239d5f 975 // @note
phsfan 0:ca471c239d5f 976 //
phsfan 0:ca471c239d5f 977 //***************************
phsfan 0:ca471c239d5f 978 int A3GS::getRSSI(int& rssi)
phsfan 0:ca471c239d5f 979 {
phsfan 0:ca471c239d5f 980 char responses[13]; // Format "$YR=OK -999"
phsfan 0:ca471c239d5f 981 int length = sizeof(responses);
phsfan 0:ca471c239d5f 982 //--
phsfan 0:ca471c239d5f 983 sendCommand("$YR"); // Send "Get RSSI" command
phsfan 0:ca471c239d5f 984
phsfan 0:ca471c239d5f 985 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 986 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 987
phsfan 0:ca471c239d5f 988 DEBUG_PRINT(">getRSSI()", responses);
phsfan 0:ca471c239d5f 989
phsfan 0:ca471c239d5f 990 // Parse response
phsfan 0:ca471c239d5f 991 rssi = atoi(responses + 7);
phsfan 0:ca471c239d5f 992
phsfan 0:ca471c239d5f 993 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 994 }
phsfan 0:ca471c239d5f 995
phsfan 0:ca471c239d5f 996 //***************************
phsfan 0:ca471c239d5f 997 // getVersion
phsfan 0:ca471c239d5f 998 //
phsfan 0:ca471c239d5f 999 // @description
phsfan 0:ca471c239d5f 1000 // Get Version
phsfan 0:ca471c239d5f 1001 // @return value
phsfan 0:ca471c239d5f 1002 // 0 .. OK
phsfan 0:ca471c239d5f 1003 // 1 .. NG
phsfan 0:ca471c239d5f 1004 // @param
phsfan 0:ca471c239d5f 1005 // version : [OUT] version ("X.YY")
phsfan 0:ca471c239d5f 1006 // @note
phsfan 0:ca471c239d5f 1007 //
phsfan 0:ca471c239d5f 1008 //***************************
phsfan 0:ca471c239d5f 1009 int A3GS::getVersion(char *version)
phsfan 0:ca471c239d5f 1010 {
phsfan 0:ca471c239d5f 1011 char responses[13]; // Format "$YV=OK 9.99"
phsfan 0:ca471c239d5f 1012 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1013 //--
phsfan 0:ca471c239d5f 1014 sendCommand("$YV"); // Send "Get Version" command
phsfan 0:ca471c239d5f 1015
phsfan 0:ca471c239d5f 1016 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 1017 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1018
phsfan 0:ca471c239d5f 1019 DEBUG_PRINT(">getVersion()", responses);
phsfan 0:ca471c239d5f 1020
phsfan 0:ca471c239d5f 1021 // Copy version
phsfan 0:ca471c239d5f 1022 strcpy(version, responses + 7);
phsfan 0:ca471c239d5f 1023
phsfan 0:ca471c239d5f 1024 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 1025 }
phsfan 0:ca471c239d5f 1026
phsfan 0:ca471c239d5f 1027 //***************************
phsfan 0:ca471c239d5f 1028 // getLocation
phsfan 0:ca471c239d5f 1029 //
phsfan 0:ca471c239d5f 1030 // @description
phsfan 0:ca471c239d5f 1031 // get Current Location from GPS and Network
phsfan 0:ca471c239d5f 1032 //
phsfan 0:ca471c239d5f 1033 // @return value
phsfan 0:ca471c239d5f 1034 // 0 .. OK
phsfan 0:ca471c239d5f 1035 // 1 .. NG(Bad parameters)
phsfan 0:ca471c239d5f 1036 // otherwise .. NG(Can't locate position..)
phsfan 0:ca471c239d5f 1037 // @param
phsfan 0:ca471c239d5f 1038 // method .. method of locate(a3gsM)
phsfan 0:ca471c239d5f 1039 // latitude .. [OUT] latitude
phsfan 0:ca471c239d5f 1040 // longitude .. [OUT] longitude
phsfan 0:ca471c239d5f 1041 // @note
phsfan 0:ca471c239d5f 1042 // 10-180 Sec. required.
phsfan 0:ca471c239d5f 1043 //***************************
phsfan 0:ca471c239d5f 1044 int A3GS::getLocation(int method, char* latitude, char* longitude)
phsfan 0:ca471c239d5f 1045 {
phsfan 0:ca471c239d5f 1046 char *cp, responses[40]; // Format "$LG=OK lat lng"
phsfan 0:ca471c239d5f 1047 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1048 //--
phsfan 0:ca471c239d5f 1049 *latitude = '\0';
phsfan 0:ca471c239d5f 1050 *longitude = '\0';
phsfan 0:ca471c239d5f 1051
phsfan 0:ca471c239d5f 1052 // Make command and send it
phsfan 0:ca471c239d5f 1053 switch (method) {
phsfan 0:ca471c239d5f 1054 case a3gsMPBASED :
phsfan 0:ca471c239d5f 1055 sendCommand("$LG MSBASED"); // Default is method=MSBASED
phsfan 0:ca471c239d5f 1056 break;
phsfan 0:ca471c239d5f 1057 case a3gsMPASSISTED :
phsfan 0:ca471c239d5f 1058 sendCommand("$LG MSASSISTED");
phsfan 0:ca471c239d5f 1059 break;
phsfan 0:ca471c239d5f 1060 case a3gsMPSTANDALONE :
phsfan 0:ca471c239d5f 1061 sendCommand("$LG STANDALONE");
phsfan 0:ca471c239d5f 1062 break;
phsfan 0:ca471c239d5f 1063 default :
phsfan 0:ca471c239d5f 1064 return 1; // bad method
phsfan 0:ca471c239d5f 1065 }
phsfan 0:ca471c239d5f 1066
phsfan 0:ca471c239d5f 1067 if (getResult(responses, &length, TIMEOUT_GPS))
phsfan 0:ca471c239d5f 1068 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1069
phsfan 0:ca471c239d5f 1070 DEBUG_PRINT(">getLocation()", responses);
phsfan 0:ca471c239d5f 1071
phsfan 0:ca471c239d5f 1072 // parse response
phsfan 0:ca471c239d5f 1073 if (! strncmp(responses, "$LG=NG", 6))
phsfan 0:ca471c239d5f 1074 return 1; // NG -- Can't locate
phsfan 0:ca471c239d5f 1075
phsfan 0:ca471c239d5f 1076 // Parse lattitude (assume enough space to store latitude)
phsfan 0:ca471c239d5f 1077 for (cp = responses+7; *cp != '\0'; cp++) {
phsfan 0:ca471c239d5f 1078 while (ISDIGIT(*cp) || *cp == '.')
phsfan 0:ca471c239d5f 1079 *latitude++ = *cp++;
phsfan 0:ca471c239d5f 1080 *latitude = '\0';
phsfan 0:ca471c239d5f 1081 DEBUG_PRINT(">getLocation() lat", latitude);
phsfan 0:ca471c239d5f 1082 break;
phsfan 0:ca471c239d5f 1083 }
phsfan 0:ca471c239d5f 1084
phsfan 0:ca471c239d5f 1085 // Skip spaces
phsfan 0:ca471c239d5f 1086 while (*cp != '\0' && ! ISDIGIT(*cp))
phsfan 0:ca471c239d5f 1087 cp++;
phsfan 0:ca471c239d5f 1088
phsfan 0:ca471c239d5f 1089 // Parse longitude (assume enough space to store longitude)
phsfan 0:ca471c239d5f 1090 for ( ; *cp != '\0'; cp++) {
phsfan 0:ca471c239d5f 1091 while (ISDIGIT(*cp) || *cp == '.')
phsfan 0:ca471c239d5f 1092 *longitude++ = *cp++;
phsfan 0:ca471c239d5f 1093 *longitude = '\0';
phsfan 0:ca471c239d5f 1094 DEBUG_PRINT(">getLocation() lng", longitude);
phsfan 0:ca471c239d5f 1095 break;
phsfan 0:ca471c239d5f 1096 }
phsfan 0:ca471c239d5f 1097
phsfan 0:ca471c239d5f 1098 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 1099 }
phsfan 0:ca471c239d5f 1100
phsfan 0:ca471c239d5f 1101 //***************************
phsfan 0:ca471c239d5f 1102 // setDefaultProfile
phsfan 0:ca471c239d5f 1103 //
phsfan 0:ca471c239d5f 1104 // @description
phsfan 0:ca471c239d5f 1105 // Set default profile(APN) number
phsfan 0:ca471c239d5f 1106 // @return value
phsfan 0:ca471c239d5f 1107 // 0 .. OK
phsfan 0:ca471c239d5f 1108 // 1 .. NG(Bad parameters)
phsfan 0:ca471c239d5f 1109 // @param
phsfan 0:ca471c239d5f 1110 // profileNum : profile number(1..a3gsMAX_PROFILE_NUMBER)
phsfan 0:ca471c239d5f 1111 // @note
phsfan 0:ca471c239d5f 1112 //
phsfan 0:ca471c239d5f 1113 //***************************
phsfan 0:ca471c239d5f 1114 int A3GS::setDefaultProfile(int profileNum)
phsfan 0:ca471c239d5f 1115 {
phsfan 0:ca471c239d5f 1116 char responses[20]; // Format "$PS=OK"
phsfan 0:ca471c239d5f 1117 char commands[20]; // Format "$PS 99"
phsfan 0:ca471c239d5f 1118 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1119 //--
phsfan 0:ca471c239d5f 1120 if (profileNum < 1 || a3gsMAX_PROFILE_NUMBER < profileNum)
phsfan 0:ca471c239d5f 1121 return 1; // NG -- Bad parameter
phsfan 0:ca471c239d5f 1122
phsfan 0:ca471c239d5f 1123 sprintf(commands, "$PS %d", profileNum);
phsfan 0:ca471c239d5f 1124 sendCommand(commands); // Send "Set Profile" command
phsfan 0:ca471c239d5f 1125
phsfan 0:ca471c239d5f 1126 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 1127 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1128
phsfan 0:ca471c239d5f 1129 DEBUG_PRINT(">setDefaultProfile()", responses);
phsfan 0:ca471c239d5f 1130
phsfan 0:ca471c239d5f 1131 // parse response
phsfan 0:ca471c239d5f 1132 if (! strncmp(responses, "$PS=NG", 6))
phsfan 0:ca471c239d5f 1133 return 1; // NG -- Can't set prfoile number
phsfan 0:ca471c239d5f 1134
phsfan 0:ca471c239d5f 1135 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 1136 }
phsfan 0:ca471c239d5f 1137
phsfan 0:ca471c239d5f 1138 //***************************
phsfan 0:ca471c239d5f 1139 // getDefaultProfile
phsfan 0:ca471c239d5f 1140 //
phsfan 0:ca471c239d5f 1141 // @description
phsfan 0:ca471c239d5f 1142 // Get default profile(APN) number
phsfan 0:ca471c239d5f 1143 // @return value
phsfan 0:ca471c239d5f 1144 // 0 .. OK
phsfan 0:ca471c239d5f 1145 // 1 .. NG
phsfan 0:ca471c239d5f 1146 // @param
phsfan 0:ca471c239d5f 1147 // profileNum : [OUT] profile number(1..a3gsMAX_PROFILE_NUMBER)
phsfan 0:ca471c239d5f 1148 // @note
phsfan 0:ca471c239d5f 1149 //
phsfan 0:ca471c239d5f 1150 //***************************
phsfan 0:ca471c239d5f 1151 int A3GS::getDefaultProfile(int* profileNum)
phsfan 0:ca471c239d5f 1152 {
phsfan 0:ca471c239d5f 1153 char responses[20]; // Format "$PR=OK 99\n"
phsfan 0:ca471c239d5f 1154 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1155 //--
phsfan 0:ca471c239d5f 1156 sendCommand("$PR"); // Send "Read Profile" command
phsfan 0:ca471c239d5f 1157
phsfan 0:ca471c239d5f 1158 if (getResult(responses, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 1159 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1160
phsfan 0:ca471c239d5f 1161 DEBUG_PRINT(">getDefaultProfile()", responses);
phsfan 0:ca471c239d5f 1162
phsfan 0:ca471c239d5f 1163 // parse response
phsfan 0:ca471c239d5f 1164 *profileNum = atoi(responses + 7);
phsfan 0:ca471c239d5f 1165
phsfan 0:ca471c239d5f 1166 return a3gsSUCCESS; // Succeeded
phsfan 0:ca471c239d5f 1167 }
phsfan 0:ca471c239d5f 1168
phsfan 0:ca471c239d5f 1169 //***************************
phsfan 0:ca471c239d5f 1170 // connectTCP
phsfan 0:ca471c239d5f 1171 //
phsfan 0:ca471c239d5f 1172 // @description
phsfan 0:ca471c239d5f 1173 // Connect to server with TCP/IP connection
phsfan 0:ca471c239d5f 1174 // @return value
phsfan 0:ca471c239d5f 1175 // 0 .. OK
phsfan 0:ca471c239d5f 1176 // 1 .. NG
phsfan 0:ca471c239d5f 1177 // @param
phsfan 0:ca471c239d5f 1178 // server : server name or IP address(ex. "www,google.com", "192.161.10.1")
phsfan 0:ca471c239d5f 1179 // port : port number(ex. 80)
phsfan 0:ca471c239d5f 1180 // @note
phsfan 0:ca471c239d5f 1181 //
phsfan 0:ca471c239d5f 1182 //***************************
phsfan 0:ca471c239d5f 1183 int A3GS::connectTCP(const char* server, int port)
phsfan 0:ca471c239d5f 1184 {
phsfan 0:ca471c239d5f 1185 char responses[30]; // FORMAT: "$TC=OK\n" or "$TC=NG errno [info]\n"
phsfan 0:ca471c239d5f 1186 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1187 //--
phsfan 0:ca471c239d5f 1188 // Check parameter size
phsfan 0:ca471c239d5f 1189 if (strlen(server) > a3gsMAX_HOST_LENGTH)
phsfan 0:ca471c239d5f 1190 return 1; // NG -- too long host name
phsfan 0:ca471c239d5f 1191 // Make command and send it
phsfan 0:ca471c239d5f 1192 sprintf(gWorkBuffer, "$TC %s %d", server, port);
phsfan 0:ca471c239d5f 1193 sendCommand(gWorkBuffer);
phsfan 0:ca471c239d5f 1194
phsfan 0:ca471c239d5f 1195 if (getResult(responses, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1196 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1197
phsfan 0:ca471c239d5f 1198 DEBUG_PRINT(">connectTCP()", responses);
phsfan 0:ca471c239d5f 1199
phsfan 0:ca471c239d5f 1200 // parse response
phsfan 0:ca471c239d5f 1201 if (! strncmp(responses, "$TC=NG", 6))
phsfan 0:ca471c239d5f 1202 return 1; // NG -- Can't connect
phsfan 0:ca471c239d5f 1203
phsfan 0:ca471c239d5f 1204 // Change status
phsfan 0:ca471c239d5f 1205 _status = TCPCONNECTEDCLIENT;
phsfan 0:ca471c239d5f 1206
phsfan 0:ca471c239d5f 1207 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 1208 }
phsfan 0:ca471c239d5f 1209
phsfan 0:ca471c239d5f 1210 //***************************
phsfan 0:ca471c239d5f 1211 // disconnectTCP
phsfan 0:ca471c239d5f 1212 //
phsfan 0:ca471c239d5f 1213 // @description
phsfan 0:ca471c239d5f 1214 // Disconnect from server with current TCP/IP connection
phsfan 0:ca471c239d5f 1215 // @return value
phsfan 0:ca471c239d5f 1216 // 0 .. OK
phsfan 0:ca471c239d5f 1217 // 1 .. NG
phsfan 0:ca471c239d5f 1218 // @param
phsfan 0:ca471c239d5f 1219 // none
phsfan 0:ca471c239d5f 1220 // @note
phsfan 0:ca471c239d5f 1221 //
phsfan 0:ca471c239d5f 1222 //***************************
phsfan 0:ca471c239d5f 1223 int A3GS::disconnectTCP()
phsfan 0:ca471c239d5f 1224 {
phsfan 0:ca471c239d5f 1225 char responses[30]; // FORMAT: "$TD=OK\n" or "$TD=NG errno [info]\n"
phsfan 0:ca471c239d5f 1226 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1227 //--
phsfan 0:ca471c239d5f 1228 // Send command
phsfan 0:ca471c239d5f 1229 sendCommand("$TD");
phsfan 0:ca471c239d5f 1230
phsfan 0:ca471c239d5f 1231 if (getResult(responses, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1232 return 1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1233
phsfan 0:ca471c239d5f 1234 DEBUG_PRINT(">disconnectTCP()", responses);
phsfan 0:ca471c239d5f 1235
phsfan 0:ca471c239d5f 1236 // parse response
phsfan 0:ca471c239d5f 1237 if (! strncmp(responses, "$TD=NG", 6))
phsfan 0:ca471c239d5f 1238 return 1; // NG -- Can't connect
phsfan 0:ca471c239d5f 1239
phsfan 0:ca471c239d5f 1240 // Change status
phsfan 0:ca471c239d5f 1241 _status = READY;
phsfan 0:ca471c239d5f 1242
phsfan 0:ca471c239d5f 1243 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 1244 }
phsfan 0:ca471c239d5f 1245
phsfan 0:ca471c239d5f 1246 //***************************
phsfan 0:ca471c239d5f 1247 // write
phsfan 0:ca471c239d5f 1248 //
phsfan 0:ca471c239d5f 1249 // @description
phsfan 0:ca471c239d5f 1250 // Write byte into current TCP/IP connection
phsfan 0:ca471c239d5f 1251 // @return value
phsfan 0:ca471c239d5f 1252 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1253 // 1 .. OK
phsfan 0:ca471c239d5f 1254 // @param
phsfan 0:ca471c239d5f 1255 // c : byte data to write
phsfan 0:ca471c239d5f 1256 // @note
phsfan 0:ca471c239d5f 1257 // R2.3 bug fix(binary data escaping)
phsfan 0:ca471c239d5f 1258 //***************************
phsfan 0:ca471c239d5f 1259 int A3GS::write(uint8_t c)
phsfan 0:ca471c239d5f 1260 {
phsfan 0:ca471c239d5f 1261 char responses[30]; // FORMAT: "$TW=OK nbytes\n" or "$TW=NG errno [info]\n"
phsfan 0:ca471c239d5f 1262 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1263 //--
phsfan 0:ca471c239d5f 1264 // Make command and send it
phsfan 0:ca471c239d5f 1265 sendData("$TW \"");
phsfan 0:ca471c239d5f 1266 if (c < 0x20) {
phsfan 0:ca471c239d5f 1267 char escaped[6];
phsfan 0:ca471c239d5f 1268 sprintf(escaped, "$x%02x", c);
phsfan 0:ca471c239d5f 1269 iemSerial.puts(escaped);
phsfan 0:ca471c239d5f 1270 }
phsfan 0:ca471c239d5f 1271 // @R2.3 add -begin-
phsfan 0:ca471c239d5f 1272 else if (c == '"') {
phsfan 0:ca471c239d5f 1273 iemSerial.puts("$\"");
phsfan 0:ca471c239d5f 1274 }
phsfan 0:ca471c239d5f 1275 else if (c == '$') {
phsfan 0:ca471c239d5f 1276 iemSerial.puts("$$");
phsfan 0:ca471c239d5f 1277 }
phsfan 0:ca471c239d5f 1278 // @R2.3 add -end-
phsfan 0:ca471c239d5f 1279 else {
phsfan 0:ca471c239d5f 1280 iemSerial.putc(c);
phsfan 0:ca471c239d5f 1281 }
phsfan 0:ca471c239d5f 1282 sendCommand("\"");
phsfan 0:ca471c239d5f 1283
phsfan 0:ca471c239d5f 1284 if (getResult(responses, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1285 return -1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1286
phsfan 0:ca471c239d5f 1287 DEBUG_PRINT(">write()", responses);
phsfan 0:ca471c239d5f 1288
phsfan 0:ca471c239d5f 1289 // parse response
phsfan 0:ca471c239d5f 1290 if (! strncmp(responses, "$TW=NG", 6))
phsfan 0:ca471c239d5f 1291 return -1; // NG -- Can't connect
phsfan 0:ca471c239d5f 1292
phsfan 0:ca471c239d5f 1293 int nbytes = atoi(responses + 7);
phsfan 0:ca471c239d5f 1294
phsfan 0:ca471c239d5f 1295 return nbytes; // OK
phsfan 0:ca471c239d5f 1296 }
phsfan 0:ca471c239d5f 1297
phsfan 0:ca471c239d5f 1298 //***************************
phsfan 0:ca471c239d5f 1299 // write
phsfan 0:ca471c239d5f 1300 //
phsfan 0:ca471c239d5f 1301 // @description
phsfan 0:ca471c239d5f 1302 // Write string into current TCP/IP connection
phsfan 0:ca471c239d5f 1303 // @return value
phsfan 0:ca471c239d5f 1304 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1305 // 0 < .. OK (= wrote bytes)
phsfan 0:ca471c239d5f 1306 // @param
phsfan 0:ca471c239d5f 1307 // str : string(= '\0' terminated byte array) to write
phsfan 0:ca471c239d5f 1308 // @note
phsfan 0:ca471c239d5f 1309 // "str" must be encoded by $ escape sequence
phsfan 0:ca471c239d5f 1310 //***************************
phsfan 0:ca471c239d5f 1311 int A3GS::write(const char* str)
phsfan 0:ca471c239d5f 1312 {
phsfan 0:ca471c239d5f 1313 char responses[30]; // FORMAT: "$TW=OK nbytes" or "$TW=NG errno [info]\n"
phsfan 0:ca471c239d5f 1314 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1315 //--
phsfan 0:ca471c239d5f 1316 if (strlen(str) > a3gsMAX_DATA_LENGTH)
phsfan 0:ca471c239d5f 1317 return -1; // NG -- too large data
phsfan 0:ca471c239d5f 1318
phsfan 0:ca471c239d5f 1319 // Make command and send it
phsfan 0:ca471c239d5f 1320 sendData("$TW \"");
phsfan 0:ca471c239d5f 1321 sendData(str);
phsfan 0:ca471c239d5f 1322 sendCommand("\"");
phsfan 0:ca471c239d5f 1323
phsfan 0:ca471c239d5f 1324 if (getResult(responses, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1325 return -1; // NG -- maybe timeou\t
phsfan 0:ca471c239d5f 1326
phsfan 0:ca471c239d5f 1327 DEBUG_PRINT(">write()", responses);
phsfan 0:ca471c239d5f 1328
phsfan 0:ca471c239d5f 1329 // parse response
phsfan 0:ca471c239d5f 1330 if (! strncmp(responses, "$TW=NG", 6))
phsfan 0:ca471c239d5f 1331 return -1; // NG -- Can't connect
phsfan 0:ca471c239d5f 1332
phsfan 0:ca471c239d5f 1333 int nbytes = atoi(responses + 7);
phsfan 0:ca471c239d5f 1334
phsfan 0:ca471c239d5f 1335 return nbytes; // OK
phsfan 0:ca471c239d5f 1336 }
phsfan 0:ca471c239d5f 1337
phsfan 0:ca471c239d5f 1338 //***************************
phsfan 0:ca471c239d5f 1339 // write
phsfan 0:ca471c239d5f 1340 //
phsfan 0:ca471c239d5f 1341 // @description
phsfan 0:ca471c239d5f 1342 // Write byte data into current TCP/IP connection
phsfan 0:ca471c239d5f 1343 // @return value
phsfan 0:ca471c239d5f 1344 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1345 // 0 < .. OK (= wrote bytes)
phsfan 0:ca471c239d5f 1346 // @param
phsfan 0:ca471c239d5f 1347 // buffer : data to write(byte array)
phsfan 0:ca471c239d5f 1348 // sz : data size(in byte)
phsfan 0:ca471c239d5f 1349 // @note
phsfan 0:ca471c239d5f 1350 // R2.3 bug fix(binary data escaping)
phsfan 0:ca471c239d5f 1351 //***************************
phsfan 0:ca471c239d5f 1352 int A3GS::write(const uint8_t* buffer, size_t sz)
phsfan 0:ca471c239d5f 1353 {
phsfan 0:ca471c239d5f 1354 char responses[30]; // FORMAT: "$TW=OK nbytes\n" or "$TW=NG errno [info]\n"
phsfan 0:ca471c239d5f 1355 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1356 //--
phsfan 0:ca471c239d5f 1357 if (sz > (size_t)a3gsMAX_DATA_LENGTH)
phsfan 0:ca471c239d5f 1358 return -1; // NG -- too large data
phsfan 0:ca471c239d5f 1359
phsfan 0:ca471c239d5f 1360 // Make command and send it
phsfan 0:ca471c239d5f 1361 sendData("$TW \"");
phsfan 0:ca471c239d5f 1362 while (sz-- > 0) {
phsfan 0:ca471c239d5f 1363 if (*buffer < 0x20) {
phsfan 0:ca471c239d5f 1364 char escaped[6];
phsfan 0:ca471c239d5f 1365 sprintf(escaped, "$x%02x", *buffer);
phsfan 0:ca471c239d5f 1366 iemSerial.puts(escaped);
phsfan 0:ca471c239d5f 1367 }
phsfan 0:ca471c239d5f 1368 // @R2.3 add -begin-
phsfan 0:ca471c239d5f 1369 else if (*buffer == '"') {
phsfan 0:ca471c239d5f 1370 iemSerial.puts("$\"");
phsfan 0:ca471c239d5f 1371 }
phsfan 0:ca471c239d5f 1372 else if (*buffer == '$') {
phsfan 0:ca471c239d5f 1373 iemSerial.puts("$$");
phsfan 0:ca471c239d5f 1374 }
phsfan 0:ca471c239d5f 1375 // @R2.3 add -end-
phsfan 0:ca471c239d5f 1376 else {
phsfan 0:ca471c239d5f 1377 iemSerial.putc((char)*buffer);
phsfan 0:ca471c239d5f 1378 }
phsfan 0:ca471c239d5f 1379 buffer++;
phsfan 0:ca471c239d5f 1380 }
phsfan 0:ca471c239d5f 1381 sendCommand("\"");
phsfan 0:ca471c239d5f 1382
phsfan 0:ca471c239d5f 1383 if (getResult(responses, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1384 return -1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1385
phsfan 0:ca471c239d5f 1386 DEBUG_PRINT(">write()", responses);
phsfan 0:ca471c239d5f 1387
phsfan 0:ca471c239d5f 1388 // parse response
phsfan 0:ca471c239d5f 1389 if (! strncmp(responses, "$TW=NG", 6))
phsfan 0:ca471c239d5f 1390 return -1; // NG -- Can't connect
phsfan 0:ca471c239d5f 1391
phsfan 0:ca471c239d5f 1392 int nbytes = atoi(responses + 7);
phsfan 0:ca471c239d5f 1393
phsfan 0:ca471c239d5f 1394 return nbytes; // OK
phsfan 0:ca471c239d5f 1395 }
phsfan 0:ca471c239d5f 1396
phsfan 0:ca471c239d5f 1397 //***************************
phsfan 0:ca471c239d5f 1398 // read
phsfan 0:ca471c239d5f 1399 //
phsfan 0:ca471c239d5f 1400 // @description
phsfan 0:ca471c239d5f 1401 // Read data from current TCP/IP connection
phsfan 0:ca471c239d5f 1402 // @return value
phsfan 0:ca471c239d5f 1403 // -2 .. NG (Closed connection by other side)
phsfan 0:ca471c239d5f 1404 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1405 // 0 .. OK (No data)
phsfan 0:ca471c239d5f 1406 // 0 < .. OK (= read bytes)
phsfan 0:ca471c239d5f 1407 // @param
phsfan 0:ca471c239d5f 1408 // result : [OUT] read data(byte array, not '\0' terminated)
phsfan 0:ca471c239d5f 1409 // resultlength : data length(in byte)
phsfan 0:ca471c239d5f 1410 // @note
phsfan 0:ca471c239d5f 1411 // R2.3 fix return value bug
phsfan 0:ca471c239d5f 1412 // This function leaves for compatibility
phsfan 0:ca471c239d5f 1413 //***************************
phsfan 0:ca471c239d5f 1414 int A3GS::read(char* result, int resultlength)
phsfan 0:ca471c239d5f 1415 {
phsfan 0:ca471c239d5f 1416 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 1417 int c; //@R2.0 Change
phsfan 0:ca471c239d5f 1418 //--
phsfan 0:ca471c239d5f 1419 if (resultlength > a3gsMAX_DATA_LENGTH)
phsfan 0:ca471c239d5f 1420 return -1; // NG -- Bad parameter
phsfan 0:ca471c239d5f 1421
phsfan 0:ca471c239d5f 1422 // Make command and send it
phsfan 0:ca471c239d5f 1423 sprintf(gWorkBuffer, "$TR %d", resultlength);
phsfan 0:ca471c239d5f 1424 sendCommand(gWorkBuffer);
phsfan 0:ca471c239d5f 1425
phsfan 0:ca471c239d5f 1426 if (getResult(gWorkBuffer, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1427 return (-1); // NG -- can't read
phsfan 0:ca471c239d5f 1428
phsfan 0:ca471c239d5f 1429 DEBUG_PRINT(">read()", gWorkBuffer);
phsfan 0:ca471c239d5f 1430
phsfan 0:ca471c239d5f 1431 // Parse response
phsfan 0:ca471c239d5f 1432 if (! strncmp(gWorkBuffer, "$TR=NG", 6)) {
phsfan 0:ca471c239d5f 1433 int errno = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1434 switch (errno) {
phsfan 0:ca471c239d5f 1435 case 635 : // Connection closed
phsfan 0:ca471c239d5f 1436 case 636 :
phsfan 0:ca471c239d5f 1437 return (-2);
phsfan 0:ca471c239d5f 1438 default : // Other error
phsfan 0:ca471c239d5f 1439 return (-1);
phsfan 0:ca471c239d5f 1440 }
phsfan 0:ca471c239d5f 1441 }
phsfan 0:ca471c239d5f 1442
phsfan 0:ca471c239d5f 1443 int nbytes = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1444 DEBUG_PRINT_NUM(">read() nbytes", nbytes);
phsfan 0:ca471c239d5f 1445
phsfan 0:ca471c239d5f 1446 // Copy response body into "result" and set "resultlength"
phsfan 0:ca471c239d5f 1447 for (int n = 0; n < nbytes; ) {
phsfan 0:ca471c239d5f 1448 while (!iemSerial.readable())
phsfan 0:ca471c239d5f 1449 ; // read until valid response
phsfan 0:ca471c239d5f 1450 c = iemSerial.getc();
phsfan 0:ca471c239d5f 1451 if (n < resultlength - 1)
phsfan 0:ca471c239d5f 1452 result[n] = c;
phsfan 0:ca471c239d5f 1453 n++;
phsfan 0:ca471c239d5f 1454 }
phsfan 0:ca471c239d5f 1455 discardUntil('\n'); // discard last '\n' -- @R2.0 Change
phsfan 0:ca471c239d5f 1456
phsfan 0:ca471c239d5f 1457 if (nbytes > resultlength - 1) { //@R2.0 Change
phsfan 0:ca471c239d5f 1458 result[resultlength - 1] = '\0';
phsfan 0:ca471c239d5f 1459 return (resultlength - 1); // OK
phsfan 0:ca471c239d5f 1460 }
phsfan 0:ca471c239d5f 1461 else {
phsfan 0:ca471c239d5f 1462 result[nbytes] = '\0';
phsfan 0:ca471c239d5f 1463 return nbytes; // OK
phsfan 0:ca471c239d5f 1464 }
phsfan 0:ca471c239d5f 1465 }
phsfan 0:ca471c239d5f 1466
phsfan 0:ca471c239d5f 1467 //***************************
phsfan 0:ca471c239d5f 1468 // read
phsfan 0:ca471c239d5f 1469 //
phsfan 0:ca471c239d5f 1470 // @description
phsfan 0:ca471c239d5f 1471 // Read (binary) data from current TCP/IP connection
phsfan 0:ca471c239d5f 1472 // @return value
phsfan 0:ca471c239d5f 1473 // -2 .. NG (Closed connection by other side)
phsfan 0:ca471c239d5f 1474 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1475 // 0 .. OK (No data)
phsfan 0:ca471c239d5f 1476 // 0 < .. OK (= read bytes)
phsfan 0:ca471c239d5f 1477 // @param
phsfan 0:ca471c239d5f 1478 // buffer : [OUT] read data(byte array, not '\0' terminated)
phsfan 0:ca471c239d5f 1479 // sz : binary data size(in byte)
phsfan 0:ca471c239d5f 1480 // @note
phsfan 0:ca471c239d5f 1481 // R2.3 Add this function
phsfan 0:ca471c239d5f 1482 //***************************
phsfan 0:ca471c239d5f 1483 int A3GS::read(uint8_t* buffer, size_t sz)
phsfan 0:ca471c239d5f 1484 {
phsfan 0:ca471c239d5f 1485 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 1486 int c;
phsfan 0:ca471c239d5f 1487 //--
phsfan 0:ca471c239d5f 1488 if (sz > (size_t)a3gsMAX_DATA_LENGTH)
phsfan 0:ca471c239d5f 1489 return -1; // NG -- Bad parameter
phsfan 0:ca471c239d5f 1490
phsfan 0:ca471c239d5f 1491 // Make command and send it
phsfan 0:ca471c239d5f 1492 sprintf(gWorkBuffer, "$TR %d", sz);
phsfan 0:ca471c239d5f 1493 sendCommand(gWorkBuffer);
phsfan 0:ca471c239d5f 1494
phsfan 0:ca471c239d5f 1495 if (getResult(gWorkBuffer, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1496 return (-1); // NG -- can't read
phsfan 0:ca471c239d5f 1497
phsfan 0:ca471c239d5f 1498 DEBUG_PRINT(">read()", gWorkBuffer);
phsfan 0:ca471c239d5f 1499
phsfan 0:ca471c239d5f 1500 // Parse response
phsfan 0:ca471c239d5f 1501 if (! strncmp(gWorkBuffer, "$TR=NG", 6)) {
phsfan 0:ca471c239d5f 1502 int errno = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1503 switch (errno) {
phsfan 0:ca471c239d5f 1504 case 635 : // Connection closed
phsfan 0:ca471c239d5f 1505 case 636 :
phsfan 0:ca471c239d5f 1506 return (-2);
phsfan 0:ca471c239d5f 1507 default : // Other error
phsfan 0:ca471c239d5f 1508 return (-1);
phsfan 0:ca471c239d5f 1509 }
phsfan 0:ca471c239d5f 1510 }
phsfan 0:ca471c239d5f 1511
phsfan 0:ca471c239d5f 1512 size_t nbytes = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1513 DEBUG_PRINT_NUM(">read() nbytes", nbytes);
phsfan 0:ca471c239d5f 1514
phsfan 0:ca471c239d5f 1515 // Copy response body into "result" and set "resultlength"
phsfan 0:ca471c239d5f 1516 size_t n;
phsfan 0:ca471c239d5f 1517 for (n = 0; n < nbytes; n++) {
phsfan 0:ca471c239d5f 1518 while (!iemSerial.readable())
phsfan 0:ca471c239d5f 1519 ; // read until valid response
phsfan 0:ca471c239d5f 1520 c = iemSerial.getc();
phsfan 0:ca471c239d5f 1521 if (n < sz)
phsfan 0:ca471c239d5f 1522 buffer[n] = (uint8_t)c;
phsfan 0:ca471c239d5f 1523 }
phsfan 0:ca471c239d5f 1524
phsfan 0:ca471c239d5f 1525 discardUntil('\n'); // discard last '\n'
phsfan 0:ca471c239d5f 1526
phsfan 0:ca471c239d5f 1527 return (int)((n < sz) ? n : sz); // OK
phsfan 0:ca471c239d5f 1528 }
phsfan 0:ca471c239d5f 1529
phsfan 0:ca471c239d5f 1530 //***************************
phsfan 0:ca471c239d5f 1531 // read
phsfan 0:ca471c239d5f 1532 //
phsfan 0:ca471c239d5f 1533 // @description
phsfan 0:ca471c239d5f 1534 // Read byte from current TCP/IP connection
phsfan 0:ca471c239d5f 1535 // @return value
phsfan 0:ca471c239d5f 1536 // -2 .. NG (Closed connection by other side)
phsfan 0:ca471c239d5f 1537 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1538 // -3 .. OK (No data)
phsfan 0:ca471c239d5f 1539 // 0..0xFF .. OK (= read byte)
phsfan 0:ca471c239d5f 1540 // @param
phsfan 0:ca471c239d5f 1541 // none
phsfan 0:ca471c239d5f 1542 // @note
phsfan 0:ca471c239d5f 1543 // This function is synchronized operation.
phsfan 0:ca471c239d5f 1544 // Change return value type at @R2.0
phsfan 0:ca471c239d5f 1545 //***************************
phsfan 0:ca471c239d5f 1546 int A3GS::read(void)
phsfan 0:ca471c239d5f 1547 {
phsfan 0:ca471c239d5f 1548 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 1549 int c; //@R2.0 Change
phsfan 0:ca471c239d5f 1550 //--
phsfan 0:ca471c239d5f 1551 // Send command
phsfan 0:ca471c239d5f 1552 sendCommand("$TR 1");
phsfan 0:ca471c239d5f 1553
phsfan 0:ca471c239d5f 1554 if (getResult(gWorkBuffer, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1555 return (-1); // NG -- can't read
phsfan 0:ca471c239d5f 1556
phsfan 0:ca471c239d5f 1557 DEBUG_PRINT(">read()", gWorkBuffer);
phsfan 0:ca471c239d5f 1558
phsfan 0:ca471c239d5f 1559 // Parse response
phsfan 0:ca471c239d5f 1560 if (! strncmp(gWorkBuffer, "$TR=NG", 6)) {
phsfan 0:ca471c239d5f 1561 int errno = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1562 switch (errno) {
phsfan 0:ca471c239d5f 1563 case 635 : // Connection closed
phsfan 0:ca471c239d5f 1564 case 636 :
phsfan 0:ca471c239d5f 1565 return (-2);
phsfan 0:ca471c239d5f 1566 default : // Other error
phsfan 0:ca471c239d5f 1567 return (-1);
phsfan 0:ca471c239d5f 1568 }
phsfan 0:ca471c239d5f 1569 }
phsfan 0:ca471c239d5f 1570
phsfan 0:ca471c239d5f 1571 size_t nbytes = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1572 DEBUG_PRINT_NUM(">read() nbytes", nbytes);
phsfan 0:ca471c239d5f 1573
phsfan 0:ca471c239d5f 1574 if (nbytes == 1) {
phsfan 0:ca471c239d5f 1575 while (!iemSerial.readable())
phsfan 0:ca471c239d5f 1576 ; // read valid response
phsfan 0:ca471c239d5f 1577 c = iemSerial.getc();
phsfan 0:ca471c239d5f 1578 }
phsfan 0:ca471c239d5f 1579 else // if (nbytes == 0)
phsfan 0:ca471c239d5f 1580 c = -3; // NG -- no data
phsfan 0:ca471c239d5f 1581
phsfan 0:ca471c239d5f 1582 discardUntil('\n'); // discard last '\n' -- @R2.0 Change
phsfan 0:ca471c239d5f 1583
phsfan 0:ca471c239d5f 1584 return c; // OK
phsfan 0:ca471c239d5f 1585 }
phsfan 0:ca471c239d5f 1586
phsfan 0:ca471c239d5f 1587 //***************************
phsfan 0:ca471c239d5f 1588 // put
phsfan 0:ca471c239d5f 1589 //
phsfan 0:ca471c239d5f 1590 // @description
phsfan 0:ca471c239d5f 1591 // Put data to non-volatile storage in 3G shield
phsfan 0:ca471c239d5f 1592 // @return value
phsfan 0:ca471c239d5f 1593 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1594 // 0 .. OK
phsfan 0:ca471c239d5f 1595 // @param
phsfan 0:ca471c239d5f 1596 // storageNum : [IN] Storage number (1..a3gsMAX_STORAGE_NUMBER)
phsfan 0:ca471c239d5f 1597 // buffer : [IN] Put data
phsfan 0:ca471c239d5f 1598 // sz : [IN] size of data (in bytes)
phsfan 0:ca471c239d5f 1599 // @note
phsfan 0:ca471c239d5f 1600 // @3.0 add
phsfan 0:ca471c239d5f 1601 //***************************
phsfan 0:ca471c239d5f 1602 int A3GS::put(int storageNum, uint8_t *buffer, size_t sz)
phsfan 0:ca471c239d5f 1603 {
phsfan 0:ca471c239d5f 1604 char responses[30]; // FORMAT: "$RW=OK nbytes\n" or "$RW=NG errno [info]\n"
phsfan 0:ca471c239d5f 1605 int length = sizeof(responses);
phsfan 0:ca471c239d5f 1606 //--
phsfan 0:ca471c239d5f 1607 if (storageNum < 0 || storageNum > a3gsMAX_STORAGE_NUMBER)
phsfan 0:ca471c239d5f 1608 return a3gsERROR; // NG -- Bad parameter
phsfan 0:ca471c239d5f 1609
phsfan 0:ca471c239d5f 1610 if (sz < 1 || sz > (size_t)a3gsMAX_STORAGE_LENGTH)
phsfan 0:ca471c239d5f 1611 return a3gsERROR; // NG -- too large data
phsfan 0:ca471c239d5f 1612
phsfan 0:ca471c239d5f 1613 // Make command and send it
phsfan 0:ca471c239d5f 1614 sprintf(responses, "$RW %d \"", storageNum);
phsfan 0:ca471c239d5f 1615 sendData(responses);
phsfan 0:ca471c239d5f 1616 while (sz-- > 0) {
phsfan 0:ca471c239d5f 1617 if (*buffer < 0x20) {
phsfan 0:ca471c239d5f 1618 char escaped[6];
phsfan 0:ca471c239d5f 1619 sprintf(escaped, "$x%02x", *buffer);
phsfan 0:ca471c239d5f 1620 iemSerial.puts(escaped);
phsfan 0:ca471c239d5f 1621 }
phsfan 0:ca471c239d5f 1622 else if (*buffer == '"')
phsfan 0:ca471c239d5f 1623 iemSerial.puts("$\"");
phsfan 0:ca471c239d5f 1624 else if (*buffer == '$')
phsfan 0:ca471c239d5f 1625 iemSerial.puts("$$");
phsfan 0:ca471c239d5f 1626 else
phsfan 0:ca471c239d5f 1627 iemSerial.putc(*buffer);
phsfan 0:ca471c239d5f 1628 buffer++;
phsfan 0:ca471c239d5f 1629 }
phsfan 0:ca471c239d5f 1630 sendCommand("\""); // execute $RW command
phsfan 0:ca471c239d5f 1631
phsfan 0:ca471c239d5f 1632 if (getResult(responses, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1633 return a3gsERROR; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1634
phsfan 0:ca471c239d5f 1635 DEBUG_PRINT(">put()", responses);
phsfan 0:ca471c239d5f 1636
phsfan 0:ca471c239d5f 1637 // parse response
phsfan 0:ca471c239d5f 1638 if (! strncmp(responses, "$RW=NG", 6))
phsfan 0:ca471c239d5f 1639 return a3gsERROR; // NG -- Can't connect
phsfan 0:ca471c239d5f 1640
phsfan 0:ca471c239d5f 1641 return a3gsSUCCESS; // OK
phsfan 0:ca471c239d5f 1642 }
phsfan 0:ca471c239d5f 1643
phsfan 0:ca471c239d5f 1644 //***************************
phsfan 0:ca471c239d5f 1645 // get
phsfan 0:ca471c239d5f 1646 //
phsfan 0:ca471c239d5f 1647 // @description
phsfan 0:ca471c239d5f 1648 // Get data from non-volatile storage in 3G shield
phsfan 0:ca471c239d5f 1649 // @return value
phsfan 0:ca471c239d5f 1650 // -1 .. NG (Error)
phsfan 0:ca471c239d5f 1651 // 0..a3gsMAX_STORAGE_LENGTH .. OK (length of data to get)
phsfan 0:ca471c239d5f 1652 // @param
phsfan 0:ca471c239d5f 1653 // storageNum : [IN] Storage number (1..a3gsMAX_STORAGE_NUMBER)
phsfan 0:ca471c239d5f 1654 // buffer : [OUT] Got data space
phsfan 0:ca471c239d5f 1655 // sz : [OUT] size of data (in bytes)
phsfan 0:ca471c239d5f 1656 // @note
phsfan 0:ca471c239d5f 1657 // @3.0 add
phsfan 0:ca471c239d5f 1658 //***************************
phsfan 0:ca471c239d5f 1659 int A3GS::get(int storageNum, uint8_t *buffer, size_t sz)
phsfan 0:ca471c239d5f 1660 {
phsfan 0:ca471c239d5f 1661 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 1662 int c;
phsfan 0:ca471c239d5f 1663 //--
phsfan 0:ca471c239d5f 1664 if (storageNum < 0 || storageNum > a3gsMAX_STORAGE_NUMBER)
phsfan 0:ca471c239d5f 1665 return a3gsERROR; // NG -- Bad parameter
phsfan 0:ca471c239d5f 1666
phsfan 0:ca471c239d5f 1667 if (sz > (size_t)a3gsMAX_STORAGE_LENGTH)
phsfan 0:ca471c239d5f 1668 return a3gsERROR; // NG -- Bad parameter
phsfan 0:ca471c239d5f 1669
phsfan 0:ca471c239d5f 1670 // Make command and send it
phsfan 0:ca471c239d5f 1671 sprintf(gWorkBuffer, "$RR %d", storageNum);
phsfan 0:ca471c239d5f 1672 sendCommand(gWorkBuffer);
phsfan 0:ca471c239d5f 1673
phsfan 0:ca471c239d5f 1674 if (getResult(gWorkBuffer, &length, TIMEOUT_NETWORK))
phsfan 0:ca471c239d5f 1675 return a3gsERROR; // NG -- can't read
phsfan 0:ca471c239d5f 1676
phsfan 0:ca471c239d5f 1677 DEBUG_PRINT(">get()", gWorkBuffer);
phsfan 0:ca471c239d5f 1678
phsfan 0:ca471c239d5f 1679 // Parse response
phsfan 0:ca471c239d5f 1680 if (! strncmp(gWorkBuffer, "$RR=NG", 6))
phsfan 0:ca471c239d5f 1681 return a3gsERROR; // NG -- can't read
phsfan 0:ca471c239d5f 1682
phsfan 0:ca471c239d5f 1683 size_t nbytes = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1684 DEBUG_PRINT_NUM(">get() nbytes", nbytes);
phsfan 0:ca471c239d5f 1685
phsfan 0:ca471c239d5f 1686 // Copy response body into "result" and set "resultlength"
phsfan 0:ca471c239d5f 1687 size_t n;
phsfan 0:ca471c239d5f 1688 for (n = 0; n < nbytes; n++) {
phsfan 0:ca471c239d5f 1689 while (!iemSerial.readable())
phsfan 0:ca471c239d5f 1690 ; // read until valid response
phsfan 0:ca471c239d5f 1691 c = iemSerial.getc();
phsfan 0:ca471c239d5f 1692 if (n < sz)
phsfan 0:ca471c239d5f 1693 buffer[n] = (uint8_t)c;
phsfan 0:ca471c239d5f 1694 }
phsfan 0:ca471c239d5f 1695 discardUntil('\n'); // discard last '\n'
phsfan 0:ca471c239d5f 1696
phsfan 0:ca471c239d5f 1697 return (int)((n < sz) ? n : sz); // OK
phsfan 0:ca471c239d5f 1698 }
phsfan 0:ca471c239d5f 1699
phsfan 0:ca471c239d5f 1700 //***************************
phsfan 0:ca471c239d5f 1701 // updateProfile
phsfan 0:ca471c239d5f 1702 //
phsfan 0:ca471c239d5f 1703 // @description
phsfan 0:ca471c239d5f 1704 // Update profile with encrypted data
phsfan 0:ca471c239d5f 1705 // @return value
phsfan 0:ca471c239d5f 1706 // -1 .. NG
phsfan 0:ca471c239d5f 1707 // 0 .. OK
phsfan 0:ca471c239d5f 1708 // @param
phsfan 0:ca471c239d5f 1709 // encryptedProfile : [IN] Encrypted profile
phsfan 0:ca471c239d5f 1710 // sz : [IN] bytes of encrypted profile
phsfan 0:ca471c239d5f 1711 // @note
phsfan 0:ca471c239d5f 1712 // @3.0 add
phsfan 0:ca471c239d5f 1713 //***************************
phsfan 0:ca471c239d5f 1714 int A3GS::updateProfile(const uint8_t *encryptedProfile, int sz)
phsfan 0:ca471c239d5f 1715 {
phsfan 0:ca471c239d5f 1716 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 1717 //--
phsfan 0:ca471c239d5f 1718 // Make command and send it
phsfan 0:ca471c239d5f 1719 sendData("$YD - \"");
phsfan 0:ca471c239d5f 1720 for (char *p = (char *)encryptedProfile; sz-- > 0; p++) {
phsfan 0:ca471c239d5f 1721 if (*p < 0x20) {
phsfan 0:ca471c239d5f 1722 char escaped[6];
phsfan 0:ca471c239d5f 1723 sprintf(escaped, "$x%02x", (uint8_t)*p);
phsfan 0:ca471c239d5f 1724 iemSerial.puts(escaped);
phsfan 0:ca471c239d5f 1725 // Serial.print(escaped);
phsfan 0:ca471c239d5f 1726 }
phsfan 0:ca471c239d5f 1727 else if (*p == '"') {
phsfan 0:ca471c239d5f 1728 iemSerial.puts("$\"");
phsfan 0:ca471c239d5f 1729 // Serial.print("$\"");
phsfan 0:ca471c239d5f 1730 }
phsfan 0:ca471c239d5f 1731 else if (*p == '$') {
phsfan 0:ca471c239d5f 1732 iemSerial.puts("$$");
phsfan 0:ca471c239d5f 1733 // Serial.print("$$");
phsfan 0:ca471c239d5f 1734 }
phsfan 0:ca471c239d5f 1735 else {
phsfan 0:ca471c239d5f 1736 iemSerial.putc(*p);
phsfan 0:ca471c239d5f 1737 // Serial.print((char)*p);
phsfan 0:ca471c239d5f 1738 }
phsfan 0:ca471c239d5f 1739 }
phsfan 0:ca471c239d5f 1740 sendCommand("\"");
phsfan 0:ca471c239d5f 1741
phsfan 0:ca471c239d5f 1742 if (getResult(gWorkBuffer, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 1743 return -1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1744
phsfan 0:ca471c239d5f 1745 // parse response
phsfan 0:ca471c239d5f 1746 if (! strncmp(gWorkBuffer, "$YD=NG", 6))
phsfan 0:ca471c239d5f 1747 return -1; // NG -- Can't do
phsfan 0:ca471c239d5f 1748
phsfan 0:ca471c239d5f 1749 return 0; // OK
phsfan 0:ca471c239d5f 1750 }
phsfan 0:ca471c239d5f 1751
phsfan 0:ca471c239d5f 1752 //***************************
phsfan 0:ca471c239d5f 1753 // encryptString
phsfan 0:ca471c239d5f 1754 //
phsfan 0:ca471c239d5f 1755 // @description
phsfan 0:ca471c239d5f 1756 // Encrypt string with password
phsfan 0:ca471c239d5f 1757 // @return value
phsfan 0:ca471c239d5f 1758 // -1 .. NG
phsfan 0:ca471c239d5f 1759 // 0 .. OK
phsfan 0:ca471c239d5f 1760 // @param
phsfan 0:ca471c239d5f 1761 // password : [IN] Password to encrypt
phsfan 0:ca471c239d5f 1762 // s : [IN] String to encrypt
phsfan 0:ca471c239d5f 1763 // @note
phsfan 0:ca471c239d5f 1764 // @3.0 add
phsfan 0:ca471c239d5f 1765 //***************************
phsfan 0:ca471c239d5f 1766 int A3GS::encryptString(const char *password, const char *s)
phsfan 0:ca471c239d5f 1767 {
phsfan 0:ca471c239d5f 1768 int length = sizeof(gWorkBuffer);
phsfan 0:ca471c239d5f 1769 //--
phsfan 0:ca471c239d5f 1770 // Make command and send it
phsfan 0:ca471c239d5f 1771 sendData("$YY ");
phsfan 0:ca471c239d5f 1772 sendData(password);
phsfan 0:ca471c239d5f 1773 sendData(" \"");
phsfan 0:ca471c239d5f 1774 sendData(s);
phsfan 0:ca471c239d5f 1775 sendCommand("\"");
phsfan 0:ca471c239d5f 1776
phsfan 0:ca471c239d5f 1777 if (getResult(gWorkBuffer, &length, TIMEOUT_LOCAL))
phsfan 0:ca471c239d5f 1778 return -1; // NG -- maybe timeout
phsfan 0:ca471c239d5f 1779
phsfan 0:ca471c239d5f 1780 // parse response
phsfan 0:ca471c239d5f 1781 if (! strncmp(gWorkBuffer, "$YY=NG", 6))
phsfan 0:ca471c239d5f 1782 return -1; // NG -- Can't encrypt
phsfan 0:ca471c239d5f 1783
phsfan 0:ca471c239d5f 1784 size_t nbytes = atoi(gWorkBuffer + 7);
phsfan 0:ca471c239d5f 1785 DEBUG_PRINT_NUM(">encrypt() nbytes", nbytes);
phsfan 0:ca471c239d5f 1786
phsfan 0:ca471c239d5f 1787 printf(">>");
phsfan 0:ca471c239d5f 1788 int c;
phsfan 0:ca471c239d5f 1789 for (int n = 0; n < (int)nbytes; n++) {
phsfan 0:ca471c239d5f 1790 while (!iemSerial.readable())
phsfan 0:ca471c239d5f 1791 ; // read until valid response
phsfan 0:ca471c239d5f 1792 c = iemSerial.getc();
phsfan 0:ca471c239d5f 1793 printf("\\x");
phsfan 0:ca471c239d5f 1794 printf("%02x", c);
phsfan 0:ca471c239d5f 1795 }
phsfan 0:ca471c239d5f 1796 printf("<<\r\n");
phsfan 0:ca471c239d5f 1797
phsfan 0:ca471c239d5f 1798 discardUntil('\n'); // discard last '\n'
phsfan 0:ca471c239d5f 1799
phsfan 0:ca471c239d5f 1800 return 0; // OK
phsfan 0:ca471c239d5f 1801 }
phsfan 0:ca471c239d5f 1802
phsfan 0:ca471c239d5f 1803
phsfan 0:ca471c239d5f 1804 //***
phsfan 0:ca471c239d5f 1805 // Private methods
phsfan 0:ca471c239d5f 1806 //***
phsfan 0:ca471c239d5f 1807
phsfan 0:ca471c239d5f 1808 // sendCommand() -- send command to iem with \n
phsfan 0:ca471c239d5f 1809 void A3GS::sendCommand(const char* cmd)
phsfan 0:ca471c239d5f 1810 {
phsfan 0:ca471c239d5f 1811 // Send command to IEM with '\n'
phsfan 0:ca471c239d5f 1812 iemSerial.puts(cmd);
phsfan 0:ca471c239d5f 1813 iemSerial.putc('\n');
phsfan 0:ca471c239d5f 1814 DEBUG_PRINT("<sendCommand()", cmd);
phsfan 0:ca471c239d5f 1815 }
phsfan 0:ca471c239d5f 1816
phsfan 0:ca471c239d5f 1817 // sendData() -- send data to iem without \n
phsfan 0:ca471c239d5f 1818 void A3GS::sendData(const char* data)
phsfan 0:ca471c239d5f 1819 {
phsfan 0:ca471c239d5f 1820 // Send data to IEM without '\n'
phsfan 0:ca471c239d5f 1821 iemSerial.puts(data);
phsfan 0:ca471c239d5f 1822 DEBUG_PRINT("<sendData()", data);
phsfan 0:ca471c239d5f 1823 }
phsfan 0:ca471c239d5f 1824
phsfan 0:ca471c239d5f 1825 // discardUntl() -- discard characters from iemSerial until match specified character
phsfan 0:ca471c239d5f 1826 void A3GS::discardUntil(const char match)
phsfan 0:ca471c239d5f 1827 {
phsfan 0:ca471c239d5f 1828 int c; //@R2.0 Change
phsfan 0:ca471c239d5f 1829 Timer millis;
phsfan 0:ca471c239d5f 1830 bool done = false;
phsfan 0:ca471c239d5f 1831 //--
phsfan 0:ca471c239d5f 1832 millis.start();
phsfan 0:ca471c239d5f 1833 while (! done) {
phsfan 0:ca471c239d5f 1834 if (millis.read_ms() >= TIMEOUT_LOCAL) {
phsfan 0:ca471c239d5f 1835 DEBUG_PRINT(">discardUntil()", "TIMEOUT");
phsfan 0:ca471c239d5f 1836 break; // Timeout !
phsfan 0:ca471c239d5f 1837 }
phsfan 0:ca471c239d5f 1838
phsfan 0:ca471c239d5f 1839 if (!iemSerial.readable())
phsfan 0:ca471c239d5f 1840 continue; // discard until valid response -- @R2.1 Change
phsfan 0:ca471c239d5f 1841
phsfan 0:ca471c239d5f 1842 c = iemSerial.getc();
phsfan 0:ca471c239d5f 1843 if (c == match)
phsfan 0:ca471c239d5f 1844 done = true;
phsfan 0:ca471c239d5f 1845 }
phsfan 0:ca471c239d5f 1846 }
phsfan 0:ca471c239d5f 1847
phsfan 0:ca471c239d5f 1848 // getResult() -- get result from IEM
phsfan 0:ca471c239d5f 1849 int A3GS::getResult(char *buf, int *len, uint32_t timeout)
phsfan 0:ca471c239d5f 1850 {
phsfan 0:ca471c239d5f 1851 Timer millis;
phsfan 0:ca471c239d5f 1852 bool completed = false;
phsfan 0:ca471c239d5f 1853 int length = 0;
phsfan 0:ca471c239d5f 1854 millis.start();
phsfan 0:ca471c239d5f 1855 while (! completed) {
phsfan 0:ca471c239d5f 1856 if (millis.read_ms() >= timeout) {
phsfan 0:ca471c239d5f 1857 DEBUG_PRINT(">getResult()", "TIMEOUT");
phsfan 0:ca471c239d5f 1858 return 1; // NG -- Timeout
phsfan 0:ca471c239d5f 1859 }
phsfan 0:ca471c239d5f 1860 if (!iemSerial.readable())
phsfan 0:ca471c239d5f 1861 continue;
phsfan 0:ca471c239d5f 1862 int c = iemSerial.getc();
phsfan 0:ca471c239d5f 1863 if (c >= 0x20 && c < 0x7f) {
phsfan 0:ca471c239d5f 1864 DBG("%c", c);
phsfan 0:ca471c239d5f 1865 } else {
phsfan 0:ca471c239d5f 1866 DBG("_%02x", c);
phsfan 0:ca471c239d5f 1867 }
phsfan 0:ca471c239d5f 1868 if (c == 0x0a) { // end of line
phsfan 0:ca471c239d5f 1869 if (buf[0] == '$')
phsfan 0:ca471c239d5f 1870 completed = true; // got result
phsfan 0:ca471c239d5f 1871 else
phsfan 0:ca471c239d5f 1872 length = 0; // got status, so retry
phsfan 0:ca471c239d5f 1873 }
phsfan 0:ca471c239d5f 1874 else if (length < *len - 1)
phsfan 0:ca471c239d5f 1875 buf[length++] = c;
phsfan 0:ca471c239d5f 1876 }
phsfan 0:ca471c239d5f 1877 buf[length] = '\0';
phsfan 0:ca471c239d5f 1878 *len = length;
phsfan 0:ca471c239d5f 1879
phsfan 0:ca471c239d5f 1880 DEBUG_PRINT("<getResult", buf);
phsfan 0:ca471c239d5f 1881
phsfan 0:ca471c239d5f 1882 return 0; // OK
phsfan 0:ca471c239d5f 1883 }
phsfan 0:ca471c239d5f 1884
phsfan 0:ca471c239d5f 1885 // handleINT0() -- Interrupt Service Routine(ISR) of INT0
phsfan 0:ca471c239d5f 1886 void A3GS::handleINT0(void)
phsfan 0:ca471c239d5f 1887 {
phsfan 0:ca471c239d5f 1888 // disable INT0
phsfan 0:ca471c239d5f 1889 _intin.fall(NULL);
phsfan 0:ca471c239d5f 1890
phsfan 0:ca471c239d5f 1891 (*SMShandler)(); // Call user handler(You can use other interrupts(UART, millis()..))
phsfan 0:ca471c239d5f 1892
phsfan 0:ca471c239d5f 1893 // Clear hander
phsfan 0:ca471c239d5f 1894 SMShandler = NULL;
phsfan 0:ca471c239d5f 1895 }
phsfan 0:ca471c239d5f 1896
phsfan 0:ca471c239d5f 1897 // END OF a3gs.cpp
phsfan 0:ca471c239d5f 1898