move lpt and logging functions into library

lib/Makefile.am

@@ -1,7 +1,7 @@
 INCLUDES=${gammu_CFLAGS}
 
 lib_LTLIBRARIES = libyasnd.la
-libyasnd_la_SOURCES = libyasnd.c yasnd-gammu.c
+libyasnd_la_SOURCES = libyasnd.c yasnd-gammu.c yasnd-log.c yasnd-lpt.c
 libyasnd_la_CPPFLAGS = -I$(top_srcdir)
 libyasnd_la_LIBADD = ${gammu_LIBS}
 

lib/yasnd-gammu.c

@@ -1,5 +1,6 @@
 #include <gammu.h>
 #include "yasnd.h"
+#include "yasnd-log.h"
 
 GSM_Error error; // structure to store possible gammu errors
 GSM_StateMachine *state_machine=NULL; // structure to interact with mobile phones

lib/yasnd-log.c

@@ -0,0 +1,30 @@
+#include <syslog.h>
+
+int debug_flag=0; // debug verbosity flag
+
+void log_init()
+{
+	return openlog("yasnd", LOG_PID|LOG_CONS, LOG_USER);
+}
+
+void log_close()
+{
+	return closelog();
+}
+
+/*
+	Function, that called to output various debug messages to syslog
+*/
+void log_debug(const char *message,int verbosity)
+{
+	if (debug_flag>=verbosity)
+		syslog(LOG_INFO,"%s",message);
+}
+
+/*
+	Function, that called to output information message to syslog
+*/
+void log_event(const char *message)
+{
+	syslog(LOG_INFO,"%s",message);
+}

lib/yasnd-lpt.c

@@ -0,0 +1,76 @@
+#include <sys/io.h>
+#include <stdbool.h>
+#include <unistd.h>
+
+bool lpt_enable=false; // control usage of LPT port to reset target devices
+int lpt_port=0x378; // LPT port in hex(0x378 is usually LPT1)
+
+/*
+	Function, that turn off all LPT port pins.
+	This is needed to unlock LPT control circuit, when
+	management computer is just booted
+*/
+void lpt_init()
+{
+	if (lpt_enable)
+	{
+		if (ioperm (lpt_port, 3, 1))
+		{
+			log_event("Error: Unlocking the circuit fails due to LPT port access error");
+			// disable LPT port usage
+			lpt_enable=false;
+			return;
+		}
+		// Unlock circuit
+		outb (0, lpt_port);
+	}
+}
+
+/*
+	Function, that turn on first LPT port pin and turn off others.
+	This is needed to lock LPT control circuit, when
+	management computer is rebooted
+*/
+void lpt_lock_cond(bool ignore_options)
+{
+	if (lpt_enable || ignore_options)
+	{
+		if (ioperm (lpt_port, 3, 1))
+		{
+			log_event("Error: Locking the circuit fails due to LPT port access error");
+			// disable LPT port usage
+			lpt_enable=false;
+			return;
+		}
+		// Lock circuit
+		outb (1, lpt_port);
+	}
+}
+
+/*
+	Function, that turn on only one LPT port pin, defined by it argument, wait a second,
+	and turn off all pins. That is enough to reset specified host.
+*/
+void reset_pin(int pin_num)
+{
+	if (lpt_enable)
+	{
+		if (pin_num==0)
+			return; // there is no LPT control for target host
+		if (pin_num<2 || pin_num>8)
+		{
+			log_event("Error: incorrent LPT pin number");
+			return;
+		}
+		int pins = 1<<(pin_num-1);
+		if (ioperm (lpt_port, 3, 1))
+		{
+			log_event("Error: LPT port access error");
+			return;
+		}
+		// Reset host
+		outb (pins, lpt_port);
+		sleep(1);
+		outb (0, lpt_port);
+	}
+}