Adding moxanix.cfg file. Moxanix is now configured with it.

moxanix.cfg

@@ -0,0 +1,29 @@
+; port config format: 
+;
+; [tcp_port]
+; dev = {tty dev path}
+; speed = {port baud rate}
+
+[4001]
+dev = /dev/ttyUSB0
+speed = 9600
+
+[4002]
+dev = /dev/ttyS2
+speed = 115201
+
+[4003]
+dev = /dev/ttyS3
+speed = 115200
+
+[4004]
+dev = /dev/ttyS4
+speed = 115200
+
+[4005]
+dev = /dev/ttyS5
+speed = 115200
+
+[4006]
+dev = /dev/ttyS6
+speed = 115200

moxerver.c

@@ -5,6 +5,7 @@
  */
 
 #include "moxerver.h"
+#include "parser.h"
 #include <signal.h> /* handling quit signals */
 #include <pthread.h>
 
@@ -15,7 +16,8 @@
 /* Prints help message. */
 static void usage() {
 	//TODO maybe some styling should be done
-	fprintf(stderr, "Usage: %s -p tcp_port -t tty_path [-d] [-h]\n", NAME);
+	fprintf(stderr, "Usage: %s -p tcp_port [-t tty_path] [-d] [-h]\n", NAME);
+	fprintf(stderr, "\t-t\ttty dev path (if not specified %s needs to be defined)\n", CONFILE);
 	fprintf(stderr, "\t-d\tturns on debug messages\n");
 	fprintf(stderr, "\n");
 }
@@ -48,11 +50,33 @@ int time2string(time_t time, char* timestamp) {
 	return 0;
 }
 
+/* Parse handler function, used to configure serial port */
+int parse_handler(void *user, const char *section, const char *name, const char *value) {
+	
+	printf("[%s] section = %s, name = %s, value = %s\n", __func__, section, name, value);
+	
+	if (!strcmp(name, "speed") && (unsigned int)atoi(section) == server.port) {
+		printf("[%s] setting %s speed for port %s\n", __func__, value, section);
+		
+		if (cfsetispeed(&(tty_dev.ttyset), baud_to_speed(atoi(value))) < 0 || 
+			cfsetospeed(&(tty_dev.ttyset), baud_to_speed(atoi(value))) < 0) {
+			fprintf(stderr, "[%s] error configuring tty device speed\n", NAME);
+			return -1;
+   		}
+   	}
+	
+	if (!strcmp(name, "dev") && (unsigned int)atoi(section) == server.port) 
+		strcpy(tty_dev.path, value);
+
+	return 1;
+}
+
 /* MoxaNix main program loop. */
 int main(int argc, char *argv[]) {
 	
 	int ret;
 	unsigned int tcp_port = -1;
+	int def_conf = 0; 	// is default config used or from .cfg file
 	
 	fd_set read_fds;
 	int fdmax;
@@ -60,6 +84,13 @@ int main(int argc, char *argv[]) {
 
 	pthread_t tty_thread; 
 
+	/* zero init tty_dev */
+	if (cfsetispeed(&(tty_dev.ttyset), B0) < 0 || 
+		cfsetospeed(&(tty_dev.ttyset), B0) < 0) {
+		fprintf(stderr, "[%s] error configuring tty device speed\n", NAME);
+		return -1;
+   	}
+	
 	/* enable catching and handling some quit signals, SIGKILL can't be caught */
 	signal(SIGTERM, quit_handler);
 	signal(SIGQUIT, quit_handler);
@@ -78,7 +109,7 @@ int main(int argc, char *argv[]) {
 			case 'p':
 				tcp_port = (unsigned int) atoi(optarg);
 				break;
-			/* get tty device path */
+			/* get tty device path, default config used */
 			case 't':
 				if ((strnlen(optarg, DEV_PATH) == 0) || 
 					(strnlen(optarg, DEV_PATH) > (DEV_PATH - 1))) {
@@ -89,6 +120,7 @@ int main(int argc, char *argv[]) {
 					/* set tty device path in tty_dev struct */
 					strcpy(tty_dev.path, optarg);
 				}
+				def_conf = 1;
 				break;
 			/* enable debug messages */
 			case 'd':
@@ -111,6 +143,16 @@ int main(int argc, char *argv[]) {
 	client.socket = -1;
 	tty_dev.fd = -1;
 	
+	/* parse config file if any */
+	if (!def_conf && ((ret = ini_parse(CONFILE, &parse_handler, NULL)) == -1)) {
+		fprintf(stderr, "[%s] error opening config file %s\n", NAME, CONFILE);
+		usage();
+		return -1;
+	}
+	else if (!def_conf && ret) {
+		fprintf(stderr, "[%s] error parsing congig file %s on line %d\n", NAME, CONFILE, ret);
+		return -1;
+	}
 	/* open tty device */
 	if (tty_open(&tty_dev) < 0) {
 		fprintf(stderr, "[%s] error: opening of tty device at %s failed\n"

moxerver.h

@@ -16,6 +16,7 @@
 #define DEV_PATH 32
 #define TIMESTAMP_FORMAT "%d.%m.%Y. %H:%M:%S"
 #define TIMESTAMP_LEN 20+1 /* calculated following timestamp format */
+#define CONFILE "moxanix.cfg"
 
 /* Structures used for communication parameters. */
 struct server_t {
@@ -160,15 +161,21 @@ int telnet_handle_client_write(char *databuf, int *datalen);
 
 /* Opens the tty device and configures it. */
 int tty_open(struct tty_t *tty_dev);
+
 /* Closes the tty device. */
 int tty_close(struct tty_t *tty_dev);
+
 /* Reconfigures the tty device. */
 int tty_reconfigure(struct tty_t *tty_dev, struct termios newttyset);
+
 /* Reads incoming data from tty device to tty data buffer. */
 int tty_read(struct tty_t *tty_dev);
+
 /* Sends data from a buffer to tty device. */
 int tty_write(struct tty_t *tty_dev, char *databuf, int datalen);
+
 /* Main tty thread function */
 void *tty_thread_func(void *arg);
-
+int speed_to_baud(speed_t speed);
+speed_t baud_to_speed(int baud);
 

tty.c

@@ -7,6 +7,7 @@
 #define TTY_THREAD_TIMEOUT_SEC 30
 #define TTY_WAIT_TIMEOUT 5 /* seconds for select() timeout in server loop */
 #define NAME "tty"
+#define TTY_DEF_BAUD_RATE B115200
 
 /* Opens the tty device and configures it. */
 int tty_open(struct tty_t *tty_dev) {
@@ -31,7 +32,14 @@ int tty_open(struct tty_t *tty_dev) {
 	tty_dev->ttyset.c_cc[VMIN]  = 1;
 	tty_dev->ttyset.c_cc[VTIME] = 0;
 
-	if(cfsetispeed(&(tty_dev->ttyset), B115200) < 0 || cfsetospeed(&(tty_dev->ttyset), B115200) < 0) {
+	/* if speed is set to B0 (e.g. cfg file is not provided), default values are used */
+	if (cfgetispeed(&(tty_dev->ttyset)) == baud_to_speed(0) && 
+		cfsetispeed(&(tty_dev->ttyset), TTY_DEF_BAUD_RATE) < 0) {
+		fprintf(stderr, "[%s] error configuring tty device speed\n", NAME);
+		return -errno;
+	}
+	if (cfgetospeed(&(tty_dev->ttyset)) == baud_to_speed(0) && 
+		cfsetospeed(&(tty_dev->ttyset), TTY_DEF_BAUD_RATE) < 0) {
 		fprintf(stderr, "[%s] error configuring tty device speed\n", NAME);
 		return -errno;
    	}
@@ -44,6 +52,7 @@ int tty_open(struct tty_t *tty_dev) {
 	return 0;
 
 }
+
 /* Closes the tty device. */
 int tty_close(struct tty_t *tty_dev) {
 	// close and set "tty_dev.fd = -1"
@@ -111,3 +120,97 @@ void *tty_thread_func(void *arg) {
 	return (void *)tty_dev;;
 }
 
+/*
+ * Converts POSIX speed_t to a baud rate.  The values of the
+ * constants for speed_t are not themselves portable.
+ */
+int speed_to_baud(speed_t speed)
+{
+	switch (speed) {
+	case B0:
+		return 0;
+	case B50:
+		return 50;
+	case B75:
+		return 75;
+	case B110:
+		return 110;
+	case B134:
+		return 134;
+	case B150:
+		return 150;
+	case B200:
+		return 200;
+	case B300:
+		return 300;
+	case B600:
+		return 600;
+	case B1200:
+		return 1200;
+	case B1800:
+		return 1800;
+	case B2400:
+		return 2400;
+	case B4800:
+		return 4800;
+	case B9600:
+		return 9600;
+	case B19200:
+		return 19200;
+	case B38400:
+		return 38400;
+	case B57600:
+		return 57600;
+	case B115200:
+		return 115200;
+	default:
+		return 115200;
+	}
+}
+
+/*
+ * Converts a numeric baud rate to a POSIX speed_t.
+ */
+speed_t baud_to_speed(int baud)
+{
+	switch (baud) {
+	case 0:
+		return B0;
+	case 50:
+		return B50;
+	case 75:
+		return B75;
+	case 110:
+		return B110;
+	case 134:
+		return B134;
+	case 150:
+		return B150;
+	case 200:
+		return B200;
+	case 300:
+		return B300;
+	case 600:
+		return B600;
+	case 1200:
+		return B1200;
+	case 1800:
+		return B1800;
+	case 2400:
+		return B2400;
+	case 4800:
+		return B4800;
+	case 9600:
+		return B9600;
+	case 19200:
+		return B19200;
+	case 38400:
+		return B38400;
+	case 57600:
+		return B57600;
+	case 115200:
+		return B115200;
+	default:
+		return B115200;
+	}
+}