--- mqtt/src/Attic/pub.c 2011/11/22 14:00:09 1.1.2.6 +++ mqtt/src/Attic/pub.c 2011/12/05 22:17:39 1.1.2.7 @@ -154,3 +154,118 @@ mqtt_msgPUBCOMP(mqtt_msg_t * __restrict buf, u_short m { return _mqtt_msgPUB_(buf, MQTT_TYPE_PUBCOMP, msgID); } + + +/* ============= decode ============ */ + +/* + * mqtt_readPUBACK() Read PUBACK message + * + * @buf = Message buffer + * return: -1 error or MessageID + */ +u_short +mqtt_readPUBACK(mqtt_msg_t * __restrict buf) +{ + int len, ret; + struct mqtthdr *hdr; + mqtt_v_t *v; + caddr_t pos; + + hdr = _mqtt_readHEADER(buf, MQTT_TYPE_PUBACK, &ret, &len); + if (!hdr) + return (u_short) -1; + if (len < sizeof(mqtt_v_t)) { + mqtt_SetErr(EINVAL, "Error:: short message length %d", len); + return (u_short) -1; + } else { + pos = buf->msg_base + ret + 1; + v = (mqtt_v_t*) pos; + } + + return ntohs(v->val); +} + +/* + * mqtt_readPUBREC() Read PUBREC message + * + * @buf = Message buffer + * return: -1 error or MessageID + */ +u_short +mqtt_readPUBREC(mqtt_msg_t * __restrict buf) +{ + int len, ret; + struct mqtthdr *hdr; + mqtt_v_t *v; + caddr_t pos; + + hdr = _mqtt_readHEADER(buf, MQTT_TYPE_PUBREC, &ret, &len); + if (!hdr) + return (u_short) -1; + if (len < sizeof(mqtt_v_t)) { + mqtt_SetErr(EINVAL, "Error:: short message length %d", len); + return (u_short) -1; + } else { + pos = buf->msg_base + ret + 1; + v = (mqtt_v_t*) pos; + } + + return ntohs(v->val); +} + +/* + * mqtt_readPUBREL() Read PUBREL message + * + * @buf = Message buffer + * return: -1 error or MessageID + */ +u_short +mqtt_readPUBREL(mqtt_msg_t * __restrict buf) +{ + int len, ret; + struct mqtthdr *hdr; + mqtt_v_t *v; + caddr_t pos; + + hdr = _mqtt_readHEADER(buf, MQTT_TYPE_PUBREL, &ret, &len); + if (!hdr) + return (u_short) -1; + if (len < sizeof(mqtt_v_t)) { + mqtt_SetErr(EINVAL, "Error:: short message length %d", len); + return (u_short) -1; + } else { + pos = buf->msg_base + ret + 1; + v = (mqtt_v_t*) pos; + } + + return ntohs(v->val); +} + +/* + * mqtt_readPUBCOMP() Read PUBCOMP message + * + * @buf = Message buffer + * return: -1 error or MessageID + */ +u_short +mqtt_readPUBCOMP(mqtt_msg_t * __restrict buf) +{ + int len, ret; + struct mqtthdr *hdr; + mqtt_v_t *v; + caddr_t pos; + + hdr = _mqtt_readHEADER(buf, MQTT_TYPE_PUBCOMP, &ret, &len); + if (!hdr) + return (u_short) -1; + if (len < sizeof(mqtt_v_t)) { + mqtt_SetErr(EINVAL, "Error:: short message length %d", len); + return (u_short) -1; + } else { + pos = buf->msg_base + ret + 1; + v = (mqtt_v_t*) pos; + } + + return ntohs(v->val); +}