Leest de waarde van een sensor binnen een maakt deze beschikbaar via internet

Dependencies:   NTPClient_NetServices mbed

Committer:
hendrikvincent
Date:
Mon Dec 02 09:01:23 2013 +0000
Revision:
0:05ccbd4f84f1
eerste programma;

Who changed what in which revision?

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