From 985548471892c5f2a7430c5f7b4c03fe39f0134f Mon Sep 17 00:00:00 2001
From: guowenxue <guowenxue@gmail.com>
Date: Tue, 25 Jun 2019 21:55:18 +0800
Subject: [PATCH] Update mqttd program, add cJSON parser and test ok with memory leak
---
mqttd/main.c | 434 ++++++++++++++++++++++++++++++++++++++++++++++++------
1 files changed, 386 insertions(+), 48 deletions(-)
diff --git a/mqttd/main.c b/mqttd/main.c
index a5989a2..f8868d2 100644
--- a/mqttd/main.c
+++ b/mqttd/main.c
@@ -14,79 +14,417 @@
#include <time.h>
#include <unistd.h>
-#include "led.h"
-#include "ds18b20.h"
-#include "sht20.h"
+#include <mosquitto.h>
-int hal_init(void);
+#include "logger.h"
+#include "cJSON.h"
+#include "proc.h"
+#include "hal.h"
-/********************************************************************************
- * Description:
- * Input Args:
- * Output Args:
- * Return Value:
- ********************************************************************************/
+#define DAEMON_PIDFILE "/tmp/.mqtt.pid"
+
+#define MQTT_SYS_TOPIC "$Sys/Studio/"
+#define MQTT_SYS_DLINK_TOPIC MQTT_SYS_TOPIC"Downlink"
+#define MQTT_SYS_ULINK_TOPIC MQTT_SYS_TOPIC"Uplink"
+
+enum
+{
+ Qos0, /* 发送者只发送一次消息，不进行重试，Broker不会返回确认消息。在Qos0情况下，Broker可能没有接受到消息 */
+ Qos1, /* 发送者最少发送一次消息，确保消息到达Broker，Broker需要返回确认消息PUBACK。在Qos1情况下，Broker可能接受到重复消息 */
+ Qos2, /* Qos2使用两阶段确认来保证消息的不丢失和不重复。在Qos2情况下，Broker肯定会收到消息，且只收到一次 */
+};
+
+typedef struct mqtt_ctx_s
+{
+ /* Broker settings */
+ char host[128]; /* MQTT broker server name */
+ int port; /* MQTT broker listen port */
+ int keepalive; /* MQTT broker send PING message to subsciber/publisher keepalive timeout<seconds> */
+ char uid[64]; /* username */
+ char pwd[64]; /* password */
+
+ /* Publisher settings */
+ int pubQos; /* Publisher Qos */
+ int interval; /* Publish sensor data interval time, unit seconds */
+
+ /* Subscriber settings */
+ int subQos; /* Subscriber Qos */
+
+} mqtt_ctx_t;
+
+
+int check_set_program_running(int daemon);
+void *mqtt_sub_worker(void *args);
+void *mqtt_pub_worker(void *args);
+
+
int main (int argc, char **argv)
{
float temp;
float rh;
+ int daemon = 0;
+ pthread_t tid;
+ mqtt_ctx_t ctx;
+ strcpy(ctx.host, "127.0.0.1");
+ ctx.port = 10883;
+ ctx.keepalive = 60;
+ strcpy(ctx.uid, "lingyun");
+ strcpy(ctx.pwd, "lingyun-emb");
+
+ ctx.pubQos = Qos0;
+ ctx.interval = 300;
+ ctx.subQos = Qos2;
+
+ //if( logger_init("mqttd.log", LOG_LEVEL_DEBUG, 1024) < 0 )
+ if( logger_init(DBG_LOG_FILE, LOG_LEVEL_DEBUG, 1024) < 0 )
+ {
+ fprintf(stderr, "Logger system initialise failure\n");
+ return -2;
+ }
+ log_dbg("Logger system initialise ok\n");
+
+#if 0
if( hal_init() < 0 )
{
- printf("Initialise hardware failure\n");
+ log_err("Initialise hardware failure\n");
return -1;
}
+ log_nrml("HAL initialise ok\n");
+#endif
- while(1)
+ install_proc_signal();
+
+ if( check_set_program_running(daemon) < 0 )
+ goto OUT;
+
+ mosquitto_lib_init();
+
+ if( thread_start(&tid, mqtt_sub_worker, &ctx ) < 0 )
{
- turn_led(LED_R, ON);
- sleep(1);
- turn_led(LED_R, OFF);
- sleep(1);
+ log_fatal("Start MQTT subsciber worker thread failure\n");
+ goto OUT;
+ }
+ log_nrml("Start MQTT subsciber worker thread ok\n");
- turn_led(LED_G, ON);
- sleep(1);
- turn_led(LED_G, OFF);
- sleep(1);
-
- turn_led(LED_B, ON);
- sleep(1);
- turn_led(LED_B, OFF);
- sleep(1);
-
- if(sht2x_get_temp_humidity(&temp, &rh) < 0)
- {
- printf("SHT2X get temperature and relative humidity failure\n");
- }
- else
- {
- printf("SHT2X Temperature=%lfC, Relative humidity=%lf%% \n", temp, rh);
- }
+ if( thread_start(&tid, mqtt_pub_worker, &ctx) < 0 )
+ {
+ log_fatal("Start MQTT publisher worker thread failure\n");
+ goto OUT;
+ }
+ log_nrml("Start MQTT publisher worker thread ok\n");
- if( ds18b20_get_temperature(&temp) < 0)
- {
- printf("DS18B20 get temperature failure\n");
- }
- else
- {
- printf("DS18B20 get temperature=%lf ℃ \n", temp);
- }
+ while( ! g_signal.stop )
+ {
+ msleep(1000);
+ //log_nrml("Main control thread continue running\n");
}
+
+OUT:
+ mosquitto_lib_cleanup();
+ logger_term();
+
return 0;
} /* ----- End of main() ----- */
-int hal_init(void)
+int check_set_program_running(int daemon)
{
- init_led();
-
- if( sht2x_init() < 0 )
+ if( check_daemon_running(DAEMON_PIDFILE) )
{
- printf("Initialise SHT20 failure\n");
- return -2;
+ log_err("Program already running, process exit now");
+ return -1;
+ }
+
+ if( daemon )
+ {
+ if( set_daemon_running(DAEMON_PIDFILE) < 0 )
+ {
+ log_err("set program running as daemon failure\n");
+ return -2;
+ }
+ }
+ else
+ {
+ if( record_daemon_pid(DAEMON_PIDFILE) < 0 )
+ {
+ log_err("record program running PID failure\n");
+ return -3;
+ }
}
return 0;
}
+
+
+void pub_connect_callback(struct mosquitto *mosq, void *userdata, int result)
+{
+ mqtt_ctx_t *ctx = (mqtt_ctx_t *)userdata;
+ int rv = 0;
+ char msg[128];
+ float temp = 25.64;
+ float rh = 65.35;
+ char light[] = "on";
+
+ if( result )
+ {
+ log_err("Publisher connect to broker server[%s:%d] failed, rv=%d\n", ctx->host, ctx->port, result);
+ return ;
+ }
+
+ log_nrml("Publisher connect to broker server[%s:%d] successfully\n", ctx->host, ctx->port);
+
+ memset(msg, 0, sizeof(msg));
+ snprintf(msg, sizeof(msg), "{ \"temp\":\"%.2f\", \"R&H\":\"%.2f%%\" }", temp, rh);
+
+ rv = mosquitto_publish(mosq, NULL, MQTT_SYS_ULINK_TOPIC, strlen(msg)+1, msg, ctx->pubQos, 0);
+ if( rv )
+ {
+ log_err("Publisher broadcast message '%s' failure: %d\n", msg, rv);
+ }
+ else
+ {
+ log_nrml("Publisher broadcast message '%s' ok\n", msg);
+ }
+
+ memset(msg, 0, sizeof(msg));
+ snprintf(msg, sizeof(msg), "{ \"light\":\"%s\" }", light);
+
+ rv = mosquitto_publish(mosq, NULL, MQTT_SYS_ULINK_TOPIC, strlen(msg)+1, msg, ctx->pubQos, 0);
+ if( rv )
+ {
+ log_err("Publisher broadcast message failure: %d\n", rv);
+ }
+ else
+ {
+ log_nrml("Publisher broadcast message '%s' ok\n", msg);
+ }
+
+ log_nrml("Publisher broadcast over and disconnect broker now\n", ctx->host, ctx->port);
+ mosquitto_disconnect(mosq);
+
+ return ;
+}
+
+
+void *mqtt_pub_worker(void *args)
+{
+ mqtt_ctx_t *ctx = (mqtt_ctx_t *)args;
+ struct mosquitto *mosq;
+ bool session = true;
+
+
+ mosq = mosquitto_new(NULL, session, ctx);
+ if( !mosq )
+ {
+ log_err("mosquitto_new failure\n");
+ return NULL;
+ }
+
+ /* set connnect to broker username and password */
+ if( strlen(ctx->uid)> 0 && strlen(ctx->pwd)> 0 )
+ mosquitto_username_pw_set(mosq, ctx->uid, ctx->pwd);
+
+ /* set callback functions */
+ mosquitto_connect_callback_set(mosq, pub_connect_callback);
+
+ while( !g_signal.stop )
+ {
+ /* connect to MQTT broker */
+ if( mosquitto_connect(mosq, ctx->host, ctx->port, ctx->keepalive) )
+ {
+ log_err("Publisher connect to broker[%s:%d] failure: %s\n", ctx->host, ctx->port, strerror(errno));
+ msleep(1000);
+ continue;
+ }
+
+ /* -1: use default timeout 1000ms 1: unused */
+ mosquitto_loop_forever(mosq, -1, 1);
+
+ /* Publisher broadcast sensors data message interval time, unit seconds */
+ sleep( ctx->interval );
+ }
+
+ mosquitto_destroy(mosq);
+ return NULL;
+}
+
+void sub_connect_callback(struct mosquitto *mosq, void *userdata, int result)
+{
+ mqtt_ctx_t *ctx = (mqtt_ctx_t *)userdata;
+
+ if( result )
+ {
+ log_err("Subscriber connect to broker server failed, rv=%d\n", result);
+ return ;
+ }
+
+ log_nrml("Subscriber connect to broker server[%s:%d] successfully\n", ctx->host, ctx->port);
+ mosquitto_subscribe(mosq, NULL, MQTT_SYS_DLINK_TOPIC, 2);
+}
+
+void sub_disconnect_callback(struct mosquitto *mosq, void *userdata, int result)
+{
+ mqtt_ctx_t *ctx = (mqtt_ctx_t *)userdata;
+
+ log_warn("Subscriber disconnect to broker server[%s:%d], reason=%d\n", ctx->host, ctx->port, result);
+}
+
+
+void proc_json_items(cJSON *root)
+{
+ int i;
+ char *value;
+ cJSON *item;
+ cJSON *array;
+
+ if( !root )
+ {
+ log_err("Invalid input arguments $root\n");
+ return ;
+ }
+
+ for( i=0; i<cJSON_GetArraySize(root); i++ )
+ {
+ item = cJSON_GetArrayItem(root, i);
+ if( !item )
+ break;
+
+ /* if item is cJSON_Object, then recursive call proc_json */
+ if( cJSON_Object == item->type )
+ {
+ proc_json_items(item);
+ }
+ else if( cJSON_Array == item->type )
+ {
+ /* RGB colors led control */
+ if( !strcasecmp(item->string, "led") )
+ {
+ array = cJSON_GetArrayItem(item, 0);
+ if( NULL != array )
+ {
+ cJSON *led_item;
+
+ if( NULL != (led_item=cJSON_GetObjectItem(array , "red")) )
+ {
+ log_nrml("turn red led '%s'\n", led_item->valuestring);
+ }
+
+ if( NULL != (led_item=cJSON_GetObjectItem(array , "green")) )
+ {
+ log_nrml("turn green led '%s'\n", led_item->valuestring);
+ }
+
+ if( NULL != (led_item=cJSON_GetObjectItem(array , "blue")) )
+ {
+ log_nrml("turn blue led '%s'\n", led_item->valuestring);
+ }
+ }
+ }
+ }
+ else
+ {
+ value = cJSON_Print(item);
+
+ /* light controled by relay */
+ if( !strcasecmp(item->string, "light") )
+ {
+ if( strcasestr(value, "on") )
+ {
+ log_nrml("Turn light on\n");
+ }
+ else if( strcasestr(value, "off") )
+ {
+ log_nrml("Turn light off\n");
+ }
+ }
+
+ /* buzzer */
+ if( !strcasecmp(item->string, "buzzer") )
+ {
+ if( strcasestr(value, "on") )
+ {
+ log_nrml("Turn buzzer on\n");
+ }
+ else if( strcasestr(value, "music") )
+ {
+ log_nrml("Turn buzzer play music\n");
+ }
+ }
+
+ free(value); /* must free it, or it will result memory leak */
+ }
+ }
+
+}
+
+void sub_message_callback(struct mosquitto *mosq, void *userdata, const struct mosquitto_message *message)
+{
+ cJSON *root = NULL;
+ char *out;
+
+
+ if ( !message->payloadlen )
+ {
+ log_err("%s (null)\n", message->topic);
+ return ;
+ }
+
+ log_nrml("Subscriber receive message: '%s'\n", message->payload);
+
+ root = cJSON_Parse(message->payload);
+ if( !root )
+ {
+ log_err("cJSON_Parse parser failure: %s\n", cJSON_GetErrorPtr());
+ return ;
+ }
+
+ proc_json_items(root);
+
+ cJSON_Delete(root); /* must delete it, or it will result memory leak */
+ return ;
+}
+
+
+void *mqtt_sub_worker(void *args)
+{
+ mqtt_ctx_t *ctx = (mqtt_ctx_t *)args;
+ struct mosquitto *mosq;
+ bool session = true;
+
+ mosq = mosquitto_new(NULL, session, ctx);
+ if( !mosq )
+ {
+ log_err("mosquitto_new failure\n");
+ return NULL;
+ }
+
+ /* set connnect to broker username and password */
+ if( strlen(ctx->uid)> 0 && strlen(ctx->pwd)> 0 )
+ mosquitto_username_pw_set(mosq, ctx->uid, ctx->pwd);
+
+ /* set callback functions */
+ mosquitto_connect_callback_set(mosq, sub_connect_callback);
+ mosquitto_disconnect_callback_set(mosq, sub_disconnect_callback);
+ mosquitto_message_callback_set(mosq, sub_message_callback);
+
+ while( !g_signal.stop )
+ {
+ /* connect to MQTT broker */
+ if( mosquitto_connect(mosq, ctx->host, ctx->port, ctx->keepalive) )
+ {
+ log_err("Subscriber connect to broker[%s:%d] failure: %s\n", ctx->host, ctx->port, strerror(errno));
+ msleep(1000);
+ continue;
+ }
+
+ /* -1: use default timeout 1000ms 1: unused */
+ mosquitto_loop_forever(mosq, -1, 1);
+ }
+
+ mosquitto_destroy(mosq);
+ return NULL;
+}
+
--
Gitblit v1.9.1