Zoltan Hudak / Mbed OS MQTT_Hello

MQTT client to test the ENC28J60-EMAC on NUCLEO-F446RE.

Dependencies:   ENC28J60-EMAC

MQTT/MQTTPacket/MQTTFormat.c@5:d9570dbf2f82, 2021-03-29 (annotated)

Committer:
hudakz
Date:
Mon Mar 29 09:32:44 2021 +0000
Revision:
5:d9570dbf2f82
Parent:
0:238f0d0c0ba3 
MQTT client to test the ENC28J60-EMAC on NUCLEO-F446RE.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hudakz 0:238f0d0c0ba3 1 /*******************************************************************************
hudakz 0:238f0d0c0ba3 2 * Copyright (c) 2014 IBM Corp.
hudakz 0:238f0d0c0ba3 3 *
hudakz 0:238f0d0c0ba3 4 * All rights reserved. This program and the accompanying materials
hudakz 0:238f0d0c0ba3 5 * are made available under the terms of the Eclipse Public License v1.0
hudakz 0:238f0d0c0ba3 6 * and Eclipse Distribution License v1.0 which accompany this distribution.
hudakz 0:238f0d0c0ba3 7 *
hudakz 0:238f0d0c0ba3 8 * The Eclipse Public License is available at
hudakz 0:238f0d0c0ba3 9 * http://www.eclipse.org/legal/epl-v10.html
hudakz 0:238f0d0c0ba3 10 * and the Eclipse Distribution License is available at
hudakz 0:238f0d0c0ba3 11 * http://www.eclipse.org/org/documents/edl-v10.php.
hudakz 0:238f0d0c0ba3 12 *
hudakz 0:238f0d0c0ba3 13 * Contributors:
hudakz 0:238f0d0c0ba3 14 * Ian Craggs - initial API and implementation and/or initial documentation
hudakz 0:238f0d0c0ba3 15 *******************************************************************************/
hudakz 0:238f0d0c0ba3 16
hudakz 0:238f0d0c0ba3 17 #include "StackTrace.h"
hudakz 0:238f0d0c0ba3 18 #include "MQTTPacket.h"
hudakz 0:238f0d0c0ba3 19
hudakz 0:238f0d0c0ba3 20 #include <string.h>
hudakz 0:238f0d0c0ba3 21
hudakz 0:238f0d0c0ba3 22
hudakz 0:238f0d0c0ba3 23 const char* MQTTPacket_names[] =
hudakz 0:238f0d0c0ba3 24 {
hudakz 0:238f0d0c0ba3 25 "RESERVED", "CONNECT", "CONNACK", "PUBLISH", "PUBACK", "PUBREC", "PUBREL",
hudakz 0:238f0d0c0ba3 26 "PUBCOMP", "SUBSCRIBE", "SUBACK", "UNSUBSCRIBE", "UNSUBACK",
hudakz 0:238f0d0c0ba3 27 "PINGREQ", "PINGRESP", "DISCONNECT"
hudakz 0:238f0d0c0ba3 28 };
hudakz 0:238f0d0c0ba3 29
hudakz 0:238f0d0c0ba3 30
hudakz 0:238f0d0c0ba3 31 const char* MQTTPacket_getName(unsigned short packetid)
hudakz 0:238f0d0c0ba3 32 {
hudakz 0:238f0d0c0ba3 33 return MQTTPacket_names[packetid];
hudakz 0:238f0d0c0ba3 34 }
hudakz 0:238f0d0c0ba3 35
hudakz 0:238f0d0c0ba3 36
hudakz 0:238f0d0c0ba3 37 int MQTTStringFormat_connect(char* strbuf, int strbuflen, MQTTPacket_connectData* data)
hudakz 0:238f0d0c0ba3 38 {
hudakz 0:238f0d0c0ba3 39 int strindex = 0;
hudakz 0:238f0d0c0ba3 40
hudakz 0:238f0d0c0ba3 41 strindex = snprintf(strbuf, strbuflen,
hudakz 0:238f0d0c0ba3 42 "CONNECT MQTT version %d, client id %.*s, clean session %d, keep alive %d",
hudakz 0:238f0d0c0ba3 43 (int)data->MQTTVersion, data->clientID.lenstring.len, data->clientID.lenstring.data,
hudakz 0:238f0d0c0ba3 44 (int)data->cleansession, data->keepAliveInterval);
hudakz 0:238f0d0c0ba3 45 if (data->willFlag)
hudakz 0:238f0d0c0ba3 46 strindex += snprintf(&strbuf[strindex], strbuflen - strindex,
hudakz 0:238f0d0c0ba3 47 ", will QoS %d, will retain %d, will topic %.*s, will message %.*s",
hudakz 0:238f0d0c0ba3 48 data->will.qos, data->will.retained,
hudakz 0:238f0d0c0ba3 49 data->will.topicName.lenstring.len, data->will.topicName.lenstring.data,
hudakz 0:238f0d0c0ba3 50 data->will.message.lenstring.len, data->will.message.lenstring.data);
hudakz 0:238f0d0c0ba3 51 if (data->username.lenstring.data && data->username.lenstring.len > 0)
hudakz 0:238f0d0c0ba3 52 strindex += snprintf(&strbuf[strindex], strbuflen - strindex,
hudakz 0:238f0d0c0ba3 53 ", user name %.*s", data->username.lenstring.len, data->username.lenstring.data);
hudakz 0:238f0d0c0ba3 54 if (data->password.lenstring.data && data->password.lenstring.len > 0)
hudakz 0:238f0d0c0ba3 55 strindex += snprintf(&strbuf[strindex], strbuflen - strindex,
hudakz 0:238f0d0c0ba3 56 ", password %.*s", data->password.lenstring.len, data->password.lenstring.data);
hudakz 0:238f0d0c0ba3 57 return strindex;
hudakz 0:238f0d0c0ba3 58 }
hudakz 0:238f0d0c0ba3 59
hudakz 0:238f0d0c0ba3 60
hudakz 0:238f0d0c0ba3 61 int MQTTStringFormat_connack(char* strbuf, int strbuflen, unsigned char connack_rc, unsigned char sessionPresent)
hudakz 0:238f0d0c0ba3 62 {
hudakz 0:238f0d0c0ba3 63 int strindex = snprintf(strbuf, strbuflen, "CONNACK session present %d, rc %d", sessionPresent, connack_rc);
hudakz 0:238f0d0c0ba3 64 return strindex;
hudakz 0:238f0d0c0ba3 65 }
hudakz 0:238f0d0c0ba3 66
hudakz 0:238f0d0c0ba3 67
hudakz 0:238f0d0c0ba3 68 int MQTTStringFormat_publish(char* strbuf, int strbuflen, unsigned char dup, int qos, unsigned char retained,
hudakz 0:238f0d0c0ba3 69 unsigned short packetid, MQTTString topicName, unsigned char* payload, int payloadlen)
hudakz 0:238f0d0c0ba3 70 {
hudakz 0:238f0d0c0ba3 71 int strindex = snprintf(strbuf, strbuflen,
hudakz 0:238f0d0c0ba3 72 "PUBLISH dup %d, QoS %d, retained %d, packet id %d, topic %.*s, payload length %d, payload %.*s",
hudakz 0:238f0d0c0ba3 73 dup, qos, retained, packetid,
hudakz 0:238f0d0c0ba3 74 (topicName.lenstring.len < 20) ? topicName.lenstring.len : 20, topicName.lenstring.data,
hudakz 0:238f0d0c0ba3 75 payloadlen, (payloadlen < 20) ? payloadlen : 20, payload);
hudakz 0:238f0d0c0ba3 76 return strindex;
hudakz 0:238f0d0c0ba3 77 }
hudakz 0:238f0d0c0ba3 78
hudakz 0:238f0d0c0ba3 79
hudakz 0:238f0d0c0ba3 80 int MQTTStringFormat_ack(char* strbuf, int strbuflen, unsigned char packettype, unsigned char dup, unsigned short packetid)
hudakz 0:238f0d0c0ba3 81 {
hudakz 0:238f0d0c0ba3 82 int strindex = snprintf(strbuf, strbuflen, "%s, packet id %d", MQTTPacket_names[packettype], packetid);
hudakz 0:238f0d0c0ba3 83 if (dup)
hudakz 0:238f0d0c0ba3 84 strindex += snprintf(strbuf + strindex, strbuflen - strindex, ", dup %d", dup);
hudakz 0:238f0d0c0ba3 85 return strindex;
hudakz 0:238f0d0c0ba3 86 }
hudakz 0:238f0d0c0ba3 87
hudakz 0:238f0d0c0ba3 88
hudakz 0:238f0d0c0ba3 89 int MQTTStringFormat_subscribe(char* strbuf, int strbuflen, unsigned char dup, unsigned short packetid, int count,
hudakz 0:238f0d0c0ba3 90 MQTTString topicFilters[], int requestedQoSs[])
hudakz 0:238f0d0c0ba3 91 {
hudakz 0:238f0d0c0ba3 92 return snprintf(strbuf, strbuflen,
hudakz 0:238f0d0c0ba3 93 "SUBSCRIBE dup %d, packet id %d count %d topic %.*s qos %d",
hudakz 0:238f0d0c0ba3 94 dup, packetid, count,
hudakz 0:238f0d0c0ba3 95 topicFilters[0].lenstring.len, topicFilters[0].lenstring.data,
hudakz 0:238f0d0c0ba3 96 requestedQoSs[0]);
hudakz 0:238f0d0c0ba3 97 }
hudakz 0:238f0d0c0ba3 98
hudakz 0:238f0d0c0ba3 99
hudakz 0:238f0d0c0ba3 100 int MQTTStringFormat_suback(char* strbuf, int strbuflen, unsigned short packetid, int count, int* grantedQoSs)
hudakz 0:238f0d0c0ba3 101 {
hudakz 0:238f0d0c0ba3 102 return snprintf(strbuf, strbuflen,
hudakz 0:238f0d0c0ba3 103 "SUBACK packet id %d count %d granted qos %d", packetid, count, grantedQoSs[0]);
hudakz 0:238f0d0c0ba3 104 }
hudakz 0:238f0d0c0ba3 105
hudakz 0:238f0d0c0ba3 106
hudakz 0:238f0d0c0ba3 107 int MQTTStringFormat_unsubscribe(char* strbuf, int strbuflen, unsigned char dup, unsigned short packetid,
hudakz 0:238f0d0c0ba3 108 int count, MQTTString topicFilters[])
hudakz 0:238f0d0c0ba3 109 {
hudakz 0:238f0d0c0ba3 110 return snprintf(strbuf, strbuflen,
hudakz 0:238f0d0c0ba3 111 "UNSUBSCRIBE dup %d, packet id %d count %d topic %.*s",
hudakz 0:238f0d0c0ba3 112 dup, packetid, count,
hudakz 0:238f0d0c0ba3 113 topicFilters[0].lenstring.len, topicFilters[0].lenstring.data);
hudakz 0:238f0d0c0ba3 114 }
hudakz 0:238f0d0c0ba3 115
hudakz 0:238f0d0c0ba3 116
hudakz 0:238f0d0c0ba3 117 #if defined(MQTT_CLIENT)
hudakz 0:238f0d0c0ba3 118 char* MQTTFormat_toClientString(char* strbuf, int strbuflen, unsigned char* buf, int buflen)
hudakz 0:238f0d0c0ba3 119 {
hudakz 0:238f0d0c0ba3 120 int index = 0;
hudakz 0:238f0d0c0ba3 121 int rem_length = 0;
hudakz 0:238f0d0c0ba3 122 MQTTHeader header = {0};
hudakz 0:238f0d0c0ba3 123 int strindex = 0;
hudakz 0:238f0d0c0ba3 124
hudakz 0:238f0d0c0ba3 125 header.byte = buf[index++];
hudakz 0:238f0d0c0ba3 126 index += MQTTPacket_decodeBuf(&buf[index], &rem_length);
hudakz 0:238f0d0c0ba3 127
hudakz 0:238f0d0c0ba3 128 switch (header.bits.type)
hudakz 0:238f0d0c0ba3 129 {
hudakz 0:238f0d0c0ba3 130
hudakz 0:238f0d0c0ba3 131 case CONNACK:
hudakz 0:238f0d0c0ba3 132 {
hudakz 0:238f0d0c0ba3 133 unsigned char sessionPresent, connack_rc;
hudakz 0:238f0d0c0ba3 134 if (MQTTDeserialize_connack(&sessionPresent, &connack_rc, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 135 strindex = MQTTStringFormat_connack(strbuf, strbuflen, connack_rc, sessionPresent);
hudakz 0:238f0d0c0ba3 136 }
hudakz 0:238f0d0c0ba3 137 break;
hudakz 0:238f0d0c0ba3 138 case PUBLISH:
hudakz 0:238f0d0c0ba3 139 {
hudakz 0:238f0d0c0ba3 140 unsigned char dup, retained, *payload;
hudakz 0:238f0d0c0ba3 141 unsigned short packetid;
hudakz 0:238f0d0c0ba3 142 int qos, payloadlen;
hudakz 0:238f0d0c0ba3 143 MQTTString topicName = MQTTString_initializer;
hudakz 0:238f0d0c0ba3 144 if (MQTTDeserialize_publish(&dup, &qos, &retained, &packetid, &topicName,
hudakz 0:238f0d0c0ba3 145 &payload, &payloadlen, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 146 strindex = MQTTStringFormat_publish(strbuf, strbuflen, dup, qos, retained, packetid,
hudakz 0:238f0d0c0ba3 147 topicName, payload, payloadlen);
hudakz 0:238f0d0c0ba3 148 }
hudakz 0:238f0d0c0ba3 149 break;
hudakz 0:238f0d0c0ba3 150 case PUBACK:
hudakz 0:238f0d0c0ba3 151 case PUBREC:
hudakz 0:238f0d0c0ba3 152 case PUBREL:
hudakz 0:238f0d0c0ba3 153 case PUBCOMP:
hudakz 0:238f0d0c0ba3 154 {
hudakz 0:238f0d0c0ba3 155 unsigned char packettype, dup;
hudakz 0:238f0d0c0ba3 156 unsigned short packetid;
hudakz 0:238f0d0c0ba3 157 if (MQTTDeserialize_ack(&packettype, &dup, &packetid, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 158 strindex = MQTTStringFormat_ack(strbuf, strbuflen, packettype, dup, packetid);
hudakz 0:238f0d0c0ba3 159 }
hudakz 0:238f0d0c0ba3 160 break;
hudakz 0:238f0d0c0ba3 161 case SUBACK:
hudakz 0:238f0d0c0ba3 162 {
hudakz 0:238f0d0c0ba3 163 unsigned short packetid;
hudakz 0:238f0d0c0ba3 164 int maxcount = 1, count = 0;
hudakz 0:238f0d0c0ba3 165 int grantedQoSs[1];
hudakz 0:238f0d0c0ba3 166 if (MQTTDeserialize_suback(&packetid, maxcount, &count, grantedQoSs, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 167 strindex = MQTTStringFormat_suback(strbuf, strbuflen, packetid, count, grantedQoSs);
hudakz 0:238f0d0c0ba3 168 }
hudakz 0:238f0d0c0ba3 169 break;
hudakz 0:238f0d0c0ba3 170 case UNSUBACK:
hudakz 0:238f0d0c0ba3 171 {
hudakz 0:238f0d0c0ba3 172 unsigned short packetid;
hudakz 0:238f0d0c0ba3 173 if (MQTTDeserialize_unsuback(&packetid, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 174 strindex = MQTTStringFormat_ack(strbuf, strbuflen, UNSUBACK, 0, packetid);
hudakz 0:238f0d0c0ba3 175 }
hudakz 0:238f0d0c0ba3 176 break;
hudakz 0:238f0d0c0ba3 177 case PINGREQ:
hudakz 0:238f0d0c0ba3 178 case PINGRESP:
hudakz 0:238f0d0c0ba3 179 case DISCONNECT:
hudakz 0:238f0d0c0ba3 180 strindex = snprintf(strbuf, strbuflen, "%s", MQTTPacket_names[header.bits.type]);
hudakz 0:238f0d0c0ba3 181 break;
hudakz 0:238f0d0c0ba3 182 }
hudakz 0:238f0d0c0ba3 183 return strbuf;
hudakz 0:238f0d0c0ba3 184 }
hudakz 0:238f0d0c0ba3 185 #endif
hudakz 0:238f0d0c0ba3 186
hudakz 0:238f0d0c0ba3 187 #if defined(MQTT_SERVER)
hudakz 0:238f0d0c0ba3 188 char* MQTTFormat_toServerString(char* strbuf, int strbuflen, unsigned char* buf, int buflen)
hudakz 0:238f0d0c0ba3 189 {
hudakz 0:238f0d0c0ba3 190 int index = 0;
hudakz 0:238f0d0c0ba3 191 int rem_length = 0;
hudakz 0:238f0d0c0ba3 192 MQTTHeader header = {0};
hudakz 0:238f0d0c0ba3 193 int strindex = 0;
hudakz 0:238f0d0c0ba3 194
hudakz 0:238f0d0c0ba3 195 header.byte = buf[index++];
hudakz 0:238f0d0c0ba3 196 index += MQTTPacket_decodeBuf(&buf[index], &rem_length);
hudakz 0:238f0d0c0ba3 197
hudakz 0:238f0d0c0ba3 198 switch (header.bits.type)
hudakz 0:238f0d0c0ba3 199 {
hudakz 0:238f0d0c0ba3 200 case CONNECT:
hudakz 0:238f0d0c0ba3 201 {
hudakz 0:238f0d0c0ba3 202 MQTTPacket_connectData data;
hudakz 0:238f0d0c0ba3 203 int rc;
hudakz 0:238f0d0c0ba3 204 if ((rc = MQTTDeserialize_connect(&data, buf, buflen)) == 1)
hudakz 0:238f0d0c0ba3 205 strindex = MQTTStringFormat_connect(strbuf, strbuflen, &data);
hudakz 0:238f0d0c0ba3 206 }
hudakz 0:238f0d0c0ba3 207 break;
hudakz 0:238f0d0c0ba3 208 case PUBLISH:
hudakz 0:238f0d0c0ba3 209 {
hudakz 0:238f0d0c0ba3 210 unsigned char dup, retained, *payload;
hudakz 0:238f0d0c0ba3 211 unsigned short packetid;
hudakz 0:238f0d0c0ba3 212 int qos, payloadlen;
hudakz 0:238f0d0c0ba3 213 MQTTString topicName = MQTTString_initializer;
hudakz 0:238f0d0c0ba3 214 if (MQTTDeserialize_publish(&dup, &qos, &retained, &packetid, &topicName,
hudakz 0:238f0d0c0ba3 215 &payload, &payloadlen, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 216 strindex = MQTTStringFormat_publish(strbuf, strbuflen, dup, qos, retained, packetid,
hudakz 0:238f0d0c0ba3 217 topicName, payload, payloadlen);
hudakz 0:238f0d0c0ba3 218 }
hudakz 0:238f0d0c0ba3 219 break;
hudakz 0:238f0d0c0ba3 220 case PUBACK:
hudakz 0:238f0d0c0ba3 221 case PUBREC:
hudakz 0:238f0d0c0ba3 222 case PUBREL:
hudakz 0:238f0d0c0ba3 223 case PUBCOMP:
hudakz 0:238f0d0c0ba3 224 {
hudakz 0:238f0d0c0ba3 225 unsigned char packettype, dup;
hudakz 0:238f0d0c0ba3 226 unsigned short packetid;
hudakz 0:238f0d0c0ba3 227 if (MQTTDeserialize_ack(&packettype, &dup, &packetid, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 228 strindex = MQTTStringFormat_ack(strbuf, strbuflen, packettype, dup, packetid);
hudakz 0:238f0d0c0ba3 229 }
hudakz 0:238f0d0c0ba3 230 break;
hudakz 0:238f0d0c0ba3 231 case SUBSCRIBE:
hudakz 0:238f0d0c0ba3 232 {
hudakz 0:238f0d0c0ba3 233 unsigned char dup;
hudakz 0:238f0d0c0ba3 234 unsigned short packetid;
hudakz 0:238f0d0c0ba3 235 int maxcount = 1, count = 0;
hudakz 0:238f0d0c0ba3 236 MQTTString topicFilters[1];
hudakz 0:238f0d0c0ba3 237 int requestedQoSs[1];
hudakz 0:238f0d0c0ba3 238 if (MQTTDeserialize_subscribe(&dup, &packetid, maxcount, &count,
hudakz 0:238f0d0c0ba3 239 topicFilters, requestedQoSs, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 240 strindex = MQTTStringFormat_subscribe(strbuf, strbuflen, dup, packetid, count, topicFilters, requestedQoSs);;
hudakz 0:238f0d0c0ba3 241 }
hudakz 0:238f0d0c0ba3 242 break;
hudakz 0:238f0d0c0ba3 243 case UNSUBSCRIBE:
hudakz 0:238f0d0c0ba3 244 {
hudakz 0:238f0d0c0ba3 245 unsigned char dup;
hudakz 0:238f0d0c0ba3 246 unsigned short packetid;
hudakz 0:238f0d0c0ba3 247 int maxcount = 1, count = 0;
hudakz 0:238f0d0c0ba3 248 MQTTString topicFilters[1];
hudakz 0:238f0d0c0ba3 249 if (MQTTDeserialize_unsubscribe(&dup, &packetid, maxcount, &count, topicFilters, buf, buflen) == 1)
hudakz 0:238f0d0c0ba3 250 strindex = MQTTStringFormat_unsubscribe(strbuf, strbuflen, dup, packetid, count, topicFilters);
hudakz 0:238f0d0c0ba3 251 }
hudakz 0:238f0d0c0ba3 252 break;
hudakz 0:238f0d0c0ba3 253 case PINGREQ:
hudakz 0:238f0d0c0ba3 254 case PINGRESP:
hudakz 0:238f0d0c0ba3 255 case DISCONNECT:
hudakz 0:238f0d0c0ba3 256 strindex = snprintf(strbuf, strbuflen, "%s", MQTTPacket_names[header.bits.type]);
hudakz 0:238f0d0c0ba3 257 break;
hudakz 0:238f0d0c0ba3 258 }
hudakz 0:238f0d0c0ba3 259 strbuf[strbuflen] = '\0';
hudakz 0:238f0d0c0ba3 260 return strbuf;
hudakz 0:238f0d0c0ba3 261 }
hudakz 0:238f0d0c0ba3 262 #endif