98 lines
2.7 KiB
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);
}