1: /*************************************************************************
2: * (C) 2011 AITNET ltd - Sofia/Bulgaria - <misho@aitbg.com>
3: * by Michael Pounov <misho@openbsd-bg.org>
4: *
5: * $Author: misho $
6: * $Id: pub.c,v 1.4.4.2 2022/09/14 18:36:23 misho Exp $
7: *
8: **************************************************************************
9: The ELWIX and AITNET software is distributed under the following
10: terms:
11:
12: All of the documentation and software included in the ELWIX and AITNET
13: Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
14:
15: Copyright 2004 - 2022
16: by Michael Pounov <misho@elwix.org>. All rights reserved.
17:
18: Redistribution and use in source and binary forms, with or without
19: modification, are permitted provided that the following conditions
20: are met:
21: 1. Redistributions of source code must retain the above copyright
22: notice, this list of conditions and the following disclaimer.
23: 2. Redistributions in binary form must reproduce the above copyright
24: notice, this list of conditions and the following disclaimer in the
25: documentation and/or other materials provided with the distribution.
26: 3. All advertising materials mentioning features or use of this software
27: must display the following acknowledgement:
28: This product includes software developed by Michael Pounov <misho@elwix.org>
29: ELWIX - Embedded LightWeight unIX and its contributors.
30: 4. Neither the name of AITNET nor the names of its contributors
31: may be used to endorse or promote products derived from this software
32: without specific prior written permission.
33:
34: THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
35: ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
36: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
37: ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
38: FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
39: DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
40: OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
41: HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
42: LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
43: OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
44: SUCH DAMAGE.
45: */
46: #include "global.h"
47:
48:
49: /*
50: * mqtt_msgPUBLISH() Create PUBLISH message
51: *
52: * @csTopic = Publish topic
53: * @msgID = MessageID >0, if QOS != MQTT_QOS_ONCE
54: * @Dup = Duplicate message
55: * @QOS = QoS
56: * @Retain = Retain message
57: * @pData = Publish data into topic
58: * @datlen = Publish data length
59: * return: NULL error or allocated PUBLISH message
60: */
61: mqtt_msg_t *
62: mqtt_msgPUBLISH(const char *csTopic, u_short msgID, u_char Dup,
63: u_char QOS, u_char Retain, const void *pData, int datlen)
64: {
65: int len, siz;
66: u_int n, *l;
67: struct mqtthdr *hdr;
68: mqtthdr_var_t *topic;
69: mqtt_len_t *mid;
70: void *data;
71: mqtt_msg_t *msg = NULL;
72:
73: if (!csTopic)
74: return NULL;
75: if (QOS > MQTT_QOS_EXACTLY) {
76: mqtt_SetErr(EINVAL, "Invalid QoS parameter");
77: return NULL;
78: }
79: if (!msgID && QOS != MQTT_QOS_ONCE) {
80: mqtt_SetErr(EINVAL, "Invalid MessageID parameter must be >0");
81: return NULL;
82: }
83:
84: /* calculate message size */
85: len = sizeof(mqtt_len_t) + strlen(csTopic); /* topic */
86: len += sizeof(mqtt_len_t); /* msgid */
87: len += datlen; /* data len */
88:
89: /* calculate header size */
90: siz = sizeof(struct mqtthdr); /* mqtt fixed header */
91: n = mqtt_encodeLen(len); /* message size */
92: siz += mqtt_sizeLen(n) - 1; /* length size */
93:
94: if (!(msg = mqtt_msgAlloc(siz + len)))
95: return NULL;
96: else {
97: data = msg->msg_base;
98: hdr = (struct mqtthdr *) data;
99: }
100:
101: /* fixed header */
102: hdr->mqtt_msg.type = MQTT_TYPE_PUBLISH;
103: hdr->mqtt_msg.qos = QOS;
104: hdr->mqtt_msg.dup = Dup ? 1 : 0;
105: hdr->mqtt_msg.retain = Retain ? 1 : 0;
106: l = (u_int*) hdr->mqtt_len;
107: *l = n;
108: data += siz;
109:
110: /* variable header */
111: topic = (mqtthdr_var_t*) data;
112: topic->var_sb.val = htons(strlen(csTopic));
113: memcpy(topic->var_data, csTopic, ntohs(topic->var_sb.val));
114: data += MQTTHDR_VAR_SIZEOF(topic);
115:
116: mid = (mqtt_len_t*) data;
117: mid->val = htons(msgID);
118: data += sizeof(mqtt_len_t);
119:
120: /* load with data */
121: if (pData && datlen)
122: memcpy(data, pData, datlen);
123:
124: return msg;
125: }
126:
127: static mqtt_msg_t *
128: _mqtt_msgPUB_(u_char cmd, u_short msgID)
129: {
130: struct mqtthdr *hdr;
131: mqtt_len_t *v;
132: mqtt_msg_t *msg = NULL;
133:
134: if (!(msg = mqtt_msgAlloc(sizeof(struct mqtthdr) + sizeof(mqtt_len_t))))
135: return NULL;
136: else {
137: hdr = (struct mqtthdr *) msg->msg_base;
138: v = (mqtt_len_t*) (msg->msg_base + sizeof(struct mqtthdr));
139: }
140:
141: /* fixed header */
142: hdr->mqtt_msg.type = cmd;
143: *hdr->mqtt_len = sizeof(mqtt_len_t);
144:
145: /* MessageID */
146: v->val = htons(msgID);
147:
148: return msg;
149: }
150:
151: /*
152: * mqtt_msgPUBACK() Create PUBACK message
153: *
154: * @msgID = MessageID
155: * return: NULL error or allocated PUBACK message
156: */
157: mqtt_msg_t *
158: mqtt_msgPUBACK(u_short msgID)
159: {
160: return _mqtt_msgPUB_(MQTT_TYPE_PUBACK, msgID);
161: }
162:
163: /*
164: * mqtt_msgPUBREC() Create PUBREC message
165: *
166: * @msgID = MessageID
167: * return: NULL error or allocated PUBREC message
168: */
169: mqtt_msg_t *
170: mqtt_msgPUBREC(u_short msgID)
171: {
172: return _mqtt_msgPUB_(MQTT_TYPE_PUBREC, msgID);
173: }
174:
175: /*
176: * mqtt_msgPUBREL() Create PUBREL message
177: *
178: * @msgID = MessageID
179: * return: NULL error or allocated PUBREL message
180: */
181: mqtt_msg_t *
182: mqtt_msgPUBREL(u_short msgID)
183: {
184: return _mqtt_msgPUB_(MQTT_TYPE_PUBREL, msgID);
185: }
186:
187: /*
188: * mqtt_msgPUBCOMP() Create PUBCOMP message
189: *
190: * @msgID = MessageID
191: * return: NULL error or allocated PUBCOMP message
192: */
193: mqtt_msg_t *
194: mqtt_msgPUBCOMP(u_short msgID)
195: {
196: return _mqtt_msgPUB_(MQTT_TYPE_PUBCOMP, msgID);
197: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>