Junichi Katsu / Mbed OS mbed-os-example-milkcocoa

mbed OS5に対応したMilkcocoaライブラリのテストバージョンです。

Fork of mbed-os-example-mbed5-blinky by mbed-os-examples

Milkcocoa/MQTT/MQTTPacket/MQTTConnectServer.c@24:6ba1245bf049, 2017-01-24 (annotated)

Committer:
jksoft
Date:
Tue Jan 24 13:41:36 2017 +0000
Revision:
24:6ba1245bf049
??????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jksoft 24:6ba1245bf049 1 /*******************************************************************************
jksoft 24:6ba1245bf049 2 * Copyright (c) 2014 IBM Corp.
jksoft 24:6ba1245bf049 3 *
jksoft 24:6ba1245bf049 4 * All rights reserved. This program and the accompanying materials
jksoft 24:6ba1245bf049 5 * are made available under the terms of the Eclipse Public License v1.0
jksoft 24:6ba1245bf049 6 * and Eclipse Distribution License v1.0 which accompany this distribution.
jksoft 24:6ba1245bf049 7 *
jksoft 24:6ba1245bf049 8 * The Eclipse Public License is available at
jksoft 24:6ba1245bf049 9 * http://www.eclipse.org/legal/epl-v10.html
jksoft 24:6ba1245bf049 10 * and the Eclipse Distribution License is available at
jksoft 24:6ba1245bf049 11 * http://www.eclipse.org/org/documents/edl-v10.php.
jksoft 24:6ba1245bf049 12 *
jksoft 24:6ba1245bf049 13 * Contributors:
jksoft 24:6ba1245bf049 14 * Ian Craggs - initial API and implementation and/or initial documentation
jksoft 24:6ba1245bf049 15 *******************************************************************************/
jksoft 24:6ba1245bf049 16
jksoft 24:6ba1245bf049 17 #include "StackTrace.h"
jksoft 24:6ba1245bf049 18 #include "MQTTPacket.h"
jksoft 24:6ba1245bf049 19 #include <string.h>
jksoft 24:6ba1245bf049 20
jksoft 24:6ba1245bf049 21 #define min(a, b) ((a < b) ? a : b)
jksoft 24:6ba1245bf049 22
jksoft 24:6ba1245bf049 23
jksoft 24:6ba1245bf049 24 /**
jksoft 24:6ba1245bf049 25 * Validates MQTT protocol name and version combinations
jksoft 24:6ba1245bf049 26 * @param protocol the MQTT protocol name as an MQTTString
jksoft 24:6ba1245bf049 27 * @param version the MQTT protocol version number, as in the connect packet
jksoft 24:6ba1245bf049 28 * @return correct MQTT combination? 1 is true, 0 is false
jksoft 24:6ba1245bf049 29 */
jksoft 24:6ba1245bf049 30 int MQTTPacket_checkVersion(MQTTString* protocol, int version)
jksoft 24:6ba1245bf049 31 {
jksoft 24:6ba1245bf049 32 int rc = 0;
jksoft 24:6ba1245bf049 33
jksoft 24:6ba1245bf049 34 if (version == 3 && memcmp(protocol->lenstring.data, "MQIdsp",
jksoft 24:6ba1245bf049 35 min(6, protocol->lenstring.len)) == 0)
jksoft 24:6ba1245bf049 36 rc = 1;
jksoft 24:6ba1245bf049 37 else if (version == 4 && memcmp(protocol->lenstring.data, "MQTT",
jksoft 24:6ba1245bf049 38 min(4, protocol->lenstring.len)) == 0)
jksoft 24:6ba1245bf049 39 rc = 1;
jksoft 24:6ba1245bf049 40 return rc;
jksoft 24:6ba1245bf049 41 }
jksoft 24:6ba1245bf049 42
jksoft 24:6ba1245bf049 43
jksoft 24:6ba1245bf049 44 /**
jksoft 24:6ba1245bf049 45 * Deserializes the supplied (wire) buffer into connect data structure
jksoft 24:6ba1245bf049 46 * @param data the connect data structure to be filled out
jksoft 24:6ba1245bf049 47 * @param buf the raw buffer data, of the correct length determined by the remaining length field
jksoft 24:6ba1245bf049 48 * @param len the length in bytes of the data in the supplied buffer
jksoft 24:6ba1245bf049 49 * @return error code. 1 is success, 0 is failure
jksoft 24:6ba1245bf049 50 */
jksoft 24:6ba1245bf049 51 int MQTTDeserialize_connect(MQTTPacket_connectData* data, unsigned char* buf, int len)
jksoft 24:6ba1245bf049 52 {
jksoft 24:6ba1245bf049 53 MQTTHeader header = {0};
jksoft 24:6ba1245bf049 54 MQTTConnectFlags flags = {0};
jksoft 24:6ba1245bf049 55 unsigned char* curdata = buf;
jksoft 24:6ba1245bf049 56 unsigned char* enddata = &buf[len];
jksoft 24:6ba1245bf049 57 int rc = 0;
jksoft 24:6ba1245bf049 58 MQTTString Protocol;
jksoft 24:6ba1245bf049 59 int version;
jksoft 24:6ba1245bf049 60 int mylen = 0;
jksoft 24:6ba1245bf049 61
jksoft 24:6ba1245bf049 62 FUNC_ENTRY;
jksoft 24:6ba1245bf049 63 header.byte = readChar(&curdata);
jksoft 24:6ba1245bf049 64 if (header.bits.type != CONNECT)
jksoft 24:6ba1245bf049 65 goto exit;
jksoft 24:6ba1245bf049 66
jksoft 24:6ba1245bf049 67 curdata += MQTTPacket_decodeBuf(curdata, &mylen); /* read remaining length */
jksoft 24:6ba1245bf049 68
jksoft 24:6ba1245bf049 69 if (!readMQTTLenString(&Protocol, &curdata, enddata) ||
jksoft 24:6ba1245bf049 70 enddata - curdata < 0) /* do we have enough data to read the protocol version byte? */
jksoft 24:6ba1245bf049 71 goto exit;
jksoft 24:6ba1245bf049 72
jksoft 24:6ba1245bf049 73 version = (int)readChar(&curdata); /* Protocol version */
jksoft 24:6ba1245bf049 74 /* If we don't recognize the protocol version, we don't parse the connect packet on the
jksoft 24:6ba1245bf049 75 * basis that we don't know what the format will be.
jksoft 24:6ba1245bf049 76 */
jksoft 24:6ba1245bf049 77 if (MQTTPacket_checkVersion(&Protocol, version))
jksoft 24:6ba1245bf049 78 {
jksoft 24:6ba1245bf049 79 flags.all = readChar(&curdata);
jksoft 24:6ba1245bf049 80 data->cleansession = flags.bits.cleansession;
jksoft 24:6ba1245bf049 81 data->keepAliveInterval = readInt(&curdata);
jksoft 24:6ba1245bf049 82 if (!readMQTTLenString(&data->clientID, &curdata, enddata))
jksoft 24:6ba1245bf049 83 goto exit;
jksoft 24:6ba1245bf049 84 if (flags.bits.will)
jksoft 24:6ba1245bf049 85 {
jksoft 24:6ba1245bf049 86 data->willFlag = 1;
jksoft 24:6ba1245bf049 87 data->will.qos = flags.bits.willQoS;
jksoft 24:6ba1245bf049 88 data->will.retained = flags.bits.willRetain;
jksoft 24:6ba1245bf049 89 if (!readMQTTLenString(&data->will.topicName, &curdata, enddata) ||
jksoft 24:6ba1245bf049 90 !readMQTTLenString(&data->will.message, &curdata, enddata))
jksoft 24:6ba1245bf049 91 goto exit;
jksoft 24:6ba1245bf049 92 }
jksoft 24:6ba1245bf049 93 if (flags.bits.username)
jksoft 24:6ba1245bf049 94 {
jksoft 24:6ba1245bf049 95 if (enddata - curdata < 3 || !readMQTTLenString(&data->username, &curdata, enddata))
jksoft 24:6ba1245bf049 96 goto exit; /* username flag set, but no username supplied - invalid */
jksoft 24:6ba1245bf049 97 if (flags.bits.password &&
jksoft 24:6ba1245bf049 98 (enddata - curdata < 3 || !readMQTTLenString(&data->password, &curdata, enddata)))
jksoft 24:6ba1245bf049 99 goto exit; /* password flag set, but no password supplied - invalid */
jksoft 24:6ba1245bf049 100 }
jksoft 24:6ba1245bf049 101 else if (flags.bits.password)
jksoft 24:6ba1245bf049 102 goto exit; /* password flag set without username - invalid */
jksoft 24:6ba1245bf049 103 rc = 1;
jksoft 24:6ba1245bf049 104 }
jksoft 24:6ba1245bf049 105 exit:
jksoft 24:6ba1245bf049 106 FUNC_EXIT_RC(rc);
jksoft 24:6ba1245bf049 107 return rc;
jksoft 24:6ba1245bf049 108 }
jksoft 24:6ba1245bf049 109
jksoft 24:6ba1245bf049 110
jksoft 24:6ba1245bf049 111 /**
jksoft 24:6ba1245bf049 112 * Serializes the connack packet into the supplied buffer.
jksoft 24:6ba1245bf049 113 * @param buf the buffer into which the packet will be serialized
jksoft 24:6ba1245bf049 114 * @param buflen the length in bytes of the supplied buffer
jksoft 24:6ba1245bf049 115 * @param connack_rc the integer connack return code to be used
jksoft 24:6ba1245bf049 116 * @param sessionPresent the MQTT 3.1.1 sessionPresent flag
jksoft 24:6ba1245bf049 117 * @return serialized length, or error if 0
jksoft 24:6ba1245bf049 118 */
jksoft 24:6ba1245bf049 119 int MQTTSerialize_connack(unsigned char* buf, int buflen, unsigned char connack_rc, unsigned char sessionPresent)
jksoft 24:6ba1245bf049 120 {
jksoft 24:6ba1245bf049 121 MQTTHeader header = {0};
jksoft 24:6ba1245bf049 122 int rc = 0;
jksoft 24:6ba1245bf049 123 unsigned char *ptr = buf;
jksoft 24:6ba1245bf049 124 MQTTConnackFlags flags = {0};
jksoft 24:6ba1245bf049 125
jksoft 24:6ba1245bf049 126 FUNC_ENTRY;
jksoft 24:6ba1245bf049 127 if (buflen < 2)
jksoft 24:6ba1245bf049 128 {
jksoft 24:6ba1245bf049 129 rc = MQTTPACKET_BUFFER_TOO_SHORT;
jksoft 24:6ba1245bf049 130 goto exit;
jksoft 24:6ba1245bf049 131 }
jksoft 24:6ba1245bf049 132 header.byte = 0;
jksoft 24:6ba1245bf049 133 header.bits.type = CONNACK;
jksoft 24:6ba1245bf049 134 writeChar(&ptr, header.byte); /* write header */
jksoft 24:6ba1245bf049 135
jksoft 24:6ba1245bf049 136 ptr += MQTTPacket_encode(ptr, 2); /* write remaining length */
jksoft 24:6ba1245bf049 137
jksoft 24:6ba1245bf049 138 flags.all = 0;
jksoft 24:6ba1245bf049 139 flags.bits.sessionpresent = sessionPresent;
jksoft 24:6ba1245bf049 140 writeChar(&ptr, flags.all);
jksoft 24:6ba1245bf049 141 writeChar(&ptr, connack_rc);
jksoft 24:6ba1245bf049 142
jksoft 24:6ba1245bf049 143 rc = ptr - buf;
jksoft 24:6ba1245bf049 144 exit:
jksoft 24:6ba1245bf049 145 FUNC_EXIT_RC(rc);
jksoft 24:6ba1245bf049 146 return rc;
jksoft 24:6ba1245bf049 147 }
jksoft 24:6ba1245bf049 148