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: C12832_lcd EthernetInterface StatusReporter LM75B MQTT-ansond endpoint_core endpoint_mqtt mbed-rtos mbed
MQTTTransport.cpp@129:c4fa24308e33, 2014-03-16 (annotated)
- Committer:
- ansond
- Date:
- Sun Mar 16 17:30:59 2014 +0000
- Revision:
- 129:c4fa24308e33
- Parent:
- 93:e3b732068ae9
- Child:
- 130:9c52e163e733
updates
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| ansond | 0:ae2a45502448 | 1 | /* Copyright C2013 Doug Anson, MIT License |
| ansond | 0:ae2a45502448 | 2 | * |
| ansond | 0:ae2a45502448 | 3 | * Permission is hereby granted, free of charge, to any person obtaining a copy of this software |
| ansond | 0:ae2a45502448 | 4 | * and associated documentation files the "Software", to deal in the Software without restriction, |
| ansond | 0:ae2a45502448 | 5 | * including without limitation the rights to use, copy, modify, merge, publish, distribute, |
| ansond | 0:ae2a45502448 | 6 | * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is |
| ansond | 0:ae2a45502448 | 7 | * furnished to do so, subject to the following conditions: |
| ansond | 0:ae2a45502448 | 8 | * |
| ansond | 0:ae2a45502448 | 9 | * The above copyright notice and this permission notice shall be included in all copies or |
| ansond | 0:ae2a45502448 | 10 | * substantial portions of the Software. |
| ansond | 0:ae2a45502448 | 11 | * |
| ansond | 0:ae2a45502448 | 12 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING |
| ansond | 0:ae2a45502448 | 13 | * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| ansond | 0:ae2a45502448 | 14 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, |
| ansond | 0:ae2a45502448 | 15 | * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| ansond | 0:ae2a45502448 | 16 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
| ansond | 0:ae2a45502448 | 17 | */ |
| ansond | 0:ae2a45502448 | 18 | |
| ansond | 0:ae2a45502448 | 19 | #include "MQTTTransport.h" |
| ansond | 0:ae2a45502448 | 20 | |
| ansond | 4:11f00b499106 | 21 | // Endpoint Support |
| ansond | 0:ae2a45502448 | 22 | #include "MBEDEndpoint.h" |
| ansond | 0:ae2a45502448 | 23 | |
| ansond | 8:45f9a920e82c | 24 | // EmulatedResourceFactory support |
| ansond | 8:45f9a920e82c | 25 | #include "EmulatedResourceFactory.h" |
| ansond | 69:090e16acccb7 | 26 | |
| ansond | 0:ae2a45502448 | 27 | // our transmitt instance |
| ansond | 15:e44d75d95b38 | 28 | MQTTTransport *_mqtt_instance = NULL; |
| ansond | 0:ae2a45502448 | 29 | |
| ansond | 0:ae2a45502448 | 30 | // MQTT callback to handle received messages |
| ansond | 0:ae2a45502448 | 31 | void _mqtt_message_handler(char *topic,char *payload,unsigned int length) { |
| ansond | 129:c4fa24308e33 | 32 | if (_mqtt_instance != NULL) { |
| ansond | 129:c4fa24308e33 | 33 | if (_mqtt_instance->isPongMessage(topic,payload,length)) _mqtt_instance->processPongMessage(payload,length); |
| ansond | 129:c4fa24308e33 | 34 | else _mqtt_instance->processMessage(_mqtt_instance->getEndpointNameFromTopic(topic),payload,length); |
| ansond | 129:c4fa24308e33 | 35 | } |
| ansond | 0:ae2a45502448 | 36 | } |
| ansond | 0:ae2a45502448 | 37 | |
| ansond | 0:ae2a45502448 | 38 | // our MQTT client endpoint |
| ansond | 0:ae2a45502448 | 39 | PubSubClient _mqtt(MQTT_HOSTNAME,MQTT_HOSTPORT,_mqtt_message_handler); |
| ansond | 0:ae2a45502448 | 40 | |
| ansond | 0:ae2a45502448 | 41 | // default constructor |
| ansond | 15:e44d75d95b38 | 42 | MQTTTransport::MQTTTransport(ErrorHandler *error_handler,void *endpoint,MBEDToIOCResourceMap *map) : Transport(error_handler,endpoint) { |
| ansond | 0:ae2a45502448 | 43 | this->m_mqtt = NULL; |
| ansond | 15:e44d75d95b38 | 44 | _mqtt_instance = this; |
| ansond | 15:e44d75d95b38 | 45 | this->m_map = map; |
| ansond | 129:c4fa24308e33 | 46 | this->m_ping_counter = 1; |
| ansond | 129:c4fa24308e33 | 47 | this->m_ping_countdown = MQTT_PING_COUNTDOWN; |
| ansond | 8:45f9a920e82c | 48 | this->initTopic(); |
| ansond | 0:ae2a45502448 | 49 | } |
| ansond | 0:ae2a45502448 | 50 | |
| ansond | 0:ae2a45502448 | 51 | // default destructor |
| ansond | 0:ae2a45502448 | 52 | MQTTTransport::~MQTTTransport() { |
| ansond | 0:ae2a45502448 | 53 | this->disconnect(); |
| ansond | 0:ae2a45502448 | 54 | } |
| ansond | 0:ae2a45502448 | 55 | |
| ansond | 8:45f9a920e82c | 56 | // init our topic |
| ansond | 8:45f9a920e82c | 57 | void MQTTTransport::initTopic() { |
| ansond | 8:45f9a920e82c | 58 | MBEDEndpoint *endpoint = (MBEDEndpoint *)this->getEndpoint(); |
| ansond | 8:45f9a920e82c | 59 | char *endpoint_name = endpoint->getEndpointName(); |
| ansond | 8:45f9a920e82c | 60 | memset(this->m_topic,0,MQTT_IOC_TOPIC_LEN+1); |
| ansond | 8:45f9a920e82c | 61 | sprintf(this->m_topic,MQTT_IOC_TOPIC,endpoint_name); |
| ansond | 8:45f9a920e82c | 62 | } |
| ansond | 8:45f9a920e82c | 63 | |
| ansond | 8:45f9a920e82c | 64 | // get our topic |
| ansond | 8:45f9a920e82c | 65 | char *MQTTTransport::getTopic() { return this->m_topic; } |
| ansond | 8:45f9a920e82c | 66 | |
| ansond | 15:e44d75d95b38 | 67 | // get the IOC <--> MBED resource map |
| ansond | 15:e44d75d95b38 | 68 | MBEDToIOCResourceMap *MQTTTransport::getMap() { return this->m_map; } |
| ansond | 15:e44d75d95b38 | 69 | |
| ansond | 6:34c07e145caa | 70 | // pull the endpoint name from the MQTT topic |
| ansond | 6:34c07e145caa | 71 | char *MQTTTransport::getEndpointNameFromTopic(char *topic) { |
| ansond | 48:d3663434128d | 72 | if (topic != NULL) { |
| ansond | 48:d3663434128d | 73 | memset(this->m_endpoint_name,0,LIGHT_NAME_LEN+1); |
| ansond | 69:090e16acccb7 | 74 | char trash[MQTT_IOC_TOPIC_LEN+1]; |
| ansond | 69:090e16acccb7 | 75 | char ep[MQTT_IOC_TOPIC_LEN+1]; |
| ansond | 69:090e16acccb7 | 76 | memset(trash,0,MQTT_IOC_TOPIC_LEN+1); |
| ansond | 69:090e16acccb7 | 77 | memset(ep,0,MQTT_IOC_TOPIC_LEN+1); |
| ansond | 69:090e16acccb7 | 78 | bool done = false; |
| ansond | 69:090e16acccb7 | 79 | int length = 0; if (topic != NULL) length = strlen(topic); |
| ansond | 69:090e16acccb7 | 80 | for(int i=length-1;i>=0 && !done;--i) if (topic[i] == '/') { topic[i] = ' ' ; done = true; } |
| ansond | 69:090e16acccb7 | 81 | sscanf(topic,"%s%s",trash,ep); |
| ansond | 69:090e16acccb7 | 82 | if (strlen(ep) > 0) { |
| ansond | 69:090e16acccb7 | 83 | if (strcmp(ep,MQTT_IOC_ALL_ENDPOINT) != 0) { |
| ansond | 69:090e16acccb7 | 84 | // just insert the name and let the parser determine if its for us or not... |
| ansond | 69:090e16acccb7 | 85 | strncpy(this->m_endpoint_name,ep,strlen(ep)); |
| ansond | 69:090e16acccb7 | 86 | } |
| ansond | 69:090e16acccb7 | 87 | else { |
| ansond | 69:090e16acccb7 | 88 | // this is a broadcast message - so we need to process it |
| ansond | 69:090e16acccb7 | 89 | MBEDEndpoint *endpoint = (MBEDEndpoint *)this->getEndpoint(); |
| ansond | 69:090e16acccb7 | 90 | char *endpoint_name = endpoint->getEndpointName(); |
| ansond | 69:090e16acccb7 | 91 | strcpy(this->m_endpoint_name,endpoint_name); |
| ansond | 69:090e16acccb7 | 92 | } |
| ansond | 48:d3663434128d | 93 | } |
| ansond | 89:6e7dd4cba216 | 94 | //this->logger()->log("MQTT Topic (discovered): %s Original: %s",this->m_endpoint_name,topic); |
| ansond | 48:d3663434128d | 95 | return this->m_endpoint_name; |
| ansond | 48:d3663434128d | 96 | } |
| ansond | 89:6e7dd4cba216 | 97 | //this->logger()->log("MQTT Topic (discovered): NULL Original: %s",topic); |
| ansond | 48:d3663434128d | 98 | return NULL; |
| ansond | 6:34c07e145caa | 99 | } |
| ansond | 6:34c07e145caa | 100 | |
| ansond | 0:ae2a45502448 | 101 | // process a MQTT Message |
| ansond | 69:090e16acccb7 | 102 | void MQTTTransport::processMessage(char *message_name,char *payload, unsigned int payload_length) { |
| ansond | 69:090e16acccb7 | 103 | char message_type[MQTT_PAYLOAD_SEGMENT_LEN+1]; |
| ansond | 69:090e16acccb7 | 104 | char message_verb[MQTT_PAYLOAD_SEGMENT_LEN+1]; |
| ansond | 69:090e16acccb7 | 105 | char message_value[MQTT_PAYLOAD_SEGMENT_LEN+1]; |
| ansond | 69:090e16acccb7 | 106 | char message_opt[MQTT_PAYLOAD_SEGMENT_LEN+1]; |
| ansond | 69:090e16acccb7 | 107 | |
| ansond | 69:090e16acccb7 | 108 | // initialize |
| ansond | 69:090e16acccb7 | 109 | memset(message_type,0,MQTT_PAYLOAD_SEGMENT_LEN+1); |
| ansond | 69:090e16acccb7 | 110 | memset(message_verb,0,MQTT_PAYLOAD_SEGMENT_LEN+1); |
| ansond | 69:090e16acccb7 | 111 | memset(message_value,0,MQTT_PAYLOAD_SEGMENT_LEN+1); |
| ansond | 69:090e16acccb7 | 112 | memset(message_opt,0,MQTT_PAYLOAD_SEGMENT_LEN+1); |
| ansond | 23:793b2898522e | 113 | |
| ansond | 6:34c07e145caa | 114 | // get our endpoint |
| ansond | 0:ae2a45502448 | 115 | MBEDEndpoint *endpoint = (MBEDEndpoint *)this->getEndpoint(); |
| ansond | 7:f570eb3f38cd | 116 | char *endpoint_name = endpoint->getEndpointName(); |
| ansond | 6:34c07e145caa | 117 | |
| ansond | 0:ae2a45502448 | 118 | // DEBUG |
| ansond | 8:45f9a920e82c | 119 | //this->logger()->log("Endpoint:[%s] Target: [%s]",endpoint_name,message_name); |
| ansond | 7:f570eb3f38cd | 120 | |
| ansond | 3:3db076b9d380 | 121 | // only respond if its for our node |
| ansond | 8:45f9a920e82c | 122 | if (strcmp(endpoint_name,message_name) == 0) { |
| ansond | 69:090e16acccb7 | 123 | // format of the MQTT message: message_type:verb|Parameter_X:value|keyword:optional_data |
| ansond | 69:090e16acccb7 | 124 | char buffer[MAX_MQTT_MESSAGE_LENGTH+1]; |
| ansond | 69:090e16acccb7 | 125 | memset(buffer,0,MAX_MQTT_MESSAGE_LENGTH+1); |
| ansond | 69:090e16acccb7 | 126 | memcpy(buffer,payload,payload_length); |
| ansond | 69:090e16acccb7 | 127 | int count = 0; for(int i=0;i<payload_length;++i) if (payload[i] == ':') ++count; |
| ansond | 72:ffd155ec8b93 | 128 | for(int i=0;i<payload_length;++i) { |
| ansond | 72:ffd155ec8b93 | 129 | if (buffer[i] == ':') { |
| ansond | 72:ffd155ec8b93 | 130 | if (i < (payload_length-1)) buffer[i] = ' '; |
| ansond | 72:ffd155ec8b93 | 131 | else buffer[i] = '\0'; |
| ansond | 72:ffd155ec8b93 | 132 | } |
| ansond | 72:ffd155ec8b93 | 133 | } |
| ansond | 69:090e16acccb7 | 134 | if (count == 1) sscanf(buffer,"%s %s",message_type,message_verb); |
| ansond | 70:144f578e4470 | 135 | if (count == 2) sscanf(buffer,"%s %s %s",message_type,message_verb,message_value); |
| ansond | 71:221500a073df | 136 | if (count == 3) sscanf(buffer,"%s %s %s %s",message_type,message_verb,message_value,message_opt); |
| ansond | 69:090e16acccb7 | 137 | |
| ansond | 7:f570eb3f38cd | 138 | // DEBUG |
| ansond | 72:ffd155ec8b93 | 139 | //this->logger()->log("Raw Payload: %s, length: %d",payload,payload_length); |
| ansond | 72:ffd155ec8b93 | 140 | //this->logger()->log("Buffer: %s, length: %d",buffer,strlen(buffer)); |
| ansond | 72:ffd155ec8b93 | 141 | //this->logger()->log("Parsed Payload: Type: [%s] Name: [%s] Verb: [%s] Value: [%s]",message_type,message_name,message_verb,message_value); |
| ansond | 8:45f9a920e82c | 142 | |
| ansond | 3:3db076b9d380 | 143 | // load endpoints |
| ansond | 15:e44d75d95b38 | 144 | if (message_type != NULL && strcmp(message_type,IOC_ENDPOINT_VERB) == 0) { // Endpoint |
| ansond | 15:e44d75d95b38 | 145 | if (message_verb != NULL && strcmp(message_verb,IOC_REQUEST_LOAD_ALL_VERB) == 0) { // load |
| ansond | 15:e44d75d95b38 | 146 | if (message_value != NULL && strcmp(message_value,IOC_ENDPOINT_ALL_VERB) == 0) { // all |
| ansond | 15:e44d75d95b38 | 147 | // load up our endpoints |
| ansond | 15:e44d75d95b38 | 148 | endpoint->loadEndpoints(); |
| ansond | 0:ae2a45502448 | 149 | } |
| ansond | 93:e3b732068ae9 | 150 | else if (message_value != NULL && strcmp(message_value,this->m_endpoint_name) == 0) { |
| ansond | 93:e3b732068ae9 | 151 | // load up our endpoints (us only) |
| ansond | 93:e3b732068ae9 | 152 | endpoint->loadEndpoints(); |
| ansond | 93:e3b732068ae9 | 153 | } |
| ansond | 0:ae2a45502448 | 154 | } |
| ansond | 15:e44d75d95b38 | 155 | |
| ansond | 15:e44d75d95b38 | 156 | else if (message_verb != NULL && strcmp(message_verb,IOC_REQUEST_UPDATE_ALL_VERB) == 0) { // update |
| ansond | 15:e44d75d95b38 | 157 | if (message_value != NULL && strcmp(message_value,IOC_ENDPOINT_ALL_VERB) == 0) { // all |
| ansond | 15:e44d75d95b38 | 158 | // update our endpoints |
| ansond | 23:793b2898522e | 159 | endpoint->updateEndpoints(); |
| ansond | 15:e44d75d95b38 | 160 | } |
| ansond | 15:e44d75d95b38 | 161 | else { |
| ansond | 15:e44d75d95b38 | 162 | // update just our endpoint |
| ansond | 15:e44d75d95b38 | 163 | int index = -1; |
| ansond | 15:e44d75d95b38 | 164 | if (message_name != NULL) { |
| ansond | 15:e44d75d95b38 | 165 | index = endpoint->indexOfLight((char *)message_name); |
| ansond | 15:e44d75d95b38 | 166 | if (index >= 0) { |
| ansond | 15:e44d75d95b38 | 167 | if (message_verb != NULL && strcmp(message_verb,IOC_REQUEST_UPDATE_ALL_VERB) == 0) { |
| ansond | 15:e44d75d95b38 | 168 | // update our endpoint |
| ansond | 23:793b2898522e | 169 | endpoint->updateEndpoints(index); |
| ansond | 15:e44d75d95b38 | 170 | } |
| ansond | 3:3db076b9d380 | 171 | } |
| ansond | 3:3db076b9d380 | 172 | } |
| ansond | 3:3db076b9d380 | 173 | } |
| ansond | 3:3db076b9d380 | 174 | } |
| ansond | 0:ae2a45502448 | 175 | } |
| ansond | 3:3db076b9d380 | 176 | |
| ansond | 3:3db076b9d380 | 177 | // change a resource value |
| ansond | 13:25448d92c205 | 178 | if (message_type != NULL && strcmp(message_type,IOC_CHANGE_VERB) == 0) { |
| ansond | 8:45f9a920e82c | 179 | if (message_name != NULL) { |
| ansond | 3:3db076b9d380 | 180 | // destined for our lights? |
| ansond | 3:3db076b9d380 | 181 | int index = endpoint->indexOfLight((char *)message_name); |
| ansond | 3:3db076b9d380 | 182 | if (index >= 0) { |
| ansond | 3:3db076b9d380 | 183 | if (message_verb != NULL) { |
| ansond | 3:3db076b9d380 | 184 | // map the parameter to one of ours |
| ansond | 14:0a6497a380a4 | 185 | char *mapped_resource = this->mapIOCResourceToEndpointResource((char *)message_verb); |
| ansond | 3:3db076b9d380 | 186 | if (mapped_resource != NULL) { |
| ansond | 3:3db076b9d380 | 187 | if (message_value != NULL) { |
| ansond | 8:45f9a920e82c | 188 | EmulatedResourceFactory *factory = (EmulatedResourceFactory *)endpoint->getResources(index); |
| ansond | 8:45f9a920e82c | 189 | bool success = factory->setResourceValue(mapped_resource,message_value); |
| ansond | 8:45f9a920e82c | 190 | |
| ansond | 8:45f9a920e82c | 191 | // end the resource value back over MQTT |
| ansond | 8:45f9a920e82c | 192 | this->sendResult(message_name,message_verb,message_value,success); |
| ansond | 3:3db076b9d380 | 193 | } |
| ansond | 3:3db076b9d380 | 194 | } |
| ansond | 3:3db076b9d380 | 195 | } |
| ansond | 3:3db076b9d380 | 196 | } |
| ansond | 3:3db076b9d380 | 197 | } |
| ansond | 3:3db076b9d380 | 198 | } |
| ansond | 3:3db076b9d380 | 199 | |
| ansond | 3:3db076b9d380 | 200 | // get a resource value |
| ansond | 13:25448d92c205 | 201 | if (message_type != NULL && strcmp(message_type,IOC_REQUEST_VALUE_VERB) == 0) { |
| ansond | 3:3db076b9d380 | 202 | if (message_name != NULL) { |
| ansond | 3:3db076b9d380 | 203 | // destined for our lights? |
| ansond | 3:3db076b9d380 | 204 | int index = endpoint->indexOfLight((char *)message_name); |
| ansond | 3:3db076b9d380 | 205 | if (index >= 0) { |
| ansond | 3:3db076b9d380 | 206 | if (message_verb != NULL) { |
| ansond | 3:3db076b9d380 | 207 | // map the parameter to one of ours |
| ansond | 13:25448d92c205 | 208 | char *mapped_resource = this->mapIOCResourceToEndpointResource((char *)message_verb); |
| ansond | 3:3db076b9d380 | 209 | if (mapped_resource != NULL) { |
| ansond | 8:45f9a920e82c | 210 | EmulatedResourceFactory *factory = (EmulatedResourceFactory *)endpoint->getResources(index); |
| ansond | 69:090e16acccb7 | 211 | strcpy(message_value,factory->getResourceValue((char *)mapped_resource)); |
| ansond | 8:45f9a920e82c | 212 | bool success = false; if (message_value != NULL) success = true; |
| ansond | 8:45f9a920e82c | 213 | |
| ansond | 8:45f9a920e82c | 214 | // log resource get |
| ansond | 8:45f9a920e82c | 215 | if (success) this->logger()->log("Resource: %s (%s) Value: %s",message_verb,mapped_resource,message_value); |
| ansond | 3:3db076b9d380 | 216 | |
| ansond | 3:3db076b9d380 | 217 | // end the resource value back over MQTT |
| ansond | 8:45f9a920e82c | 218 | this->sendResult(message_name,message_verb,message_value,success); |
| ansond | 3:3db076b9d380 | 219 | } |
| ansond | 3:3db076b9d380 | 220 | } |
| ansond | 3:3db076b9d380 | 221 | } |
| ansond | 0:ae2a45502448 | 222 | } |
| ansond | 0:ae2a45502448 | 223 | } |
| ansond | 0:ae2a45502448 | 224 | } |
| ansond | 3:3db076b9d380 | 225 | else { |
| ansond | 3:3db076b9d380 | 226 | // message not bound for our node |
| ansond | 3:3db076b9d380 | 227 | this->logger()->log("MQTT Message: %s not for us: %s... ignoring...",payload,endpoint_name); |
| ansond | 7:f570eb3f38cd | 228 | } |
| ansond | 0:ae2a45502448 | 229 | } |
| ansond | 0:ae2a45502448 | 230 | |
| ansond | 8:45f9a920e82c | 231 | // send result back to MQTT |
| ansond | 8:45f9a920e82c | 232 | void MQTTTransport::sendResult(char *endpoint_name,char *resource_name,char *value,bool success) { |
| ansond | 8:45f9a920e82c | 233 | if (this->m_connected == true) { |
| ansond | 8:45f9a920e82c | 234 | // send the response back to MQTT |
| ansond | 8:45f9a920e82c | 235 | this->logger()->log("Sending Response back to MQTT..."); |
| ansond | 8:45f9a920e82c | 236 | char message[MAX_MQTT_MESSAGE_LENGTH+1]; |
| ansond | 8:45f9a920e82c | 237 | memset(message,0,MAX_MQTT_MESSAGE_LENGTH+1); |
| ansond | 13:25448d92c205 | 238 | char *str_success = IOC_RESPONSE_OK; if (!success) str_success = IOC_RESPONSE_FAILED; |
| ansond | 13:25448d92c205 | 239 | sprintf(message,IOC_RESPONSE_TEMPLATE,IOC_RESPONSE_VERB,endpoint_name,resource_name,value,str_success); |
| ansond | 8:45f9a920e82c | 240 | bool sent = this->m_mqtt->publish(this->getTopic(),message,strlen(message)); |
| ansond | 8:45f9a920e82c | 241 | if (sent) { |
| ansond | 8:45f9a920e82c | 242 | this->logger()->log("Result sent successfully"); |
| ansond | 36:210f3956038c | 243 | this->logger()->blinkTransportTxLED(); |
| ansond | 8:45f9a920e82c | 244 | } |
| ansond | 8:45f9a920e82c | 245 | else { |
| ansond | 8:45f9a920e82c | 246 | this->logger()->log("Result send FAILED"); |
| ansond | 8:45f9a920e82c | 247 | } |
| ansond | 8:45f9a920e82c | 248 | } |
| ansond | 8:45f9a920e82c | 249 | else { |
| ansond | 8:45f9a920e82c | 250 | // unable to send the response |
| ansond | 8:45f9a920e82c | 251 | this->logger()->log("Unable to send response back to MQTT. Not connected."); |
| ansond | 8:45f9a920e82c | 252 | } |
| ansond | 0:ae2a45502448 | 253 | } |
| ansond | 0:ae2a45502448 | 254 | |
| ansond | 15:e44d75d95b38 | 255 | char *MQTTTransport::mapIOCResourceToEndpointResource(char *ioc_name) { return this->getMap()->iocNameToEndpointName(ioc_name); } |
| ansond | 0:ae2a45502448 | 256 | |
| ansond | 0:ae2a45502448 | 257 | char *MQTTTransport::makeID(char *id_template,char *buffer) { |
| ansond | 0:ae2a45502448 | 258 | srand(time(0)); |
| ansond | 0:ae2a45502448 | 259 | srand(rand()); |
| ansond | 0:ae2a45502448 | 260 | sprintf(buffer,id_template,rand()%MQTT_MAXID_VALUE); |
| ansond | 0:ae2a45502448 | 261 | return buffer; |
| ansond | 0:ae2a45502448 | 262 | } |
| ansond | 0:ae2a45502448 | 263 | |
| ansond | 129:c4fa24308e33 | 264 | // is this message a PONG message? |
| ansond | 129:c4fa24308e33 | 265 | bool MQTTTransport::isPongMessage(char *topic,char *payload,int payload_length) { |
| ansond | 129:c4fa24308e33 | 266 | bool isPong = false; |
| ansond | 129:c4fa24308e33 | 267 | char verb[MQTT_PING_VERB_LEN+1]; |
| ansond | 129:c4fa24308e33 | 268 | char ep_name[LIGHT_NAME_LEN+1]; |
| ansond | 129:c4fa24308e33 | 269 | int counter = 0; |
| ansond | 129:c4fa24308e33 | 270 | |
| ansond | 129:c4fa24308e33 | 271 | // clean |
| ansond | 129:c4fa24308e33 | 272 | memset(verb,0,MQTT_PING_VERB_LEN+1); |
| ansond | 129:c4fa24308e33 | 273 | memset(ep_name,0,LIGHT_NAME_LEN+1); |
| ansond | 129:c4fa24308e33 | 274 | |
| ansond | 129:c4fa24308e33 | 275 | // make sure we have the right topic |
| ansond | 129:c4fa24308e33 | 276 | if (topic != NULL && strcmp(topic,MQTT_PING_TOPIC) == 0) { |
| ansond | 129:c4fa24308e33 | 277 | // parse the payload |
| ansond | 129:c4fa24308e33 | 278 | for(int i=0;payload != NULL && i<payload_length;++i) if (payload[i] == ':') payload[i] = ' '; |
| ansond | 129:c4fa24308e33 | 279 | sscanf(payload,"%s %s %d",verb,ep_name,&counter); |
| ansond | 129:c4fa24308e33 | 280 | |
| ansond | 129:c4fa24308e33 | 281 | // check the contents to make sure its for us... |
| ansond | 129:c4fa24308e33 | 282 | if (strcmp(verb,"pong") == 0 && strcmp(ep_name,this->m_endpoint_name) == 0 && counter == this->m_ping_counter) { |
| ansond | 129:c4fa24308e33 | 283 | // its a PONG message to our PING... |
| ansond | 129:c4fa24308e33 | 284 | isPong = true; |
| ansond | 129:c4fa24308e33 | 285 | } |
| ansond | 129:c4fa24308e33 | 286 | } |
| ansond | 129:c4fa24308e33 | 287 | |
| ansond | 129:c4fa24308e33 | 288 | // return isPong status |
| ansond | 129:c4fa24308e33 | 289 | return isPong; |
| ansond | 129:c4fa24308e33 | 290 | } |
| ansond | 129:c4fa24308e33 | 291 | |
| ansond | 129:c4fa24308e33 | 292 | |
| ansond | 129:c4fa24308e33 | 293 | // process this PONG message |
| ansond | 129:c4fa24308e33 | 294 | void MQTTTransport::processPongMessage(char *payload,int payload_length) { |
| ansond | 129:c4fa24308e33 | 295 | // DEBUG |
| ansond | 129:c4fa24308e33 | 296 | this->logger()->log("Received PONG: counter=%d",this->m_ping_counter); |
| ansond | 129:c4fa24308e33 | 297 | |
| ansond | 129:c4fa24308e33 | 298 | // simply increment the counter |
| ansond | 129:c4fa24308e33 | 299 | ++this->m_ping_counter; |
| ansond | 129:c4fa24308e33 | 300 | |
| ansond | 129:c4fa24308e33 | 301 | // reset counter if maxed |
| ansond | 129:c4fa24308e33 | 302 | if (this->m_ping_counter >= MQTT_MAX_COUNTER) this->m_ping_counter = 1; |
| ansond | 129:c4fa24308e33 | 303 | } |
| ansond | 129:c4fa24308e33 | 304 | |
| ansond | 129:c4fa24308e33 | 305 | // send a PING message |
| ansond | 129:c4fa24308e33 | 306 | bool MQTTTransport::sendPingMessage() { |
| ansond | 129:c4fa24308e33 | 307 | bool sent = false; |
| ansond | 129:c4fa24308e33 | 308 | char message[MAX_MQTT_MESSAGE_LENGTH+1]; |
| ansond | 129:c4fa24308e33 | 309 | |
| ansond | 129:c4fa24308e33 | 310 | // initialize... |
| ansond | 129:c4fa24308e33 | 311 | memset(message,0,MAX_MQTT_MESSAGE_LENGTH+1); |
| ansond | 129:c4fa24308e33 | 312 | |
| ansond | 129:c4fa24308e33 | 313 | // build message |
| ansond | 129:c4fa24308e33 | 314 | sprintf(message,"ping:%s:%d",this->m_endpoint_name,this->m_ping_counter); |
| ansond | 129:c4fa24308e33 | 315 | |
| ansond | 129:c4fa24308e33 | 316 | // send the message over the ping/pong topic |
| ansond | 129:c4fa24308e33 | 317 | sent = this->m_mqtt->publish(MQTT_PING_TOPIC,message,strlen(message)); |
| ansond | 129:c4fa24308e33 | 318 | if (sent) { |
| ansond | 129:c4fa24308e33 | 319 | // send succeeded |
| ansond | 129:c4fa24308e33 | 320 | this->logger()->log("PING %d sent successfully",this->m_ping_counter); |
| ansond | 129:c4fa24308e33 | 321 | this->logger()->blinkTransportTxLED(); |
| ansond | 129:c4fa24308e33 | 322 | } |
| ansond | 129:c4fa24308e33 | 323 | else { |
| ansond | 129:c4fa24308e33 | 324 | // send failed! - reconnect |
| ansond | 129:c4fa24308e33 | 325 | this->logger()->log("PING send %d FAILED... (re)connecting...",this->m_ping_counter); |
| ansond | 129:c4fa24308e33 | 326 | |
| ansond | 129:c4fa24308e33 | 327 | // attempt reconnect |
| ansond | 129:c4fa24308e33 | 328 | this->disconnect(); |
| ansond | 129:c4fa24308e33 | 329 | sent = this->connect(); |
| ansond | 129:c4fa24308e33 | 330 | if (sent) this->logger()->log("PING %d: MQTT reconnection successful...",this->m_ping_counter); |
| ansond | 129:c4fa24308e33 | 331 | } |
| ansond | 129:c4fa24308e33 | 332 | |
| ansond | 129:c4fa24308e33 | 333 | // return our status |
| ansond | 129:c4fa24308e33 | 334 | return sent; |
| ansond | 129:c4fa24308e33 | 335 | } |
| ansond | 129:c4fa24308e33 | 336 | |
| ansond | 0:ae2a45502448 | 337 | // connect up MQTT |
| ansond | 0:ae2a45502448 | 338 | bool MQTTTransport::connect() { |
| ansond | 0:ae2a45502448 | 339 | char mqtt_id[MQTT_ENDPOINT_IDLEN+1]; |
| ansond | 0:ae2a45502448 | 340 | memset(mqtt_id,0,(MQTT_ENDPOINT_IDLEN+1)); |
| ansond | 0:ae2a45502448 | 341 | if (this->m_connected == false) { |
| ansond | 0:ae2a45502448 | 342 | this->logger()->log("MQTT Init: %s:%d...",MQTT_HOSTNAME,MQTT_HOSTPORT); |
| ansond | 0:ae2a45502448 | 343 | this->m_mqtt = &_mqtt; |
| ansond | 0:ae2a45502448 | 344 | if (this->m_mqtt != NULL) { |
| ansond | 0:ae2a45502448 | 345 | char *id = this->makeID(MQTT_ENDPOINT_ID,mqtt_id); |
| ansond | 0:ae2a45502448 | 346 | this->logger()->log("MQTT Connect: ID: %s...",id); |
| ansond | 0:ae2a45502448 | 347 | if (this->m_mqtt->connect(id)) { |
| ansond | 8:45f9a920e82c | 348 | this->logger()->log("MQTT Subscribe: Topic: %s...",this->getTopic()); |
| ansond | 8:45f9a920e82c | 349 | if (this->m_mqtt->subscribe(this->getTopic())) { |
| ansond | 22:f1002e5993c5 | 350 | if (this->m_mqtt->subscribe(MQTT_IOC_ANNOUNCE_TOPIC)) { |
| ansond | 129:c4fa24308e33 | 351 | if (this->m_mqtt->subscribe(MQTT_PING_TOPIC)) { |
| ansond | 129:c4fa24308e33 | 352 | this->logger()->log("MQTT CONNECTED."); |
| ansond | 129:c4fa24308e33 | 353 | this->m_connected = true; |
| ansond | 129:c4fa24308e33 | 354 | } |
| ansond | 129:c4fa24308e33 | 355 | else { |
| ansond | 129:c4fa24308e33 | 356 | this->logger()->log("MQTT Subscribe: Topic(PING): %s FAILED",MQTT_PING_TOPIC); |
| ansond | 129:c4fa24308e33 | 357 | this->logger()->turnLEDRed(); |
| ansond | 129:c4fa24308e33 | 358 | this->m_connected = false; |
| ansond | 129:c4fa24308e33 | 359 | } |
| ansond | 22:f1002e5993c5 | 360 | } |
| ansond | 22:f1002e5993c5 | 361 | else { |
| ansond | 129:c4fa24308e33 | 362 | this->logger()->log("MQTT Subscribe: Topic(ANNOUNCE): %s FAILED",MQTT_IOC_ANNOUNCE_TOPIC); |
| ansond | 22:f1002e5993c5 | 363 | this->logger()->turnLEDRed(); |
| ansond | 22:f1002e5993c5 | 364 | this->m_connected = false; |
| ansond | 22:f1002e5993c5 | 365 | } |
| ansond | 0:ae2a45502448 | 366 | } |
| ansond | 0:ae2a45502448 | 367 | else { |
| ansond | 129:c4fa24308e33 | 368 | this->logger()->log("MQTT Subscribe: Topic(ENDPOINT): %s FAILED",this->getTopic()); |
| ansond | 0:ae2a45502448 | 369 | this->logger()->turnLEDRed(); |
| ansond | 7:f570eb3f38cd | 370 | this->m_connected = false; |
| ansond | 0:ae2a45502448 | 371 | } |
| ansond | 0:ae2a45502448 | 372 | } |
| ansond | 0:ae2a45502448 | 373 | else { |
| ansond | 0:ae2a45502448 | 374 | this->logger()->log("MQTT Connect: ID: %s FAILED",id); |
| ansond | 0:ae2a45502448 | 375 | this->logger()->turnLEDRed(); |
| ansond | 7:f570eb3f38cd | 376 | this->m_connected = false; |
| ansond | 0:ae2a45502448 | 377 | } |
| ansond | 0:ae2a45502448 | 378 | } |
| ansond | 0:ae2a45502448 | 379 | else { |
| ansond | 0:ae2a45502448 | 380 | this->logger()->log("MQTT Unable to allocate new instance"); |
| ansond | 0:ae2a45502448 | 381 | this->logger()->turnLEDRed(); |
| ansond | 7:f570eb3f38cd | 382 | this->m_connected = false; |
| ansond | 0:ae2a45502448 | 383 | } |
| ansond | 0:ae2a45502448 | 384 | } |
| ansond | 0:ae2a45502448 | 385 | else { |
| ansond | 0:ae2a45502448 | 386 | this->logger()->log("MQTT already connected (OK)"); |
| ansond | 0:ae2a45502448 | 387 | } |
| ansond | 0:ae2a45502448 | 388 | return this->m_connected; |
| ansond | 0:ae2a45502448 | 389 | } |
| ansond | 0:ae2a45502448 | 390 | |
| ansond | 0:ae2a45502448 | 391 | // disconnect from MQTT |
| ansond | 0:ae2a45502448 | 392 | bool MQTTTransport::disconnect() { |
| ansond | 0:ae2a45502448 | 393 | if (this->m_mqtt != NULL) { |
| ansond | 8:45f9a920e82c | 394 | this->logger()->log("MQTT Unsubscribing from: %s...",this->getTopic()); |
| ansond | 8:45f9a920e82c | 395 | this->m_mqtt->unsubscribe(this->getTopic()); |
| ansond | 129:c4fa24308e33 | 396 | this->logger()->log("MQTT Unsubscribing from: %s...",MQTT_IOC_ANNOUNCE_TOPIC); |
| ansond | 22:f1002e5993c5 | 397 | this->m_mqtt->unsubscribe(MQTT_IOC_ANNOUNCE_TOPIC); |
| ansond | 129:c4fa24308e33 | 398 | this->logger()->log("MQTT Unsubscribing from: %s...",MQTT_PING_TOPIC); |
| ansond | 129:c4fa24308e33 | 399 | this->m_mqtt->unsubscribe(MQTT_PING_TOPIC); |
| ansond | 0:ae2a45502448 | 400 | this->logger()->log("MQTT Disconnecting..."); |
| ansond | 0:ae2a45502448 | 401 | this->m_mqtt->disconnect(); |
| ansond | 0:ae2a45502448 | 402 | } |
| ansond | 0:ae2a45502448 | 403 | else { |
| ansond | 0:ae2a45502448 | 404 | this->logger()->log("MQTT already disconnected (OK)"); |
| ansond | 0:ae2a45502448 | 405 | } |
| ansond | 0:ae2a45502448 | 406 | this->m_connected = false; |
| ansond | 0:ae2a45502448 | 407 | return true; |
| ansond | 0:ae2a45502448 | 408 | } |
| ansond | 0:ae2a45502448 | 409 | |
| ansond | 0:ae2a45502448 | 410 | // check transport and process stuff |
| ansond | 0:ae2a45502448 | 411 | void MQTTTransport::checkAndProcess() { |
| ansond | 129:c4fa24308e33 | 412 | // process any MQTT messages |
| ansond | 0:ae2a45502448 | 413 | if (this->m_mqtt != NULL && this->m_connected == true) { |
| ansond | 0:ae2a45502448 | 414 | this->m_mqtt->loop(); |
| ansond | 36:210f3956038c | 415 | this->logger()->blinkTransportRxLED(); |
| ansond | 0:ae2a45502448 | 416 | } |
| ansond | 129:c4fa24308e33 | 417 | |
| ansond | 129:c4fa24308e33 | 418 | // send a PING if time for it |
| ansond | 129:c4fa24308e33 | 419 | --this->m_ping_countdown; |
| ansond | 129:c4fa24308e33 | 420 | if (this->m_ping_countdown <= 0) { |
| ansond | 129:c4fa24308e33 | 421 | this->logger()->log("MQTT: Sending PING..."); |
| ansond | 129:c4fa24308e33 | 422 | this->m_ping_countdown = MQTT_PING_COUNTDOWN; |
| ansond | 129:c4fa24308e33 | 423 | this->sendPingMessage(); |
| ansond | 129:c4fa24308e33 | 424 | } |
| ansond | 0:ae2a45502448 | 425 | } |