--- libaitmqtt/src/pub.c	2012/06/20 15:02:24	1.2
+++ libaitmqtt/src/pub.c	2012/06/28 11:06:17	1.3
@@ -3,7 +3,7 @@
 *  by Michael Pounov <misho@openbsd-bg.org>
 *
 * $Author: misho $
-* $Id: pub.c,v 1.2 2012/06/20 15:02:24 misho Exp $
+* $Id: pub.c,v 1.3 2012/06/28 11:06:17 misho Exp $
 *
 **************************************************************************
 The ELWIX and AITNET software is distributed under the following
@@ -64,7 +64,7 @@ mqtt_msgPUBLISH(mqtt_msg_t * __restrict buf, const cha
 		u_char Dup, u_char QOS, u_char Retain, const void *pData, int datlen)
 {
 	int len, siz;
-	u_int n;
+	u_int n, *l;
 	struct mqtthdr *hdr;
 	mqtthdr_var_t *topic;
 	mqtt_len_t *mid;
@@ -104,7 +104,8 @@ mqtt_msgPUBLISH(mqtt_msg_t * __restrict buf, const cha
 	hdr->mqtt_msg.qos = QOS;
 	hdr->mqtt_msg.dup = Dup ? 1 : 0;
 	hdr->mqtt_msg.retain = Retain ? 1 : 0;
-	*(u_int*) hdr->mqtt_len = n;
+	l = (u_int*) hdr->mqtt_len;
+	*l = n;
 	data += siz;
 
 	/* variable header */
@@ -127,7 +128,7 @@ mqtt_msgPUBLISH(mqtt_msg_t * __restrict buf, const cha
 static int
 _mqtt_msgPUB_(mqtt_msg_t * __restrict buf, u_char cmd, u_short msgID)
 {
-	int siz = 0;
+	int siz = sizeof(struct mqtthdr);
 	struct mqtthdr *hdr;
 	mqtt_len_t *v;
 
@@ -136,12 +137,8 @@ _mqtt_msgPUB_(mqtt_msg_t * __restrict buf, u_char cmd,
 
 	if (mqtt_msgRealloc(buf, sizeof(struct mqtthdr) + sizeof(mqtt_len_t)) == -1)
 		return -1;
-	else {
-		hdr = (struct mqtthdr *) (buf->msg_base + siz);
-		siz += sizeof(struct mqtthdr);
-		v = (mqtt_len_t*) (buf->msg_base + siz);
-		siz += sizeof(mqtt_len_t);
-	}
+	else
+		hdr = (struct mqtthdr *) buf->msg_base;
 
 	/* fixed header */
 	MQTTHDR_MSGINIT(hdr);
@@ -149,7 +146,9 @@ _mqtt_msgPUB_(mqtt_msg_t * __restrict buf, u_char cmd,
 	*hdr->mqtt_len = sizeof(mqtt_len_t);
 
 	/* MessageID */
+	v = (mqtt_len_t*) (buf->msg_base + siz);
 	v->val = htons(msgID);
+	siz += sizeof(mqtt_len_t);
 
 	return siz;
 }