Net stack with AutoIP enabled

Dependencies:   mbed

Committer:
darran
Date:
Fri Jul 02 17:21:58 2010 +0000
Revision:
0:ac21159e27f4

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
darran 0:ac21159e27f4 1
darran 0:ac21159e27f4 2 /*
darran 0:ac21159e27f4 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
darran 0:ac21159e27f4 4
darran 0:ac21159e27f4 5 Permission is hereby granted, free of charge, to any person obtaining a copy
darran 0:ac21159e27f4 6 of this software and associated documentation files (the "Software"), to deal
darran 0:ac21159e27f4 7 in the Software without restriction, including without limitation the rights
darran 0:ac21159e27f4 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
darran 0:ac21159e27f4 9 copies of the Software, and to permit persons to whom the Software is
darran 0:ac21159e27f4 10 furnished to do so, subject to the following conditions:
darran 0:ac21159e27f4 11
darran 0:ac21159e27f4 12 The above copyright notice and this permission notice shall be included in
darran 0:ac21159e27f4 13 all copies or substantial portions of the Software.
darran 0:ac21159e27f4 14
darran 0:ac21159e27f4 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
darran 0:ac21159e27f4 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
darran 0:ac21159e27f4 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
darran 0:ac21159e27f4 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
darran 0:ac21159e27f4 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
darran 0:ac21159e27f4 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
darran 0:ac21159e27f4 21 THE SOFTWARE.
darran 0:ac21159e27f4 22 */
darran 0:ac21159e27f4 23
darran 0:ac21159e27f4 24 #include "MySQLClient.h"
darran 0:ac21159e27f4 25 #include "sha1.h" //For 4.1+ passwords
darran 0:ac21159e27f4 26 #include "mycrypt.h" //For 4.0- passwords
darran 0:ac21159e27f4 27
darran 0:ac21159e27f4 28 #define __DEBUG
darran 0:ac21159e27f4 29 #include "dbg/dbg.h"
darran 0:ac21159e27f4 30
darran 0:ac21159e27f4 31 #define MYSQL_TIMEOUT_MS 15000
darran 0:ac21159e27f4 32 #define MYSQL_PORT 3306
darran 0:ac21159e27f4 33
darran 0:ac21159e27f4 34 #define BUF_SIZE 256
darran 0:ac21159e27f4 35
darran 0:ac21159e27f4 36 #define CLIENT_LONG_PASSWORD 1
darran 0:ac21159e27f4 37 #define CLIENT_CONNECT_WITH_DB 8
darran 0:ac21159e27f4 38 #define CLIENT_PROTOCOL_41 512
darran 0:ac21159e27f4 39 #define CLIENT_INTERACTIVE 1024
darran 0:ac21159e27f4 40 #define CLIENT_SECURE_CONNECTION 32768
darran 0:ac21159e27f4 41
darran 0:ac21159e27f4 42 #define MIN(a,b) ((a)<(b)?(a):(b))
darran 0:ac21159e27f4 43 #define ABS(a) (((a)>0)?(a):0)
darran 0:ac21159e27f4 44
darran 0:ac21159e27f4 45 //MySQL commands
darran 0:ac21159e27f4 46 #define COM_QUIT 0x01 //Exit
darran 0:ac21159e27f4 47 #define COM_QUERY 0x03 //Execute an SQL query
darran 0:ac21159e27f4 48
darran 0:ac21159e27f4 49 //#define htons( x ) ( (( x << 8 ) & 0xFF00) | (( x >> 8 ) & 0x00FF) )
darran 0:ac21159e27f4 50 #define ntohs( x ) (htons(x))
darran 0:ac21159e27f4 51
darran 0:ac21159e27f4 52 /*#define htonl( x ) ( (( x << 24 ) & 0xFF000000) \
darran 0:ac21159e27f4 53 | (( x << 8 ) & 0x00FF0000) \
darran 0:ac21159e27f4 54 | (( x >> 8 ) & 0x0000FF00) \
darran 0:ac21159e27f4 55 | (( x >> 24 ) & 0x000000FF) )*/
darran 0:ac21159e27f4 56 #define htonl( x ) (x)
darran 0:ac21159e27f4 57 #define ntohl( x ) (htonl(x))
darran 0:ac21159e27f4 58
darran 0:ac21159e27f4 59 MySQLClient::MySQLClient() : NetService(false) /*Not owned by the pool*/, m_pCbItem(NULL), m_pCbMeth(NULL), m_pCb(NULL),
darran 0:ac21159e27f4 60 m_pTCPSocket(NULL), m_watchdog(), m_timeout(MYSQL_TIMEOUT_MS*1000), m_pDnsReq(NULL), m_closed(true),
darran 0:ac21159e27f4 61 m_host(), m_user(), m_password(), m_db(), m_state(MYSQL_CLOSED)
darran 0:ac21159e27f4 62 {
darran 0:ac21159e27f4 63 m_buf = new byte[BUF_SIZE];
darran 0:ac21159e27f4 64 m_pPos = m_buf;
darran 0:ac21159e27f4 65 m_len = 0;
darran 0:ac21159e27f4 66 m_size = BUF_SIZE;
darran 0:ac21159e27f4 67 }
darran 0:ac21159e27f4 68
darran 0:ac21159e27f4 69 MySQLClient::~MySQLClient()
darran 0:ac21159e27f4 70 {
darran 0:ac21159e27f4 71 close();
darran 0:ac21159e27f4 72 delete[] m_buf;
darran 0:ac21159e27f4 73 }
darran 0:ac21159e27f4 74
darran 0:ac21159e27f4 75 //High Level setup functions
darran 0:ac21159e27f4 76 MySQLResult MySQLClient::open(Host& host, const string& user, const string& password, const string& db, void (*pMethod)(MySQLResult)) //Non blocking
darran 0:ac21159e27f4 77 {
darran 0:ac21159e27f4 78 setOnResult(pMethod);
darran 0:ac21159e27f4 79 setup(host, user, password, db);
darran 0:ac21159e27f4 80 return MYSQL_PROCESSING;
darran 0:ac21159e27f4 81 }
darran 0:ac21159e27f4 82
darran 0:ac21159e27f4 83 #if 0 //Ref only
darran 0:ac21159e27f4 84 template<class T>
darran 0:ac21159e27f4 85 MySQLResult MySQLClient::open(Host& host, const string& user, const string& password, const string& db, T* pItem, void (T::*pMethod)(MySQLResult)) //Non blocking
darran 0:ac21159e27f4 86 {
darran 0:ac21159e27f4 87 setOnResult(pItem, pMethod);
darran 0:ac21159e27f4 88 setup(host, user, password, db);
darran 0:ac21159e27f4 89 return MYSQL_PROCESSING;
darran 0:ac21159e27f4 90 }
darran 0:ac21159e27f4 91 #endif
darran 0:ac21159e27f4 92
darran 0:ac21159e27f4 93 MySQLResult MySQLClient::sql(string& sqlCommand)
darran 0:ac21159e27f4 94 {
darran 0:ac21159e27f4 95 if(m_state!=MYSQL_COMMANDS)
darran 0:ac21159e27f4 96 return MYSQL_SETUP;
darran 0:ac21159e27f4 97 sendCommand(COM_QUERY, (byte*)sqlCommand.data(), sqlCommand.length());
darran 0:ac21159e27f4 98 return MYSQL_PROCESSING;
darran 0:ac21159e27f4 99 }
darran 0:ac21159e27f4 100
darran 0:ac21159e27f4 101 MySQLResult MySQLClient::exit()
darran 0:ac21159e27f4 102 {
darran 0:ac21159e27f4 103 sendCommand(COM_QUIT, NULL, 0);
darran 0:ac21159e27f4 104 close();
darran 0:ac21159e27f4 105 return MYSQL_OK;
darran 0:ac21159e27f4 106 }
darran 0:ac21159e27f4 107
darran 0:ac21159e27f4 108 void MySQLClient::setOnResult( void (*pMethod)(MySQLResult) )
darran 0:ac21159e27f4 109 {
darran 0:ac21159e27f4 110 m_pCb = pMethod;
darran 0:ac21159e27f4 111 m_pCbItem = NULL;
darran 0:ac21159e27f4 112 m_pCbMeth = NULL;
darran 0:ac21159e27f4 113 }
darran 0:ac21159e27f4 114
darran 0:ac21159e27f4 115 #if 0 //Ref only
darran 0:ac21159e27f4 116 template<class T>
darran 0:ac21159e27f4 117 void MySQLClient::setOnResult( T* pItem, void (T::*pMethod)(MySQLResult) )
darran 0:ac21159e27f4 118 {
darran 0:ac21159e27f4 119 m_pCb = NULL;
darran 0:ac21159e27f4 120 m_pCbItem = (CDummy*) pItem;
darran 0:ac21159e27f4 121 m_pCbMeth = (void (CDummy::*)(MySQLResult)) pMethod;
darran 0:ac21159e27f4 122 }
darran 0:ac21159e27f4 123 #endif
darran 0:ac21159e27f4 124
darran 0:ac21159e27f4 125 void MySQLClient::setTimeout(int ms)
darran 0:ac21159e27f4 126 {
darran 0:ac21159e27f4 127 m_timeout = 1000*ms;
darran 0:ac21159e27f4 128 }
darran 0:ac21159e27f4 129
darran 0:ac21159e27f4 130 void MySQLClient::poll() //Called by NetServices
darran 0:ac21159e27f4 131 {
darran 0:ac21159e27f4 132 if(m_closed)
darran 0:ac21159e27f4 133 {
darran 0:ac21159e27f4 134 return;
darran 0:ac21159e27f4 135 }
darran 0:ac21159e27f4 136 if(m_watchdog.read_us()>m_timeout)
darran 0:ac21159e27f4 137 {
darran 0:ac21159e27f4 138 onTimeout();
darran 0:ac21159e27f4 139 }
darran 0:ac21159e27f4 140 }
darran 0:ac21159e27f4 141
darran 0:ac21159e27f4 142 void MySQLClient::resetTimeout()
darran 0:ac21159e27f4 143 {
darran 0:ac21159e27f4 144 m_watchdog.reset();
darran 0:ac21159e27f4 145 m_watchdog.start();
darran 0:ac21159e27f4 146 }
darran 0:ac21159e27f4 147
darran 0:ac21159e27f4 148 void MySQLClient::init()
darran 0:ac21159e27f4 149 {
darran 0:ac21159e27f4 150 close(); //Remove previous elements
darran 0:ac21159e27f4 151 if(!m_closed) //Already opened
darran 0:ac21159e27f4 152 return;
darran 0:ac21159e27f4 153 m_state = MYSQL_HANDSHAKE;
darran 0:ac21159e27f4 154 m_pTCPSocket = new TCPSocket;
darran 0:ac21159e27f4 155 m_pTCPSocket->setOnEvent(this, &MySQLClient::onTCPSocketEvent);
darran 0:ac21159e27f4 156 m_closed = false;
darran 0:ac21159e27f4 157 }
darran 0:ac21159e27f4 158
darran 0:ac21159e27f4 159 void MySQLClient::close()
darran 0:ac21159e27f4 160 {
darran 0:ac21159e27f4 161 if(m_closed)
darran 0:ac21159e27f4 162 return;
darran 0:ac21159e27f4 163 m_state = MYSQL_CLOSED;
darran 0:ac21159e27f4 164 m_closed = true; //Prevent recursive calling or calling on an object being destructed by someone else
darran 0:ac21159e27f4 165 m_watchdog.stop(); //Stop timeout
darran 0:ac21159e27f4 166 m_watchdog.reset();
darran 0:ac21159e27f4 167 m_pTCPSocket->resetOnEvent();
darran 0:ac21159e27f4 168 m_pTCPSocket->close();
darran 0:ac21159e27f4 169 delete m_pTCPSocket;
darran 0:ac21159e27f4 170 m_pTCPSocket = NULL;
darran 0:ac21159e27f4 171 if( m_pDnsReq )
darran 0:ac21159e27f4 172 {
darran 0:ac21159e27f4 173 m_pDnsReq->close();
darran 0:ac21159e27f4 174 delete m_pDnsReq;
darran 0:ac21159e27f4 175 m_pDnsReq = NULL;
darran 0:ac21159e27f4 176 }
darran 0:ac21159e27f4 177 }
darran 0:ac21159e27f4 178
darran 0:ac21159e27f4 179 void MySQLClient::setup(Host& host, const string& user, const string& password, const string& db) //Setup connection, make DNS Req if necessary
darran 0:ac21159e27f4 180 {
darran 0:ac21159e27f4 181 init(); //Initialize client in known state, create socket
darran 0:ac21159e27f4 182 resetTimeout();
darran 0:ac21159e27f4 183 m_host = host;
darran 0:ac21159e27f4 184 if(!host.getPort())
darran 0:ac21159e27f4 185 host.setPort( MYSQL_PORT ); //Default port
darran 0:ac21159e27f4 186
darran 0:ac21159e27f4 187 m_user = user;
darran 0:ac21159e27f4 188 m_password = password;
darran 0:ac21159e27f4 189
darran 0:ac21159e27f4 190 m_db = db;
darran 0:ac21159e27f4 191
darran 0:ac21159e27f4 192 IpAddr ip;
darran 0:ac21159e27f4 193 if( !host.getIp().isNull() )
darran 0:ac21159e27f4 194 {
darran 0:ac21159e27f4 195 connect();
darran 0:ac21159e27f4 196 }
darran 0:ac21159e27f4 197 else //Need to do a DNS Query...
darran 0:ac21159e27f4 198 {
darran 0:ac21159e27f4 199 DBG("\r\nDNS Query...\r\n");
darran 0:ac21159e27f4 200 m_pDnsReq = new DNSRequest();
darran 0:ac21159e27f4 201 m_pDnsReq->setOnReply(this, &MySQLClient::onDNSReply);
darran 0:ac21159e27f4 202 m_pDnsReq->resolve(&m_host);
darran 0:ac21159e27f4 203 DBG("\r\nMySQLClient : DNSRequest %p\r\n", m_pDnsReq);
darran 0:ac21159e27f4 204 }
darran 0:ac21159e27f4 205 }
darran 0:ac21159e27f4 206
darran 0:ac21159e27f4 207 void MySQLClient::connect() //Start Connection
darran 0:ac21159e27f4 208 {
darran 0:ac21159e27f4 209 resetTimeout();
darran 0:ac21159e27f4 210 DBG("\r\nConnecting...\r\n");
darran 0:ac21159e27f4 211 m_pTCPSocket->connect(m_host);
darran 0:ac21159e27f4 212 m_packetId = 0;
darran 0:ac21159e27f4 213 }
darran 0:ac21159e27f4 214
darran 0:ac21159e27f4 215 void MySQLClient::handleHandshake()
darran 0:ac21159e27f4 216 {
darran 0:ac21159e27f4 217 readData();
darran 0:ac21159e27f4 218 if( ! (( m_len > 1 ) && ( memchr( m_buf + 1, 0, m_len ) != NULL )) )
darran 0:ac21159e27f4 219 {
darran 0:ac21159e27f4 220 DBG("Connected but could not find pcsz...\n");
darran 0:ac21159e27f4 221 onResult(MYSQL_PRTCL);
darran 0:ac21159e27f4 222 return;
darran 0:ac21159e27f4 223 }
darran 0:ac21159e27f4 224
darran 0:ac21159e27f4 225 DBG("Connected to server: %d bytes read ; Protocol version %d, mysql-%s.\n", m_len, m_buf[0], &m_buf[1]);
darran 0:ac21159e27f4 226
darran 0:ac21159e27f4 227 m_pPos = (byte*) memchr( (char*)(m_buf + 1), 0, m_len ) + 1;
darran 0:ac21159e27f4 228
darran 0:ac21159e27f4 229 sendAuth();
darran 0:ac21159e27f4 230 }
darran 0:ac21159e27f4 231
darran 0:ac21159e27f4 232 void MySQLClient::sendAuth()
darran 0:ac21159e27f4 233 {
darran 0:ac21159e27f4 234 if( m_len - (m_pPos - m_buf) != 44)
darran 0:ac21159e27f4 235 {
darran 0:ac21159e27f4 236 //We only support protocol >= mysql-4.1
darran 0:ac21159e27f4 237 DBG("Message after pcsz has wrong len (%d != 44)...\n", m_len - (m_pPos - m_buf));
darran 0:ac21159e27f4 238 onResult(MYSQL_PRTCL);
darran 0:ac21159e27f4 239 return;
darran 0:ac21159e27f4 240 }
darran 0:ac21159e27f4 241
darran 0:ac21159e27f4 242 uint16_t serverFlags = *((uint16_t*)&m_pPos[13]);
darran 0:ac21159e27f4 243 DBG("Server capabilities are %04X.\n", serverFlags);
darran 0:ac21159e27f4 244
darran 0:ac21159e27f4 245 uint32_t clientFlags = CLIENT_CONNECT_WITH_DB | CLIENT_PROTOCOL_41 | CLIENT_SECURE_CONNECTION | CLIENT_INTERACTIVE;;
darran 0:ac21159e27f4 246
darran 0:ac21159e27f4 247 //if(serverFlags & CLIENT_LONG_PASSWORD)
darran 0:ac21159e27f4 248
darran 0:ac21159e27f4 249 DBG("Using auth 4.1+\n");
darran 0:ac21159e27f4 250 //Encrypt pw using scramble
darran 0:ac21159e27f4 251 byte scramble[20+20]={0};
darran 0:ac21159e27f4 252 memcpy(scramble, m_pPos+4, 8);
darran 0:ac21159e27f4 253 memcpy(scramble+8, m_pPos+31, 12); // *(m_pPos+43) == 0 (zero-terminated char*)
darran 0:ac21159e27f4 254
darran 0:ac21159e27f4 255 byte stage1_hash[20] = {0};
darran 0:ac21159e27f4 256 sha1( (byte*)m_password.data(), m_password.length(), stage1_hash );
darran 0:ac21159e27f4 257
darran 0:ac21159e27f4 258 sha1( stage1_hash, 20, ((byte*)scramble + 20) );
darran 0:ac21159e27f4 259
darran 0:ac21159e27f4 260 byte token[20] = {0};
darran 0:ac21159e27f4 261 sha1( scramble, 40, token );
darran 0:ac21159e27f4 262
darran 0:ac21159e27f4 263 for(int i=0;i<20;i++)
darran 0:ac21159e27f4 264 token[i] = token[i] ^ stage1_hash[i];
darran 0:ac21159e27f4 265
darran 0:ac21159e27f4 266 clientFlags |= CLIENT_LONG_PASSWORD;
darran 0:ac21159e27f4 267
darran 0:ac21159e27f4 268 DBG("Building response\n");
darran 0:ac21159e27f4 269 //Build response
darran 0:ac21159e27f4 270
darran 0:ac21159e27f4 271 //BE
darran 0:ac21159e27f4 272 *((uint32_t*)&m_buf[0]) = htonl(clientFlags);
darran 0:ac21159e27f4 273 *((uint32_t*)&m_buf[4]) = BUF_SIZE; //Max packets size
darran 0:ac21159e27f4 274 m_buf[8] = 8; //latin1 charset
darran 0:ac21159e27f4 275 memset((char*)(m_buf+9),0,23);
darran 0:ac21159e27f4 276 strcpy((char*)(m_buf+32),m_user.c_str());
darran 0:ac21159e27f4 277 m_pPos = m_buf + 32 + m_user.length() + 1;
darran 0:ac21159e27f4 278 m_pPos[0] = 20;
darran 0:ac21159e27f4 279 memcpy((char*)&m_pPos[1],token,20);
darran 0:ac21159e27f4 280 strcpy((char*)(m_pPos+21),m_db.c_str());
darran 0:ac21159e27f4 281 m_len = 32 + m_user.length() + 1 + 21 + m_db.length() + 1;
darran 0:ac21159e27f4 282
darran 0:ac21159e27f4 283 //Save first part of scramble in case we need it again
darran 0:ac21159e27f4 284 memcpy(&m_buf[BUF_SIZE-8], scramble, 8);
darran 0:ac21159e27f4 285
darran 0:ac21159e27f4 286 m_state = MYSQL_AUTH;
darran 0:ac21159e27f4 287
darran 0:ac21159e27f4 288 DBG("Writing data\n");
darran 0:ac21159e27f4 289 writeData();
darran 0:ac21159e27f4 290 }
darran 0:ac21159e27f4 291
darran 0:ac21159e27f4 292 void MySQLClient::handleAuthResult()
darran 0:ac21159e27f4 293 {
darran 0:ac21159e27f4 294 readData();
darran 0:ac21159e27f4 295 if(m_len==1 && *m_buf==0xfe)
darran 0:ac21159e27f4 296 {
darran 0:ac21159e27f4 297 //Re-send auth using 4.0- auth
darran 0:ac21159e27f4 298 sendAuth323();
darran 0:ac21159e27f4 299 return;
darran 0:ac21159e27f4 300 }
darran 0:ac21159e27f4 301 m_watchdog.stop(); //Stop timeout
darran 0:ac21159e27f4 302 m_watchdog.reset();
darran 0:ac21159e27f4 303 if(m_len<2)
darran 0:ac21159e27f4 304 {
darran 0:ac21159e27f4 305 DBG("Response too short..\n");
darran 0:ac21159e27f4 306 onResult(MYSQL_PRTCL);
darran 0:ac21159e27f4 307 return;
darran 0:ac21159e27f4 308 }
darran 0:ac21159e27f4 309 DBG("RC=%d ",m_buf[0]);
darran 0:ac21159e27f4 310 if(m_buf[0]==0)
darran 0:ac21159e27f4 311 {
darran 0:ac21159e27f4 312 m_buf[m_len] = 0;
darran 0:ac21159e27f4 313 m_pPos = m_buf + 1;
darran 0:ac21159e27f4 314 m_pPos += m_buf[1] +1;
darran 0:ac21159e27f4 315 m_pPos += m_pPos[0];
darran 0:ac21159e27f4 316 m_pPos += 1;
darran 0:ac21159e27f4 317 DBG("(OK) : Server status %d, Message : %s\n", *((uint16_t*)&m_pPos[0]), m_pPos+4);
darran 0:ac21159e27f4 318 onResult(MYSQL_OK);
darran 0:ac21159e27f4 319 }
darran 0:ac21159e27f4 320 else
darran 0:ac21159e27f4 321 {
darran 0:ac21159e27f4 322 m_buf[m_len] = 0;
darran 0:ac21159e27f4 323 DBG("(Error %d) : %s\n", *((uint16_t*)&m_buf[1]), &m_buf[9]); //LE
darran 0:ac21159e27f4 324 onResult(MYSQL_AUTHFAILED);
darran 0:ac21159e27f4 325 return;
darran 0:ac21159e27f4 326 }
darran 0:ac21159e27f4 327 m_state = MYSQL_COMMANDS;
darran 0:ac21159e27f4 328 }
darran 0:ac21159e27f4 329
darran 0:ac21159e27f4 330 void MySQLClient::sendAuth323()
darran 0:ac21159e27f4 331 {
darran 0:ac21159e27f4 332 DBG("Using auth 4.0-\n");
darran 0:ac21159e27f4 333 byte scramble[8]={0};
darran 0:ac21159e27f4 334
darran 0:ac21159e27f4 335 memcpy(scramble, &m_buf[BUF_SIZE-8], 8); //Recover scramble
darran 0:ac21159e27f4 336
darran 0:ac21159e27f4 337 //memcpy(scramble+8, m_pPos+31, 12); // *(m_pPos+43) == 0 (zero-terminated char*)
darran 0:ac21159e27f4 338
darran 0:ac21159e27f4 339 byte token[9]={0};
darran 0:ac21159e27f4 340
darran 0:ac21159e27f4 341 scramble_323((char*)token, (const char*)scramble, m_password.c_str());
darran 0:ac21159e27f4 342
darran 0:ac21159e27f4 343 DBG("Building response\n");
darran 0:ac21159e27f4 344 //Build response
darran 0:ac21159e27f4 345
darran 0:ac21159e27f4 346 memcpy((char*)m_buf,token,9);
darran 0:ac21159e27f4 347 m_len = 9;
darran 0:ac21159e27f4 348
darran 0:ac21159e27f4 349 #if 0
darran 0:ac21159e27f4 350 *((uint32_t*)&m_buf[0]) = htonl(clientFlags);
darran 0:ac21159e27f4 351 *((uint32_t*)&m_buf[4]) = BUF_SIZE; //Max packets size
darran 0:ac21159e27f4 352 m_buf[8] = 8; //latin1 charset
darran 0:ac21159e27f4 353 memset((char*)(m_buf+9),0,23);
darran 0:ac21159e27f4 354 strcpy((char*)(m_buf+32),m_user.c_str());
darran 0:ac21159e27f4 355 m_pPos = m_buf + 32 + m_user.length() + 1;
darran 0:ac21159e27f4 356 m_pPos[0] = 8;
darran 0:ac21159e27f4 357 memcpy((char*)&m_pPos[1],token+1,8);
darran 0:ac21159e27f4 358 strcpy((char*)(m_pPos+9),m_db.c_str());
darran 0:ac21159e27f4 359 m_len = 32 + m_user.length() + 1 + 9 + m_db.length() + 1;
darran 0:ac21159e27f4 360 #endif
darran 0:ac21159e27f4 361
darran 0:ac21159e27f4 362 DBG("Writing data\n");
darran 0:ac21159e27f4 363 writeData();
darran 0:ac21159e27f4 364 }
darran 0:ac21159e27f4 365
darran 0:ac21159e27f4 366 void MySQLClient::sendCommand(byte command, byte* arg, int len)
darran 0:ac21159e27f4 367 {
darran 0:ac21159e27f4 368 DBG("Sending command %d, payload of len %d\n", command, len);
darran 0:ac21159e27f4 369 m_packetId=0;//Reset packet ID (New sequence)
darran 0:ac21159e27f4 370 m_buf[0] = command;
darran 0:ac21159e27f4 371 memcpy(&m_buf[1], arg, len);
darran 0:ac21159e27f4 372 m_len = 1 + len;
darran 0:ac21159e27f4 373 writeData();
darran 0:ac21159e27f4 374 m_watchdog.start();
darran 0:ac21159e27f4 375 }
darran 0:ac21159e27f4 376
darran 0:ac21159e27f4 377 void MySQLClient::handleCommandResult()
darran 0:ac21159e27f4 378 {
darran 0:ac21159e27f4 379 readData();
darran 0:ac21159e27f4 380 m_watchdog.stop(); //Stop timeout
darran 0:ac21159e27f4 381 m_watchdog.reset();
darran 0:ac21159e27f4 382 if(m_len<2)
darran 0:ac21159e27f4 383 {
darran 0:ac21159e27f4 384 DBG("Response too short..\n");
darran 0:ac21159e27f4 385 onResult(MYSQL_PRTCL);
darran 0:ac21159e27f4 386 return;
darran 0:ac21159e27f4 387 }
darran 0:ac21159e27f4 388 DBG("RC=%d ",m_buf[0]);
darran 0:ac21159e27f4 389 if(m_buf[0]==0)
darran 0:ac21159e27f4 390 {
darran 0:ac21159e27f4 391 DBG("(OK)\n");
darran 0:ac21159e27f4 392 onResult(MYSQL_OK);
darran 0:ac21159e27f4 393 }
darran 0:ac21159e27f4 394 else
darran 0:ac21159e27f4 395 {
darran 0:ac21159e27f4 396 m_buf[m_len] = 0;
darran 0:ac21159e27f4 397 DBG("(SQL Error %d) : %s\n", *((uint16_t*)&m_buf[1]), &m_buf[9]); //LE
darran 0:ac21159e27f4 398 onResult(MYSQL_SQL);
darran 0:ac21159e27f4 399 return;
darran 0:ac21159e27f4 400 }
darran 0:ac21159e27f4 401 }
darran 0:ac21159e27f4 402
darran 0:ac21159e27f4 403 void MySQLClient::readData() //Copy to buf
darran 0:ac21159e27f4 404 {
darran 0:ac21159e27f4 405 byte head[4];
darran 0:ac21159e27f4 406 int ret = m_pTCPSocket->recv((char*)head, 4); //Packet header
darran 0:ac21159e27f4 407 m_len = *((uint16_t*)&head[0]);
darran 0:ac21159e27f4 408 m_packetId = head[3];
darran 0:ac21159e27f4 409 DBG("Packet Id %d of length %d\n", head[3], m_len);
darran 0:ac21159e27f4 410 m_packetId++;
darran 0:ac21159e27f4 411 if(ret>0)
darran 0:ac21159e27f4 412 ret = m_pTCPSocket->recv((char*)m_buf, m_len);
darran 0:ac21159e27f4 413 if(ret < 0)//Error
darran 0:ac21159e27f4 414 {
darran 0:ac21159e27f4 415 onResult(MYSQL_CONN);
darran 0:ac21159e27f4 416 return;
darran 0:ac21159e27f4 417 }
darran 0:ac21159e27f4 418 if(ret < m_len)
darran 0:ac21159e27f4 419 {
darran 0:ac21159e27f4 420 DBG("WARN: Incomplete packet\n");
darran 0:ac21159e27f4 421 }
darran 0:ac21159e27f4 422 m_len = ret;
darran 0:ac21159e27f4 423 }
darran 0:ac21159e27f4 424
darran 0:ac21159e27f4 425 void MySQLClient::writeData() //Copy from buf
darran 0:ac21159e27f4 426 {
darran 0:ac21159e27f4 427 byte head[4] = { 0 };
darran 0:ac21159e27f4 428 *((uint16_t*)&head[0]) = m_len;
darran 0:ac21159e27f4 429 head[3] = m_packetId;
darran 0:ac21159e27f4 430 DBG("Packet Id %d\n", head[3]);
darran 0:ac21159e27f4 431 m_packetId++;
darran 0:ac21159e27f4 432 int ret = m_pTCPSocket->send((char*)head, 4); //Packet header
darran 0:ac21159e27f4 433 if(ret>0)
darran 0:ac21159e27f4 434 ret = m_pTCPSocket->send((char*)m_buf, m_len);
darran 0:ac21159e27f4 435 if(ret < 0)//Error
darran 0:ac21159e27f4 436 {
darran 0:ac21159e27f4 437 onResult(MYSQL_CONN);
darran 0:ac21159e27f4 438 return;
darran 0:ac21159e27f4 439 }
darran 0:ac21159e27f4 440 m_len = 0;//FIXME... incomplete packets handling
darran 0:ac21159e27f4 441 }
darran 0:ac21159e27f4 442
darran 0:ac21159e27f4 443 void MySQLClient::onTCPSocketEvent(TCPSocketEvent e)
darran 0:ac21159e27f4 444 {
darran 0:ac21159e27f4 445 DBG("\r\nEvent %d in MySQLClient::onTCPSocketEvent()\r\n", e);
darran 0:ac21159e27f4 446
darran 0:ac21159e27f4 447 if(m_closed)
darran 0:ac21159e27f4 448 {
darran 0:ac21159e27f4 449 DBG("\r\nWARN: Discarded\r\n");
darran 0:ac21159e27f4 450 return;
darran 0:ac21159e27f4 451 }
darran 0:ac21159e27f4 452
darran 0:ac21159e27f4 453 switch(e)
darran 0:ac21159e27f4 454 {
darran 0:ac21159e27f4 455 case TCPSOCKET_READABLE: //Incoming data
darran 0:ac21159e27f4 456 resetTimeout();
darran 0:ac21159e27f4 457 if(m_state == MYSQL_HANDSHAKE)
darran 0:ac21159e27f4 458 handleHandshake();
darran 0:ac21159e27f4 459 else if(m_state == MYSQL_AUTH)
darran 0:ac21159e27f4 460 handleAuthResult();
darran 0:ac21159e27f4 461 else if(m_state == MYSQL_COMMANDS)
darran 0:ac21159e27f4 462 handleCommandResult();
darran 0:ac21159e27f4 463 break;
darran 0:ac21159e27f4 464 case TCPSOCKET_WRITEABLE: //We can send data
darran 0:ac21159e27f4 465 resetTimeout();
darran 0:ac21159e27f4 466 break;
darran 0:ac21159e27f4 467 case TCPSOCKET_CONNECTED: //Connected, wait for handshake packet
darran 0:ac21159e27f4 468 resetTimeout();
darran 0:ac21159e27f4 469 break;
darran 0:ac21159e27f4 470 case TCPSOCKET_CONTIMEOUT:
darran 0:ac21159e27f4 471 case TCPSOCKET_CONRST:
darran 0:ac21159e27f4 472 case TCPSOCKET_CONABRT:
darran 0:ac21159e27f4 473 case TCPSOCKET_ERROR:
darran 0:ac21159e27f4 474 DBG("\r\nConnection error.\r\n");
darran 0:ac21159e27f4 475 onResult(MYSQL_CONN);
darran 0:ac21159e27f4 476 case TCPSOCKET_DISCONNECTED:
darran 0:ac21159e27f4 477 //There might still be some data available for reading
darran 0:ac21159e27f4 478 //So if we are in a reading state, do not close the socket yet
darran 0:ac21159e27f4 479 if(m_state != MYSQL_CLOSED)
darran 0:ac21159e27f4 480 {
darran 0:ac21159e27f4 481 onResult(MYSQL_CONN);
darran 0:ac21159e27f4 482 }
darran 0:ac21159e27f4 483 DBG("\r\nConnection closed by remote host.\r\n");
darran 0:ac21159e27f4 484 break;
darran 0:ac21159e27f4 485 }
darran 0:ac21159e27f4 486 }
darran 0:ac21159e27f4 487
darran 0:ac21159e27f4 488 void MySQLClient::onDNSReply(DNSReply r)
darran 0:ac21159e27f4 489 {
darran 0:ac21159e27f4 490 if(m_closed)
darran 0:ac21159e27f4 491 {
darran 0:ac21159e27f4 492 DBG("\r\nWARN: Discarded\r\n");
darran 0:ac21159e27f4 493 return;
darran 0:ac21159e27f4 494 }
darran 0:ac21159e27f4 495
darran 0:ac21159e27f4 496 if( r != DNS_FOUND )
darran 0:ac21159e27f4 497 {
darran 0:ac21159e27f4 498 DBG("\r\nCould not resolve hostname.\r\n");
darran 0:ac21159e27f4 499 onResult(MYSQL_DNS);
darran 0:ac21159e27f4 500 return;
darran 0:ac21159e27f4 501 }
darran 0:ac21159e27f4 502
darran 0:ac21159e27f4 503 DBG("\r\nDNS Resolved to %d.%d.%d.%d.\r\n",m_host.getIp()[0],m_host.getIp()[1],m_host.getIp()[2],m_host.getIp()[3]);
darran 0:ac21159e27f4 504 //If no error, m_host has been updated by m_pDnsReq so we're set to go !
darran 0:ac21159e27f4 505 m_pDnsReq->close();
darran 0:ac21159e27f4 506 delete m_pDnsReq;
darran 0:ac21159e27f4 507 m_pDnsReq = NULL;
darran 0:ac21159e27f4 508 connect();
darran 0:ac21159e27f4 509 }
darran 0:ac21159e27f4 510
darran 0:ac21159e27f4 511 void MySQLClient::onResult(MySQLResult r) //Called when exchange completed or on failure
darran 0:ac21159e27f4 512 {
darran 0:ac21159e27f4 513 if(m_pCbItem && m_pCbMeth)
darran 0:ac21159e27f4 514 (m_pCbItem->*m_pCbMeth)(r);
darran 0:ac21159e27f4 515 else if(m_pCb)
darran 0:ac21159e27f4 516 m_pCb(r);
darran 0:ac21159e27f4 517
darran 0:ac21159e27f4 518 if( (r==MYSQL_DNS) || (r==MYSQL_PRTCL) || (r==MYSQL_AUTHFAILED) || (r==MYSQL_TIMEOUT) || (r==MYSQL_CONN) ) //Fatal error, close connection
darran 0:ac21159e27f4 519 close();
darran 0:ac21159e27f4 520 }
darran 0:ac21159e27f4 521
darran 0:ac21159e27f4 522 void MySQLClient::onTimeout() //Connection has timed out
darran 0:ac21159e27f4 523 {
darran 0:ac21159e27f4 524 DBG("\r\nTimed out.\n");
darran 0:ac21159e27f4 525 onResult(MYSQL_DNS);
darran 0:ac21159e27f4 526 close();
darran 0:ac21159e27f4 527 }