Fri, 20 Jun 2014 17:42:36 +0200
Compiles with 1-wire bus on PC hardware
/***************************************************************************** * 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 "thermometers.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; }