--- a/thermometers/main.c Sun May 25 16:39:54 2014 +0200
+++ /dev/null Thu Jan 01 00:00:00 1970 +0000
@@ -1,554 +0,0 @@
-/*****************************************************************************
- * Copyright (C) 2014
- *
- * Michiel Broek <mbroek at mbse dot eu>
- *
- * This file is part of the mbsePi-apps
- *
- * This is free software; you can redistribute it and/or modify it
- * under the terms of the GNU General Public License as published by the
- * Free Software Foundation; either version 2, or (at your option) any
- * later version.
- *
- * mbsePi-apps is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with EC-65K; see the file COPYING. If not, write to the Free
- * Software Foundation, 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
- *****************************************************************************/
-
-#include "../lib/mbselib.h"
-#include "main.h"
-
-
-#define STATUS_CONNECTING 0
-#define STATUS_CONNACK_RECVD 1
-#define STATUS_WAITING 2
-
-/* Global variables for use in callbacks. */
-static int qos = 0;
-static int status = STATUS_CONNECTING;
-static int mid_sent = 0;
-static int last_mid = -1;
-static int last_mid_sent = -1;
-static bool connected = true;
-static bool disconnect_sent = false;
-static bool connect_lost = false;
-static bool my_shutdown = false;
-static pid_t pgrp, mypid;
-
-extern bool debug;
-extern sys_config Config;
-#ifdef HAVE_WIRINGPI_H
-extern int lcdHandle;
-#endif
-
-int server(void);
-void help(void);
-void die(int);
-
-
-void help(void)
-{
- fprintf(stdout, "mbsePi-apps thermometers v%s starting\n\n", VERSION);
- fprintf(stdout, "Usage: thermomeneters [-d] [-h]\n");
- fprintf(stdout, " -d --debug Debug and run in foreground\n");
- fprintf(stdout, " -h --help Display this help\n");
-}
-
-
-
-void die(int onsig)
-{
- switch (onsig) {
- case SIGHUP: syslog(LOG_NOTICE, "Got SIGHUP, shutting down");
- break;
- case SIGINT: syslog(LOG_NOTICE, "Keyboard interrupt, shutting down");
- break;
- case SIGTERM: syslog(LOG_NOTICE, "Got SIGTERM, shutting down");
- break;
- default: syslog(LOG_NOTICE, "die() on signal %d", onsig);
- }
-
- my_shutdown = true;
-}
-
-
-
-void my_connect_callback(struct mosquitto *mosq, void *obj, int result)
-{
- if (connect_lost) {
- connect_lost = false;
- syslog(LOG_NOTICE, "Reconnect: %s", mosquitto_connack_string(result));
- }
-
- if (!result) {
- status = STATUS_CONNACK_RECVD;
- } else {
- syslog(LOG_NOTICE, "my_connect_callback: %s\n", mosquitto_connack_string(result));
- }
-}
-
-
-
-void my_disconnect_callback(struct mosquitto *mosq, void *obj, int rc)
-{
- if (my_shutdown) {
- syslog(LOG_NOTICE, "Acknowledged DISCONNECT from %s", Config.mosq_host);
- connected = false;
- } else {
- /*
- * The remove server was brought down. We must keep running
- */
- syslog(LOG_NOTICE, "Received DISCONNECT from %s, connection lost", Config.mosq_host);
- connect_lost = true;
- }
-}
-
-
-
-void my_publish_callback(struct mosquitto *mosq, void *obj, int mid)
-{
- last_mid_sent = mid;
-}
-
-
-
-void my_log_callback(struct mosquitto *mosq, void *obj, int level, const char *str)
-{
- syslog(LOG_NOTICE, "MQTT: %s", str);
- printf("MQTT: %s\n", str);
-}
-
-
-
-#ifdef HAVE_WIRINGPI_H
-void stopLCD(void)
-{
- lcdClear(lcdHandle);
- setBacklight(0);
-}
-#endif
-
-
-
-int main(int argc, char *argv[])
-{
- int rc, c, i;
- pid_t frk;
-#ifdef HAVE_WIRINGPI_H
- char buf[80];
-#endif
-
- while (1) {
- int option_index = 0;
- static struct option long_options[] = {
- {"debug", 0, 0, 'c'},
- {"help", 0, 0, 'h'},
- {0, 0, 0, 0}
- };
-
- c = getopt_long(argc, argv, "dh", long_options, &option_index);
- if (c == -1)
- break;
-
- switch (c) {
- case 'd': debug = true;
- break;
- case 'h': help();
- return 1;
- }
- }
-
- openlog("thermometers", LOG_PID|LOG_CONS|LOG_NOWAIT, LOG_USER);
- syslog(LOG_NOTICE, "mbsePi-apps thermometers v%s starting", VERSION);
- if (debug)
- fprintf(stdout, "mbsePi-apps thermometers v%s starting\n", VERSION);
-
- if (rdconfig((char *)"thermometers.conf")) {
- fprintf(stderr, "Error reading configuration\n");
- syslog(LOG_NOTICE, "halted");
- return 1;
- }
-
- /*
- * Catch all the signals we can, and ignore the rest. Note that SIGKILL can't be ignored
- * but that's live. This daemon should only be stopped by SIGTERM.
- * Don't catch SIGCHLD.
- */
- for (i = 0; i < NSIG; i++) {
- if ((i != SIGCHLD) && (i != SIGKILL) && (i != SIGSTOP))
- signal(i, (void (*))die);
- }
-
-#ifdef HAVE_WIRINGPI_H
-
- if (wiringPiSetup () )
- return 1;
-
- if ((rc = initLCD (16, 2))) {
- fprintf(stderr, "Cannot initialize LCD display, rc=%d\n", rc);
- return 1;
- }
-
- lcdPosition(lcdHandle, 0, 0);
- lcdPuts(lcdHandle, "Thermometers");
- lcdPosition(lcdHandle, 0, 1);
- sprintf(buf, "Version %s", VERSION);
- lcdPuts(lcdHandle, buf);
-#endif
-
- if (debug) {
- /*
- * For debugging run in foreground.
- */
- rc = server();
- } else {
- /*
- * Server initialization is complete. Now we can fork the
- * daemon and return to the user. We need to do a setpgrp
- * so that the daemon will no longer be assosiated with the
- * users control terminal. This is done before the fork, so
- * that the child will not be a process group leader. Otherwise,
- * if the child were to open a terminal, it would become
- * associated with that terminal as its control terminal.
- */
- if ((pgrp = setpgid(0, 0)) == -1) {
- syslog(LOG_NOTICE, "setpgpid failed");
- }
-
- frk = fork();
- switch (frk) {
- case -1:
- syslog(LOG_NOTICE, "Daemon fork failed: %s", strerror(errno));
- syslog(LOG_NOTICE, "Finished, rc=1");
-#ifdef HAVE_WIRINGPI_H
- stopLCD();
-#endif
- exit(1);
- case 0: /*
- * Run the daemon
- */
- fclose(stdin);
- if (open("/dev/null", O_RDONLY) != 0) {
- syslog(LOG_NOTICE, "Reopen of stdin to /dev/null failed");
- _exit(2);
- }
- fclose(stdout);
- if (open("/dev/null", O_WRONLY | O_APPEND | O_CREAT,0600) != 1) {
- syslog(LOG_NOTICE, "Reopen of stdout to /dev/null failed");
- _exit(2);
- }
- fclose(stderr);
- if (open("/dev/null", O_WRONLY | O_APPEND | O_CREAT,0600) != 2) {
- syslog(LOG_NOTICE, "Reopen of stderr to /dev/null failed");
- _exit(2);
- }
- mypid = getpid();
- rc = server();
- break;
- /* Not reached */
- default:
- /*
- * Here we detach this process and let the child
- * run the deamon process.
- */
- syslog(LOG_NOTICE, "Starting daemon with pid %d", frk);
- exit(0);
- }
- }
-
- syslog(LOG_NOTICE, "Finished, rc=%d", rc);
- return rc;
-}
-
-
-
-int server(void)
-{
- char *id = NULL, *state = NULL;
- struct mosquitto *mosq = NULL;
- char hostname[256], buf[1024];
- int temp, rc, deviation, keepalive = 60;
-#ifdef HAVE_WIRINGPI_H
- int lcdupdate;
-#endif
- unsigned int max_inflight = 20;
- char err[1024];
- w1_therm *tmp1, *old1;
- char *device, *alias, line[60], *p = NULL;
- FILE *fp;
-
- /*
- * Initialize mosquitto communication
- */
- mosquitto_lib_init();
-
- /*
- * Build MQTT id
- */
- hostname[0] = '\0';
- gethostname(hostname, 256);
- hostname[255] = '\0';
-
- id = xstrcpy((char *)"thermometers/");
- id = xstrcat(id, hostname);
- if(strlen(id) > MOSQ_MQTT_ID_MAX_LENGTH) {
- /*
- * Enforce maximum client id length of 23 characters
- */
- id[MOSQ_MQTT_ID_MAX_LENGTH] = '\0';
- }
-
- mosq = mosquitto_new(id, true, NULL);
- if(!mosq) {
- switch(errno) {
- case ENOMEM:
- syslog(LOG_NOTICE, "mosquitto_new: Out of memory");
- break;
- case EINVAL:
- syslog(LOG_NOTICE, "mosquitto_new: Invalid id");
- break;
- }
- mosquitto_lib_cleanup();
- return 1;
- }
-
- if (debug) {
- mosquitto_log_callback_set(mosq, my_log_callback);
- }
-
- /*
- * Set our will
- */
- state = xstrcpy((char *)"clients/");
- state = xstrcat(state, hostname);
- state = xstrcat(state, (char *)"/thermometers/state");
- sprintf(buf, "0");
- if ((rc = mosquitto_will_set(mosq, state, strlen(buf), buf, qos, true))) {
- if (rc == MOSQ_ERR_INVAL) {
- syslog(LOG_NOTICE, "mosquitto_will_set: input parameters invalid");
- } else if (rc == MOSQ_ERR_NOMEM) {
- syslog(LOG_NOTICE, "mosquitto_will_set: Out of Memory");
- } else if (rc == MOSQ_ERR_PAYLOAD_SIZE) {
- syslog(LOG_NOTICE, "mosquitto_will_set: invalid payload size");
- }
- mosquitto_lib_cleanup();
- return rc;
- }
-
- mosquitto_max_inflight_messages_set(mosq, max_inflight);
- mosquitto_connect_callback_set(mosq, my_connect_callback);
- mosquitto_disconnect_callback_set(mosq, my_disconnect_callback);
- mosquitto_publish_callback_set(mosq, my_publish_callback);
-
- if ((rc = mosquitto_connect(mosq, Config.mosq_host, Config.mosq_port, keepalive))) {
- if (rc == MOSQ_ERR_ERRNO) {
- strerror_r(errno, err, 1024);
- syslog(LOG_NOTICE, "mosquitto_connect: error: %s", err);
- } else {
- syslog(LOG_NOTICE, "mosquitto_connect: unable to connect (%d)", rc);
- }
- mosquitto_lib_cleanup();
- return rc;
- }
- syslog(LOG_NOTICE, "Connected with %s:%d", Config.mosq_host, Config.mosq_port);
-
- /*
- * Initialise is complete, report our presence state
- */
- mosquitto_loop_start(mosq);
- sprintf(buf, "1");
- rc = mosquitto_publish(mosq, &mid_sent, state, strlen(buf), buf, qos, 1);
-#ifdef HAVE_WIRINGPI_H
-// setBacklight(0);
-#endif
-
- /*
- * Report alias names
- */
- for (tmp1 = Config.w1therms; tmp1; tmp1 = old1) {
- old1 = tmp1->next;
-
- alias = xstrcpy((char *)"/raw/");
- alias = xstrcat(alias, hostname);
- alias = xstrcat(alias, (char *)"/thermometers/w1/");
- alias = xstrcat(alias, tmp1->master);
- alias = xstrcat(alias, (char *)"/");
- alias = xstrcat(alias, tmp1->name);
- alias = xstrcat(alias, (char *)"/alias");
-
- sprintf(buf, "%s", tmp1->alias);
- if ((rc = mosquitto_publish(mosq, &mid_sent, alias, strlen(buf), buf, qos, 1))) {
- if (rc == MOSQ_ERR_NO_CONN)
- mosquitto_reconnect(mosq);
- else
- syslog(LOG_NOTICE, "mainloop: error %d from mosquitto_publish", rc);
- }
-
- free(alias);
- alias = NULL;
- }
-
- if (debug)
- fprintf(stdout, (char *)"Enter loop, connected %d\n", connected);
-
- do {
- if (status == STATUS_CONNACK_RECVD) {
-#ifdef HAVE_WIRINGPI_H
- lcdupdate = FALSE;
-#endif
-
- /*
- * Here send our 1-wire sensors values
- */
- for (tmp1 = Config.w1therms; tmp1; tmp1 = old1) {
- old1 = tmp1->next;
-
- /*
- * Build path and alias topic
- */
- device = xstrcpy((char *)"/sys/bus/w1/devices/");
- device = xstrcat(device, tmp1->master);
- device = xstrcat(device, (char *)"/");
- device = xstrcat(device, tmp1->name);
- device = xstrcat(device, (char *)"/w1_slave");
- alias = xstrcpy((char *)"/raw/");
- alias = xstrcat(alias, hostname);
- alias = xstrcat(alias, (char *)"/thermometers/w1/");
- alias = xstrcat(alias, tmp1->master);
- alias = xstrcat(alias, (char *)"/");
- alias = xstrcat(alias, tmp1->name);
- alias = xstrcat(alias, (char *)"/temperature");
-
- /*
- * Read sensor data
- */
- if ((fp = fopen(device, "r"))) {
- /*
- * The output looks like:
- * 72 01 4b 46 7f ff 0e 10 57 : crc=57 YES
- * 72 01 4b 46 7f ff 0e 10 57 t=23125
- */
- fgets(line, 50, fp);
- line[strlen(line)-1] = '\0';
- if ((line[36] == 'Y') && (line[37] == 'E')) {
- /*
- * CRC is Ok, continue
- */
- fgets(line, 50, fp);
- line[strlen(line)-1] = '\0';
- strtok(line, (char *)"=");
- p = strtok(NULL, (char *)"=");
- rc = sscanf(p, "%d", &temp);
- if ((rc == 1) && (tmp1->lastval != temp)) {
- /*
- * It is possible to have read errors or extreme values.
- * This can happen with bad connections so we compare the
- * value with the previous one. If the difference is too
- * much, we don't send that value. That also means that if
- * the next value is ok again, it will be marked invalid too.
- * Maximum error is 20 degrees for now.
- */
- deviation = 20000;
- if ((tmp1->lastval == 0) ||
- (tmp1->lastval && (temp > (tmp1->lastval - deviation)) && (temp < (tmp1->lastval + deviation)))) {
- /*
- * Temperature is changed and valid, update and publish this.
- */
- sprintf(buf, "%.1f", temp / 1000.0);
- if ((rc = mosquitto_publish(mosq, &mid_sent, alias, strlen(buf), buf, qos, 1))) {
- if (rc == MOSQ_ERR_NO_CONN)
- mosquitto_reconnect(mosq);
- else
- syslog(LOG_NOTICE, "mainloop: error %d from mosquitto_publish", rc);
- }
- } else {
- syslog(LOG_NOTICE, "deviation error deviation=%d, old=%d new=%d", deviation, tmp1->lastval, temp);
- if (debug) {
- fprintf(stdout, "deviation error deviation=%d, old=%d new=%d\n", deviation, tmp1->lastval, temp);
- }
- }
- tmp1->lastval = temp;
-#ifdef HAVE_WIRINGPI_H
- lcdupdate = TRUE;
-#endif
- }
- } else {
- syslog(LOG_NOTICE, "sensor %s/%s CRC error", tmp1->master, tmp1->name);
- }
- fclose(fp);
- tmp1->present = 1;
- } else {
- tmp1->present = 0;
- if (debug)
- printf("sensor %s is missing\n", tmp1->name);
- }
-
- free(device);
- device = NULL;
- free(alias);
- alias = NULL;
- }
-
-#ifdef HAVE_WIRINGPI_H
- if (lcdupdate) {
- lcdPosition(lcdHandle, 0, 0);
- tmp1 = Config.w1therms;
- snprintf(buf, 16, "%5.1f %cC %s ", tmp1->lastval / 1000.0, 0xdf, tmp1->alias);
- lcdPuts(lcdHandle, buf);
- old1 = tmp1->next;
- tmp1 = old1;
- lcdPosition(lcdHandle, 0, 1);
- snprintf(buf, 16, "%5.1f %cC %s ", tmp1->lastval / 1000.0, 0xdf, tmp1->alias);
- lcdPuts(lcdHandle, buf);
- }
-#endif
-
- if (my_shutdown) {
- /*
- * Final publish 0 to clients/<hostname>/thermometers/state
- */
- sprintf(buf, "0");
- mosquitto_publish(mosq, &mid_sent, state, strlen(buf), buf, qos, true);
- last_mid = mid_sent;
- status = STATUS_WAITING;
-#ifdef HAVE_WIRINGPI_H
- lcdClear(lcdHandle);
- lcdPosition(lcdHandle, 0, 0);
- lcdPuts(lcdHandle, "Shuting down ...");
-#endif
- }
-
- usleep(100000);
-
- } else if (status == STATUS_WAITING) {
- if (debug)
- fprintf(stdout, (char *)"Waiting\n");
- if (last_mid_sent == last_mid && disconnect_sent == false) {
- mosquitto_disconnect(mosq);
- disconnect_sent = true;
- }
- usleep(100000);
- }
- rc = MOSQ_ERR_SUCCESS;
-
- } while (rc == MOSQ_ERR_SUCCESS && connected);
-
- if (debug)
- fprintf(stdout, (char *)"Out of loop\n");
-
- mosquitto_loop_stop(mosq, false);
- mosquitto_destroy(mosq);
- mosquitto_lib_cleanup();
-
-#ifdef HAVE_WIRINGPI_H
- stopLCD();
-#endif
-
- return rc;
-}
-