123
Diff: MQTTSNConnectServer.c
- Revision:
- 0:c524a894b5e8
- Child:
- 1:7fa362fa563f
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/MQTTSNConnectServer.c Thu Feb 26 15:59:36 2015 +0000 @@ -0,0 +1,431 @@ +/******************************************************************************* + * Copyright (c) 2014 IBM Corp. + * + * All rights reserved. This program and the accompanying materials + * are made available under the terms of the Eclipse Public License v1.0 + * and Eclipse Distribution License v1.0 which accompany this distribution. + * + * The Eclipse Public License is available at + * http://www.eclipse.org/legal/epl-v10.html + * and the Eclipse Distribution License is available at + * http://www.eclipse.org/org/documents/edl-v10.php. + * + * Contributors: + * Ian Craggs - initial API and implementation and/or initial documentation + *******************************************************************************/ + +#include "StackTrace.h" +#include "MQTTSNPacket.h" +#include <string.h> + +#define min(a, b) ((a < b) ? 1 : 0) + + +/** + * Deserializes the supplied (wire) buffer into connect data structure + * @param data the connect data structure to be filled out + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_connect(MQTTSNPacket_connectData* data, unsigned char* buf, int len) +{ + MQTTSNFlags flags = {0}; + unsigned char* curdata = buf; + unsigned char* enddata = &buf[len]; + int rc = 0; + int version = 0; + int mylen = 0; + + FUNC_ENTRY; + curdata += (rc = MQTTSNPacket_decode(curdata, len, &mylen)); /* read length */ + enddata = buf + mylen; + if (enddata - curdata < 2) + goto exit; + + if (readChar(&curdata) != MQTTSN_CONNECT) + goto exit; + + flags.all = readChar(&curdata); + data->cleansession = flags.bits.cleanSession; + data->willFlag = flags.bits.will; + + if ((version = (int)readChar(&curdata)) != 1) /* Protocol version */ + goto exit; + + data->duration = readInt(&curdata); + + if (!readMQTTSNString(&data->clientID, &curdata, enddata)) + goto exit; + + rc = 1; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Serializes the connack packet into the supplied buffer. + * @param buf the buffer into which the packet will be serialized + * @param buflen the length in bytes of the supplied buffer + * @param connack_rc the integer connack return code to be used + * @return serialized length, or error if 0 + */ +int MQTTSNSerialize_connack(unsigned char* buf, int buflen, int connack_rc) +{ + int rc = 0; + unsigned char *ptr = buf; + + FUNC_ENTRY; + if (buflen < 3) + { + rc = MQTTSNPACKET_BUFFER_TOO_SHORT; + goto exit; + } + + ptr += MQTTSNPacket_encode(ptr, 3); /* write length */ + writeChar(&ptr, MQTTSN_CONNACK); + writeChar(&ptr, connack_rc); + + rc = ptr - buf; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Deserializes the supplied (wire) buffer into disconnect data - optional duration + * @param duration returned integer value of the duration field, -1 if no duration was specified + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_disconnect(int* duration, unsigned char* buf, int buflen) +{ + unsigned char* curdata = buf; + unsigned char* enddata = NULL; + int rc = -1; + int mylen; + + FUNC_ENTRY; + curdata += (rc = MQTTSNPacket_decode(curdata, buflen, &mylen)); /* read length */ + enddata = buf + mylen; + if (enddata - curdata < 1) + goto exit; + + if (readChar(&curdata) != MQTTSN_DISCONNECT) + goto exit; + + if (enddata - curdata == 2) + *duration = readInt(&curdata); + else if (enddata != curdata) + goto exit; + + rc = 1; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Serializes a willtopicreq packet into the supplied buffer. + * @param buf the buffer into which the packet will be serialized + * @param buflen the length in bytes of the supplied buffer + * @return serialized length, or error if 0 + */ +int MQTTSNSerialize_willtopicreq(unsigned char* buf, int buflen) +{ + int rc = 0; + unsigned char *ptr = buf; + + FUNC_ENTRY; + if (buflen < 2) + { + rc = MQTTSNPACKET_BUFFER_TOO_SHORT; + goto exit; + } + + ptr += MQTTSNPacket_encode(ptr, 2); /* write length */ + writeChar(&ptr, MQTTSN_WILLTOPICREQ); + + rc = ptr - buf; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Serializes a willmsgreq packet into the supplied buffer. + * @param buf the buffer into which the packet will be serialized + * @param buflen the length in bytes of the supplied buffer + * @return serialized length, or error if 0 + */ +int MQTTSNSerialize_willmsgreq(unsigned char* buf, int buflen) +{ + int rc = 0; + unsigned char *ptr = buf; + + FUNC_ENTRY; + if (buflen < 2) + { + rc = MQTTSNPACKET_BUFFER_TOO_SHORT; + goto exit; + } + + ptr += MQTTSNPacket_encode(ptr, 2); /* write length */ + writeChar(&ptr, MQTTSN_WILLMSGREQ); + + rc = ptr - buf; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + + +/** + * Deserializes the supplied (wire) buffer into pingreq data + * @param clientID the connect data structure to be filled out + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_pingreq(MQTTSNString* clientID, unsigned char* buf, int len) +{ + unsigned char* curdata = buf; + unsigned char* enddata = &buf[len]; + int rc = 0; + int mylen = 0; + + FUNC_ENTRY; + curdata += (rc = MQTTSNPacket_decode(curdata, len, &mylen)); /* read length */ + enddata = buf + mylen; + if (enddata - curdata < 1) + goto exit; + + if (readChar(&curdata) != MQTTSN_PINGREQ) + goto exit; + + if (!readMQTTSNString(clientID, &curdata, enddata)) + goto exit; + + rc = 1; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Serializes a pingresp packet into the supplied buffer. + * @param buf the buffer into which the packet will be serialized + * @param buflen the length in bytes of the supplied buffer + * @return serialized length, or error if 0 + */ +int MQTTSNSerialize_pingresp(unsigned char* buf, int buflen) +{ + int rc = 0; + unsigned char *ptr = buf; + + FUNC_ENTRY; + if (buflen < 2) + { + rc = MQTTSNPACKET_BUFFER_TOO_SHORT; + goto exit; + } + + ptr += MQTTSNPacket_encode(ptr, 2); /* write length */ + writeChar(&ptr, MQTTSN_PINGRESP); + + rc = ptr - buf; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Deserializes the supplied (wire) buffer into willtopic or willtopicupd data structure + * @param data the connect data structure to be filled out + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_willtopic1(int *willQoS, unsigned char *willRetain, MQTTSNString* willTopic, unsigned char* buf, int len, + enum MQTTSN_msgTypes packet_type) +{ + MQTTSNFlags flags = {0}; + unsigned char* curdata = buf; + unsigned char* enddata = &buf[len]; + int rc = 0; + int mylen = 0; + + FUNC_ENTRY; + curdata += (rc = MQTTSNPacket_decode(curdata, len, &mylen)); /* read length */ + enddata = buf + mylen; + if (enddata > buf + len) + goto exit; + + if (readChar(&curdata) != packet_type) + goto exit; + + flags.all = readChar(&curdata); + *willQoS = flags.bits.QoS; + *willRetain = flags.bits.retain; + + if (!readMQTTSNString(willTopic, &curdata, enddata)) + goto exit; + + rc = 1; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Deserializes the supplied (wire) buffer into willtopic data structure + * @param data the connect data structure to be filled out + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_willtopic(int *willQoS, unsigned char *willRetain, MQTTSNString* willTopic, unsigned char* buf, int len) +{ + return MQTTSNDeserialize_willtopic1(willQoS, willRetain, willTopic, buf, len, MQTTSN_WILLTOPIC); +} + +/** + * Deserializes the supplied (wire) buffer into willtopic data structure + * @param data the connect data structure to be filled out + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_willtopicupd(int *willQoS, unsigned char *willRetain, MQTTSNString* willTopic, unsigned char* buf, int len) +{ + return MQTTSNDeserialize_willtopic1(willQoS, willRetain, willTopic, buf, len, MQTTSN_WILLTOPICUPD); +} + + +/** + * Deserializes the supplied (wire) buffer into willmsg or willmsgupd data + * @param willMsg the will message to be retrieved + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_willmsg1(MQTTSNString* willMsg, unsigned char* buf, int len, enum MQTTSN_msgTypes packet_type) +{ + unsigned char* curdata = buf; + unsigned char* enddata = &buf[len]; + int rc = 0; + int mylen = 0; + + FUNC_ENTRY; + curdata += (rc = MQTTSNPacket_decode(curdata, len, &mylen)); /* read length */ + enddata = buf + mylen; + if (enddata > buf + len) + goto exit; + + if (readChar(&curdata) != packet_type) + goto exit; + + if (!readMQTTSNString(willMsg, &curdata, enddata)) + goto exit; + + rc = 1; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Deserializes the supplied (wire) buffer into willmsg data + * @param willMsg the will message to be retrieved + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_willmsg(MQTTSNString* willMsg, unsigned char* buf, int len) +{ + return MQTTSNDeserialize_willmsg1(willMsg, buf, len, MQTTSN_WILLMSG); +} + +/** + * Deserializes the supplied (wire) buffer into willmsgupd data + * @param willMsg the will message to be retrieved + * @param buf the raw buffer data, of the correct length determined by the remaining length field + * @param len the length in bytes of the data in the supplied buffer + * @return error code. 1 is success, 0 is failure + */ +int MQTTSNDeserialize_willmsgupd(MQTTSNString* willMsg, unsigned char* buf, int len) +{ + return MQTTSNDeserialize_willmsg1(willMsg, buf, len, MQTTSN_WILLMSGUPD); +} + + +/** + * Serializes the willtopicresp packet into the supplied buffer. + * @param buf the buffer into which the packet will be serialized + * @param buflen the length in bytes of the supplied buffer + * @param rc the integer return code to be used + * @return serialized length, or error if 0 + */ +int MQTTSNSerialize_willtopicresp(unsigned char* buf, int buflen, int resp_rc) +{ + int rc = 0; + unsigned char *ptr = buf; + + FUNC_ENTRY; + if (buflen < 3) + { + rc = MQTTSNPACKET_BUFFER_TOO_SHORT; + goto exit; + } + + ptr += MQTTSNPacket_encode(ptr, 3); /* write length */ + writeChar(&ptr, MQTTSN_WILLTOPICRESP); + writeChar(&ptr, resp_rc); + + rc = ptr - buf; +exit: + FUNC_EXIT_RC(rc); + return rc; +} + + +/** + * Serializes the willmsgresp packet into the supplied buffer. + * @param buf the buffer into which the packet will be serialized + * @param buflen the length in bytes of the supplied buffer + * @param rc the integer return code to be used + * @return serialized length, or error if 0 + */ +int MQTTSNSerialize_willmsgresp(unsigned char* buf, int buflen, int resp_rc) +{ + int rc = 0; + unsigned char *ptr = buf; + + FUNC_ENTRY; + if (buflen < 3) + { + rc = MQTTSNPACKET_BUFFER_TOO_SHORT; + goto exit; + } + + ptr += MQTTSNPacket_encode(ptr, 3); /* write length */ + writeChar(&ptr, MQTTSN_WILLMSGRESP); + writeChar(&ptr, resp_rc); + + rc = ptr - buf; +exit: + FUNC_EXIT_RC(rc); + return rc; +} +