mbusgateway3variant/cube/User/Src/mqttTest.c

#include <mqttTest.h>
#include <logger.h>

#include <pubsubc.h>
#include <platformAdaption.h>
#include <PontCoopScheduler.h>
#include <wizHelper.h>

#include <stdint.h>
#include <stdlib.h>
#include <stdbool.h>
#include <string.h>


extern const uint8_t MQTT_SOCK;

client_t client;
mqttClient_t mqttClient;

uint8_t brokerAddress[] = { 172, 16, 2, 16 };
uint16_t brokerPort = 1883;

// typedef void (*callback_t)(char*, uint8_t*, uint16_t);
static void mqttCallback(char *topic, uint8_t *payload, uint16_t payloadLength) {
    logMsg("mcb: %s : %*s", topic, payloadLength, payload);
}


void mqttLoopHandler(void *handle) {
    mqttLoop(&mqttClient);
}

void mqttTestHandler(void *handle) {
    static uint8_t state = 0;
    static uint8_t message[] = "Hello world\n\r";

    if (isNetworkAvailable()) {
        switch (state) {
        case 0:
            coloredMsg(LOG_YELLOW, "mth, initializing mqtt client");
            client.sockNum = MQTT_SOCK;
            mqttClientInit(&mqttClient, &client, mqttCallback);
            coloredMsg(LOG_YELLOW, "mth: mqtt client initialized");

            state = 1;
            break;

        case 1:
            coloredMsg(LOG_YELLOW, "mth, connecting to broker ");
            bool res = mqttConnect(&mqttClient, brokerAddress, 1883, "mbv3gw-client", NULL, NULL, NULL, 0, false, NULL, false);
            coloredMsg(LOG_YELLOW, "mth, mqttConnect returns %d", res);

            if (res) {
                coloredMsg(LOG_YELLOW, "mth, ok, connected");
                state = 2;
            } else {
                state = 255;
            }
            break;

        case 2:
            coloredMsg(LOG_YELLOW, "mth, start mqtt loop");
            schAdd(mqttLoopHandler, NULL, 0, 100);
            state = 3;
            break;

        case 3:
            coloredMsg(LOG_YELLOW, "mth, publish something");
            res = publish(&mqttClient, "wiznet/hello", message, strlen(message), false);
            coloredMsg(LOG_YELLOW, "mth, publish returned %d", res);
            state = 4;
            break;

        case 4:
            coloredMsg(LOG_YELLOW, "mth, subscribe something");
            res = subscribe(&mqttClient, "wiznet/helloback", MQTTQOS0);
            coloredMsg(LOG_YELLOW, "mth, subscribe returned %d", res);
            state = 5;
            break;

        case 5:
            // coloredMsg(LOG_YELLOW, "mth, waiting");
            break;

        case 255:
            coloredMsg(LOG_YELLOW, "mth, error state, will stop here");
            schDel(mqttTestHandler, NULL);
            schDel(mqttLoopHandler, NULL);
            break;
        }
    } else {
        coloredMsg(LOG_YELLOW, "mth, network not yet ready");
    }
}

void mqttTestInit() {
    schAdd(mqttTestHandler, NULL, 0, 100);
}