mbsePi-apps: comparison thermometers/main.c

-:01fec4ddad17
+:f4cbe008da72
 static bool		shutdown = false;
 static pid_t		pgrp, mypid;
 extern bool		debug;
 extern sys_config	Config;
+extern int		lcdHandle;
 int server(void);
 void help(void);
 void die(int);
 printf("MQTT: %s\n", str);
 }
+void stopLCD(void)
+{
+lcdClear(lcdHandle);
+setBacklight(0);
+}
 int main(int argc, char *argv[])
 {
 int		rc, c, i;
 pid_t	frk;
+char	buf[80];
 while (1) {
 	int option_index = 0;
 	static struct option long_options[] = {
 	    {"debug", 0, 0, 'c'},
 for (i = 0; i < NSIG; i++) {
 	if ((i != SIGCHLD) && (i != SIGKILL) && (i != SIGSTOP))
 	    signal(i, (void (*))die);
 }
+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);
 if (debug) {
 	/*
 	 * For debugging run in foreground.
 	 */
 	frk = fork();
 	switch (frk) {
 	    case -1:
 		    	syslog(LOG_NOTICE, "Daemon fork failed: %s", strerror(errno));
 			syslog(LOG_NOTICE, "Finished, rc=1");
+			stopLCD();
 			exit(1);
 	    case 0:	/*
 			 * Run the daemon
 			 */
 			fclose(stdin);
 int server(void)
 {
 char                *id = NULL, *state = NULL;
 struct mosquitto    *mosq = NULL;
 char                hostname[256], buf[1024];
-int                 temp, rc, deviation, keepalive = 60;
+int                 temp, rc, deviation, keepalive = 60, lcdupdate;
 unsigned int        max_inflight = 20;
 char                err[1024];
 w1_therm		*tmp1, *old1;
 char		*device, *alias, line[60], *p = NULL;
 FILE		*fp;
 if (debug)
 	fprintf(stdout, (char *)"Enter loop, connected %d\n", connected);
 do {
 	if (status == STATUS_CONNACK_RECVD) {
+	    lcdupdate = FALSE;
 	    /*
 	     * Here send our 1-wire sensors values
 	     */
 	    for (tmp1 = Config.w1therms; tmp1; tmp1 = old1) {
 		old1 = tmp1->next;
 			     * 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 = (temp + tmp1->lastval) / 10;
+			    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.
 			    	 */
 				    	mosquitto_reconnect(mosq);
 			    	    else
 				    	syslog(LOG_NOTICE, "mainloop: error %d from mosquitto_publish", rc);
 			    	}
 			    } else {
-				if (debug)
+				syslog(LOG_NOTICE, "deviation error deviation=%d, old=%d new=%d", deviation, tmp1->lastval, temp);
-				    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;
+			    lcdupdate = TRUE;
 			}
 		    } else {
 			syslog(LOG_NOTICE, "sensor %s/%s CRC error", tmp1->master, tmp1->name);
 		    }
 		    fclose(fp);
 		free(device);
 		device = NULL;
 		free(alias);
 		alias = NULL;
 	    }
-	    usleep(100000);
+	    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);
+	    }
 	    if (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;
+		lcdClear(lcdHandle);
+		lcdPosition(lcdHandle, 0, 0);
+		lcdPuts(lcdHandle, "Shuting down ...");
 	    }
+	    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);
 mosquitto_loop_stop(mosq, false);
 mosquitto_destroy(mosq);
 mosquitto_lib_cleanup();
+stopLCD();
 return rc;
 }

Mercurial > mbsePi-apps / file comparison

comparison: thermometers/main.c

thermometers/main.c