version 1.3, 2012/06/28 11:06:17
|
version 1.3.12.1, 2022/09/14 21:44:21
|
Line 12 terms:
|
Line 12 terms:
|
All of the documentation and software included in the ELWIX and AITNET |
All of the documentation and software included in the ELWIX and AITNET |
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
|
|
Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012 | Copyright 2004 - 2022 |
by Michael Pounov <misho@elwix.org>. All rights reserved. |
by Michael Pounov <misho@elwix.org>. All rights reserved. |
|
|
Redistribution and use in source and binary forms, with or without |
Redistribution and use in source and binary forms, with or without |
Line 49 SUCH DAMAGE.
|
Line 49 SUCH DAMAGE.
|
/* |
/* |
* mqtt_msgSUBSCRIBE() Create SUBSCRIBE message |
* mqtt_msgSUBSCRIBE() Create SUBSCRIBE message |
* |
* |
* @buf = Message buffer |
|
* @Topics = MQTT subscription topics |
* @Topics = MQTT subscription topics |
* @msgID = MessageID |
* @msgID = MessageID |
* @Dup = Duplicate message |
* @Dup = Duplicate message |
* @QOS = QoS |
* @QOS = QoS |
* return: -1 error or >-1 message size for send | * return: NULL error or allocated SUBSCRIBE message |
*/ |
*/ |
int | mqtt_msg_t * |
mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_subscr_t * __restrict Topics, | mqtt_msgSUBSCRIBE(mqtt_subscr_t ** __restrict Topics, u_short msgID, |
u_short msgID, u_char Dup, u_char QOS) | u_char Dup, u_char QOS) |
{ |
{ |
int len, siz = 0; | int len, siz; |
u_int n, *l; |
u_int n, *l; |
struct mqtthdr *hdr; |
struct mqtthdr *hdr; |
mqtthdr_var_t *topic; |
mqtthdr_var_t *topic; |
Line 68 mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_su
|
Line 67 mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_su
|
mqtt_subscr_t *t; |
mqtt_subscr_t *t; |
u_char *qos; |
u_char *qos; |
void *data; |
void *data; |
|
mqtt_msg_t *msg = NULL; |
|
|
if (!buf || !Topics) | if (!Topics || !*Topics) |
return -1; | return NULL; |
if (QOS > MQTT_QOS_EXACTLY) { |
if (QOS > MQTT_QOS_EXACTLY) { |
mqtt_SetErr(EINVAL, "Invalid QoS parameter"); |
mqtt_SetErr(EINVAL, "Invalid QoS parameter"); |
return -1; | return NULL; |
} |
} |
if (!msgID && QOS != MQTT_QOS_ONCE) { |
if (!msgID && QOS != MQTT_QOS_ONCE) { |
mqtt_SetErr(EINVAL, "Invalid MessageID parameter must be >0"); |
mqtt_SetErr(EINVAL, "Invalid MessageID parameter must be >0"); |
return -1; | return NULL; |
} |
} |
|
|
/* calculate message size */ |
/* calculate message size */ |
len = sizeof(mqtt_len_t); /* msgid */ |
len = sizeof(mqtt_len_t); /* msgid */ |
for (t = Topics; t && t->sub_topic.msg_base; t++) /* subscribes & qos */ | for (t = *Topics; t && t->sub_topic.msg_base; t++) /* subscribes & qos */ |
len += sizeof(mqtt_len_t) + t->sub_topic.msg_len + 1; | len += sizeof(mqtt_len_t) + t->sub_topic.msg_len; |
|
|
/* calculate header size */ |
/* calculate header size */ |
siz = sizeof(struct mqtthdr); /* mqtt fixed header */ |
siz = sizeof(struct mqtthdr); /* mqtt fixed header */ |
n = mqtt_encodeLen(len); /* message size */ |
n = mqtt_encodeLen(len); /* message size */ |
siz += mqtt_sizeLen(n) - 1; /* length size */ |
siz += mqtt_sizeLen(n) - 1; /* length size */ |
|
|
if (mqtt_msgRealloc(buf, siz + len) == -1) | if (!(msg = mqtt_msgAlloc(siz + len))) |
return -1; | return NULL; |
else { |
else { |
data = buf->msg_base; | data = msg->msg_base; |
hdr = (struct mqtthdr *) data; |
hdr = (struct mqtthdr *) data; |
} |
} |
|
|
/* fixed header */ |
/* fixed header */ |
MQTTHDR_MSGINIT(hdr); |
|
hdr->mqtt_msg.type = MQTT_TYPE_SUBSCRIBE; |
hdr->mqtt_msg.type = MQTT_TYPE_SUBSCRIBE; |
hdr->mqtt_msg.qos = QOS; |
hdr->mqtt_msg.qos = QOS; |
hdr->mqtt_msg.dup = Dup ? 1 : 0; |
hdr->mqtt_msg.dup = Dup ? 1 : 0; |
Line 113 mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_su
|
Line 112 mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_su
|
data += sizeof(mqtt_len_t); |
data += sizeof(mqtt_len_t); |
|
|
/* payload with subscriptions */ |
/* payload with subscriptions */ |
for (t = Topics; t && t->sub_topic.msg_base; t++) { | for (t = *Topics; t && t->sub_topic.msg_base; t++) { |
topic = (mqtthdr_var_t*) data; |
topic = (mqtthdr_var_t*) data; |
topic->var_sb.val = htons(t->sub_topic.msg_len); |
topic->var_sb.val = htons(t->sub_topic.msg_len); |
memcpy(topic->var_data, t->sub_topic.msg_base, ntohs(topic->var_sb.val)); |
memcpy(topic->var_data, t->sub_topic.msg_base, ntohs(topic->var_sb.val)); |
Line 122 mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_su
|
Line 121 mqtt_msgSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_su
|
*qos = t->sub_ret; |
*qos = t->sub_ret; |
} |
} |
|
|
return siz + len; | return msg; |
} |
} |
|
|
/* |
/* |
* mqtt_msgSUBACK() Create SUBACK message |
* mqtt_msgSUBACK() Create SUBACK message |
* |
* |
* @buf = Message buffer |
|
* @Topics = MQTT subscription topics |
* @Topics = MQTT subscription topics |
* @msgID = MessageID |
* @msgID = MessageID |
* return: -1 error or >-1 message size for send | * return: NULL error or allocated SUBACK message |
*/ |
*/ |
int | mqtt_msg_t * |
mqtt_msgSUBACK(mqtt_msg_t * __restrict buf, mqtt_subscr_t * __restrict Topics, u_short msgID) | mqtt_msgSUBACK(mqtt_subscr_t ** __restrict Topics, u_short msgID) |
{ |
{ |
int siz = 0; |
int siz = 0; |
struct mqtthdr *hdr; |
struct mqtthdr *hdr; |
mqtt_len_t *v; |
mqtt_len_t *v; |
mqtt_subscr_t *t; |
mqtt_subscr_t *t; |
u_char *qos; |
u_char *qos; |
|
mqtt_msg_t *msg = NULL; |
|
|
if (!buf || !Topics) | if (!Topics || !*Topics) |
return -1; | return NULL; |
|
|
if (mqtt_msgRealloc(buf, MQTTMSG_MAX) == -1) | if (!(msg = mqtt_msgAlloc(MQTTMSG_MAX))) |
return -1; | return NULL; |
else { |
else { |
hdr = (struct mqtthdr *) (buf->msg_base + siz); | hdr = (struct mqtthdr *) msg->msg_base; |
siz += sizeof(struct mqtthdr); | siz = sizeof(struct mqtthdr); |
v = (mqtt_len_t*) (buf->msg_base + siz); | v = (mqtt_len_t*) (msg->msg_base + siz); |
siz += sizeof(mqtt_len_t); |
siz += sizeof(mqtt_len_t); |
} |
} |
|
|
Line 158 mqtt_msgSUBACK(mqtt_msg_t * __restrict buf, mqtt_subsc
|
Line 157 mqtt_msgSUBACK(mqtt_msg_t * __restrict buf, mqtt_subsc
|
v->val = htons(msgID); |
v->val = htons(msgID); |
|
|
/* QoS payload from subscriptions */ |
/* QoS payload from subscriptions */ |
for (t = Topics; t && t->sub_topic.msg_base; t++) { | for (t = *Topics; t && t->sub_topic.msg_base; t++, siz++) { |
qos = (buf->msg_base + siz); | qos = (msg->msg_base + siz); |
*qos = t->sub_ret; |
*qos = t->sub_ret; |
siz++; |
|
} |
} |
|
|
/* fixed header */ |
/* fixed header */ |
MQTTHDR_MSGINIT(hdr); |
|
hdr->mqtt_msg.type = MQTT_TYPE_SUBACK; |
hdr->mqtt_msg.type = MQTT_TYPE_SUBACK; |
*hdr->mqtt_len = mqtt_encodeLen(siz - sizeof(struct mqtthdr)); |
*hdr->mqtt_len = mqtt_encodeLen(siz - sizeof(struct mqtthdr)); |
|
|
return siz; | return msg; |
} |
} |
|
|
/* |
/* |
* mqtt_msgUNSUBSCRIBE() Create UNSUBSCRIBE message |
* mqtt_msgUNSUBSCRIBE() Create UNSUBSCRIBE message |
* |
* |
* @buf = Message buffer |
|
* @Topics = MQTT subscription topics |
* @Topics = MQTT subscription topics |
* @msgID = MessageID |
* @msgID = MessageID |
* @Dup = Duplicate message |
* @Dup = Duplicate message |
* @QOS = QoS |
* @QOS = QoS |
* return: -1 error or >-1 message size for send | * return: NULL error or allocated UNSUBSCRIBE message |
*/ |
*/ |
int | mqtt_msg_t * |
mqtt_msgUNSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_subscr_t * __restrict Topics, | mqtt_msgUNSUBSCRIBE(mqtt_subscr_t ** __restrict Topics, u_short msgID, |
u_short msgID, u_char Dup, u_char QOS) | u_char Dup, u_char QOS) |
{ |
{ |
int len, siz = 0; |
int len, siz = 0; |
u_int n, *l; |
u_int n, *l; |
Line 193 mqtt_msgUNSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_
|
Line 189 mqtt_msgUNSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_
|
mqtt_len_t *mid; |
mqtt_len_t *mid; |
mqtt_subscr_t *t; |
mqtt_subscr_t *t; |
void *data; |
void *data; |
|
mqtt_msg_t *msg = NULL; |
|
|
if (!buf || !Topics) | if (!Topics || !*Topics) |
return -1; | return NULL; |
if (QOS > MQTT_QOS_EXACTLY) { |
if (QOS > MQTT_QOS_EXACTLY) { |
mqtt_SetErr(EINVAL, "Invalid QoS parameter"); |
mqtt_SetErr(EINVAL, "Invalid QoS parameter"); |
return -1; | return NULL; |
} |
} |
if (!msgID && QOS != MQTT_QOS_ONCE) { |
if (!msgID && QOS != MQTT_QOS_ONCE) { |
mqtt_SetErr(EINVAL, "Invalid MessageID parameter must be >0"); |
mqtt_SetErr(EINVAL, "Invalid MessageID parameter must be >0"); |
return -1; | return NULL; |
} |
} |
|
|
/* calculate message size */ |
/* calculate message size */ |
len = sizeof(mqtt_len_t); /* msgid */ |
len = sizeof(mqtt_len_t); /* msgid */ |
for (t = Topics; t && t->sub_topic.msg_base; t++) /* subscribes */ | for (t = *Topics; t && t->sub_topic.msg_base; t++) /* subscribes */ |
len += sizeof(mqtt_len_t) + t->sub_topic.msg_len; |
len += sizeof(mqtt_len_t) + t->sub_topic.msg_len; |
|
|
/* calculate header size */ |
/* calculate header size */ |
Line 215 mqtt_msgUNSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_
|
Line 212 mqtt_msgUNSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_
|
n = mqtt_encodeLen(len); /* message size */ |
n = mqtt_encodeLen(len); /* message size */ |
siz += mqtt_sizeLen(n) - 1; /* length size */ |
siz += mqtt_sizeLen(n) - 1; /* length size */ |
|
|
if (mqtt_msgRealloc(buf, siz + len) == -1) | if (!(msg = mqtt_msgAlloc(siz + len))) |
return -1; | return NULL; |
else { |
else { |
data = buf->msg_base; | data = msg->msg_base; |
hdr = (struct mqtthdr *) data; |
hdr = (struct mqtthdr *) data; |
} |
} |
|
|
/* fixed header */ |
/* fixed header */ |
MQTTHDR_MSGINIT(hdr); |
|
hdr->mqtt_msg.type = MQTT_TYPE_UNSUBSCRIBE; |
hdr->mqtt_msg.type = MQTT_TYPE_UNSUBSCRIBE; |
hdr->mqtt_msg.qos = QOS; |
hdr->mqtt_msg.qos = QOS; |
hdr->mqtt_msg.dup = Dup ? 1 : 0; |
hdr->mqtt_msg.dup = Dup ? 1 : 0; |
Line 233 mqtt_msgUNSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_
|
Line 229 mqtt_msgUNSUBSCRIBE(mqtt_msg_t * __restrict buf, mqtt_
|
data += siz; |
data += siz; |
|
|
/* variable header */ |
/* variable header */ |
mid = (mqtt_len_t*) (buf->msg_base + siz); | mid = (mqtt_len_t*) (msg->msg_base + siz); |
mid->val = htons(msgID); |
mid->val = htons(msgID); |
data += sizeof(mqtt_len_t); |
data += sizeof(mqtt_len_t); |
|
|
/* payload with subscriptions */ |
/* payload with subscriptions */ |
for (t = Topics; t && t->sub_topic.msg_base; t++) { | for (t = *Topics; t && t->sub_topic.msg_base; t++) { |
topic = (mqtthdr_var_t*) data; |
topic = (mqtthdr_var_t*) data; |
topic->var_sb.val = htons(t->sub_topic.msg_len); |
topic->var_sb.val = htons(t->sub_topic.msg_len); |
memcpy(topic->var_data, t->sub_topic.msg_base, ntohs(topic->var_sb.val)); |
memcpy(topic->var_data, t->sub_topic.msg_base, ntohs(topic->var_sb.val)); |
data += MQTTHDR_VAR_SIZEOF(topic); |
data += MQTTHDR_VAR_SIZEOF(topic); |
} |
} |
|
|
return siz + len; | return msg; |
} |
} |
|
|
/* |
/* |
* mqtt_msgUNSUBACK() Create UNSUBACK message |
* mqtt_msgUNSUBACK() Create UNSUBACK message |
* |
* |
* @buf = Message buffer |
|
* @msgID = MessageID |
* @msgID = MessageID |
* return: -1 error or >-1 message size for send | * return: NULL error or allocated UNSUBACK message |
*/ |
*/ |
int | mqtt_msg_t * |
mqtt_msgUNSUBACK(mqtt_msg_t * __restrict buf, u_short msgID) | mqtt_msgUNSUBACK(u_short msgID) |
{ |
{ |
int siz = 0; |
|
struct mqtthdr *hdr; |
struct mqtthdr *hdr; |
mqtt_len_t *v; |
mqtt_len_t *v; |
|
mqtt_msg_t *msg = NULL; |
|
|
if (!buf) | if (!(msg = mqtt_msgAlloc(sizeof(struct mqtthdr) + sizeof(mqtt_len_t)))) |
return -1; | return NULL; |
| |
if (mqtt_msgRealloc(buf, sizeof(struct mqtthdr) + sizeof(mqtt_len_t)) == -1) | |
return -1; | |
else { |
else { |
hdr = (struct mqtthdr *) (buf->msg_base + siz); | hdr = (struct mqtthdr *) msg->msg_base; |
siz += sizeof(struct mqtthdr); | v = (mqtt_len_t*) (msg->msg_base + sizeof(struct mqtthdr)); |
v = (mqtt_len_t*) (buf->msg_base + siz); | |
siz += sizeof(mqtt_len_t); | |
} |
} |
|
|
/* fixed header */ |
/* fixed header */ |
MQTTHDR_MSGINIT(hdr); |
|
hdr->mqtt_msg.type = MQTT_TYPE_UNSUBACK; |
hdr->mqtt_msg.type = MQTT_TYPE_UNSUBACK; |
*hdr->mqtt_len = sizeof(mqtt_len_t); |
*hdr->mqtt_len = sizeof(mqtt_len_t); |
|
|
/* MessageID */ |
/* MessageID */ |
v->val = htons(msgID); |
v->val = htons(msgID); |
|
|
return siz; | return msg; |
} |
} |
|
|
|
|
/* ============= decode ============ */ |
/* ============= decode ============ */ |
|
|
|
#if 0 |
/* |
/* |
* mqtt_readSUBSCRIBE() Read SUBSCRIBE message |
* mqtt_readSUBSCRIBE() Read SUBSCRIBE message |
* |
* |
Line 516 mqtt_readUNSUBACK(mqtt_msg_t * __restrict buf)
|
Line 506 mqtt_readUNSUBACK(mqtt_msg_t * __restrict buf)
|
|
|
return ntohs(v->val); |
return ntohs(v->val); |
} |
} |
|
#endif |