/*
 * Analogy for Linux, calibration program
 *
 * Copyright (C) 2014 Jorge A. Ramirez-Ortiz <jro@xenomai.org>
 *
 * from original code from the Comedi project
 *
 * Xenomai is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * Xenomai is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with Xenomai; if not, write to the Free Software Foundation,
 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */


#ifndef __ANALOGY_CALIBRATE_H__
#define __ANALOGY_CALIBRATE_H__

#include <string.h>
#include <errno.h>
#include <stdio.h>
#include <unistd.h>
#include <stdlib.h>
#include <time.h>
#include "error.h"

extern struct timespec calibration_start_time;
extern a4l_desc_t descriptor;
extern FILE *cal;

#define ARRAY_LEN(a)  (sizeof(a) / sizeof((a)[0]))

#define RETURN	 1
#define CONT 	 0
#define EXIT	-1

#define error(action, code, fmt, ...) 						\
do {										\
       error_at_line(action, code, __FILE__, __LINE__, fmt, ##__VA_ARGS__ );	\
       if (action == RETURN) 							\
               return -1;							\
}while(0)

struct breakdown_time {
	int ms;
	int us;
	int ns;
};

static inline void do_time_breakdown(struct breakdown_time *p,
				     const struct timespec *t)
{
	unsigned long long ms, us, ns;

	ns = t->tv_sec * 1000000000ULL;
	ns += t->tv_nsec;
	ms = ns / 1000000ULL;
	us = (ns % 1000000ULL) / 1000ULL;

	p->ms = (int)ms;
	p->us = (int)us;
	p->ns = (int)ns;
}

static inline void timespec_sub(struct timespec *r,
				const struct timespec *__restrict t1,
				const struct timespec *__restrict t2)
{
	r->tv_sec = t1->tv_sec - t2->tv_sec;
	r->tv_nsec = t1->tv_nsec - t2->tv_nsec;
	if (r->tv_nsec < 0) {
		r->tv_sec--;
		r->tv_nsec += 1000000000;
	}
}

static inline void __debug(char *fmt, ...)
{
	struct timespec now, delta;
	struct breakdown_time tm;
	char *header, *msg;
	int hlen, mlen;
	va_list ap;
	__attribute__((unused)) int err;

	va_start(ap, fmt);

	clock_gettime(CLOCK_MONOTONIC, &now);
	timespec_sub(&delta, &now, &calibration_start_time);
	do_time_breakdown(&tm, &delta);

	hlen = asprintf(&header, "%4d\"%.3d.%.3d| ",
			tm.ms / 1000, tm.ms % 1000, tm.us);

	mlen = vasprintf(&msg, fmt, ap);

	err = write(fileno(stdout), header, hlen);
	err = write(fileno(stdout), msg, mlen);

	free(header);
	free(msg);

	va_end(ap);
}


static inline int __array_search(char *elem, const char *array[], int len)
{
	int i;

	for (i = 0; i < len; i++)
		if (strncmp(elem, array[i], strlen(array[i])) == 0)
			return 0;

	return -1;
}


static inline double rng_max(a4l_rnginfo_t *range)
{
	double a, b;
	b = A4L_RNG_FACTOR * 1.0;

	a = (double) range->max;
	a = a / b;
	return a;
}

static inline double rng_min(a4l_rnginfo_t *range)
{
	double a, b;

	b = A4L_RNG_FACTOR * 1.0;
	a = (double) range->min;
	a = a / b;
	return a;
}




#endif