Return to recv.c CVS log

Up to [ELWIX - Embedded LightWeight unIX -] / mqtt / src

Annotation of mqtt/src/recv.c, revision 1.1.2.2

1.1.2.1   misho       1: #include "global.h"
                      2: 
                      3: 
                      4: /* ------------------------------------------------------------------- */
                      5: 
                      6: /*
                      7:  * mqttInitCallbacks() Init callback array for dispatcher
                      8:  *
                      9:  * return: NULL error or !=NULL allocated callback array, after use free with mqttFiniCallbacks()
                     10:  */
                     11: mqtt_cb_t *
                     12: mqttInitCallbacks(void)
                     13: {
                     14:        mqtt_cb_t *cb = NULL;
                     15: 
                     16:        cb = malloc((MQTT_TYPE_MAX + 1) * sizeof(mqtt_cb_t));
                     17:        if (!cb) {
                     18:                LOGERR;
                     19:                return NULL;
                     20:        } else
                     21:                memset(cb, 0, (MQTT_TYPE_MAX + 1) * sizeof(mqtt_cb_t));
                     22: 
                     23:        return cb;
                     24: }
                     25: 
                     26: /*
                     27:  * mqttFiniCallbacks() Free callback array
                     28:  *
                     29:  * @cb = Callback array
                     30:  * return: none
                     31:  */
                     32: void
                     33: mqttFiniCallbacks(mqtt_cb_t ** __restrict cb)
                     34: {
                     35:        if (!cb)
                     36:                return;
                     37: 
                     38:        if ((*cb)[MQTT_TYPE_MAX])
                     39:                (*cb)[MQTT_TYPE_MAX](*cb);
                     40: 
                     41:        free(*cb);
                     42:        *cb = NULL;
                     43: }
1.1.2.2 ! misho      44: 
        !            45: /*
        !            46:  * mqttDispatcher() MQTT Message type dispatcher
        !            47:  *
        !            48:  * @cb = Callback array
        !            49:  * @buf = Received MQTT message
        !            50:  * return: -1 error or >-1 return value from executed callback
        !            51:  */
        !            52: inline int
        !            53: mqttDispatcher(mqtt_cb_t * __restrict cb, mqtt_msg_t * __restrict buf)
        !            54: {
        !            55:        struct mqtthdr *hdr;
        !            56: 
        !            57:        if (!cb || !buf)
        !            58:                return -1;
        !            59:        if (buf->msg_len < sizeof(struct mqtthdr)) {
        !            60:                mqtt_SetErr(EBADMSG, "Error:: message is too small ...");
        !            61:                return -1;
        !            62:        }
        !            63: 
        !            64:        hdr = (struct mqtthdr *) buf->msg_base;
        !            65:        if (hdr->mqtt_msg.type > MQTT_TYPE_MAX) {
        !            66:                mqtt_SetErr(ENOSYS, "Error:: message type %d not implemented", hdr->mqtt_msg.type);
        !            67:                return -1;
        !            68:        }
        !            69: 
        !            70:        if (cb[hdr->mqtt_msg.type])
        !            71:                return cb[hdr->mqtt_msg.type](buf);
        !            72: 
        !            73:        mqtt_SetErr(ENOTSUP, "Error:: Unsupported message type %d", hdr->mqtt_msg.type);
        !            74:        return -1;
        !            75: }