Cleanup work (much needed)

[tpg/opendispense2.git] / src / server / main.c

diff --git a/src/server/main.c b/src/server/main.c
index ac6dd27..8abb984 100644 (file)
--- a/src/server/main.c
+++ b/src/server/main.c
@@ -12,6 +12,11 @@
 #include <string.h>
 #include <signal.h>
 #include "common.h"
+#include <termios.h>
+#include <unistd.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <stdarg.h>
 
 // === IMPORTS ===
 extern void    Init_Cokebank(const char *Argument);    // cokebank.c
@@ -118,4 +123,55 @@ void CompileRegex(regex_t *regex, const char *pattern, int flags)
        }
 }
 
+// Serial helper
+int InitSerial(const char *File, int BaudRate)
+{
+       struct termios  info;
+        int    baud;
+        int    fd;
+       
+       fd = open(File, O_RDWR | O_NOCTTY | O_NONBLOCK);
+       if( fd == -1 )  return -1;
+       
+       switch(BaudRate)
+       {
+       case 9600:      baud = B9600;   break;
+       default:        close(fd);      return -1;
+       }
+       
+       info.c_lflag = 0;       // Non-Canoical, No Echo
+       info.c_cflag = baud | CS8 | CLOCAL | CREAD;     // baud, 8N1
+       cfsetspeed(&info, baud);
+       info.c_cc[VTIME] = 0;   // No time limit
+       info.c_cc[VMIN] = 1;    // Block until 1 char
+       
+       tcflush(fd, TCIFLUSH);
+       tcsetattr(fd, TCSANOW, &info);
+       
+       return fd;
+}
+
+
+/**
+ * \brief Create a formatted heap string
+ */
+char *mkstr(const char *Format, ...)
+{
+       va_list args;
+        int    len;
+       char    *ret;
+
+       va_start(args, Format);
+       len = vsnprintf(NULL, 0, Format, args);
+       va_end(args);
+
+       ret = malloc( len + 1 );
+       if(!ret)        return NULL;
+
+       va_start(args, Format);
+       vsprintf(ret, Format, args);
+       va_end(args);
+       
+       return ret;
+}