mirror of
https://github.com/jialexd/sdk-ameba-v4.0c_180328.git
synced 2024-11-24 23:14:18 +00:00
255 lines
8.3 KiB
C
255 lines
8.3 KiB
C
|
/*******************************************************************************
|
||
|
|
* 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 "MQTTPacket.h"
|
||
|
|
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
|
||
|
|
const char* MQTTPacket_names[] =
|
||
|
|
{
|
||
|
|
"RESERVED", "CONNECT", "CONNACK", "PUBLISH", "PUBACK", "PUBREC", "PUBREL",
|
||
|
|
"PUBCOMP", "SUBSCRIBE", "SUBACK", "UNSUBSCRIBE", "UNSUBACK",
|
||
|
|
"PINGREQ", "PINGRESP", "DISCONNECT"
|
||
|
|
};
|
||
|
|
|
||
|
|
|
||
|
|
const char* MQTTPacket_getName(unsigned short packetid)
|
||
|
|
{
|
||
|
|
return MQTTPacket_names[packetid];
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int MQTTStringFormat_connect(char* strbuf, int strbuflen, MQTTPacket_connectData* data)
|
||
|
|
{
|
||
|
|
int strindex = 0;
|
||
|
|
|
||
|
|
strindex = snprintf(strbuf, strbuflen,
|
||
|
|
"CONNECT MQTT version %d, client id %.*s, clean session %d, keep alive %d",
|
||
|
|
(int)data->MQTTVersion, data->clientID.lenstring.len, data->clientID.lenstring.data,
|
||
|
|
(int)data->cleansession, data->keepAliveInterval);
|
||
|
|
if (data->willFlag)
|
||
|
|
strindex += snprintf(&strbuf[strindex], strbuflen - strindex,
|
||
|
|
", will QoS %d, will retain %d, will topic %.*s, will message %.*s",
|
||
|
|
data->will.qos, data->will.retained,
|
||
|
|
data->will.topicName.lenstring.len, data->will.topicName.lenstring.data,
|
||
|
|
data->will.message.lenstring.len, data->will.message.lenstring.data);
|
||
|
|
if (data->username.lenstring.data && data->username.lenstring.len > 0)
|
||
|
|
strindex += snprintf(&strbuf[strindex], strbuflen - strindex,
|
||
|
|
", user name %.*s", data->username.lenstring.len, data->username.lenstring.data);
|
||
|
|
if (data->password.lenstring.data && data->password.lenstring.len > 0)
|
||
|
|
strindex += snprintf(&strbuf[strindex], strbuflen - strindex,
|
||
|
|
", password %.*s", data->password.lenstring.len, data->password.lenstring.data);
|
||
|
|
return strindex;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int MQTTStringFormat_connack(char* strbuf, int strbuflen, unsigned char connack_rc, unsigned char sessionPresent)
|
||
|
|
{
|
||
|
|
int strindex = snprintf(strbuf, strbuflen, "CONNACK session present %d, rc %d", sessionPresent, connack_rc);
|
||
|
|
return strindex;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int MQTTStringFormat_publish(char* strbuf, int strbuflen, unsigned char dup, int qos, unsigned char retained,
|
||
|
|
unsigned short packetid, MQTTString topicName, unsigned char* payload, int payloadlen)
|
||
|
|
{
|
||
|
|
int strindex = snprintf(strbuf, strbuflen,
|
||
|
|
"PUBLISH dup %d, QoS %d, retained %d, packet id %d, topic %.*s, payload length %d, payload %.*s",
|
||
|
|
dup, qos, retained, packetid,
|
||
|
|
(topicName.lenstring.len < 20) ? topicName.lenstring.len : 20, topicName.lenstring.data,
|
||
|
|
payloadlen, (payloadlen < 20) ? payloadlen : 20, payload);
|
||
|
|
return strindex;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int MQTTStringFormat_ack(char* strbuf, int strbuflen, unsigned char packettype, unsigned char dup, unsigned short packetid)
|
||
|
|
{
|
||
|
|
int strindex = snprintf(strbuf, strbuflen, "%s, packet id %d", MQTTPacket_names[packettype], packetid);
|
||
|
|
if (dup)
|
||
|
|
strindex += snprintf(strbuf + strindex, strbuflen - strindex, ", dup %d", dup);
|
||
|
|
return strindex;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int MQTTStringFormat_subscribe(char* strbuf, int strbuflen, unsigned char dup, unsigned short packetid, int count,
|
||
|
|
MQTTString topicFilters[], int requestedQoSs[])
|
||
|
|
{
|
||
|
|
return snprintf(strbuf, strbuflen,
|
||
|
|
"SUBSCRIBE dup %d, packet id %d count %d topic %.*s qos %d",
|
||
|
|
dup, packetid, count,
|
||
|
|
topicFilters[0].lenstring.len, topicFilters[0].lenstring.data,
|
||
|
|
requestedQoSs[0]);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int MQTTStringFormat_suback(char* strbuf, int strbuflen, unsigned short packetid, int count, int* grantedQoSs)
|
||
|
|
{
|
||
|
|
return snprintf(strbuf, strbuflen,
|
||
|
|
"SUBACK packet id %d count %d granted qos %d", packetid, count, grantedQoSs[0]);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int MQTTStringFormat_unsubscribe(char* strbuf, int strbuflen, unsigned char dup, unsigned short packetid,
|
||
|
|
int count, MQTTString topicFilters[])
|
||
|
|
{
|
||
|
|
return snprintf(strbuf, strbuflen,
|
||
|
|
"UNSUBSCRIBE dup %d, packet id %d count %d topic %.*s",
|
||
|
|
dup, packetid, count,
|
||
|
|
topicFilters[0].lenstring.len, topicFilters[0].lenstring.data);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
char* MQTTFormat_toClientString(char* strbuf, int strbuflen, unsigned char* buf, int buflen)
|
||
|
|
{
|
||
|
|
int index = 0;
|
||
|
|
int rem_length = 0;
|
||
|
|
MQTTHeader header = {0};
|
||
|
|
|
||
|
|
header.byte = buf[index++];
|
||
|
|
index += MQTTPacket_decodeBuf(&buf[index], &rem_length);
|
||
|
|
|
||
|
|
switch (header.bits.type)
|
||
|
|
{
|
||
|
|
case CONNACK:
|
||
|
|
{
|
||
|
|
unsigned char sessionPresent, connack_rc;
|
||
|
|
if (MQTTDeserialize_connack(&sessionPresent, &connack_rc, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_connack(strbuf, strbuflen, connack_rc, sessionPresent);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case PUBLISH:
|
||
|
|
{
|
||
|
|
unsigned char dup, retained, *payload;
|
||
|
|
unsigned short packetid;
|
||
|
|
int qos, payloadlen;
|
||
|
|
MQTTString topicName = MQTTString_initializer;
|
||
|
|
if (MQTTDeserialize_publish(&dup, &qos, &retained, &packetid, &topicName,
|
||
|
|
&payload, &payloadlen, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_publish(strbuf, strbuflen, dup, qos, retained, packetid,
|
||
|
|
topicName, payload, payloadlen);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case PUBACK:
|
||
|
|
case PUBREC:
|
||
|
|
case PUBREL:
|
||
|
|
case PUBCOMP:
|
||
|
|
{
|
||
|
|
unsigned char packettype, dup;
|
||
|
|
unsigned short packetid;
|
||
|
|
if (MQTTDeserialize_ack(&packettype, &dup, &packetid, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_ack(strbuf, strbuflen, packettype, dup, packetid);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case SUBACK:
|
||
|
|
{
|
||
|
|
unsigned short packetid;
|
||
|
|
int maxcount = 1, count = 0;
|
||
|
|
int grantedQoSs[1];
|
||
|
|
if (MQTTDeserialize_suback(&packetid, maxcount, &count, grantedQoSs, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_suback(strbuf, strbuflen, packetid, count, grantedQoSs);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case UNSUBACK:
|
||
|
|
{
|
||
|
|
unsigned short packetid;
|
||
|
|
if (MQTTDeserialize_unsuback(&packetid, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_ack(strbuf, strbuflen, UNSUBACK, 0, packetid);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case PINGREQ:
|
||
|
|
case PINGRESP:
|
||
|
|
case DISCONNECT:
|
||
|
|
snprintf(strbuf, strbuflen, "%s", MQTTPacket_names[header.bits.type]);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
return strbuf;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
char* MQTTFormat_toServerString(char* strbuf, int strbuflen, unsigned char* buf, int buflen)
|
||
|
|
{
|
||
|
|
int index = 0;
|
||
|
|
int rem_length = 0;
|
||
|
|
MQTTHeader header = {0};
|
||
|
|
|
||
|
|
header.byte = buf[index++];
|
||
|
|
index += MQTTPacket_decodeBuf(&buf[index], &rem_length);
|
||
|
|
|
||
|
|
switch (header.bits.type)
|
||
|
|
{
|
||
|
|
case CONNECT:
|
||
|
|
{
|
||
|
|
MQTTPacket_connectData data;
|
||
|
|
if ((MQTTDeserialize_connect(&data, buf, buflen)) == 1)
|
||
|
|
MQTTStringFormat_connect(strbuf, strbuflen, &data);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case PUBLISH:
|
||
|
|
{
|
||
|
|
unsigned char dup, retained, *payload;
|
||
|
|
unsigned short packetid;
|
||
|
|
int qos, payloadlen;
|
||
|
|
MQTTString topicName = MQTTString_initializer;
|
||
|
|
if (MQTTDeserialize_publish(&dup, &qos, &retained, &packetid, &topicName,
|
||
|
|
&payload, &payloadlen, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_publish(strbuf, strbuflen, dup, qos, retained, packetid,
|
||
|
|
topicName, payload, payloadlen);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case PUBACK:
|
||
|
|
case PUBREC:
|
||
|
|
case PUBREL:
|
||
|
|
case PUBCOMP:
|
||
|
|
{
|
||
|
|
unsigned char packettype, dup;
|
||
|
|
unsigned short packetid;
|
||
|
|
if (MQTTDeserialize_ack(&packettype, &dup, &packetid, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_ack(strbuf, strbuflen, packettype, dup, packetid);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case SUBSCRIBE:
|
||
|
|
{
|
||
|
|
unsigned char dup;
|
||
|
|
unsigned short packetid;
|
||
|
|
int maxcount = 1, count = 0;
|
||
|
|
MQTTString topicFilters[1];
|
||
|
|
int requestedQoSs[1];
|
||
|
|
if (MQTTDeserialize_subscribe(&dup, &packetid, maxcount, &count,
|
||
|
|
topicFilters, requestedQoSs, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_subscribe(strbuf, strbuflen, dup, packetid, count, topicFilters, requestedQoSs);;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case UNSUBSCRIBE:
|
||
|
|
{
|
||
|
|
unsigned char dup;
|
||
|
|
unsigned short packetid;
|
||
|
|
int maxcount = 1, count = 0;
|
||
|
|
MQTTString topicFilters[1];
|
||
|
|
if (MQTTDeserialize_unsubscribe(&dup, &packetid, maxcount, &count, topicFilters, buf, buflen) == 1)
|
||
|
|
MQTTStringFormat_unsubscribe(strbuf, strbuflen, dup, packetid, count, topicFilters);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case PINGREQ:
|
||
|
|
case PINGRESP:
|
||
|
|
case DISCONNECT:
|
||
|
|
snprintf(strbuf, strbuflen, "%s", MQTTPacket_names[header.bits.type]);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
strbuf[strbuflen] = '\0';
|
||
|
|
return strbuf;
|
||
|
|
}
|