// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright 2020 Aspeed Technology Inc.
 */
#include <stdio.h>
#include <sys/ioctl.h>
#include <sys/types.h>
#include <fcntl.h>
#include <unistd.h>
#include <errno.h>
#include <stdlib.h>
#include <getopt.h>
#include <string.h>
#include <termios.h>

#include <sys/mman.h>
#include "ast-jtag.h"
#include "svf.h"

#define ERROR_OK                        (0)
#define ERROR_NO_CONFIG_FILE            (-2)
#define ERROR_BUF_TOO_SMALL             (-3)
#define ERROR_FAIL                      (-4)
#define ERROR_WAIT                      (-5)
#define ERROR_TIMEOUT_REACHED           (-6)

enum { LOG_TRACE, LOG_DEBUG, LOG_INFO, LOG_WARN, LOG_ERROR, LOG_FATAL };
int loglevel = LOG_WARN;

static void
usage(FILE *fp, int argc, char **argv)
{
	if(0)
	{
		argc = argc;
	}
	fprintf(fp,
			"Usage: %s [options]\n\n"
			"Options:\n"
			" -h | --help                   Print this message\n"
			" -d | --debug                  Set log level, default = 3\n"
			" -n | --node                   jtag device node\n"
			" -f | --frequency              frequency\n"
			" -p | --play                   play SVF file\n"
			" -s | --software               software mode\n"
			"",
			argv[0]);
}

static const char short_options [] = "hsd:n:f:p:";



static const struct option
	long_options [] = {
	{ "help",		no_argument,		NULL,	'h' },
	{ "debug",		required_argument,	NULL,	'd' },
	{ "node",		required_argument,	NULL,	'n' },
	{ "fequency",	required_argument,	NULL,	'f' },
	{ "play",		required_argument,	NULL,	'p' },
	{ "software",   no_argument,		NULL,	's' },
	{ 0, 0, 0, 0 }
};

/*********************************************************************************/

#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))


/*************************************************************************************/
int main(int argc, char *argv[])
{
	int  ret;
	char option;
	char svf_name[100] = "";
	char dev_name[100] = "";
	int svf = 0;
	unsigned int freq = 0;
	unsigned int jtag_freq = 0;
	uint8_t sw_mode = 0;

	while ((option = getopt_long(argc, argv, short_options, long_options, NULL)) != (char) -1) {
		switch (option) {
		case 'h':
			usage(stdout, argc, argv);
			exit(EXIT_SUCCESS);
			break;
		case 'd':
			loglevel = atol(optarg);
			printf("loglevel %d\n", loglevel);
			break;
		case 'n':
			strcpy(dev_name, optarg);
			if (!strcmp(dev_name, "")) {
				printf("No dev file name!\n");
				usage(stdout, argc, argv);
				exit(EXIT_FAILURE);
			}
			break;
		case 'f':
			freq = atol(optarg);
			printf("frequency %d\n", freq);
			break;
		case 'p':
			svf = 1;
			strcpy(svf_name, optarg);
			if (!strcmp(svf_name, "")) {
				printf("No out file name!\n");
				usage(stdout, argc, argv);
				exit(EXIT_FAILURE);
			}
			break;
		case 's':
			sw_mode = 1;
			break;
		default:
			usage(stdout, argc, argv);
			exit(EXIT_FAILURE);
		}
	}
	if (!svf){
		usage(stdout, argc, argv);
		exit(EXIT_FAILURE);
	}
#if 1
	if (ast_jtag_open(dev_name))
		exit(1);

	ast_set_jtag_mode(sw_mode);
	//show current ast jtag configuration
	jtag_freq = ast_get_jtag_freq();

	if (jtag_freq == 0) {
		perror("Jtag freq error !! \n");
		goto out;
	}

	if (freq) {
		ast_set_jtag_freq(freq);
		printf("JTAG Set Freq %d\n", freq);
	} else {
		printf("JTAG Freq %d\n", jtag_freq);
	}
#endif
	if (svf) {
		printf("Playing %s \n", svf_name);
		ret = handle_svf_command(svf_name);
		if (ret == ERROR_OK) {
			printf("Success!\n");
		} else {
			printf("Error: %d\n", ret);
		}
	}

out:
	ast_jtag_close();

	return 0;
}