|
version 1.1.1.1.2.1, 2011/11/07 13:34:06
|
version 1.1.1.1.2.3, 2011/11/07 16:55:46
|
|
Line 67 mqtt_encodeLen(u_int num)
|
Line 67 mqtt_encodeLen(u_int num)
|
| /* |
/* |
| * mqtt_decodeLen() Decode length from MQTT packet |
* mqtt_decodeLen() Decode length from MQTT packet |
| * @len = length |
* @len = length |
| |
* @n = sizeof bytes, if !=NULL |
| * return: -1 error, >-1 length of message |
* return: -1 error, >-1 length of message |
| */ |
*/ |
| inline u_int |
inline u_int |
| mqtt_decodeLen(u_int len) | mqtt_decodeLen(u_int len, char *n) |
| { |
{ |
| register u_int i, dig, mul; |
register u_int i, dig, mul; |
| u_int ret = 0; |
u_int ret = 0; |
|
Line 87 mqtt_decodeLen(u_int len)
|
Line 88 mqtt_decodeLen(u_int len)
|
| break; |
break; |
| } |
} |
| |
|
| |
if (n) |
| |
*n = (char) (i & 0x7f) + 1; |
| return ret; |
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; |
| |
} |
| |
|
| |
/* |
| |
* mqtt_str2var Create MQTT variable from string |
| |
* @csStr = string |
| |
* @strLen = string length |
| |
* return: NULL error or != ok variable, must be free after use! |
| |
*/ |
| |
inline mqtthdr_var_t * |
| |
mqtt_str2var(const u_char *csStr, u_short strLen) |
| |
{ |
| |
mqtthdr_var_t *v; |
| |
|
| |
if (!csStr) |
| |
return NULL; |
| |
if (!(v = malloc(strLen + sizeof(mqtthdr_var_t)))) { |
| |
LOGERR; |
| |
return NULL; |
| |
} else |
| |
memset(v, 0, strLen + sizeof(mqtthdr_var_t)); |
| |
|
| |
memcpy(v->var_data, csStr, strLen); |
| |
v->var_sb.val = htons(strLen); |
| |
|
| |
return v; |
| } |
} |