Andrew Lindsay
MQTTClient
Dependents: IoTGateway_Basic test
MQTTClient.cpp@8:f7afec229461, 2012-04-04 (annotated)
- Committer:
- SomeRandomBloke
- Date:
- Wed Apr 04 22:00:28 2012 +0000
- Revision:
- 8:f7afec229461
- Parent:
- 7:c12d2bfe40e2
- Child:
- 9:a0e39cea763a
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| SomeRandomBloke | 4:9e25b78e0352 | 1 | /* |
| SomeRandomBloke | 0:260fb10c0755 | 2 | MQTTClient.cpp |
| SomeRandomBloke | 0:260fb10c0755 | 3 | Based on MQTTClient from http://ceit.uq.edu.au/content/mqttclient-mbed-version-20 |
| SomeRandomBloke | 0:260fb10c0755 | 4 | A simple MQTT client for mbed, version 2.0 |
| SomeRandomBloke | 0:260fb10c0755 | 5 | By Yilun FAN, @CEIT, @JAN 2011 |
| SomeRandomBloke | 0:260fb10c0755 | 6 | |
| SomeRandomBloke | 0:260fb10c0755 | 7 | Bug fixes and additions by Andrew Lindsay (andrew [at] thiseldo [dot] co [dot] uk) |
| SomeRandomBloke | 0:260fb10c0755 | 8 | |
| SomeRandomBloke | 0:260fb10c0755 | 9 | Permission is hereby granted, free of charge, to any person obtaining a copy |
| SomeRandomBloke | 0:260fb10c0755 | 10 | of this software and associated documentation files (the "Software"), to deal |
| SomeRandomBloke | 0:260fb10c0755 | 11 | in the Software without restriction, including without limitation the rights |
| SomeRandomBloke | 0:260fb10c0755 | 12 | to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| SomeRandomBloke | 0:260fb10c0755 | 13 | copies of the Software, and to permit persons to whom the Software is |
| SomeRandomBloke | 0:260fb10c0755 | 14 | furnished to do so, subject to the following conditions: |
| SomeRandomBloke | 0:260fb10c0755 | 15 | |
| SomeRandomBloke | 0:260fb10c0755 | 16 | The above copyright notice and this permission notice shall be included in |
| SomeRandomBloke | 0:260fb10c0755 | 17 | all copies or substantial portions of the Software. |
| SomeRandomBloke | 0:260fb10c0755 | 18 | |
| SomeRandomBloke | 0:260fb10c0755 | 19 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| SomeRandomBloke | 0:260fb10c0755 | 20 | IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| SomeRandomBloke | 0:260fb10c0755 | 21 | FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
| SomeRandomBloke | 0:260fb10c0755 | 22 | AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| SomeRandomBloke | 0:260fb10c0755 | 23 | LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| SomeRandomBloke | 0:260fb10c0755 | 24 | OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| SomeRandomBloke | 0:260fb10c0755 | 25 | THE SOFTWARE. |
| SomeRandomBloke | 0:260fb10c0755 | 26 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 27 | |
| SomeRandomBloke | 0:260fb10c0755 | 28 | #include "MQTTClient.h" |
| SomeRandomBloke | 0:260fb10c0755 | 29 | |
| SomeRandomBloke | 1:a50b6c866a3b | 30 | /** Default Constructor |
| SomeRandomBloke | 1:a50b6c866a3b | 31 | */ |
| SomeRandomBloke | 1:a50b6c866a3b | 32 | MQTTClient::MQTTClient() {} |
| SomeRandomBloke | 1:a50b6c866a3b | 33 | |
| SomeRandomBloke | 1:a50b6c866a3b | 34 | /** Default Destructor |
| SomeRandomBloke | 1:a50b6c866a3b | 35 | */ |
| SomeRandomBloke | 1:a50b6c866a3b | 36 | MQTTClient::~MQTTClient() {} |
| SomeRandomBloke | 1:a50b6c866a3b | 37 | |
| SomeRandomBloke | 3:ac326c5b065c | 38 | /** Alternative Constructor with parameters |
| SomeRandomBloke | 1:a50b6c866a3b | 39 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 40 | * Allow object to be constructed with minimum parameters. |
| SomeRandomBloke | 1:a50b6c866a3b | 41 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 42 | * @param server The IP address of the server to connect to |
| SomeRandomBloke | 1:a50b6c866a3b | 43 | * @param port The TCP/IP port on the server to connect to |
| SomeRandomBloke | 1:a50b6c866a3b | 44 | * @param callback Callback function to handle subscription to topics |
| SomeRandomBloke | 1:a50b6c866a3b | 45 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 46 | MQTTClient::MQTTClient(IpAddr server, int port, void (*callback)(char*, char*)) { |
| SomeRandomBloke | 0:260fb10c0755 | 47 | this->port = port; |
| SomeRandomBloke | 0:260fb10c0755 | 48 | callback_server = callback; |
| SomeRandomBloke | 0:260fb10c0755 | 49 | serverIp = server; |
| SomeRandomBloke | 0:260fb10c0755 | 50 | connected = false; |
| SomeRandomBloke | 0:260fb10c0755 | 51 | sessionOpened = false; |
| SomeRandomBloke | 0:260fb10c0755 | 52 | timer.start(); |
| SomeRandomBloke | 0:260fb10c0755 | 53 | } |
| SomeRandomBloke | 0:260fb10c0755 | 54 | |
| SomeRandomBloke | 0:260fb10c0755 | 55 | |
| SomeRandomBloke | 1:a50b6c866a3b | 56 | /** MQTT initialisation method |
| SomeRandomBloke | 1:a50b6c866a3b | 57 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 58 | * Used when default constructor used and need to specify parameters at runtime |
| SomeRandomBloke | 1:a50b6c866a3b | 59 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 60 | * @param server The IP address of the server to connect to |
| SomeRandomBloke | 1:a50b6c866a3b | 61 | * @param port The TCP/IP port on the server to connect to |
| SomeRandomBloke | 1:a50b6c866a3b | 62 | * @param callback Callback function to handle subscription to topics |
| SomeRandomBloke | 1:a50b6c866a3b | 63 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 64 | void MQTTClient::init(IpAddr *server, int port, void (*callback)(char*, char*)) { |
| SomeRandomBloke | 0:260fb10c0755 | 65 | this->port = port; |
| SomeRandomBloke | 0:260fb10c0755 | 66 | callback_server = callback; |
| SomeRandomBloke | 0:260fb10c0755 | 67 | serverIp = *server; |
| SomeRandomBloke | 0:260fb10c0755 | 68 | this->userName = NULL; |
| SomeRandomBloke | 0:260fb10c0755 | 69 | this->password = NULL; |
| SomeRandomBloke | 0:260fb10c0755 | 70 | connected = false; |
| SomeRandomBloke | 0:260fb10c0755 | 71 | sessionOpened = false; |
| SomeRandomBloke | 0:260fb10c0755 | 72 | timer.start(); |
| SomeRandomBloke | 0:260fb10c0755 | 73 | } |
| SomeRandomBloke | 0:260fb10c0755 | 74 | |
| SomeRandomBloke | 1:a50b6c866a3b | 75 | /** A brief description of the function foo |
| SomeRandomBloke | 1:a50b6c866a3b | 76 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 77 | * More details about the function goes here |
| SomeRandomBloke | 1:a50b6c866a3b | 78 | * and here |
| SomeRandomBloke | 1:a50b6c866a3b | 79 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 80 | * @param server The IP address of the server to connect to |
| SomeRandomBloke | 1:a50b6c866a3b | 81 | * @param port The TCP/IP port on the server to connect to |
| SomeRandomBloke | 1:a50b6c866a3b | 82 | * @param userName Pointer to username string, zero terminated. Null for not used |
| SomeRandomBloke | 1:a50b6c866a3b | 83 | * @param password Pointer to password string, zero terminated. Null for not used |
| SomeRandomBloke | 1:a50b6c866a3b | 84 | * @param callback Callback function to handle subscription to topics |
| SomeRandomBloke | 1:a50b6c866a3b | 85 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 86 | void MQTTClient::init(IpAddr *server, int port, char *userName, char *password, void (*callback)(char*, char*)) { |
| SomeRandomBloke | 0:260fb10c0755 | 87 | this->port = port; |
| SomeRandomBloke | 0:260fb10c0755 | 88 | callback_server = callback; |
| SomeRandomBloke | 0:260fb10c0755 | 89 | serverIp = *server; |
| SomeRandomBloke | 0:260fb10c0755 | 90 | this->userName = userName; |
| SomeRandomBloke | 0:260fb10c0755 | 91 | this->password = password; |
| SomeRandomBloke | 0:260fb10c0755 | 92 | connected = false; |
| SomeRandomBloke | 0:260fb10c0755 | 93 | sessionOpened = false; |
| SomeRandomBloke | 0:260fb10c0755 | 94 | timer.start(); |
| SomeRandomBloke | 0:260fb10c0755 | 95 | } |
| SomeRandomBloke | 0:260fb10c0755 | 96 | |
| SomeRandomBloke | 1:a50b6c866a3b | 97 | /** Send a message of specified size |
| SomeRandomBloke | 1:a50b6c866a3b | 98 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 99 | * @param msg message string |
| SomeRandomBloke | 1:a50b6c866a3b | 100 | * @param size Size of the message to send |
| SomeRandomBloke | 1:a50b6c866a3b | 101 | * @returns value to indicate message sent successfully or not, -1 for error, 1 for success. |
| SomeRandomBloke | 1:a50b6c866a3b | 102 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 103 | int MQTTClient::send_data(const char* msg, int size) { |
| SomeRandomBloke | 0:260fb10c0755 | 104 | int transLen = pTCPSocket->send(msg, size); |
| SomeRandomBloke | 0:260fb10c0755 | 105 | |
| SomeRandomBloke | 0:260fb10c0755 | 106 | /*Check send length matches the message length*/ |
| SomeRandomBloke | 0:260fb10c0755 | 107 | if (transLen != size) { |
| SomeRandomBloke | 0:260fb10c0755 | 108 | for (int i = 0; i < size; i++) { |
| SomeRandomBloke | 0:260fb10c0755 | 109 | printf("%x, ", msg[i]); |
| SomeRandomBloke | 0:260fb10c0755 | 110 | } |
| SomeRandomBloke | 0:260fb10c0755 | 111 | printf("Error on send.\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 112 | return -1; |
| SomeRandomBloke | 0:260fb10c0755 | 113 | } |
| SomeRandomBloke | 0:260fb10c0755 | 114 | return 1; |
| SomeRandomBloke | 0:260fb10c0755 | 115 | } |
| SomeRandomBloke | 0:260fb10c0755 | 116 | |
| SomeRandomBloke | 1:a50b6c866a3b | 117 | /** Start a MQTT session, build CONNECT packet |
| SomeRandomBloke | 1:a50b6c866a3b | 118 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 119 | * @param id The client name shown on MQTT server. |
| SomeRandomBloke | 1:a50b6c866a3b | 120 | * @returns -1 for error, 1 for success |
| SomeRandomBloke | 1:a50b6c866a3b | 121 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 122 | int MQTTClient::open_session(char* id) { |
| SomeRandomBloke | 0:260fb10c0755 | 123 | /*variable header*/ |
| SomeRandomBloke | 0:260fb10c0755 | 124 | char var_header[] = {0x00,0x06,0x4d,0x51,0x49,0x73,0x64,0x70,0x03,0x02,0x00,KEEPALIVE/500,0x00,strlen(id)}; |
| SomeRandomBloke | 0:260fb10c0755 | 125 | |
| SomeRandomBloke | 0:260fb10c0755 | 126 | /*fixed header: 2 bytes, big endian*/ |
| SomeRandomBloke | 0:260fb10c0755 | 127 | char fixed_header[] = {MQTTCONNECT,12+strlen(id)+2}; |
| SomeRandomBloke | 0:260fb10c0755 | 128 | short usernameLen = strlen( userName ); |
| SomeRandomBloke | 0:260fb10c0755 | 129 | short passwordLen = strlen( password ); |
| SomeRandomBloke | 0:260fb10c0755 | 130 | var_header[9] |= (usernameLen > 0 ? 0x80 : 0x00 ); |
| SomeRandomBloke | 0:260fb10c0755 | 131 | var_header[9] |= (passwordLen > 0 ? 0x40 : 0x00 ); |
| SomeRandomBloke | 0:260fb10c0755 | 132 | |
| SomeRandomBloke | 0:260fb10c0755 | 133 | // printf("fixed %d, var %d id %d, username %d, password %d\n",sizeof(fixed_header), sizeof(var_header), sizeof(id), usernameLen, passwordLen ); |
| SomeRandomBloke | 8:f7afec229461 | 134 | char packet[sizeof(fixed_header) + sizeof(var_header) + sizeof(id) + 6 + usernameLen + (usernameLen > 0 ? 2 : 0) + passwordLen + (passwordLen > 0 ? 2 : 0) ]; |
| SomeRandomBloke | 0:260fb10c0755 | 135 | |
| SomeRandomBloke | 0:260fb10c0755 | 136 | memset(packet,0,sizeof(packet)); |
| SomeRandomBloke | 0:260fb10c0755 | 137 | memcpy(packet,fixed_header,sizeof(fixed_header)); |
| SomeRandomBloke | 0:260fb10c0755 | 138 | memcpy(packet+sizeof(fixed_header),var_header,sizeof(var_header)); |
| SomeRandomBloke | 0:260fb10c0755 | 139 | memcpy(packet+sizeof(fixed_header)+sizeof(var_header), id, strlen(id)); |
| SomeRandomBloke | 0:260fb10c0755 | 140 | if ( usernameLen > 0 ) { |
| SomeRandomBloke | 0:260fb10c0755 | 141 | packet[sizeof(fixed_header)+sizeof(var_header)+strlen(id)] = 0x00; |
| SomeRandomBloke | 0:260fb10c0755 | 142 | packet[sizeof(fixed_header)+sizeof(var_header)+strlen(id)+1] = usernameLen; |
| SomeRandomBloke | 0:260fb10c0755 | 143 | memcpy(packet+sizeof(fixed_header)+sizeof(var_header)+strlen(id)+2, userName, usernameLen); |
| SomeRandomBloke | 0:260fb10c0755 | 144 | packet[1] += (usernameLen + 2); |
| SomeRandomBloke | 0:260fb10c0755 | 145 | } |
| SomeRandomBloke | 0:260fb10c0755 | 146 | if ( passwordLen > 0 ) { |
| SomeRandomBloke | 0:260fb10c0755 | 147 | packet[sizeof(fixed_header)+sizeof(var_header)+strlen(id) + usernameLen + (usernameLen > 0 ? 2 : 0) ] = 0x00; |
| SomeRandomBloke | 0:260fb10c0755 | 148 | packet[sizeof(fixed_header)+sizeof(var_header)+strlen(id) + usernameLen + (usernameLen > 0 ? 2 : 0)+1] = passwordLen; |
| SomeRandomBloke | 0:260fb10c0755 | 149 | memcpy(packet+sizeof(fixed_header)+sizeof(var_header)+strlen(id)+ usernameLen + (usernameLen > 0 ? 2 : 0)+2, password, passwordLen); |
| SomeRandomBloke | 0:260fb10c0755 | 150 | packet[1] += (passwordLen + 2); |
| SomeRandomBloke | 0:260fb10c0755 | 151 | } |
| SomeRandomBloke | 0:260fb10c0755 | 152 | |
| SomeRandomBloke | 0:260fb10c0755 | 153 | /* printf("Packet length %d\n", sizeof(packet)); |
| SomeRandomBloke | 0:260fb10c0755 | 154 | for (int i = 0; i < sizeof(packet); i++) { |
| SomeRandomBloke | 0:260fb10c0755 | 155 | printf("%x, ", packet[i]); |
| SomeRandomBloke | 0:260fb10c0755 | 156 | } |
| SomeRandomBloke | 0:260fb10c0755 | 157 | printf("\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 158 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 159 | if (!send_data(packet, sizeof(packet))) { |
| SomeRandomBloke | 0:260fb10c0755 | 160 | return -1; |
| SomeRandomBloke | 0:260fb10c0755 | 161 | } |
| SomeRandomBloke | 0:260fb10c0755 | 162 | // printf("Sent\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 163 | return 1; |
| SomeRandomBloke | 0:260fb10c0755 | 164 | } |
| SomeRandomBloke | 0:260fb10c0755 | 165 | |
| SomeRandomBloke | 1:a50b6c866a3b | 166 | /** Open TCP port, connect to server on given IP address. |
| SomeRandomBloke | 1:a50b6c866a3b | 167 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 168 | * @param id The client name shown on MQTT server. |
| SomeRandomBloke | 1:a50b6c866a3b | 169 | * @returns -1: If connect to server failed. -2: Failed to open session on server. 1: Connection accessed. |
| SomeRandomBloke | 1:a50b6c866a3b | 170 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 171 | int MQTTClient::connect(char* id) { |
| SomeRandomBloke | 0:260fb10c0755 | 172 | clientId = id; |
| SomeRandomBloke | 0:260fb10c0755 | 173 | |
| SomeRandomBloke | 0:260fb10c0755 | 174 | /*Initial TCP socket*/ |
| SomeRandomBloke | 0:260fb10c0755 | 175 | pTCPSocket = new TCPSocket; |
| SomeRandomBloke | 0:260fb10c0755 | 176 | pTCPSocket->setOnEvent(this, &MQTTClient::onTCPSocketEvent); |
| SomeRandomBloke | 0:260fb10c0755 | 177 | |
| SomeRandomBloke | 0:260fb10c0755 | 178 | host.setPort(port); |
| SomeRandomBloke | 0:260fb10c0755 | 179 | host.setIp(serverIp); |
| SomeRandomBloke | 0:260fb10c0755 | 180 | host.setName("localhost"); |
| SomeRandomBloke | 0:260fb10c0755 | 181 | |
| SomeRandomBloke | 0:260fb10c0755 | 182 | /*Trying to connect to host*/ |
| SomeRandomBloke | 0:260fb10c0755 | 183 | printf("Trying to connect to host..\r\n\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 184 | TCPSocketErr err = pTCPSocket->connect(host); |
| SomeRandomBloke | 0:260fb10c0755 | 185 | |
| SomeRandomBloke | 0:260fb10c0755 | 186 | Net::poll(); |
| SomeRandomBloke | 0:260fb10c0755 | 187 | if (err) { |
| SomeRandomBloke | 0:260fb10c0755 | 188 | printf("Error connecting to host [%d]\r\n", (int) err); |
| SomeRandomBloke | 0:260fb10c0755 | 189 | return -1; |
| SomeRandomBloke | 0:260fb10c0755 | 190 | } |
| SomeRandomBloke | 0:260fb10c0755 | 191 | printf("Connect to host sucessed..\r\n\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 192 | |
| SomeRandomBloke | 0:260fb10c0755 | 193 | /*Wait TCP connection with server to be established*/ |
| SomeRandomBloke | 0:260fb10c0755 | 194 | int i = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 195 | while (!connected) { |
| SomeRandomBloke | 0:260fb10c0755 | 196 | Net::poll(); |
| SomeRandomBloke | 0:260fb10c0755 | 197 | wait(1); |
| SomeRandomBloke | 0:260fb10c0755 | 198 | i++; |
| SomeRandomBloke | 0:260fb10c0755 | 199 | printf("Wait for connections %d..\r\n", i); |
| SomeRandomBloke | 0:260fb10c0755 | 200 | if (i == 35) {//If wait too long, give up. |
| SomeRandomBloke | 0:260fb10c0755 | 201 | return -1; |
| SomeRandomBloke | 0:260fb10c0755 | 202 | } |
| SomeRandomBloke | 0:260fb10c0755 | 203 | } |
| SomeRandomBloke | 0:260fb10c0755 | 204 | |
| SomeRandomBloke | 0:260fb10c0755 | 205 | /*Send open session message to server*/ |
| SomeRandomBloke | 0:260fb10c0755 | 206 | open_session(id); |
| SomeRandomBloke | 0:260fb10c0755 | 207 | |
| SomeRandomBloke | 0:260fb10c0755 | 208 | /*Wait server notice of open sesion*/ |
| SomeRandomBloke | 7:c12d2bfe40e2 | 209 | i = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 210 | while (!sessionOpened) { |
| SomeRandomBloke | 0:260fb10c0755 | 211 | Net::poll(); |
| SomeRandomBloke | 0:260fb10c0755 | 212 | wait(1); |
| SomeRandomBloke | 7:c12d2bfe40e2 | 213 | if (!connected || ++i >30) { |
| SomeRandomBloke | 0:260fb10c0755 | 214 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 215 | } |
| SomeRandomBloke | 0:260fb10c0755 | 216 | printf("Wait for session..\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 217 | } |
| SomeRandomBloke | 0:260fb10c0755 | 218 | if (!connected) { |
| SomeRandomBloke | 0:260fb10c0755 | 219 | return -2; |
| SomeRandomBloke | 0:260fb10c0755 | 220 | } |
| SomeRandomBloke | 0:260fb10c0755 | 221 | lastActivity = timer.read_ms(); |
| SomeRandomBloke | 0:260fb10c0755 | 222 | return 1; |
| SomeRandomBloke | 0:260fb10c0755 | 223 | } |
| SomeRandomBloke | 0:260fb10c0755 | 224 | |
| SomeRandomBloke | 1:a50b6c866a3b | 225 | /** Publish a message on a topic. |
| SomeRandomBloke | 1:a50b6c866a3b | 226 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 227 | * @param pub_topic The topic name the massage will be publish on. |
| SomeRandomBloke | 1:a50b6c866a3b | 228 | * @param msg The massage to be published. |
| SomeRandomBloke | 1:a50b6c866a3b | 229 | * @returns -1: Failed to publish message. 1: Publish sucessed. |
| SomeRandomBloke | 1:a50b6c866a3b | 230 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 231 | int MQTTClient::publish(char* pub_topic, char* msg) { |
| SomeRandomBloke | 0:260fb10c0755 | 232 | uint8_t var_header_pub[strlen(pub_topic)+3]; |
| SomeRandomBloke | 0:260fb10c0755 | 233 | strcpy((char *)&var_header_pub[2], pub_topic); |
| SomeRandomBloke | 0:260fb10c0755 | 234 | var_header_pub[0] = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 235 | var_header_pub[1] = strlen(pub_topic); |
| SomeRandomBloke | 0:260fb10c0755 | 236 | var_header_pub[sizeof(var_header_pub)-1] = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 237 | |
| SomeRandomBloke | 0:260fb10c0755 | 238 | uint8_t fixed_header_pub[] = {MQTTPUBLISH,sizeof(var_header_pub)+strlen(msg)}; |
| SomeRandomBloke | 0:260fb10c0755 | 239 | |
| SomeRandomBloke | 0:260fb10c0755 | 240 | uint8_t packet_pub[sizeof(fixed_header_pub)+sizeof(var_header_pub)+strlen(msg)]; |
| SomeRandomBloke | 0:260fb10c0755 | 241 | memset(packet_pub,0,sizeof(packet_pub)); |
| SomeRandomBloke | 0:260fb10c0755 | 242 | memcpy(packet_pub,fixed_header_pub,sizeof(fixed_header_pub)); |
| SomeRandomBloke | 0:260fb10c0755 | 243 | memcpy(packet_pub+sizeof(fixed_header_pub),var_header_pub,sizeof(var_header_pub)); |
| SomeRandomBloke | 0:260fb10c0755 | 244 | memcpy(packet_pub+sizeof(fixed_header_pub)+sizeof(var_header_pub),msg,strlen(msg)); |
| SomeRandomBloke | 0:260fb10c0755 | 245 | |
| SomeRandomBloke | 0:260fb10c0755 | 246 | if (!send_data((char*)packet_pub, sizeof(packet_pub))) { |
| SomeRandomBloke | 0:260fb10c0755 | 247 | return -1; |
| SomeRandomBloke | 0:260fb10c0755 | 248 | } |
| SomeRandomBloke | 0:260fb10c0755 | 249 | return 1; |
| SomeRandomBloke | 0:260fb10c0755 | 250 | } |
| SomeRandomBloke | 0:260fb10c0755 | 251 | |
| SomeRandomBloke | 1:a50b6c866a3b | 252 | /** Disconnect from server |
| SomeRandomBloke | 1:a50b6c866a3b | 253 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 254 | void MQTTClient::disconnect() { |
| SomeRandomBloke | 0:260fb10c0755 | 255 | char packet_224[] = {0xe0, 0x00}; |
| SomeRandomBloke | 0:260fb10c0755 | 256 | send_data((char*)packet_224, 2); |
| SomeRandomBloke | 0:260fb10c0755 | 257 | |
| SomeRandomBloke | 0:260fb10c0755 | 258 | connected = false; |
| SomeRandomBloke | 0:260fb10c0755 | 259 | } |
| SomeRandomBloke | 0:260fb10c0755 | 260 | |
| SomeRandomBloke | 1:a50b6c866a3b | 261 | /** Read data from receive packet |
| SomeRandomBloke | 1:a50b6c866a3b | 262 | * Determine what needs to be done with packet. |
| SomeRandomBloke | 1:a50b6c866a3b | 263 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 264 | void MQTTClient::read_data() { |
| SomeRandomBloke | 0:260fb10c0755 | 265 | char buffer[1024]; |
| SomeRandomBloke | 0:260fb10c0755 | 266 | int len = 0, readLen; |
| SomeRandomBloke | 0:260fb10c0755 | 267 | |
| SomeRandomBloke | 0:260fb10c0755 | 268 | while ((readLen = pTCPSocket->recv(buffer, 1024)) != 0) { |
| SomeRandomBloke | 0:260fb10c0755 | 269 | len += readLen; |
| SomeRandomBloke | 0:260fb10c0755 | 270 | } |
| SomeRandomBloke | 0:260fb10c0755 | 271 | |
| SomeRandomBloke | 0:260fb10c0755 | 272 | buffer[len] = '\0'; |
| SomeRandomBloke | 0:260fb10c0755 | 273 | |
| SomeRandomBloke | 0:260fb10c0755 | 274 | |
| SomeRandomBloke | 0:260fb10c0755 | 275 | printf("Read length: %d %d\r\n", len, readLen); |
| SomeRandomBloke | 0:260fb10c0755 | 276 | |
| SomeRandomBloke | 0:260fb10c0755 | 277 | for (int i = 0; i < len; i++) { |
| SomeRandomBloke | 0:260fb10c0755 | 278 | printf("%2X ", buffer[i]); |
| SomeRandomBloke | 0:260fb10c0755 | 279 | } |
| SomeRandomBloke | 0:260fb10c0755 | 280 | printf("\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 281 | |
| SomeRandomBloke | 0:260fb10c0755 | 282 | char type = buffer[0]>>4; |
| SomeRandomBloke | 0:260fb10c0755 | 283 | if ( type == 2 ) { // CONNACK |
| SomeRandomBloke | 0:260fb10c0755 | 284 | printf("CONNACK\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 285 | |
| SomeRandomBloke | 0:260fb10c0755 | 286 | } else if (type == 3) { // PUBLISH |
| SomeRandomBloke | 0:260fb10c0755 | 287 | if (callback_server) { |
| SomeRandomBloke | 0:260fb10c0755 | 288 | short index = 1; |
| SomeRandomBloke | 0:260fb10c0755 | 289 | short multiplier = 1; |
| SomeRandomBloke | 0:260fb10c0755 | 290 | short value = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 291 | uint8_t digit; |
| SomeRandomBloke | 0:260fb10c0755 | 292 | do { |
| SomeRandomBloke | 0:260fb10c0755 | 293 | digit = buffer[index++]; |
| SomeRandomBloke | 0:260fb10c0755 | 294 | value += (digit & 127) * multiplier; |
| SomeRandomBloke | 0:260fb10c0755 | 295 | multiplier *= 128; |
| SomeRandomBloke | 0:260fb10c0755 | 296 | } while ((digit & 128) != 0); |
| SomeRandomBloke | 0:260fb10c0755 | 297 | printf( "variable length %d, index %d\n", value, index ); |
| SomeRandomBloke | 0:260fb10c0755 | 298 | |
| SomeRandomBloke | 0:260fb10c0755 | 299 | // uint8_t tl = (buffer[2]<<3)+buffer[3]; |
| SomeRandomBloke | 0:260fb10c0755 | 300 | uint8_t tl = (buffer[index]<<3)+buffer[index+1]; |
| SomeRandomBloke | 0:260fb10c0755 | 301 | printf("Topic len %d\n",tl); |
| SomeRandomBloke | 0:260fb10c0755 | 302 | char topic[tl+1]; |
| SomeRandomBloke | 0:260fb10c0755 | 303 | for (int i=0; i<tl; i++) { |
| SomeRandomBloke | 0:260fb10c0755 | 304 | topic[i] = buffer[index+2+i]; |
| SomeRandomBloke | 0:260fb10c0755 | 305 | } |
| SomeRandomBloke | 0:260fb10c0755 | 306 | topic[tl] = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 307 | // ignore msgID - only support QoS 0 subs |
| SomeRandomBloke | 0:260fb10c0755 | 308 | char *payload = buffer+index+2+tl; |
| SomeRandomBloke | 0:260fb10c0755 | 309 | callback_server(topic,(char*)payload); |
| SomeRandomBloke | 0:260fb10c0755 | 310 | } |
| SomeRandomBloke | 0:260fb10c0755 | 311 | } else if (type == 12) { // PINGREG -- Ask for alive |
| SomeRandomBloke | 0:260fb10c0755 | 312 | char packet_208[] = {0xd0, 0x00}; |
| SomeRandomBloke | 0:260fb10c0755 | 313 | send_data((char*)packet_208, 2); |
| SomeRandomBloke | 0:260fb10c0755 | 314 | lastActivity = timer.read_ms(); |
| SomeRandomBloke | 0:260fb10c0755 | 315 | } |
| SomeRandomBloke | 0:260fb10c0755 | 316 | } |
| SomeRandomBloke | 0:260fb10c0755 | 317 | |
| SomeRandomBloke | 1:a50b6c866a3b | 318 | /** Check for session opened |
| SomeRandomBloke | 1:a50b6c866a3b | 319 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 320 | void MQTTClient::read_open_session() { |
| SomeRandomBloke | 0:260fb10c0755 | 321 | char buffer[32]; |
| SomeRandomBloke | 0:260fb10c0755 | 322 | int len = 0, readLen; |
| SomeRandomBloke | 0:260fb10c0755 | 323 | |
| SomeRandomBloke | 0:260fb10c0755 | 324 | while ((readLen = pTCPSocket->recv(buffer, 32)) != 0) { |
| SomeRandomBloke | 0:260fb10c0755 | 325 | len += readLen; |
| SomeRandomBloke | 0:260fb10c0755 | 326 | } |
| SomeRandomBloke | 0:260fb10c0755 | 327 | |
| SomeRandomBloke | 0:260fb10c0755 | 328 | if (len == 4 && buffer[3] == 0) { |
| SomeRandomBloke | 0:260fb10c0755 | 329 | printf("Session opened\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 330 | sessionOpened = true; |
| SomeRandomBloke | 0:260fb10c0755 | 331 | } |
| SomeRandomBloke | 0:260fb10c0755 | 332 | } |
| SomeRandomBloke | 0:260fb10c0755 | 333 | |
| SomeRandomBloke | 1:a50b6c866a3b | 334 | /** Subscribe to a topic |
| SomeRandomBloke | 1:a50b6c866a3b | 335 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 336 | * @param topic The topic name to be subscribed. |
| SomeRandomBloke | 1:a50b6c866a3b | 337 | * @returns -1: Failed to subscribe to topic. 1: Subscribe sucessed. |
| SomeRandomBloke | 1:a50b6c866a3b | 338 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 339 | int MQTTClient::subscribe(char* topic) { |
| SomeRandomBloke | 0:260fb10c0755 | 340 | |
| SomeRandomBloke | 0:260fb10c0755 | 341 | if (connected) { |
| SomeRandomBloke | 0:260fb10c0755 | 342 | uint8_t var_header_topic[] = {0,10}; |
| SomeRandomBloke | 0:260fb10c0755 | 343 | uint8_t fixed_header_topic[] = {MQTTSUBSCRIBE,sizeof(var_header_topic)+strlen(topic)+3}; |
| SomeRandomBloke | 0:260fb10c0755 | 344 | |
| SomeRandomBloke | 0:260fb10c0755 | 345 | //utf topic |
| SomeRandomBloke | 0:260fb10c0755 | 346 | uint8_t utf_topic[strlen(topic)+3]; |
| SomeRandomBloke | 0:260fb10c0755 | 347 | strcpy((char *)&utf_topic[2], topic); |
| SomeRandomBloke | 0:260fb10c0755 | 348 | |
| SomeRandomBloke | 0:260fb10c0755 | 349 | utf_topic[0] = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 350 | utf_topic[1] = strlen(topic); |
| SomeRandomBloke | 0:260fb10c0755 | 351 | utf_topic[sizeof(utf_topic)-1] = 0; |
| SomeRandomBloke | 0:260fb10c0755 | 352 | |
| SomeRandomBloke | 0:260fb10c0755 | 353 | char packet_topic[sizeof(var_header_topic)+sizeof(fixed_header_topic)+strlen(topic)+3]; |
| SomeRandomBloke | 0:260fb10c0755 | 354 | memset(packet_topic,0,sizeof(packet_topic)); |
| SomeRandomBloke | 0:260fb10c0755 | 355 | memcpy(packet_topic,fixed_header_topic,sizeof(fixed_header_topic)); |
| SomeRandomBloke | 0:260fb10c0755 | 356 | memcpy(packet_topic+sizeof(fixed_header_topic),var_header_topic,sizeof(var_header_topic)); |
| SomeRandomBloke | 0:260fb10c0755 | 357 | memcpy(packet_topic+sizeof(fixed_header_topic)+sizeof(var_header_topic),utf_topic,sizeof(utf_topic)); |
| SomeRandomBloke | 0:260fb10c0755 | 358 | |
| SomeRandomBloke | 0:260fb10c0755 | 359 | if (!send_data(packet_topic, sizeof(packet_topic))) { |
| SomeRandomBloke | 0:260fb10c0755 | 360 | return -1; |
| SomeRandomBloke | 0:260fb10c0755 | 361 | } |
| SomeRandomBloke | 0:260fb10c0755 | 362 | return 1; |
| SomeRandomBloke | 0:260fb10c0755 | 363 | } |
| SomeRandomBloke | 0:260fb10c0755 | 364 | return -1; |
| SomeRandomBloke | 0:260fb10c0755 | 365 | } |
| SomeRandomBloke | 0:260fb10c0755 | 366 | |
| SomeRandomBloke | 1:a50b6c866a3b | 367 | /** Send heartbeat/keep-alive message |
| SomeRandomBloke | 1:a50b6c866a3b | 368 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 369 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 370 | void MQTTClient::live() { |
| SomeRandomBloke | 0:260fb10c0755 | 371 | if (connected) { |
| SomeRandomBloke | 0:260fb10c0755 | 372 | int t = timer.read_ms(); |
| SomeRandomBloke | 0:260fb10c0755 | 373 | if (t - lastActivity > KEEPALIVE) { |
| SomeRandomBloke | 0:260fb10c0755 | 374 | //Send 192 0 to broker |
| SomeRandomBloke | 0:260fb10c0755 | 375 | printf("Send 192\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 376 | char packet_192[] = {0xc0, 0x00}; |
| SomeRandomBloke | 0:260fb10c0755 | 377 | send_data((char*)packet_192, 2); |
| SomeRandomBloke | 0:260fb10c0755 | 378 | lastActivity = t; |
| SomeRandomBloke | 0:260fb10c0755 | 379 | } |
| SomeRandomBloke | 0:260fb10c0755 | 380 | } |
| SomeRandomBloke | 0:260fb10c0755 | 381 | } |
| SomeRandomBloke | 0:260fb10c0755 | 382 | |
| SomeRandomBloke | 1:a50b6c866a3b | 383 | /** TCP Socket event handling |
| SomeRandomBloke | 1:a50b6c866a3b | 384 | * |
| SomeRandomBloke | 1:a50b6c866a3b | 385 | * @param e Event object |
| SomeRandomBloke | 1:a50b6c866a3b | 386 | */ |
| SomeRandomBloke | 0:260fb10c0755 | 387 | void MQTTClient::onTCPSocketEvent(TCPSocketEvent e) { |
| SomeRandomBloke | 0:260fb10c0755 | 388 | switch (e) { |
| SomeRandomBloke | 0:260fb10c0755 | 389 | case TCPSOCKET_ACCEPT: |
| SomeRandomBloke | 0:260fb10c0755 | 390 | printf("New TCPSocketEvent: TCPSOCKET_ACCEPT\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 391 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 392 | case TCPSOCKET_CONNECTED: |
| SomeRandomBloke | 0:260fb10c0755 | 393 | printf("New TCPSocketEvent: TCPSOCKET_CONNECTED\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 394 | connected = true; |
| SomeRandomBloke | 0:260fb10c0755 | 395 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 396 | case TCPSOCKET_WRITEABLE: |
| SomeRandomBloke | 0:260fb10c0755 | 397 | printf("New TCPSocketEvent: TCPSOCKET_WRITEABLE\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 398 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 399 | case TCPSOCKET_READABLE: |
| SomeRandomBloke | 0:260fb10c0755 | 400 | printf("New TCPSocketEvent: TCPSOCKET_READABLE\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 401 | if (!sessionOpened) { |
| SomeRandomBloke | 0:260fb10c0755 | 402 | read_open_session(); |
| SomeRandomBloke | 0:260fb10c0755 | 403 | } |
| SomeRandomBloke | 0:260fb10c0755 | 404 | read_data(); |
| SomeRandomBloke | 0:260fb10c0755 | 405 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 406 | case TCPSOCKET_CONTIMEOUT: |
| SomeRandomBloke | 0:260fb10c0755 | 407 | printf("New TCPSocketEvent: TCPSOCKET_CONTIMEOUT\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 408 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 409 | case TCPSOCKET_CONRST: |
| SomeRandomBloke | 0:260fb10c0755 | 410 | printf("New TCPSocketEvent: TCPSOCKET_CONRST\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 411 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 412 | case TCPSOCKET_CONABRT: |
| SomeRandomBloke | 0:260fb10c0755 | 413 | printf("New TCPSocketEvent: TCPSOCKET_CONABRT\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 414 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 415 | case TCPSOCKET_ERROR: |
| SomeRandomBloke | 0:260fb10c0755 | 416 | printf("New TCPSocketEvent: TCPSOCKET_ERROR\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 417 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 418 | case TCPSOCKET_DISCONNECTED: |
| SomeRandomBloke | 0:260fb10c0755 | 419 | printf("New TCPSocketEvent: TCPSOCKET_DISCONNECTED\r\n"); |
| SomeRandomBloke | 0:260fb10c0755 | 420 | pTCPSocket->close(); |
| SomeRandomBloke | 0:260fb10c0755 | 421 | connected = false; |
| SomeRandomBloke | 0:260fb10c0755 | 422 | break; |
| SomeRandomBloke | 0:260fb10c0755 | 423 | } |
| SomeRandomBloke | 0:260fb10c0755 | 424 | } |