From 6a924a29cefbea27a101790343137db819b361be Mon Sep 17 00:00:00 2001 From: guowenxue <guowenxue@gmail.com> Date: Wed, 26 Jun 2019 00:08:35 +0800 Subject: [PATCH] update mqttd to add configure file parser support --- mqttd/main.c | 398 ++++++++++++++++++++++++++++++++++++++++++++++++++------ 1 files changed, 350 insertions(+), 48 deletions(-) diff --git a/mqttd/main.c b/mqttd/main.c index a5989a2..982b34a 100644 --- a/mqttd/main.c +++ b/mqttd/main.c @@ -14,79 +14,381 @@ #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: - ********************************************************************************/ +#include "conf.h" + +#define DAEMON_PIDFILE "/tmp/.mqtt.pid" + + +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; + char *conf="./etc/mqttd.conf"; + int debug = 1; + if( mqttd_parser_conf(conf, &ctx, debug)<0 ) + { + fprintf(stderr, "Parser mqtted configure file failure\n"); + return -2; + } + +#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"; + int retain = 0; + + 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, ctx->pubTopic, strlen(msg)+1, msg, ctx->pubQos, retain); + 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, ctx->pubTopic, strlen(msg)+1, msg, ctx->pubQos, retain); + 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, ctx->subTopic, ctx->subQos); +} + +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