/*
 * 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.
 */

#include <sys/time.h>
#include <sys/resource.h>
#include <getopt.h>
#include <pthread.h>
#include <sys/mman.h>
#include <xeno_config.h>
#include <rtdm/analogy.h>
#include "analogy_calibrate.h"
#include "calibration_ni_m.h"

struct timespec calibration_start_time;
a4l_desc_t descriptor;

static const struct option options[] = {
	{
#define help_opt	0
		.name = "help",
		.has_arg = no_argument,
	},
	{
#define device_opt	1
		.name = "device",
		.has_arg = required_argument,
	},
	{
#define output_opt	2
		.name = "output",
		.has_arg = required_argument,
	},
	{ /* Sentinel */ }
};

static void
print_usage(void)
{
	fprintf(stderr, "Usage: analogy_calibrate \n"
	       "  --help                  : this menu \n"
	       "  --device /dev/analogyX  : analogy device to calibrate \n"
	       "  --output filename       : calibration results \n"
	      );
}

static void __attribute__ ((constructor)) __analogy_calibrate_init(void)
{
	clock_gettime(CLOCK_MONOTONIC, &calibration_start_time);
}

/*
 *
 * the calibration file generated by the Analogy software calibrate utility is
 * not compatible with Comedi's despite holding the exact same information.
 *
 */
int main(int argc, char *argv[])
{
	char *device = NULL, *file = NULL;
	int v, i, fd, err = 0;
	FILE *p = NULL;

	for (;;) {
		i = -1;
		v = getopt_long_only(argc, argv, "", options, &i);
		if (v == EOF)
			break;
		switch (i) {
		case help_opt:
			print_usage();
			exit(0);
		case device_opt:
			device = optarg;
			break;
		case output_opt:
			file = optarg;
			p = fopen(file, "w+");
			__debug("calibration output: %s \n", file);
			break;
		default:
			print_usage();
			exit(EXIT_FAILURE);
		}
	}

	if (!p || !device)
		error(EXIT, errno, "missing input parameters");

	fd = a4l_open(&descriptor, device);
	if (fd < 0)
		error(EXIT, 0, "open %s failed (%d)", device, fd);

	err = ni_m_board_supported(descriptor.driver_name);
	if (err)
		error(EXIT, 0, "board %s: driver %s not supported",
		      descriptor.board_name, descriptor.driver_name);

	err = ni_m_software_calibrate(p);
	if (err)
		error(CONT, 0, "software calibration failed (%d)", err);

	a4l_close(&descriptor);

	return err;
}