From 5b0985618c8a49ea5ff872486672324120e25361 Mon Sep 17 00:00:00 2001 From: guowenxue <guowenxue@gmail.com> Date: Mon, 10 Jul 2023 15:24:32 +0800 Subject: [PATCH] add gpsd program and booster --- mqttd/main.c | 315 ++++++++++++++++++++++++++++++++++++++-------------- 1 files changed, 229 insertions(+), 86 deletions(-) diff --git a/mqttd/main.c b/mqttd/main.c index f8868d2..f021966 100644 --- a/mqttd/main.c +++ b/mqttd/main.c @@ -13,6 +13,9 @@ #include <stdio.h> #include <time.h> #include <unistd.h> +#include <getopt.h> +#include <libgen.h> +#include <string.h> #include <mosquitto.h> @@ -21,79 +24,123 @@ #include "proc.h" #include "hal.h" +#include "conf.h" + +#define PROG_VERSION "v1.0.0" #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; - +#define FLAG_DETECTD (1<<0) +#define FLAG_RELAYON (1<<1) +int g_breakin_flag = 0; /* relay already turn on and wait to off */ int check_set_program_running(int daemon); void *mqtt_sub_worker(void *args); void *mqtt_pub_worker(void *args); +static void program_usage(char *progname) +{ + + printf("Usage: %s [OPTION]...\n", progname); + printf(" %s is LingYun studio MQTT daemon program running on RaspberryPi\n", progname); + + printf("\nMandatory arguments to long options are mandatory for short options too:\n"); + printf(" -d[debug ] Running in debug mode\n"); + printf(" -c[conf ] Specify configure file\n"); + printf(" -h[help ] Display this help information\n"); + printf(" -v[version ] Display the program version\n"); + + printf("\n%s version %s\n", progname, PROG_VERSION); + return; +} + +void turn_light_off(int signum) +{ + if( g_breakin_flag&FLAG_RELAYON ) + { + log_nrml("fill-in light timeout and turn light off now\n"); + turn_relay(OFF); + } + + g_breakin_flag = 0; +} int main (int argc, char **argv) { float temp; float rh; - int daemon = 0; + int daemon = 1; pthread_t tid; mqtt_ctx_t ctx; + char *conf_file=NULL; + int debug = 0; + int opt; + char *progname=NULL; + double lux = 0.0; - strcpy(ctx.host, "127.0.0.1"); - ctx.port = 10883; - ctx.keepalive = 60; - strcpy(ctx.uid, "lingyun"); - strcpy(ctx.pwd, "lingyun-emb"); + struct option long_options[] = { + {"conf", required_argument, NULL, 'c'}, + {"debug", no_argument, NULL, 'd'}, + {"version", no_argument, NULL, 'v'}, + {"help", no_argument, NULL, 'h'}, + {NULL, 0, NULL, 0} + }; - ctx.pubQos = Qos0; - ctx.interval = 300; - ctx.subQos = Qos2; + progname = (char *)basename(argv[0]); - //if( logger_init("mqttd.log", LOG_LEVEL_DEBUG, 1024) < 0 ) - if( logger_init(DBG_LOG_FILE, LOG_LEVEL_DEBUG, 1024) < 0 ) + /* Parser the command line parameters */ + while ((opt = getopt_long(argc, argv, "c:dvh", long_options, NULL)) != -1) { - fprintf(stderr, "Logger system initialise failure\n"); + switch (opt) + { + case 'c': /* Set configure file */ + conf_file = optarg; + break; + + case 'd': /* Set debug running */ + daemon = 0; + debug = 1; + break; + + case 'v': /* Get software version */ + printf("%s version %s\n", progname, PROG_VERSION); + return 0; + + case 'h': /* Get help information */ + program_usage(progname); + return 0; + + default: + break; + } + + } + + if( !conf_file ) + debug = 1; + + if( mqttd_parser_conf(conf_file, &ctx, debug)<0 ) + { + fprintf(stderr, "Parser mqtted configure file failure\n"); return -2; } - log_dbg("Logger system initialise ok\n"); -#if 0 - if( hal_init() < 0 ) + if( hal_init(&ctx.hwconf) < 0 ) { log_err("Initialise hardware failure\n"); - return -1; + return -3; } - log_nrml("HAL initialise ok\n"); -#endif - + else + { + log_nrml("HAL initialise ok\n"); + } + install_proc_signal(); + + if( ctx.hwconf.fillin_light ) + { + log_nrml("Install inbreak detected fill-in light off signal\n"); + signal(SIGALRM, turn_light_off); + } if( check_set_program_running(daemon) < 0 ) goto OUT; @@ -114,10 +161,54 @@ } log_nrml("Start MQTT publisher worker thread ok\n"); - while( ! g_signal.stop ) { msleep(1000); + + if( ctx.hwconf.infrared_pin && !g_breakin_flag ) + { + //log_nrml("infrared dected human incoming\n"); + if( infrared_detect(1000) ) + { + log_nrml("Someone incoming detected by infrared\n"); + g_breakin_flag |= FLAG_DETECTD; + + /* setup alarm to turn relay off or clear the flag */ + alarm(ctx.hwconf.light_intval); + + if( ctx.hwconf.inbreak_beep ) + { + turn_beep(ctx.hwconf.beep_times); + } + + if( ctx.hwconf.fillin_light==FILLIN_LIGHT_ON && !g_breakin_flag ) + { + log_nrml("Force fill-in light on and will be off in [%d] seconds\n", ctx.hwconf.light_intval); + turn_relay(ON); + g_breakin_flag |= FLAG_RELAYON; + } + else if( ctx.hwconf.fillin_light==FILLIN_LIGHT_AUTO && ctx.hwconf.lux ) + { + lux = tsl2561_get_lux(); + log_nrml("TSL2516 detect illumination intensity %.3flux and threshold %.3flux\n", + lux, ctx.hwconf.lux_threshold); + + /* only lux<0.01 will turn on light */ + if( lux-0.001 > ctx.hwconf.lux_threshold) + { + log_nrml("Illumination intensity enuf, no need fill-in light\n"); + } + else + { + log_nrml("Auto fill-in light on and will be off in [%d] seconds\n", ctx.hwconf.light_intval); + turn_relay(ON); + g_breakin_flag |= FLAG_RELAYON; + } + } + + } + + } //log_nrml("Main control thread continue running\n"); } @@ -128,7 +219,6 @@ return 0; } /* ----- End of main() ----- */ - int check_set_program_running(int daemon) { @@ -164,9 +254,9 @@ 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"; + float temp = 0.0; /* temperature */ + float rh = 0.0; /* relative humidity */ + int retain = 0; if( result ) { @@ -176,32 +266,47 @@ 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); + if( ctx->hwconf.ds18b20 ) + { + memset(msg, 0, sizeof(msg)); + + if( ds18b20_get_temperature(&temp) < 0 ) + snprintf(msg, sizeof(msg), "{ \"id\":%s, \"temp\":\"error\" }", ctx->id); + else + snprintf(msg, sizeof(msg), "{ \"id\":%s, \"temp\":\"%.2f\" }", ctx->id, temp); - 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); + rv = mosquitto_publish(mosq, NULL, ctx->pubTopic, strlen(msg), 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); + if( ctx->hwconf.sht2x ) + { + memset(msg, 0, sizeof(msg)); + + if( sht2x_get_temp_humidity(&temp, &rh) < 0 ) + snprintf(msg, sizeof(msg), "{ \"id\":%s, \"temp\":\"error\", \"RH\":\"error\" }", ctx->id); + else + snprintf(msg, sizeof(msg), "{ \"id\":%s, \"temp\":\"%.2f\", \"RH\":\"%.2f\" }", ctx->id, 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 failure: %d\n", rv); - } - else - { - log_nrml("Publisher broadcast message '%s' ok\n", msg); + rv = mosquitto_publish(mosq, NULL, ctx->pubTopic, strlen(msg), 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); + } } + log_nrml("Publisher broadcast over and disconnect broker now\n", ctx->host, ctx->port); mosquitto_disconnect(mosq); @@ -262,7 +367,7 @@ } log_nrml("Subscriber connect to broker server[%s:%d] successfully\n", ctx->host, ctx->port); - mosquitto_subscribe(mosq, NULL, MQTT_SYS_DLINK_TOPIC, 2); + mosquitto_subscribe(mosq, NULL, ctx->subTopic, ctx->subQos); } void sub_disconnect_callback(struct mosquitto *mosq, void *userdata, int result) @@ -272,13 +377,21 @@ log_warn("Subscriber disconnect to broker server[%s:%d], reason=%d\n", ctx->host, ctx->port, result); } +static inline void mqtt_turn_led(int which, char *cmd) +{ + if( strcasestr(cmd, "on") ) + turn_led(which, ON); + else if( strcasestr(cmd, "off") ) + turn_led(which, OFF); +} -void proc_json_items(cJSON *root) +void proc_json_items(cJSON *root, mqtt_ctx_t *ctx) { int i; char *value; cJSON *item; cJSON *array; + hwconf_t *hwconf = &ctx->hwconf; if( !root ) { @@ -295,12 +408,12 @@ /* if item is cJSON_Object, then recursive call proc_json */ if( cJSON_Object == item->type ) { - proc_json_items(item); + proc_json_items(item, ctx); } else if( cJSON_Array == item->type ) { /* RGB colors led control */ - if( !strcasecmp(item->string, "led") ) + if( hwconf->leds && !strcasecmp(item->string, "led") ) { array = cJSON_GetArrayItem(item, 0); if( NULL != array ) @@ -310,16 +423,19 @@ if( NULL != (led_item=cJSON_GetObjectItem(array , "red")) ) { log_nrml("turn red led '%s'\n", led_item->valuestring); + mqtt_turn_led(LED_R, led_item->valuestring); } if( NULL != (led_item=cJSON_GetObjectItem(array , "green")) ) { log_nrml("turn green led '%s'\n", led_item->valuestring); + mqtt_turn_led(LED_G, led_item->valuestring); } if( NULL != (led_item=cJSON_GetObjectItem(array , "blue")) ) { log_nrml("turn blue led '%s'\n", led_item->valuestring); + mqtt_turn_led(LED_B, led_item->valuestring); } } } @@ -329,28 +445,34 @@ value = cJSON_Print(item); /* light controled by relay */ - if( !strcasecmp(item->string, "light") ) + if( hwconf->relay_pin && !strcasecmp(item->string, "light") ) { if( strcasestr(value, "on") ) { log_nrml("Turn light on\n"); + turn_relay(ON); } else if( strcasestr(value, "off") ) { log_nrml("Turn light off\n"); + turn_relay(OFF); } } /* buzzer */ - if( !strcasecmp(item->string, "buzzer") ) + if( hwconf->beep_pin && !strcasecmp(item->string, "buzzer") ) { if( strcasestr(value, "on") ) { - log_nrml("Turn buzzer on\n"); + turn_passive_beep(ON, BEEP_FREQ); } - else if( strcasestr(value, "music") ) + else if( strcasestr(value, "off") ) { - log_nrml("Turn buzzer play music\n"); + turn_passive_beep(OFF, BEEP_FREQ); + } + else if( strcasestr(value, "music") ) + { + play_little_star(); } } @@ -362,8 +484,11 @@ void sub_message_callback(struct mosquitto *mosq, void *userdata, const struct mosquitto_message *message) { - cJSON *root = NULL; - char *out; + mqtt_ctx_t *ctx = (mqtt_ctx_t *)userdata; + + cJSON *root = NULL; + cJSON *item; + char *value; if ( !message->payloadlen ) @@ -372,7 +497,7 @@ return ; } - log_nrml("Subscriber receive message: '%s'\n", message->payload); + log_dbg("Subscriber receive message: '%s'\n", message->payload); root = cJSON_Parse(message->payload); if( !root ) @@ -381,8 +506,26 @@ return ; } - proc_json_items(root); + item = cJSON_GetObjectItem(root, "id"); + if( !item ) + { + log_err("cJSON_Parse get ID failure: %s\n", cJSON_GetErrorPtr()); + goto OUT; + } + value = cJSON_PrintUnformatted(item); + if( strcasecmp(value, ctx->id) ) + { + free(value); + goto OUT; + } + + free(value); + log_nrml("Subscriber receive message: '%s'\n", message->payload); + + proc_json_items(root, ctx); + +OUT: cJSON_Delete(root); /* must delete it, or it will result memory leak */ return ; } -- Gitblit v1.9.1