main.c

/*****************************************************************************\
**                                                                           **
** Linux Call Router                                                         **
**                                                                           **
**---------------------------------------------------------------------------**
** Copyright: Andreas Eversberg                                              **
**                                                                           **
** Main function                                                             **
**                                                                           **
\*****************************************************************************/ 

#include "main.h"
#ifdef PACKAGE_VERSION
#undef PACKAGE_VERSION
#endif
#include "config.h"

//MESSAGES

struct timeval now_tv;
struct timezone now_tz;
#define GET_NOW() \
	{ \
		gettimeofday(&now_tv, &now_tz); \
		now_d = ((double)(now_tv.tv_usec))/1000000 + now_tv.tv_sec; \
	}

FILE *debug_fp = NULL;
int quit = 0;

#if 0
struct lcr_fdset lcr_fdset[FD_SETSIZE];
#endif

pthread_mutex_t mutexd; // debug output mutex
pthread_mutex_t mutext; // trace output mutex
pthread_mutex_t mutexe; // error output mutex
//pthread_mutex_t mutex_lcr; // lcr process mutex

int memuse = 0;
int mmemuse = 0;
int cmemuse = 0;
int ememuse = 0;
int pmemuse = 0;
int amemuse = 0;
int rmemuse = 0;
int classuse = 0;
int fduse = 0;
int fhuse = 0;

int debug_count = 0;
int last_debug = 0;
int debug_newline = 1;
int nooutput = 0;

void debug(const char *file, const char *function, int line, const char *prefix, char *buffer)
{
	time_t now;
	struct tm *now_tm;

	/* if we have a new debug count, we add a mark */
	if (last_debug != debug_count) {
		last_debug = debug_count;
		time(&now);
		now_tm = localtime(&now);
		if (!nooutput)
			printf("\033[34m--------------------- %04d.%02d.%02d %02d:%02d:%02d %06d\033[36m\n", now_tm->tm_year+1900, now_tm->tm_mon+1, now_tm->tm_mday, now_tm->tm_hour, now_tm->tm_min, now_tm->tm_sec, debug_count%1000000);
		if (debug_fp)
			fprintf(debug_fp, "--------------------- %04d.%02d.%02d %02d:%02d:%02d %06d\n", now_tm->tm_year+1900, now_tm->tm_mon+1, now_tm->tm_mday, now_tm->tm_hour, now_tm->tm_min, now_tm->tm_sec, debug_count%1000000);
	}

	if (!nooutput) {
		if (debug_newline)
			printf("\033[32m%06d %s\033[37m%s", debug_count%1000000, prefix?prefix:"", prefix?" ":"");
		if (function)
			printf("(in %s/%s() line %d): %s", file, function, line, buffer);
		else
			printf("%s", buffer);
	}

	if (debug_fp) {
		if (debug_newline) {
			if (function)
				fprintf(debug_fp, "%s%s(in %s() line %d): %s", prefix?prefix:"", prefix?" ":"", function, line, buffer);
			else
				fprintf(debug_fp, "%s%s: %s", prefix?prefix:"", prefix?" ":"", buffer);
			fflush(debug_fp);
		}
	}

	debug_newline = 0;
	if (buffer[0])
		if (buffer[strlen(buffer)-1] == '\n')
			debug_newline = 1;
}


void _printdebug(const char *file, const char *function, int line, unsigned int mask, const char *fmt, ...)
{
	char buffer[4096];
	va_list args;

	if (!(options.deb & mask))
		return;
	pthread_mutex_lock(&mutexd);

	va_start(args,fmt);
	VUNPRINT(buffer,sizeof(buffer)-1,fmt,args);
	buffer[sizeof(buffer)-1]=0;
	va_end(args);

	debug(file, function, line, "DEBUG", buffer);

	pthread_mutex_unlock(&mutexd);
}

void _printerror(const char *file, const char *function, int line, const char *fmt, ...)
{
	char buffer[4096];
	va_list args;

	pthread_mutex_lock(&mutexe);

	va_start(args,fmt);
	VUNPRINT(buffer,sizeof(buffer)-1,fmt,args);
	buffer[sizeof(buffer)-1]=0;
	va_end(args);

	if (options.deb)
		debug(file, function, line, "ERROR", buffer);
	else { /* only if we do not debug */
		if (function)
			fprintf(stderr, "ERROR (in %s() line %d) %s", function, line, buffer);
		else
			fprintf(stderr, "ERROR %s", buffer);
	}

	pthread_mutex_unlock(&mutexe);
}


void sighandler(int sigset)
{
	struct sched_param schedp;

	if (sigset == SIGHUP)
		return;
	if (sigset == SIGPIPE)
		return;
	fprintf(stderr, "LCR: Signal received: %d\n", sigset);
	PDEBUG(DEBUG_LOG, "Signal received: %d\n", sigset);
	/* reset signals */
	signal(SIGINT,SIG_DFL);
	signal(SIGHUP,SIG_DFL);
	signal(SIGTERM,SIG_DFL);
	signal(SIGPIPE,SIG_DFL);
	if (!quit) {
		quit = sigset;
		/* set scheduler & priority */
		if (options.schedule > 1) {
			memset(&schedp, 0, sizeof(schedp));
			schedp.sched_priority = 0;
			sched_setscheduler(0, SCHED_OTHER, &schedp);
		}
	}
}


/*
 * the main
 */
int main(int argc, char *argv[])
{
#if 0
	double			now_d, last_d;
	int			all_idle;
#endif
	int			ret = -1;
	int			lockfd = -1; /* file lock */
	struct lcr_msg		*message;
	int			i;
	struct sched_param	schedp;
	int			created_mutexd = 0,/* created_mutext = 0,*/ created_mutexe = 0,
        			created_lock = 0, created_signal = 0, created_message = 0;
#ifdef WITH_MISDN
	int			created_misdn = 0;
#endif
	char			tracetext[256], lock[128];
	char			options_error[256];
	int			polling = 0;

#if 0
	/* init fdset */
	memset(lcr_fdset, 0, sizeof(lcr_fdset));
#endif

	/* lock LCR process */
//	pthread_mutex_lock(&mutex_lcr);

	/* show version */
	printf("\n** %s  Version %s\n\n", NAME, VERSION_STRING);

	/* show options */
	if (argc <= 1) {
		usage:
		printf("\n");
		printf("Usage: lcr (query | start | fork | rules | route)\n");
		printf("query     = Show available isdn ports.\n");
		printf("start     = Run lcr normally, abort with CTRL+C.\n");
		printf("fork      = Do daemon fork and run as background process.\n");
		printf("interface = Get help of available interface syntax.\n");
		printf("rules     = Get help of available routing rule syntax.\n");
		printf("rules [action] = Get individual help for given action.\n");
//		printf("route = Show current routing as it is parsed.\n");
		printf("\n");
		ret = 999;
		goto free;
	}

#ifdef WITH_CRYPT
	/* init crc */
	crc_init();
#endif

	/* the mutex init */
	if (pthread_mutex_init(&mutexd, NULL)) {
		fprintf(stderr, "cannot create 'PDEBUG' mutex\n");
		goto free;
	}
	created_mutexd = 1;
//	if (pthread_mutex_init(&mutext, NULL)) {
//		fprintf(stderr, "cannot create 'trace' mutex\n");
//		goto free;
//	}
//	created_mutext = 1;
	if (pthread_mutex_init(&mutexe, NULL)) {
		fprintf(stderr, "cannot create 'PERROR' mutex\n");
		goto free;
	}
	created_mutexe = 1;

	/* show interface */
	if (!(strcasecmp(argv[1],"interface"))) {
		doc_interface();
		ret = 0;
		goto free;
	}

	/* show rules */
	if (!(strcasecmp(argv[1],"rules"))) {
		if (argc <= 2)
			doc_rules(NULL);
		else
			doc_rules(argv[2]);
		ret = 0;
		goto free;
	}

	/* query available isdn ports */
	if (!(strcasecmp(argv[1],"query"))) {
		int rc;
		fprintf(stderr, "-> Using 'misdn_info'\n");
		rc = system("misdn_info");
		ret = 0;
		goto free;
	}

	/* read options */
	if (read_options(options_error) == 0) {
		PERROR("%s", options_error);
		goto free;
	}
	polling = options.polling;

#ifdef WITH_MISDN
	/* init mISDN */
	if (mISDN_initialize() < 0)
		goto free;
	created_misdn = 1;
#endif

	/* read ruleset(s) */
	if (!(ruleset_first = ruleset_parse()))
		goto free;

	/* set pointer to main ruleset */
	ruleset_main = getrulesetbyname("main");
	if (!ruleset_main) {
		fprintf(stderr, "\n***\n -> Missing 'main' ruleset, causing ALL calls to be disconnected.\n***\n\n");
		PDEBUG(DEBUG_LOG, "Missing 'main' ruleset, causing ALL calls to be disconnected.\n");
		sleep(2);
	}

#if 0
	/* query available isdn ports */
	if (!(strcasecmp(argv[1],"route"))) {
		ruleset_debug(ruleset_first);
		ret = 0;
		goto free;
	}
#endif

	/* do fork in special cases */
	if (!(strcasecmp(argv[1],"fork"))) {
		pid_t pid;
		FILE *pidfile;

		/* do daemon fork */
		pid = fork();

		if (pid < 0) {
			fprintf(stderr, "Cannot fork!\n");
			goto free;
		}
		if (pid != 0) {
			exit(0);
		}
		usleep(200000);
		printf("\n");
		
		/* do second fork */
		pid = fork();

		if (pid < 0) {
			fprintf(stderr, "Cannot fork!\n");
			goto free;
		}
		if (pid != 0) {
			printf("LCR: Starting daemon.\n");
			exit(0);
		}
		nooutput = 1;

		/* write pid file */
		SPRINT(lock, "%s/lcr.pid", options.lock);
		pidfile = fopen(lock,"w");
		if (pidfile) {
			fprintf(pidfile, "%d\n", getpid());
			fclose(pidfile);
		} else
			fprintf(stderr, "Failed to create PID file: %s\n", lock);
	} else
	/* if not start */
	if (!!strcasecmp(argv[1],"start")) {
		goto usage;
	}

	/* create lock and lock! */
	SPRINT(lock, "%s/lcr.lock", options.lock);
	if ((lockfd = open(lock, O_CREAT | O_WRONLY, S_IWUSR)) < 0) {
		fprintf(stderr, "Cannot create lock file: %s\n", lock);
		fprintf(stderr, "Check options.conf to change to path with permissions for you.\n");
		goto free;
	}
	if (flock(lockfd, LOCK_EX|LOCK_NB) < 0) {
		if (errno == EWOULDBLOCK)
			fprintf(stderr, "LCR: Another LCR process is running. Please kill the other one.\n");
		else	fprintf(stderr, "Locking process failed: errno=%d\n", errno);
		goto free;
	}
	created_lock = 1;

	/* initialize admin socket */
	if (admin_init()) {
		fprintf(stderr, "Unable to initialize admin socket.\n");
		goto free;
	}

	/* generate alaw / ulaw tables */
	generate_tables(options.law);

#ifdef WITH_SIP
	/* init SIP globals */
	sip_init();
	polling = 1; /* must poll, because of SIP events */
#endif

#ifdef WITH_SS5
	/* init ss5 sine tables */
	ss5_sine_generate();
	ss5_test_decode();
#endif

	/* load tones (if requested) */
	if (fetch_tones() == 0) {
		fprintf(stderr, "Unable to fetch tones into memory.\n");
		goto free;
	}

#if defined WITH_GSM_BS || defined WITH_GSM_MS
	/* init gsm */
	if (gsm_init()) {
		fprintf(stderr, "GSM initialization failed.\n");
		goto free;
	}
#endif
#if 0
init is done when interface is up
#ifdef WITH_GSM_BS
	if (gsm_bs_init()) {
		fprintf(stderr, "GSM BS initialization failed.\n");
		goto free;
	}
#endif
#endif
#ifdef WITH_GSM_MS
	if (gsm_ms_init()) {
		fprintf(stderr, "GSM MS initialization failed.\n");
		goto free;
	}
#endif

	/* read interfaces and open ports */
	if (!read_interfaces()) {
		PERROR_RUNTIME("No interfaces specified or failed to parse interface.conf.\n");
		fprintf(stderr, "No interfaces specified or failed to parse interface.conf.\n");
		goto free;
	}
	relink_interfaces();
	interface_first = interface_newlist;
	interface_newlist = NULL;
	
	/* locking memory paging */
	i = 0;
	while(i < 10) {
		if (mlockall(MCL_CURRENT | MCL_FUTURE) >= 0)
			break;
		usleep(200000);
		i++;
	}
	if (i == 10) {
		switch(errno) {
			case ENOMEM:
			fprintf(stderr, "Warning: Not enough memory to lock paging.\n");
			break;
			case EPERM:
			fprintf(stderr, "Warning: No permission to lock paging.\n");
			break;
			case EFAULT:
			fprintf(stderr, "Warning: 'Bad address' while locking paging.\n");
			break;
			default:
			fprintf(stderr, "Warning: Unknown error %d while locking paging.\n", errno);
		}
	}

	/* set real time scheduler & priority */
	if (options.schedule > 1) {
		memset(&schedp, 0, sizeof(schedp));
		schedp.sched_priority = options.schedule;
		ret = sched_setscheduler(0, SCHED_RR, &schedp);
		if (ret < 0) {
			PERROR("Scheduling failed with given priority %d (errno = %d).\nCheck options.conf 'schedule', exitting...\n", options.schedule, errno);
			goto free;
		}
	}

	/* signal handlers */	
	signal(SIGINT,sighandler);
	signal(SIGHUP,sighandler);
	signal(SIGTERM,sighandler);
	signal(SIGPIPE,sighandler);
	created_signal = 1;

	/* init message */
	init_message();
	created_message = 1;

	/*** main loop ***/
	SPRINT(tracetext, "%s %s started, waiting for calls...", NAME, VERSION_STRING);
	start_trace(-1, NULL, NULL, NULL, 0, 0, 0, tracetext);
	printf("%s\n", tracetext);
	end_trace();
	quit = 0;
#if 0
	GET_NOW();
#endif
	while(!quit) {
#if 0
		last_d = now_d;
		GET_NOW();
		if (now_d-last_d > 1.0) {
			PERROR("LCR was stalling %d.%d seconds\n", ((int)((now_d-last_d)*10.0))/10, (int)((now_d-last_d)*10.0));
		}
		/* all loops must be counted from the beginning since nodes might get freed during handler */
		all_idle = 1;

		/* must be processed after all queues, so they are empty */
		if (select_main(1, NULL, NULL, NULL))
			all_idle = 0;
		if (all_idle) {
			usleep(10000);
		}
#else
		if (options.polling) {
			if (!select_main(1, NULL, NULL, NULL)) {
#ifdef WITH_SIP
				/* FIXME: check if work was done */
				sip_handle();
#endif
				usleep(10000);
			}
		} else
			select_main(0, NULL, NULL, NULL);
#endif
	}
	SPRINT(tracetext, "%s terminated", NAME);
	printf("%s\n", tracetext);
	start_trace(-1, NULL, NULL, NULL, 0, 0, 0, tracetext);
	if (quit > 0)
		add_trace((char *)"signal", NULL, "%d", quit);
	if (quit < 0)
		add_trace((char *)"errno", NULL, "%d", quit);
	end_trace();
	ret=0;

	/* free all */
free:

	/* set scheduler & priority
	 */
	if (options.schedule > 1) {
		memset(&schedp, 0, sizeof(schedp));
		schedp.sched_priority = options.schedule;
		sched_setscheduler(0, SCHED_OTHER, &schedp);
	}
	/* reset signals */
	if (created_signal) {
		signal(SIGINT,SIG_DFL);
		signal(SIGHUP,SIG_DFL);
		signal(SIGTERM,SIG_DFL);
		signal(SIGPIPE,SIG_DFL);
	}

	/* destroy objects */
	while(port_first) {
		debug_count++;
		delete port_first;
	}
	while(epoint_first) {
		debug_count++;
		delete epoint_first;
	}
	epoint_first = NULL;
	debug_count++;
	join_free();

	/* free interfaces */
	if (interface_first)
		free_interfaces(interface_first);
	interface_first = NULL;

#ifdef WITH_MISDN
	/* close isdn ports */
	mISDNport_close_all();
#endif

	/* flush messages */
	debug_count++;
	i = 0;
	while ((message = message_get())) {
		i++;
		message_free(message);
	}
	if (i) {
		PDEBUG(DEBUG_MSG, "freed %d pending messages\n", i);
	}

	/* clean messages */
	if (created_message)
		cleanup_message();

	/* free tones */
	if (toneset_first)
		free_tones();

	/* free admin socket */
	admin_cleanup();

	/* close lock */
	if (created_lock)
		flock(lockfd, LOCK_UN);
	if (lockfd >= 0) {
		chmod(lock, 0700);
		unlink(lock);
		close(lockfd);
	}

	/* free rulesets */
	if (ruleset_first)
		ruleset_free(ruleset_first);
	ruleset_first = NULL;

	/* free mutex */
	if (created_mutexe)
		if (pthread_mutex_destroy(&mutexe))
			fprintf(stderr, "cannot destroy 'PERROR' mutex\n");
//	if (created_mutext)
//		if (pthread_mutex_destroy(&mutext))
//			fprintf(stderr, "cannot destroy 'trace' mutex\n");
	if (created_mutexd)
		if (pthread_mutex_destroy(&mutexd))
			fprintf(stderr, "cannot destroy 'PDEBUG' mutex\n");

#ifdef WITH_MISDN
	/* deinitialize mISDN */
	if (created_misdn)
		mISDN_deinitialize();
#endif

	/* free gsm */
#if 0
exit is done when interface is down
#ifdef WITH_GSM_BS
	gsm_bs_exit(0);
#endif
#endif
#ifdef WITH_GSM_MS
	gsm_ms_exit(0);
#endif
#if defined WITH_GSM_BS || defined WITH_GSM_MS
	gsm_exit(0);
#endif

#ifdef WITH_SIP
	/* cleanup SIP globals */
	sip_exit();
#endif

#ifdef WITH_MISDN
	/* close loopback, if used by GSM or remote */
	if (mISDNloop.sock > -1)
		mISDNloop_close();
#endif

	/* display memory leak */
#define MEMCHECK(a, b) \
	if (b) { \
		SPRINT(tracetext, a, NAME); \
		start_trace(-1, NULL, NULL, NULL, 0, 0, 0, tracetext); \
		if (ret) add_trace("blocks", NULL, "%d", b); \
		end_trace(); \
		printf("\n******************************\n\007"); \
		printf("\nERROR: %d %s\n", b, a); \
		printf("\n******************************\n"); \
		ret = -1; \
	}
	MEMCHECK("",memuse)
	MEMCHECK("memory block(s) left (port.cpp ...)",pmemuse)
	MEMCHECK("memory block(s) left (epoint*.cpp ...)",ememuse)
	MEMCHECK("memory block(s) left (join*.cpp)",cmemuse)
	MEMCHECK("memory block(s) left (message.c)",mmemuse)
	MEMCHECK("memory block(s) left (route.c)",rmemuse)
	MEMCHECK("memory block(s) left (args)",amemuse)
	MEMCHECK("class(es) left",classuse)
	MEMCHECK("file descriptor(s) left",fduse)
	MEMCHECK("file handler(s) left",fhuse)

	/* unlock LCR process */
//	pthread_mutex_unlock(&mutex_lcr);

	/* take me out */
	return(ret);
}