mbed official / CellularModem

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   Socket lwip-sys lwip

Dependents:   CellularUSBModem CellularUSBModem

ip/PPPIPInterface.cpp@1:4a23efdf0da9, 2013-10-17 (annotated)

Committer:
bogdanm
Date:
Thu Oct 17 12:29:05 2013 +0300
Revision:
1:4a23efdf0da9
Child:
4:3fc75e611736
Initial release of the CellularModem library

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bogdanm 1:4a23efdf0da9 1 /* PPPIPInterface.cpp */
bogdanm 1:4a23efdf0da9 2 /* Copyright (C) 2012 mbed.org, MIT License
bogdanm 1:4a23efdf0da9 3 *
bogdanm 1:4a23efdf0da9 4 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
bogdanm 1:4a23efdf0da9 5 * and associated documentation files (the "Software"), to deal in the Software without restriction,
bogdanm 1:4a23efdf0da9 6 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
bogdanm 1:4a23efdf0da9 7 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
bogdanm 1:4a23efdf0da9 8 * furnished to do so, subject to the following conditions:
bogdanm 1:4a23efdf0da9 9 *
bogdanm 1:4a23efdf0da9 10 * The above copyright notice and this permission notice shall be included in all copies or
bogdanm 1:4a23efdf0da9 11 * substantial portions of the Software.
bogdanm 1:4a23efdf0da9 12 *
bogdanm 1:4a23efdf0da9 13 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
bogdanm 1:4a23efdf0da9 14 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
bogdanm 1:4a23efdf0da9 15 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
bogdanm 1:4a23efdf0da9 16 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
bogdanm 1:4a23efdf0da9 17 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
bogdanm 1:4a23efdf0da9 18 */
bogdanm 1:4a23efdf0da9 19
bogdanm 1:4a23efdf0da9 20 #define __DEBUG__ 0
bogdanm 1:4a23efdf0da9 21 #ifndef __MODULE__
bogdanm 1:4a23efdf0da9 22 #define __MODULE__ "PPPIPInterface.cpp"
bogdanm 1:4a23efdf0da9 23 #endif
bogdanm 1:4a23efdf0da9 24
bogdanm 1:4a23efdf0da9 25 #include "core/fwk.h"
bogdanm 1:4a23efdf0da9 26 #include "rtos.h"
bogdanm 1:4a23efdf0da9 27
bogdanm 1:4a23efdf0da9 28 #include <cstdio>
bogdanm 1:4a23efdf0da9 29 using std::sscanf;
bogdanm 1:4a23efdf0da9 30
bogdanm 1:4a23efdf0da9 31 #include "PPPIPInterface.h"
bogdanm 1:4a23efdf0da9 32
bogdanm 1:4a23efdf0da9 33 #define MSISDN "*99#"
bogdanm 1:4a23efdf0da9 34
bogdanm 1:4a23efdf0da9 35 #define CONNECT_CMD_PREFIX "ATD "
bogdanm 1:4a23efdf0da9 36 #define CONNECT_CMD_SUFFIX "\x0D"
bogdanm 1:4a23efdf0da9 37 #define EXPECTED_RESP_SUFFIX "\x0D" "\x0A" "CONNECT" "\x0D" "\x0A"
bogdanm 1:4a23efdf0da9 38 #define EXPECTED_RESP_DATARATE_SUFFIX "\x0D" "\x0A" "CONNECT %d" "\x0D" "\x0A"
bogdanm 1:4a23efdf0da9 39 #define EXPECTED_RESP_MIN_LEN 20
bogdanm 1:4a23efdf0da9 40 #define OK_RESP "\x0D" "\x0A" "OK" "\x0D" "\x0A"
bogdanm 1:4a23efdf0da9 41 #define ESCAPE_SEQ "+++"
bogdanm 1:4a23efdf0da9 42 #define HANGUP_CMD "ATH" "\x0D"
bogdanm 1:4a23efdf0da9 43 #define NO_CARRIER_RESP "\x0D" "\x0A" "NO CARRIER" "\x0D" "\x0A"
bogdanm 1:4a23efdf0da9 44 extern "C" {
bogdanm 1:4a23efdf0da9 45 #include "lwip/ip_addr.h"
bogdanm 1:4a23efdf0da9 46 #include "lwip/inet.h"
bogdanm 1:4a23efdf0da9 47 #include "lwip/err.h"
bogdanm 1:4a23efdf0da9 48 #include "lwip/dns.h"
bogdanm 1:4a23efdf0da9 49
bogdanm 1:4a23efdf0da9 50 #include "netif/ppp/ppp.h"
bogdanm 1:4a23efdf0da9 51 }
bogdanm 1:4a23efdf0da9 52
bogdanm 1:4a23efdf0da9 53 PPPIPInterface::PPPIPInterface(IOStream* pStream, const char* msisdn) : LwIPInterface(), m_linkStatusSphre(1), m_pppErrCode(0), m_pStream(pStream), m_streamAvail(true), m_pppd(-1)
bogdanm 1:4a23efdf0da9 54 {
bogdanm 1:4a23efdf0da9 55 m_connectCmd = new char[strlen(CONNECT_CMD_PREFIX) + strlen(msisdn) + strlen(CONNECT_CMD_SUFFIX) + 1];
bogdanm 1:4a23efdf0da9 56 sprintf(m_connectCmd, "%s%s%s", CONNECT_CMD_PREFIX, msisdn, CONNECT_CMD_SUFFIX);
bogdanm 1:4a23efdf0da9 57 m_expectedResp = new char[strlen(m_connectCmd) + strlen(EXPECTED_RESP_SUFFIX) + 1];
bogdanm 1:4a23efdf0da9 58 sprintf(m_expectedResp, "%s%s", m_connectCmd, EXPECTED_RESP_SUFFIX);
bogdanm 1:4a23efdf0da9 59 m_expectedRespDatarate = new char[strlen(m_connectCmd) + strlen(EXPECTED_RESP_DATARATE_SUFFIX) + 1];
bogdanm 1:4a23efdf0da9 60 sprintf(m_expectedRespDatarate, "%s%s", m_connectCmd, EXPECTED_RESP_DATARATE_SUFFIX);
bogdanm 1:4a23efdf0da9 61 m_linkStatusSphre.wait();
bogdanm 1:4a23efdf0da9 62 }
bogdanm 1:4a23efdf0da9 63
bogdanm 1:4a23efdf0da9 64 /*virtual*/ PPPIPInterface::~PPPIPInterface()
bogdanm 1:4a23efdf0da9 65 {
bogdanm 1:4a23efdf0da9 66 delete m_connectCmd;
bogdanm 1:4a23efdf0da9 67 delete m_expectedResp;
bogdanm 1:4a23efdf0da9 68 delete m_expectedRespDatarate;
bogdanm 1:4a23efdf0da9 69 }
bogdanm 1:4a23efdf0da9 70
bogdanm 1:4a23efdf0da9 71 /*virtual*/ int PPPIPInterface::init() //Init PPP-specific stuff, create the right bindings, etc
bogdanm 1:4a23efdf0da9 72 {
bogdanm 1:4a23efdf0da9 73 DBG("Initializing LwIP");
bogdanm 1:4a23efdf0da9 74 LwIPInterface::init(); //Init LwIP, NOT including PPP
bogdanm 1:4a23efdf0da9 75 DBG("Initializing PPP");
bogdanm 1:4a23efdf0da9 76 pppInit();
bogdanm 1:4a23efdf0da9 77 DBG("Done");
bogdanm 1:4a23efdf0da9 78 return OK;
bogdanm 1:4a23efdf0da9 79 }
bogdanm 1:4a23efdf0da9 80
bogdanm 1:4a23efdf0da9 81 int PPPIPInterface::setup(const char* user, const char* pw)
bogdanm 1:4a23efdf0da9 82 {
bogdanm 1:4a23efdf0da9 83 DBG("Configuring PPP authentication method");
bogdanm 1:4a23efdf0da9 84 pppSetAuth(PPPAUTHTYPE_ANY, user, pw);
bogdanm 1:4a23efdf0da9 85 DBG("Done");
bogdanm 1:4a23efdf0da9 86 return OK;
bogdanm 1:4a23efdf0da9 87 }
bogdanm 1:4a23efdf0da9 88
bogdanm 1:4a23efdf0da9 89 /*virtual*/ int PPPIPInterface::connect()
bogdanm 1:4a23efdf0da9 90 {
bogdanm 1:4a23efdf0da9 91 int ret;
bogdanm 1:4a23efdf0da9 92 char buf[32];
bogdanm 1:4a23efdf0da9 93 size_t len;
bogdanm 1:4a23efdf0da9 94 DBG("Trying to connect with PPP");
bogdanm 1:4a23efdf0da9 95
bogdanm 1:4a23efdf0da9 96 cleanupLink();
bogdanm 1:4a23efdf0da9 97
bogdanm 1:4a23efdf0da9 98 DBG("Sending %s", m_connectCmd);
bogdanm 1:4a23efdf0da9 99
bogdanm 1:4a23efdf0da9 100 ret = m_pStream->write((uint8_t*)m_connectCmd, strlen(m_connectCmd), osWaitForever);
bogdanm 1:4a23efdf0da9 101 if( ret != OK )
bogdanm 1:4a23efdf0da9 102 {
bogdanm 1:4a23efdf0da9 103 return NET_UNKNOWN;
bogdanm 1:4a23efdf0da9 104 }
bogdanm 1:4a23efdf0da9 105
bogdanm 1:4a23efdf0da9 106 DBG("Expect %s", m_expectedResp);
bogdanm 1:4a23efdf0da9 107
bogdanm 1:4a23efdf0da9 108 len = 0;
bogdanm 1:4a23efdf0da9 109 size_t readLen;
bogdanm 1:4a23efdf0da9 110 ret = m_pStream->read((uint8_t*)buf + len, &readLen, EXPECTED_RESP_MIN_LEN, 10000);
bogdanm 1:4a23efdf0da9 111 if( ret != OK )
bogdanm 1:4a23efdf0da9 112 {
bogdanm 1:4a23efdf0da9 113 return NET_UNKNOWN;
bogdanm 1:4a23efdf0da9 114 }
bogdanm 1:4a23efdf0da9 115 len += readLen;
bogdanm 1:4a23efdf0da9 116 while( (len < EXPECTED_RESP_MIN_LEN) || (buf[len-1] != LF) )
bogdanm 1:4a23efdf0da9 117 {
bogdanm 1:4a23efdf0da9 118 ret = m_pStream->read((uint8_t*)buf + len, &readLen, 1, 10000);
bogdanm 1:4a23efdf0da9 119 if( ret != OK )
bogdanm 1:4a23efdf0da9 120 {
bogdanm 1:4a23efdf0da9 121 return NET_UNKNOWN;
bogdanm 1:4a23efdf0da9 122 }
bogdanm 1:4a23efdf0da9 123 len += readLen;
bogdanm 1:4a23efdf0da9 124 }
bogdanm 1:4a23efdf0da9 125
bogdanm 1:4a23efdf0da9 126 buf[len]=0;
bogdanm 1:4a23efdf0da9 127
bogdanm 1:4a23efdf0da9 128 DBG("Got %s[len %d]", buf, len);
bogdanm 1:4a23efdf0da9 129
bogdanm 1:4a23efdf0da9 130 int datarate = 0;
bogdanm 1:4a23efdf0da9 131 if( (sscanf(buf, m_expectedRespDatarate, &datarate ) != 1) && (strcmp(m_expectedResp, buf) != 0) )
bogdanm 1:4a23efdf0da9 132 {
bogdanm 1:4a23efdf0da9 133 //Discard buffer
bogdanm 1:4a23efdf0da9 134 do //Clear buf
bogdanm 1:4a23efdf0da9 135 {
bogdanm 1:4a23efdf0da9 136 ret = m_pStream->read((uint8_t*)buf, &len, 32, 0);
bogdanm 1:4a23efdf0da9 137 } while( (ret == OK) && (len > 0) );
bogdanm 1:4a23efdf0da9 138 return NET_CONN;
bogdanm 1:4a23efdf0da9 139 }
bogdanm 1:4a23efdf0da9 140
bogdanm 1:4a23efdf0da9 141 DBG("Transport link open");
bogdanm 1:4a23efdf0da9 142 if(datarate != 0)
bogdanm 1:4a23efdf0da9 143 {
bogdanm 1:4a23efdf0da9 144 DBG("Datarate: %d bps", datarate);
bogdanm 1:4a23efdf0da9 145 }
bogdanm 1:4a23efdf0da9 146 m_linkStatusSphre.wait(0);
bogdanm 1:4a23efdf0da9 147 if((m_pppd != -1) && (m_pppErrCode == 0)) //Already connected
bogdanm 1:4a23efdf0da9 148 {
bogdanm 1:4a23efdf0da9 149 return NET_INVALID;
bogdanm 1:4a23efdf0da9 150 }
bogdanm 1:4a23efdf0da9 151
bogdanm 1:4a23efdf0da9 152 ret = pppOverSerialOpen(this, PPPIPInterface::linkStatusCb, this);
bogdanm 1:4a23efdf0da9 153 if(ret < 0)
bogdanm 1:4a23efdf0da9 154 {
bogdanm 1:4a23efdf0da9 155 switch(ret)
bogdanm 1:4a23efdf0da9 156 {
bogdanm 1:4a23efdf0da9 157 case PPPERR_OPEN:
bogdanm 1:4a23efdf0da9 158 default:
bogdanm 1:4a23efdf0da9 159 return NET_FULL; //All available resources are already used
bogdanm 1:4a23efdf0da9 160 }
bogdanm 1:4a23efdf0da9 161 }
bogdanm 1:4a23efdf0da9 162 m_pppd = ret; //PPP descriptor
bogdanm 1:4a23efdf0da9 163 m_linkStatusSphre.wait(); //Block indefinitely; there should be a timeout there
bogdanm 1:4a23efdf0da9 164 if(m_pppErrCode != PPPERR_NONE)
bogdanm 1:4a23efdf0da9 165 {
bogdanm 1:4a23efdf0da9 166 m_pppd = -1;
bogdanm 1:4a23efdf0da9 167 }
bogdanm 1:4a23efdf0da9 168 switch(m_pppErrCode)
bogdanm 1:4a23efdf0da9 169 {
bogdanm 1:4a23efdf0da9 170 case PPPERR_NONE: //Connected OK
bogdanm 1:4a23efdf0da9 171 return OK;
bogdanm 1:4a23efdf0da9 172 case PPPERR_CONNECT: //Connection lost
bogdanm 1:4a23efdf0da9 173 return NET_INTERRUPTED;
bogdanm 1:4a23efdf0da9 174 case PPPERR_AUTHFAIL: //Authentication failed
bogdanm 1:4a23efdf0da9 175 return NET_AUTH;
bogdanm 1:4a23efdf0da9 176 case PPPERR_PROTOCOL: //Protocol error
bogdanm 1:4a23efdf0da9 177 return NET_PROTOCOL;
bogdanm 1:4a23efdf0da9 178 default:
bogdanm 1:4a23efdf0da9 179 return NET_UNKNOWN;
bogdanm 1:4a23efdf0da9 180 }
bogdanm 1:4a23efdf0da9 181 }
bogdanm 1:4a23efdf0da9 182
bogdanm 1:4a23efdf0da9 183 /*virtual*/ int PPPIPInterface::disconnect()
bogdanm 1:4a23efdf0da9 184 {
bogdanm 1:4a23efdf0da9 185 int ret = m_linkStatusSphre.wait(0);
bogdanm 1:4a23efdf0da9 186 if(ret > 0) //Already disconnected?
bogdanm 1:4a23efdf0da9 187 {
bogdanm 1:4a23efdf0da9 188 m_pppd = -1; //Discard PPP descriptor
bogdanm 1:4a23efdf0da9 189 switch(m_pppErrCode)
bogdanm 1:4a23efdf0da9 190 {
bogdanm 1:4a23efdf0da9 191 case PPPERR_CONNECT: //Connection terminated
bogdanm 1:4a23efdf0da9 192 case PPPERR_AUTHFAIL: //Authentication failed
bogdanm 1:4a23efdf0da9 193 case PPPERR_PROTOCOL: //Protocol error
bogdanm 1:4a23efdf0da9 194 case PPPERR_USER:
bogdanm 1:4a23efdf0da9 195 return OK;
bogdanm 1:4a23efdf0da9 196 default:
bogdanm 1:4a23efdf0da9 197 return NET_UNKNOWN;
bogdanm 1:4a23efdf0da9 198 }
bogdanm 1:4a23efdf0da9 199 }
bogdanm 1:4a23efdf0da9 200 else
bogdanm 1:4a23efdf0da9 201 {
bogdanm 1:4a23efdf0da9 202 if(m_pppd == -1)
bogdanm 1:4a23efdf0da9 203 {
bogdanm 1:4a23efdf0da9 204 return NET_INVALID;
bogdanm 1:4a23efdf0da9 205 }
bogdanm 1:4a23efdf0da9 206 pppClose(m_pppd);
bogdanm 1:4a23efdf0da9 207 do
bogdanm 1:4a23efdf0da9 208 {
bogdanm 1:4a23efdf0da9 209 m_linkStatusSphre.wait(); //Block indefinitely; there should be a timeout there
bogdanm 1:4a23efdf0da9 210 DBG("Received PPP err code %d", m_pppErrCode);
bogdanm 1:4a23efdf0da9 211 } while(m_pppErrCode != PPPERR_USER);
bogdanm 1:4a23efdf0da9 212 m_pppd = -1; //Discard PPP descriptor
bogdanm 1:4a23efdf0da9 213 }
bogdanm 1:4a23efdf0da9 214
bogdanm 1:4a23efdf0da9 215 DBG("Sending %s", ESCAPE_SEQ);
bogdanm 1:4a23efdf0da9 216
bogdanm 1:4a23efdf0da9 217 ret = m_pStream->write((uint8_t*)ESCAPE_SEQ, strlen(ESCAPE_SEQ), osWaitForever);
bogdanm 1:4a23efdf0da9 218 if( ret != OK )
bogdanm 1:4a23efdf0da9 219 {
bogdanm 1:4a23efdf0da9 220 return NET_UNKNOWN;
bogdanm 1:4a23efdf0da9 221 }
bogdanm 1:4a23efdf0da9 222
bogdanm 1:4a23efdf0da9 223 cleanupLink();
bogdanm 1:4a23efdf0da9 224
bogdanm 1:4a23efdf0da9 225 return OK;
bogdanm 1:4a23efdf0da9 226 }
bogdanm 1:4a23efdf0da9 227
bogdanm 1:4a23efdf0da9 228
bogdanm 1:4a23efdf0da9 229 int PPPIPInterface::cleanupLink()
bogdanm 1:4a23efdf0da9 230 {
bogdanm 1:4a23efdf0da9 231 int ret;
bogdanm 1:4a23efdf0da9 232 char buf[32];
bogdanm 1:4a23efdf0da9 233 size_t len;
bogdanm 1:4a23efdf0da9 234
bogdanm 1:4a23efdf0da9 235 do //Clear buf
bogdanm 1:4a23efdf0da9 236 {
bogdanm 1:4a23efdf0da9 237 ret = m_pStream->read((uint8_t*)buf, &len, 32, 100);
bogdanm 1:4a23efdf0da9 238 if(ret == OK)
bogdanm 1:4a23efdf0da9 239 {
bogdanm 1:4a23efdf0da9 240 buf[len] = '\0';
bogdanm 1:4a23efdf0da9 241 DBG("Got %s", buf);
bogdanm 1:4a23efdf0da9 242 }
bogdanm 1:4a23efdf0da9 243 } while( (ret == OK) && (len > 0) );
bogdanm 1:4a23efdf0da9 244
bogdanm 1:4a23efdf0da9 245 DBG("Sending %s", HANGUP_CMD);
bogdanm 1:4a23efdf0da9 246
bogdanm 1:4a23efdf0da9 247 ret = m_pStream->write((uint8_t*)HANGUP_CMD, strlen(HANGUP_CMD), osWaitForever);
bogdanm 1:4a23efdf0da9 248 if( ret != OK )
bogdanm 1:4a23efdf0da9 249 {
bogdanm 1:4a23efdf0da9 250 return NET_UNKNOWN;
bogdanm 1:4a23efdf0da9 251 }
bogdanm 1:4a23efdf0da9 252
bogdanm 1:4a23efdf0da9 253 size_t readLen;
bogdanm 1:4a23efdf0da9 254
bogdanm 1:4a23efdf0da9 255 //Hangup
bogdanm 1:4a23efdf0da9 256 DBG("Expect %s", HANGUP_CMD);
bogdanm 1:4a23efdf0da9 257
bogdanm 1:4a23efdf0da9 258 len = 0;
bogdanm 1:4a23efdf0da9 259 while( len < strlen(HANGUP_CMD) )
bogdanm 1:4a23efdf0da9 260 {
bogdanm 1:4a23efdf0da9 261 ret = m_pStream->read((uint8_t*)buf + len, &readLen, strlen(HANGUP_CMD) - len, 100);
bogdanm 1:4a23efdf0da9 262 if( ret != OK )
bogdanm 1:4a23efdf0da9 263 {
bogdanm 1:4a23efdf0da9 264 break;
bogdanm 1:4a23efdf0da9 265 }
bogdanm 1:4a23efdf0da9 266 len += readLen;
bogdanm 1:4a23efdf0da9 267 /////
bogdanm 1:4a23efdf0da9 268 buf[len]=0;
bogdanm 1:4a23efdf0da9 269 DBG("Got %s", buf);
bogdanm 1:4a23efdf0da9 270 }
bogdanm 1:4a23efdf0da9 271
bogdanm 1:4a23efdf0da9 272 buf[len]=0;
bogdanm 1:4a23efdf0da9 273
bogdanm 1:4a23efdf0da9 274 DBG("Got %s[len %d]", buf, len);
bogdanm 1:4a23efdf0da9 275
bogdanm 1:4a23efdf0da9 276 //OK response
bogdanm 1:4a23efdf0da9 277 DBG("Expect %s", OK_RESP);
bogdanm 1:4a23efdf0da9 278
bogdanm 1:4a23efdf0da9 279 len = 0;
bogdanm 1:4a23efdf0da9 280 while( len < strlen(OK_RESP) )
bogdanm 1:4a23efdf0da9 281 {
bogdanm 1:4a23efdf0da9 282 ret = m_pStream->read((uint8_t*)buf + len, &readLen, strlen(OK_RESP) - len, 100);
bogdanm 1:4a23efdf0da9 283 if( ret != OK )
bogdanm 1:4a23efdf0da9 284 {
bogdanm 1:4a23efdf0da9 285 break;
bogdanm 1:4a23efdf0da9 286 }
bogdanm 1:4a23efdf0da9 287 len += readLen;
bogdanm 1:4a23efdf0da9 288 /////
bogdanm 1:4a23efdf0da9 289 buf[len]=0;
bogdanm 1:4a23efdf0da9 290 DBG("Got %s", buf);
bogdanm 1:4a23efdf0da9 291 }
bogdanm 1:4a23efdf0da9 292
bogdanm 1:4a23efdf0da9 293 buf[len]=0;
bogdanm 1:4a23efdf0da9 294
bogdanm 1:4a23efdf0da9 295 DBG("Got %s[len %d]", buf, len);
bogdanm 1:4a23efdf0da9 296
bogdanm 1:4a23efdf0da9 297 //NO CARRIER event
bogdanm 1:4a23efdf0da9 298 DBG("Expect %s", NO_CARRIER_RESP);
bogdanm 1:4a23efdf0da9 299
bogdanm 1:4a23efdf0da9 300 len = 0;
bogdanm 1:4a23efdf0da9 301 while( len < strlen(NO_CARRIER_RESP) )
bogdanm 1:4a23efdf0da9 302 {
bogdanm 1:4a23efdf0da9 303 ret = m_pStream->read((uint8_t*)buf + len, &readLen, strlen(NO_CARRIER_RESP) - len, 100);
bogdanm 1:4a23efdf0da9 304 if( ret != OK )
bogdanm 1:4a23efdf0da9 305 {
bogdanm 1:4a23efdf0da9 306 break;
bogdanm 1:4a23efdf0da9 307 }
bogdanm 1:4a23efdf0da9 308 len += readLen;
bogdanm 1:4a23efdf0da9 309 /////
bogdanm 1:4a23efdf0da9 310 buf[len]=0;
bogdanm 1:4a23efdf0da9 311 DBG("Got %s", buf);
bogdanm 1:4a23efdf0da9 312 }
bogdanm 1:4a23efdf0da9 313
bogdanm 1:4a23efdf0da9 314 buf[len]=0;
bogdanm 1:4a23efdf0da9 315
bogdanm 1:4a23efdf0da9 316 DBG("Got %s[len %d]", buf, len);
bogdanm 1:4a23efdf0da9 317
bogdanm 1:4a23efdf0da9 318 do //Clear buf
bogdanm 1:4a23efdf0da9 319 {
bogdanm 1:4a23efdf0da9 320 ret = m_pStream->read((uint8_t*)buf, &len, 32, 100);
bogdanm 1:4a23efdf0da9 321 if(ret == OK)
bogdanm 1:4a23efdf0da9 322 {
bogdanm 1:4a23efdf0da9 323 buf[len] = '\0';
bogdanm 1:4a23efdf0da9 324 DBG("Got %s", buf);
bogdanm 1:4a23efdf0da9 325 }
bogdanm 1:4a23efdf0da9 326 } while( (ret == OK) && (len > 0) );
bogdanm 1:4a23efdf0da9 327
bogdanm 1:4a23efdf0da9 328
bogdanm 1:4a23efdf0da9 329 return OK;
bogdanm 1:4a23efdf0da9 330 }
bogdanm 1:4a23efdf0da9 331
bogdanm 1:4a23efdf0da9 332 /*static*/ void PPPIPInterface::linkStatusCb(void *ctx, int errCode, void *arg) //PPP link status
bogdanm 1:4a23efdf0da9 333 {
bogdanm 1:4a23efdf0da9 334 PPPIPInterface* pIf = (PPPIPInterface*)ctx;
bogdanm 1:4a23efdf0da9 335 struct ppp_addrs* addrs = (struct ppp_addrs*) arg;
bogdanm 1:4a23efdf0da9 336
bogdanm 1:4a23efdf0da9 337 switch(errCode)
bogdanm 1:4a23efdf0da9 338 {
bogdanm 1:4a23efdf0da9 339 case PPPERR_NONE:
bogdanm 1:4a23efdf0da9 340 WARN("Connected via PPP.");
bogdanm 1:4a23efdf0da9 341 DBG("Local IP address: %s", inet_ntoa(addrs->our_ipaddr));
bogdanm 1:4a23efdf0da9 342 DBG("Netmask: %s", inet_ntoa(addrs->netmask));
bogdanm 1:4a23efdf0da9 343 DBG("Remote IP address: %s", inet_ntoa(addrs->his_ipaddr));
bogdanm 1:4a23efdf0da9 344 DBG("Primary DNS: %s", inet_ntoa(addrs->dns1));
bogdanm 1:4a23efdf0da9 345 DBG("Secondary DNS: %s", inet_ntoa(addrs->dns2));
bogdanm 1:4a23efdf0da9 346 //Setup DNS
bogdanm 1:4a23efdf0da9 347 if (addrs->dns1.addr != 0)
bogdanm 1:4a23efdf0da9 348 {
bogdanm 1:4a23efdf0da9 349 dns_setserver(0, (struct ip_addr*)&(addrs->dns1));
bogdanm 1:4a23efdf0da9 350 }
bogdanm 1:4a23efdf0da9 351 if (addrs->dns2.addr != 0)
bogdanm 1:4a23efdf0da9 352 {
bogdanm 1:4a23efdf0da9 353 dns_setserver(1, (struct ip_addr*)&(addrs->dns1));
bogdanm 1:4a23efdf0da9 354 }
bogdanm 1:4a23efdf0da9 355
bogdanm 1:4a23efdf0da9 356 pIf->setConnected(true);
bogdanm 1:4a23efdf0da9 357 pIf->setIPAddress(inet_ntoa(addrs->our_ipaddr));
bogdanm 1:4a23efdf0da9 358 break;
bogdanm 1:4a23efdf0da9 359 case PPPERR_CONNECT: //Connection lost
bogdanm 1:4a23efdf0da9 360 WARN("Connection lost/terminated");
bogdanm 1:4a23efdf0da9 361 pIf->setConnected(false);
bogdanm 1:4a23efdf0da9 362 break;
bogdanm 1:4a23efdf0da9 363 case PPPERR_AUTHFAIL: //Authentication failed
bogdanm 1:4a23efdf0da9 364 WARN("Authentication failed");
bogdanm 1:4a23efdf0da9 365 pIf->setConnected(false);
bogdanm 1:4a23efdf0da9 366 break;
bogdanm 1:4a23efdf0da9 367 case PPPERR_PROTOCOL: //Protocol error
bogdanm 1:4a23efdf0da9 368 WARN("Protocol error");
bogdanm 1:4a23efdf0da9 369 pIf->setConnected(false);
bogdanm 1:4a23efdf0da9 370 break;
bogdanm 1:4a23efdf0da9 371 case PPPERR_USER:
bogdanm 1:4a23efdf0da9 372 WARN("Disconnected by user");
bogdanm 1:4a23efdf0da9 373 pIf->setConnected(false);
bogdanm 1:4a23efdf0da9 374 break;
bogdanm 1:4a23efdf0da9 375 default:
bogdanm 1:4a23efdf0da9 376 WARN("Unknown error (%d)", errCode);
bogdanm 1:4a23efdf0da9 377 pIf->setConnected(false);
bogdanm 1:4a23efdf0da9 378 break;
bogdanm 1:4a23efdf0da9 379 }
bogdanm 1:4a23efdf0da9 380
bogdanm 1:4a23efdf0da9 381 pIf->m_linkStatusSphre.wait(0); //If previous event has not been handled, "delete" it now
bogdanm 1:4a23efdf0da9 382 pIf->m_pppErrCode = errCode;
bogdanm 1:4a23efdf0da9 383 pIf->m_linkStatusSphre.release();
bogdanm 1:4a23efdf0da9 384 }
bogdanm 1:4a23efdf0da9 385
bogdanm 1:4a23efdf0da9 386 //LwIP PPP implementation
bogdanm 1:4a23efdf0da9 387 extern "C"
bogdanm 1:4a23efdf0da9 388 {
bogdanm 1:4a23efdf0da9 389
bogdanm 1:4a23efdf0da9 390 /**
bogdanm 1:4a23efdf0da9 391 * Writes to the serial device.
bogdanm 1:4a23efdf0da9 392 *
bogdanm 1:4a23efdf0da9 393 * @param fd serial device handle
bogdanm 1:4a23efdf0da9 394 * @param data pointer to data to send
bogdanm 1:4a23efdf0da9 395 * @param len length (in bytes) of data to send
bogdanm 1:4a23efdf0da9 396 * @return number of bytes actually sent
bogdanm 1:4a23efdf0da9 397 *
bogdanm 1:4a23efdf0da9 398 * @note This function will block until all data can be sent.
bogdanm 1:4a23efdf0da9 399 */
bogdanm 1:4a23efdf0da9 400 u32_t sio_write(sio_fd_t fd, u8_t *data, u32_t len)
bogdanm 1:4a23efdf0da9 401 {
bogdanm 1:4a23efdf0da9 402 DBG("sio_write");
bogdanm 1:4a23efdf0da9 403 PPPIPInterface* pIf = (PPPIPInterface*)fd;
bogdanm 1:4a23efdf0da9 404 int ret;
bogdanm 1:4a23efdf0da9 405 if(!pIf->m_streamAvail) //If stream is not available (it is a shared resource) don't go further
bogdanm 1:4a23efdf0da9 406 {
bogdanm 1:4a23efdf0da9 407 return 0;
bogdanm 1:4a23efdf0da9 408 }
bogdanm 1:4a23efdf0da9 409 ret = pIf->m_pStream->write(data, len, osWaitForever); //Blocks until all data is sent or an error happens
bogdanm 1:4a23efdf0da9 410 if(ret != OK)
bogdanm 1:4a23efdf0da9 411 {
bogdanm 1:4a23efdf0da9 412 return 0;
bogdanm 1:4a23efdf0da9 413 }
bogdanm 1:4a23efdf0da9 414 return len;
bogdanm 1:4a23efdf0da9 415 }
bogdanm 1:4a23efdf0da9 416
bogdanm 1:4a23efdf0da9 417 /**
bogdanm 1:4a23efdf0da9 418 * Reads from the serial device.
bogdanm 1:4a23efdf0da9 419 *
bogdanm 1:4a23efdf0da9 420 * @param fd serial device handle
bogdanm 1:4a23efdf0da9 421 * @param data pointer to data buffer for receiving
bogdanm 1:4a23efdf0da9 422 * @param len maximum length (in bytes) of data to receive
bogdanm 1:4a23efdf0da9 423 * @return number of bytes actually received - may be 0 if aborted by sio_read_abort
bogdanm 1:4a23efdf0da9 424 *
bogdanm 1:4a23efdf0da9 425 * @note This function will block until data can be received. The blocking
bogdanm 1:4a23efdf0da9 426 * can be cancelled by calling sio_read_abort().
bogdanm 1:4a23efdf0da9 427 */
bogdanm 1:4a23efdf0da9 428 u32_t sio_read(sio_fd_t fd, u8_t *data, u32_t len)
bogdanm 1:4a23efdf0da9 429 {
bogdanm 1:4a23efdf0da9 430 DBG("sio_read");
bogdanm 1:4a23efdf0da9 431 PPPIPInterface* pIf = (PPPIPInterface*)fd;
bogdanm 1:4a23efdf0da9 432 int ret;
bogdanm 1:4a23efdf0da9 433 size_t readLen;
bogdanm 1:4a23efdf0da9 434 if(!pIf->m_streamAvail) //If stream is not available (it is a shared resource) don't go further
bogdanm 1:4a23efdf0da9 435 {
bogdanm 1:4a23efdf0da9 436 WARN("EXIT NOT AVAIL");
bogdanm 1:4a23efdf0da9 437 return 0;
bogdanm 1:4a23efdf0da9 438 }
bogdanm 1:4a23efdf0da9 439 ret = pIf->m_pStream->read(data, &readLen, len, osWaitForever); //Blocks until some data is received or an error happens
bogdanm 1:4a23efdf0da9 440 if(ret != OK)
bogdanm 1:4a23efdf0da9 441 {
bogdanm 1:4a23efdf0da9 442 return 0;
bogdanm 1:4a23efdf0da9 443 }
bogdanm 1:4a23efdf0da9 444 DBG("ret");
bogdanm 1:4a23efdf0da9 445 return readLen;
bogdanm 1:4a23efdf0da9 446 }
bogdanm 1:4a23efdf0da9 447
bogdanm 1:4a23efdf0da9 448 /**
bogdanm 1:4a23efdf0da9 449 * Aborts a blocking sio_read() call.
bogdanm 1:4a23efdf0da9 450 *
bogdanm 1:4a23efdf0da9 451 * @param fd serial device handle
bogdanm 1:4a23efdf0da9 452 */
bogdanm 1:4a23efdf0da9 453 void sio_read_abort(sio_fd_t fd)
bogdanm 1:4a23efdf0da9 454 {
bogdanm 1:4a23efdf0da9 455 DBG("sio_read_abort");
bogdanm 1:4a23efdf0da9 456 PPPIPInterface* pIf = (PPPIPInterface*)fd;
bogdanm 1:4a23efdf0da9 457 if(!pIf->m_streamAvail) //If stream is not available (it is a shared resource) don't go further
bogdanm 1:4a23efdf0da9 458 {
bogdanm 1:4a23efdf0da9 459 return;
bogdanm 1:4a23efdf0da9 460 }
bogdanm 1:4a23efdf0da9 461 pIf->m_pStream->abortRead();
bogdanm 1:4a23efdf0da9 462 DBG("ret");
bogdanm 1:4a23efdf0da9 463 }
bogdanm 1:4a23efdf0da9 464
bogdanm 1:4a23efdf0da9 465 }
bogdanm 1:4a23efdf0da9 466