Add run time options to RPi gateway

Author: marceloaqno

Diff for: configure

@@ -28,7 +28,7 @@ Installation options:
 
 MySensors options:
     --my-debug=[enable|disable]
-                                Enables or disables debugging. [enable]
+                                Enables or disables MySensors core debugging. [enable]
     --my-config-file=<FILE>     Config file path. [/etc/mysensors.dat]
     --my-gateway=[none|ethernet|serial|mqtt]
                                 Gateway type, set to none to disable gateway feature. [ethernet]

Diff for: core/MyGatewayTransportSerial.cpp

@@ -17,7 +17,6 @@
  * version 2 as published by the Free Software Foundation.
  */
 
-
 #include "MyConfig.h"
 #include "MyProtocol.h"
 #include "MyGatewayTransport.h"
@@ -31,7 +30,6 @@ char _serialInputString[MY_GATEWAY_MAX_RECEIVE_LENGTH];    // A buffer for incom
 int _serialInputPos;
 MyMessage _serialMsg;
 
-
 bool gatewayTransportSend(MyMessage &message) {
     setIndication(INDICATION_GW_TX);
 	MY_SERIALDEVICE.print(protocolFormat(message));
@@ -47,7 +45,6 @@ bool gatewayTransportInit() {
 	return true;
 }
 
-
 bool gatewayTransportAvailable() {
 	while (MY_SERIALDEVICE.available()) {
 		// get the new byte:

Diff for: core/MyHwLinuxGeneric.cpp

@@ -24,12 +24,14 @@
 #include <iostream>
 #include <fstream>
 #include <sys/stat.h>
+#include "log.h"
 
 static const char* CONFIG_FILE = MY_LINUX_CONFIG_FILE;
 static const size_t _length = 1024;	// ATMega328 has 1024 bytes
 static uint8_t _config[_length];
 
-bool CheckConfigFile() {
+bool CheckConfigFile()
+{
 	struct stat fileInfo;
 
 	if (stat(CONFIG_FILE, &fileInfo) != 0) {
@@ -152,27 +154,31 @@ int8_t hwSleep(uint8_t interrupt1, uint8_t mode1, uint8_t interrupt2, uint8_t mo
 	return -2;
 }
 
-uint16_t hwCPUVoltage() {
+uint16_t hwCPUVoltage()
+{
 	// TODO: Not supported!
 	return 0;
 }
 
-uint16_t hwCPUFrequency() {
+uint16_t hwCPUFrequency()
+{
 	// TODO: Not supported!
 	return 0;
 }
 
-uint16_t hwFreeMem() {
+uint16_t hwFreeMem()
+{
 	// TODO: Not supported!
 	return 0;
 }
 
 #ifdef MY_DEBUG
-void hwDebugPrint(const char *fmt, ... )
+void hwDebugPrint(const char *fmt, ...)
 {
-	va_list arglist;
-	va_start(arglist, fmt);
-	vprintf(fmt, arglist);
-	va_end(arglist);
+	va_list args;
+
+	va_start(args, fmt);
+	mys_log_v(LOG_DEBUG, fmt, args);
+	va_end(args);
 }
 #endif

Diff for: core/MyMainLinux.cpp

@@ -1,19 +1,23 @@
 // Initialize library and handle sketch functions like we want to
 
-#include <iostream>
+#include <stdio.h>
 #include <csignal>
 #include <cstdlib>
+#include <unistd.h>
+#include <fcntl.h>
+#include <syslog.h>
+#include <errno.h>
+#include "log.h"
 #include "MySensorsCore.h"
 
-/*
- * handler for SIGINT signal
- */
 void handle_sigint(int sig)
 {
 	if (sig == SIGINT) {
-		std::cout << "Received SIGINT\n" << std::endl;
+		mys_log(LOG_NOTICE, "Received SIGINT\n\n");
 	} else if (sig == SIGTERM) {
-		std::cout << "Received SIGTERM\n" << std::endl;
+		mys_log(LOG_NOTICE, "Received SIGTERM\n\n");
+	} else {
+		return;
 	}
 
 	#ifdef MY_RF24_IRQ_PIN
@@ -27,11 +31,91 @@ void handle_sigint(int sig)
 	exit(0);
 }
 
-int main(void) {
+static int daemonize(void)
+{
+	pid_t pid, sid;
+
+	/* Fork off the parent process */
+	pid = fork();
+	if (pid < 0) {
+		mys_log(LOG_ERR, "fork: %s", strerror(errno));
+		return -1;
+	}
+	/* If we got a good PID, then we can exit the parent process. */
+	if (pid > 0) {
+		exit(EXIT_SUCCESS);
+	}
+
+	/* At this point we are executing as the child process */
+
+	/* Change the file mode mask */
+	umask(0);
+
+	/* Create a new SID for the child process */
+	sid = setsid();
+	if (sid < 0) {
+		mys_log(LOG_ERR, "setsid: %s", strerror(errno));
+		return -1;
+	}
+
+	/* Change the current working directory.  This prevents the current
+	directory from being locked; hence not being able to remove it. */
+	if ((chdir("/")) < 0) {
+		mys_log(LOG_ERR, "chdir(\"/\"): %s", strerror(errno));
+		return -1;
+	}
+
+	freopen( "/dev/null", "r", stdin);
+	freopen( "/dev/null", "r", stdout);
+	freopen( "/dev/null", "r", stderr);
+
+	return 0;
+}
+
+int main(int argc, char *argv[])
+{
+	int opt, log_opts, debug = 0, foreground = 1;
+
 	/* register the signal handler */
 	signal(SIGINT, handle_sigint);
 	signal(SIGTERM, handle_sigint);
 
+	while ((opt = getopt(argc, argv, "hdb")) != -1) {
+		switch (opt) {
+			case 'h':
+				printf("Usage: mysGateway [options]\n\n" \
+							 "Options:\n" \
+							 "-h            Display a short summary of all program options.\n" \
+							 "-d            Enable debug.\n" \
+							 "-b            Become a daemon.\n");
+				exit(0);
+			case 'd':
+				debug = 1;
+				break;
+			case 'b':
+				foreground = 0;
+				break;
+		}
+	}
+
+	log_opts = LOG_CONS;
+	if (foreground && isatty(STDIN_FILENO)) {
+		log_opts |= LOG_PERROR;
+	}
+	if (!debug) {
+		setlogmask(LOG_UPTO (LOG_INFO));
+	}
+	openlog(NULL, log_opts, LOG_USER);
+
+	if (!foreground && !debug) {
+		if (daemonize() != 0) {
+			exit(EXIT_FAILURE);
+		}
+	}
+
+	mys_log(LOG_INFO, "Starting gateway...\n");
+	mys_log(LOG_INFO, "Protocol version - %s\n", MYSENSORS_LIBRARY_VERSION);
+
 	_begin(); // Startup MySensors library
 
 	for (;;) {

Diff for: drivers/Linux/EthernetClient.cpp

@@ -29,6 +29,7 @@
 #include <sys/time.h>
 #include <netinet/tcp.h>
 #include <errno.h>
+#include "log.h"
 #include "EthernetClient.h"
 
 EthernetClient::EthernetClient() : _sock(-1) {
@@ -50,37 +51,37 @@ int EthernetClient::connect(const char* host, uint16_t port) {
 
 	sprintf(port_str, "%hu", port);
 	if ((rv = getaddrinfo(host, port_str, &hints, &servinfo)) != 0) {
-			fprintf(stderr, "getaddrinfo: %s\n", gai_strerror(rv));
+			mys_log(LOG_ERR, "getaddrinfo: %s\n", gai_strerror(rv));
 		return -1;
 	}
 
 	// loop through all the results and connect to the first we can
 	for (p = servinfo; p != NULL; p = p->ai_next) {
 		if ((sockfd = socket(p->ai_family, p->ai_socktype,
 				p->ai_protocol)) == -1) {
-			perror("socket");
+			mys_log(LOG_ERR, "socket: %s\n", strerror(errno));
 			continue;
 		}
 
 		if (::connect(sockfd, p->ai_addr, p->ai_addrlen) == -1) {
 			close(sockfd);
-			perror("connect");
+			mys_log(LOG_ERR, "connect: %s\n", strerror(errno));
 			continue;
 		}
 
 		break;
 	}
 
 	if (p == NULL) {
-		fprintf(stderr, "failed to connect\n");
+		mys_log(LOG_ERR, "failed to connect\n");
 		return -1;
 	}
 
 	_sock = sockfd;
 
 	void *addr = &(((struct sockaddr_in*)p->ai_addr)->sin_addr);
 	inet_ntop(p->ai_family, addr, s, sizeof s);
-	ETHERNETCLIENT_DEBUG("connected to %s\n", s);
+	mys_log(LOG_DEBUG, "connected to %s\n", s);
 
 	freeaddrinfo(servinfo); // all done with this structure
 
@@ -106,7 +107,7 @@ size_t EthernetClient::write(const uint8_t *buf, size_t size) {
 	while (size > 0) {
 		rc = send(_sock, buf + bytes, size, MSG_NOSIGNAL | MSG_DONTWAIT);
 		if (rc == -1) {
-			perror("send");
+			mys_log(LOG_ERR, "send: %s\n", strerror(errno));
 			close(_sock);
 			_sock = -1;
 			break;

Diff for: drivers/Linux/EthernetClient.h

@@ -37,13 +37,6 @@
 #define ETHERNETCLIENT_W5100_CLOSE_WAIT 0x1C
 #define ETHERNETCLIENT_W5100_LAST_ACK 0x1D
 
-// debug 
-#if defined(ETHERNETCLIENT_VERBOSE)
-	#define ETHERNETCLIENT_DEBUG(x,...) debug(x, ##__VA_ARGS__) //!< debug
-#else
-	#define ETHERNETCLIENT_DEBUG(x,...) //!< debug NULL
-#endif
-
 /**
  * EthernetClient class
  */

Diff for: drivers/Linux/EthernetServer.cpp

@@ -28,6 +28,7 @@
 #include <unistd.h>
 #include <errno.h>
 #include <fcntl.h>
+#include "log.h"
 #include "EthernetClient.h"
 #include "EthernetServer.h"
 
@@ -56,40 +57,40 @@ void EthernetServer::begin(IPAddress address)
 
 	sprintf(portstr, "%d", port);
 	if ((rv = getaddrinfo(address.toString().c_str(), portstr, &hints, &servinfo)) != 0) {
-		fprintf(stderr, "getaddrinfo: %s\n", gai_strerror(rv));
+		mys_log(LOG_ERR, "getaddrinfo: %s\n", gai_strerror(rv));
 		return;
 	}
 
 	// loop through all the results and bind to the first we can
 	for (p = servinfo; p != NULL; p = p->ai_next) {
 		if ((sockfd = socket(p->ai_family, p->ai_socktype, p->ai_protocol)) == -1) {
-			perror("socket");
+			mys_log(LOG_ERR, "socket: %s\n", strerror(errno));
 			continue;
 		}
 
 		if (setsockopt(sockfd, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(int)) == -1) {
-			perror("setsockopt");
+			mys_log(LOG_ERR, "setsockopt: %s\n", strerror(errno));
 			freeaddrinfo(servinfo);
 			return;
 		}
 
 		if (bind(sockfd, p->ai_addr, p->ai_addrlen) == -1) {
 			close(sockfd);
-			perror("bind");
+			mys_log(LOG_ERR, "bind: %s\n", strerror(errno));
 			continue;
 		}
 
 		break;
 	}
 
 	if (p == NULL)  {
-		fprintf(stderr, "failed to bind\n");
+		mys_log(LOG_ERR, "failed to bind\n");
 		freeaddrinfo(servinfo);
 		return;
 	}
 
 	if (listen(sockfd, ETHERNETSERVER_BACKLOG) == -1) {
-		perror("listen");
+		mys_log(LOG_ERR, "listen: %s\n", strerror(errno));
 		freeaddrinfo(servinfo);
 		return;
 	}
@@ -101,7 +102,7 @@ void EthernetServer::begin(IPAddress address)
 	struct sockaddr_in *ipv4 = (struct sockaddr_in *)p->ai_addr;
 	void *addr = &(ipv4->sin_addr);
 	inet_ntop(p->ai_family, addr, ipstr, sizeof ipstr);
-	ETHERNETSERVER_DEBUG("Listening for connections on %s:%s\n", ipstr, portstr);
+	mys_log(LOG_DEBUG, "Listening for connections on %s:%s\n", ipstr, portstr);
 }
 
 bool EthernetServer::hasClient()
@@ -141,7 +142,7 @@ size_t EthernetServer::write(const uint8_t *buffer, size_t size)
 			client.stop();
 			clients[i] = clients.back();
 			clients.pop_back();
-			ETHERNETSERVER_DEBUG("Client disconnected.");
+			mys_log(LOG_DEBUG, "Client disconnected.");
 		}
 	}
 
@@ -191,7 +192,7 @@ void EthernetServer::_accept()
 			}
 		}
 		if (no_free_slots) {
-			ETHERNETSERVER_DEBUG("Max number of ethernet clients reached.");
+			mys_log(LOG_DEBUG, "Max number of ethernet clients reached.");
 			return;
 		}
 	}
@@ -200,7 +201,7 @@ void EthernetServer::_accept()
 	new_fd = accept(sockfd, (struct sockaddr *)&client_addr, &sin_size);
 	if (new_fd == -1) {
 		if (errno != EAGAIN && errno != EWOULDBLOCK) {
-			perror("accept");
+			mys_log(LOG_ERR, "accept: %s\n", strerror(errno));
 		}
 		return;
 	}
@@ -210,5 +211,5 @@ void EthernetServer::_accept()
 
 	void *addr = &(((struct sockaddr_in*)&client_addr)->sin_addr);
 	inet_ntop(client_addr.ss_family, addr, ipstr, sizeof ipstr);
-	ETHERNETSERVER_DEBUG("New connection from %s\n", ipstr);
+	mys_log(LOG_DEBUG, "New connection from %s\n", ipstr);
 }

Diff for: drivers/Linux/EthernetServer.h

@@ -34,13 +34,6 @@
 	#define ETHERNETSERVER_BACKLOG 10 //!< Maximum length to which the queue of pending connections may grow.
 #endif
 
-// debug 
-#if defined(ETHERNETSERVER_VERBOSE)
-	#define ETHERNETSERVER_DEBUG(x,...) printf(x, ##__VA_ARGS__) //!< debug
-#else
-	#define ETHERNETSERVER_DEBUG(x,...) //!< debug NULL
-#endif
-
 class EthernetClient;
 
 /**