--- mqtt/src/Attic/aitmqtt.c	2011/11/07 13:34:06	1.1.1.1.2.1
+++ mqtt/src/Attic/aitmqtt.c	2011/11/07 13:58:27	1.1.1.1.2.2
@@ -67,10 +67,11 @@ mqtt_encodeLen(u_int num)
 /*
  * mqtt_decodeLen() Decode length from MQTT packet
  * @len = length
+ * @n = sizeof bytes, if !=NULL
  * return: -1 error, >-1 length of message
  */
 inline u_int
-mqtt_decodeLen(u_int len)
+mqtt_decodeLen(u_int len, char *n)
 {
 	register u_int i, dig, mul;
 	u_int ret = 0;
@@ -87,5 +88,28 @@ mqtt_decodeLen(u_int len)
 			break;
 	}
 
+	if (n)
+		*n = (char) (i & 0x7f) + 1;
 	return ret;
+}
+
+/*
+ * mqtt_sizeLen Return sizeof len field
+ * @len = length
+ * return: -1 error, >-1 sizeof len in bytes
+ */
+inline char
+mqtt_sizeLen(u_int len)
+{
+	register char i;
+	u_char *p = (u_char*) &len;
+
+	if (len > 0xffffff7f)
+		return -1;
+
+	for (i = 0; i < sizeof len; i++)
+		if (!(*(p + i) & 0x80))
+			break;
+
+	return ++i;
 }