--- libaitmqtt/src/aitmqtt.c	2012/06/11 08:37:41	1.1.1.1.2.15
+++ libaitmqtt/src/aitmqtt.c	2012/06/20 08:15:13	1.1.1.1.2.16
@@ -3,7 +3,7 @@
 *  by Michael Pounov <misho@openbsd-bg.org>
 *
 * $Author: misho $
-* $Id: aitmqtt.c,v 1.1.1.1.2.15 2012/06/11 08:37:41 misho Exp $
+* $Id: aitmqtt.c,v 1.1.1.1.2.16 2012/06/20 08:15:13 misho Exp $
 *
 **************************************************************************
 The ELWIX and AITNET software is distributed under the following
@@ -299,6 +299,26 @@ mqtt_sizeLen(u_int len)
 			break;
 
 	return ++i;
+}
+
+/*
+ * mqtt_pktLen() - Get total packet length
+ *
+ * @hdr = MQTT packet header
+ * return: packet length
+ */
+inline u_int
+mqtt_pktLen(struct mqtthdr * __restrict hdr)
+{
+	int siz, n = 0;
+
+	if (!hdr)
+		return 0;
+
+	siz = mqtt_decodeLen(hdr->mqtt_len, &n);
+	siz += sizeof(struct mqtthdr) + n - 1;
+
+	return siz;
 }
 
 /*