Zoltan Hudak
/
MQTT_Hello
MQTT client to test the ENC28J60-EMAC on NUCLEO-F446RE.
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?
User | Revision | Line number | New 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 |