Zoltan Hudak / Mbed OS MQTT_Hello

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

Dependencies:   ENC28J60-EMAC

MQTT/MQTTPacket/MQTTDeserializePublish.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 #include <string.h>
hudakz 0:238f0d0c0ba3 20
hudakz 0:238f0d0c0ba3 21 #define min(a, b) ((a < b) ? 1 : 0)
hudakz 0:238f0d0c0ba3 22
hudakz 0:238f0d0c0ba3 23 /**
hudakz 0:238f0d0c0ba3 24 * Deserializes the supplied (wire) buffer into publish data
hudakz 0:238f0d0c0ba3 25 * @param dup returned integer - the MQTT dup flag
hudakz 0:238f0d0c0ba3 26 * @param qos returned integer - the MQTT QoS value
hudakz 0:238f0d0c0ba3 27 * @param retained returned integer - the MQTT retained flag
hudakz 0:238f0d0c0ba3 28 * @param packetid returned integer - the MQTT packet identifier
hudakz 0:238f0d0c0ba3 29 * @param topicName returned MQTTString - the MQTT topic in the publish
hudakz 0:238f0d0c0ba3 30 * @param payload returned byte buffer - the MQTT publish payload
hudakz 0:238f0d0c0ba3 31 * @param payloadlen returned integer - the length of the MQTT payload
hudakz 0:238f0d0c0ba3 32 * @param buf the raw buffer data, of the correct length determined by the remaining length field
hudakz 0:238f0d0c0ba3 33 * @param buflen the length in bytes of the data in the supplied buffer
hudakz 0:238f0d0c0ba3 34 * @return error code. 1 is success
hudakz 0:238f0d0c0ba3 35 */
hudakz 0:238f0d0c0ba3 36 int MQTTDeserialize_publish(unsigned char* dup, int* qos, unsigned char* retained, unsigned short* packetid, MQTTString* topicName,
hudakz 0:238f0d0c0ba3 37 unsigned char** payload, int* payloadlen, unsigned char* buf, int buflen)
hudakz 0:238f0d0c0ba3 38 {
hudakz 0:238f0d0c0ba3 39 MQTTHeader header = {0};
hudakz 0:238f0d0c0ba3 40 unsigned char* curdata = buf;
hudakz 0:238f0d0c0ba3 41 unsigned char* enddata = NULL;
hudakz 0:238f0d0c0ba3 42 int rc = 0;
hudakz 0:238f0d0c0ba3 43 int mylen = 0;
hudakz 0:238f0d0c0ba3 44
hudakz 0:238f0d0c0ba3 45 FUNC_ENTRY;
hudakz 0:238f0d0c0ba3 46 header.byte = readChar(&curdata);
hudakz 0:238f0d0c0ba3 47 if (header.bits.type != PUBLISH)
hudakz 0:238f0d0c0ba3 48 goto exit;
hudakz 0:238f0d0c0ba3 49 *dup = header.bits.dup;
hudakz 0:238f0d0c0ba3 50 *qos = header.bits.qos;
hudakz 0:238f0d0c0ba3 51 *retained = header.bits.retain;
hudakz 0:238f0d0c0ba3 52
hudakz 0:238f0d0c0ba3 53 curdata += (rc = MQTTPacket_decodeBuf(curdata, &mylen)); /* read remaining length */
hudakz 0:238f0d0c0ba3 54 enddata = curdata + mylen;
hudakz 0:238f0d0c0ba3 55
hudakz 0:238f0d0c0ba3 56 if (!readMQTTLenString(topicName, &curdata, enddata) ||
hudakz 0:238f0d0c0ba3 57 enddata - curdata < 0) /* do we have enough data to read the protocol version byte? */
hudakz 0:238f0d0c0ba3 58 goto exit;
hudakz 0:238f0d0c0ba3 59
hudakz 0:238f0d0c0ba3 60 if (*qos > 0)
hudakz 0:238f0d0c0ba3 61 *packetid = readInt(&curdata);
hudakz 0:238f0d0c0ba3 62
hudakz 0:238f0d0c0ba3 63 *payloadlen = enddata - curdata;
hudakz 0:238f0d0c0ba3 64 *payload = curdata;
hudakz 0:238f0d0c0ba3 65 rc = 1;
hudakz 0:238f0d0c0ba3 66 exit:
hudakz 0:238f0d0c0ba3 67 FUNC_EXIT_RC(rc);
hudakz 0:238f0d0c0ba3 68 return rc;
hudakz 0:238f0d0c0ba3 69 }
hudakz 0:238f0d0c0ba3 70
hudakz 0:238f0d0c0ba3 71
hudakz 0:238f0d0c0ba3 72
hudakz 0:238f0d0c0ba3 73 /**
hudakz 0:238f0d0c0ba3 74 * Deserializes the supplied (wire) buffer into an ack
hudakz 0:238f0d0c0ba3 75 * @param packettype returned integer - the MQTT packet type
hudakz 0:238f0d0c0ba3 76 * @param dup returned integer - the MQTT dup flag
hudakz 0:238f0d0c0ba3 77 * @param packetid returned integer - the MQTT packet identifier
hudakz 0:238f0d0c0ba3 78 * @param buf the raw buffer data, of the correct length determined by the remaining length field
hudakz 0:238f0d0c0ba3 79 * @param buflen the length in bytes of the data in the supplied buffer
hudakz 0:238f0d0c0ba3 80 * @return error code. 1 is success, 0 is failure
hudakz 0:238f0d0c0ba3 81 */
hudakz 0:238f0d0c0ba3 82 int MQTTDeserialize_ack(unsigned char* packettype, unsigned char* dup, unsigned short* packetid, unsigned char* buf, int buflen)
hudakz 0:238f0d0c0ba3 83 {
hudakz 0:238f0d0c0ba3 84 MQTTHeader header = {0};
hudakz 0:238f0d0c0ba3 85 unsigned char* curdata = buf;
hudakz 0:238f0d0c0ba3 86 unsigned char* enddata = NULL;
hudakz 0:238f0d0c0ba3 87 int rc = 0;
hudakz 0:238f0d0c0ba3 88 int mylen;
hudakz 0:238f0d0c0ba3 89
hudakz 0:238f0d0c0ba3 90 FUNC_ENTRY;
hudakz 0:238f0d0c0ba3 91 header.byte = readChar(&curdata);
hudakz 0:238f0d0c0ba3 92 *dup = header.bits.dup;
hudakz 0:238f0d0c0ba3 93 *packettype = header.bits.type;
hudakz 0:238f0d0c0ba3 94
hudakz 0:238f0d0c0ba3 95 curdata += (rc = MQTTPacket_decodeBuf(curdata, &mylen)); /* read remaining length */
hudakz 0:238f0d0c0ba3 96 enddata = curdata + mylen;
hudakz 0:238f0d0c0ba3 97
hudakz 0:238f0d0c0ba3 98 if (enddata - curdata < 2)
hudakz 0:238f0d0c0ba3 99 goto exit;
hudakz 0:238f0d0c0ba3 100 *packetid = readInt(&curdata);
hudakz 0:238f0d0c0ba3 101
hudakz 0:238f0d0c0ba3 102 rc = 1;
hudakz 0:238f0d0c0ba3 103 exit:
hudakz 0:238f0d0c0ba3 104 FUNC_EXIT_RC(rc);
hudakz 0:238f0d0c0ba3 105 return rc;
hudakz 0:238f0d0c0ba3 106 }
hudakz 0:238f0d0c0ba3 107