1 files changed, 310 insertions, 0 deletions
diff --git a/src/fl2k_test.c b/src/fl2k_test.c
new file mode 100644
index 0000000..ee2753d
--- /dev/null
+++ b/src/fl2k_test.c
@@ -0,0 +1,310 @@
+/*
+ * osmo-fl2k, turns FL2000-based USB 3.0 to VGA adapters into
+ * low cost DACs
+ *
+ * Copyright (C) 2016-2018 by Steve Markgraf <steve@steve-m.de>
+ *
+ * based on rtl_test:
+ * 
+ * Copyright (C) 2012-2014 by Steve Markgraf <steve@steve-m.de>
+ * Copyright (C) 2012-2014 by Kyle Keen <keenerd@gmail.com>
+ * Copyright (C) 2014 by Michael Tatarinov <kukabu@gmail.com>
+ *
+ * SPDX-License-Identifier: GPL-2.0+
+ *
+ * This program 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.
+ *
+ * This program 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 this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <errno.h>
+#include <signal.h>
+#include <string.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <math.h>
+
+#ifdef __APPLE__
+#include <sys/time.h>
+#else
+#include <time.h>
+#endif
+
+#ifndef _WIN32
+#include <unistd.h>
+#else
+#include <windows.h>
+#include "getopt/getopt.h"
+#endif
+
+#include "osmo-fl2k.h"
+
+#define DEFAULT_SAMPLE_RATE		100000000
+#define PPM_DURATION			10
+#define PPM_DUMP_TIME			1
+
+struct time_generic
+	/* holds all the platform specific values */
+{
+#ifndef _WIN32
+	time_t tv_sec;
+	long tv_nsec;
+#else
+	long tv_sec;
+	long tv_nsec;
+	int init;
+	LARGE_INTEGER frequency;
+	LARGE_INTEGER ticks;
+#endif
+};
+
+static int do_exit = 0;
+static fl2k_dev_t *dev = NULL;
+
+static uint32_t samp_rate = DEFAULT_SAMPLE_RATE;
+static unsigned int ppm_duration = PPM_DURATION;
+
+static char *buffer;
+static int cb_cnt = 0;
+
+void usage(void)
+{
+	fprintf(stderr,
+		"fl2k_test, clock accuracy test for FL2K VGA dongles,\n"
+		"also outputs a square wave at fs/2\n\n"
+		"Usage:\n"
+		"\t[-d device_index (default: 0)]\n"
+		"\t[-s samplerate (default: 100 MS/s)]\n"
+	);
+	exit(1);
+}
+
+#ifdef _WIN32
+BOOL WINAPI
+sighandler(int signum)
+{
+	if (CTRL_C_EVENT == signum) {
+		fprintf(stderr, "Signal caught, exiting!\n");
+		fl2k_stop_tx(dev);
+		do_exit = 1;
+		return TRUE;
+	}
+	return FALSE;
+}
+#else
+static void sighandler(int signum)
+{
+	fprintf(stderr, "Signal caught, exiting!\n");
+	fl2k_stop_tx(dev);
+	do_exit = 1;
+}
+#endif
+
+#ifndef _WIN32
+static int ppm_gettime(struct time_generic *tg)
+{
+	int rv = ENOSYS;
+	struct timespec ts;
+
+#ifdef __unix__
+	rv = clock_gettime(CLOCK_MONOTONIC, &ts);
+	tg->tv_sec = ts.tv_sec;
+	tg->tv_nsec = ts.tv_nsec;
+#elif __APPLE__
+	struct timeval tv;
+
+	rv = gettimeofday(&tv, NULL);
+	ts->tv_sec = tv.tv_sec;
+	ts->tv_nsec = tv.tv_usec * 1000;
+#endif
+	return rv;
+}
+#endif
+
+#ifdef _WIN32
+static int ppm_gettime(struct time_generic *tg)
+{
+	int rv;
+	int64_t frac;
+	if (!tg->init) {
+		QueryPerformanceFrequency(&tg->frequency);
+		tg->init = 1;
+	}
+	rv = QueryPerformanceCounter(&tg->ticks);
+	tg->tv_sec = tg->ticks.QuadPart / tg->frequency.QuadPart;
+	frac = (int64_t)(tg->ticks.QuadPart - (tg->tv_sec * tg->frequency.QuadPart));
+	tg->tv_nsec = (long)(frac * 1000000000L / (int64_t)tg->frequency.QuadPart);
+	return !rv;
+}
+#endif
+
+static int ppm_report(uint64_t nsamples, uint64_t interval)
+{
+	double real_rate, ppm;
+
+	real_rate = nsamples * 1e9 / interval;
+	ppm = 1e6 * (real_rate / (double)samp_rate - 1.);
+	return (int)round(ppm);
+}
+
+static void ppm_test(uint32_t len)
+{
+	static uint64_t nsamples = 0;
+	static uint64_t interval = 0;
+	static uint64_t nsamples_total = 0;
+	static uint64_t interval_total = 0;
+	static struct time_generic ppm_now;
+	static struct time_generic ppm_recent;
+
+	static enum {
+		PPM_INIT_NO,
+		PPM_INIT_DUMP,
+		PPM_INIT_RUN
+	} ppm_init = PPM_INIT_NO;
+
+	ppm_gettime(&ppm_now);
+
+	if (ppm_init != PPM_INIT_RUN) {
+		/*
+		* Kyle Keen wrote:
+		* PPM_DUMP_TIME throws out the first N seconds of data.
+		* The dongle's PPM is usually very bad when first starting up,
+		* typically incorrect by more than twice the final value.
+		* Discarding the first few seconds allows the value to stabilize much faster.
+		*/
+		if (ppm_init == PPM_INIT_NO) {
+			ppm_recent.tv_sec = ppm_now.tv_sec + PPM_DUMP_TIME;
+			ppm_init = PPM_INIT_DUMP;
+			return;
+		}
+		if (ppm_init == PPM_INIT_DUMP && ppm_recent.tv_sec < ppm_now.tv_sec)
+			return;
+		ppm_recent = ppm_now;
+		ppm_init = PPM_INIT_RUN;
+		return;
+	}
+	nsamples += (uint64_t)len;
+	interval = (uint64_t)(ppm_now.tv_sec - ppm_recent.tv_sec);
+	if (interval < ppm_duration)
+		return;
+	interval *= 1000000000UL;
+	interval += (int64_t)(ppm_now.tv_nsec - ppm_recent.tv_nsec);
+
+	nsamples_total += nsamples;
+	interval_total += interval;
+	printf("real sample rate: %i current PPM: %i cumulative PPM: %i\n",
+		(int)((1000000000UL * nsamples) / interval),
+		ppm_report(nsamples, interval),
+		ppm_report(nsamples_total, interval_total));
+	ppm_recent = ppm_now;
+	nsamples = 0;
+}
+
+void fl2k_callback(fl2k_data_info_t *data_info)
+{
+	/* drop first couple of callbacks until everything is settled */
+	if (cb_cnt > 20) {
+		ppm_test(FL2K_BUF_LEN);
+	} else {
+		/* as data is repetitive, it only needs to be handed
+		 * over until all transfer buffers contain the data */
+		data_info->r_buf = buffer;
+		cb_cnt++;
+	}
+
+}
+
+int main(int argc, char **argv)
+{
+#ifndef _WIN32
+	struct sigaction sigact;
+#endif
+	int r, opt, i;
+	uint32_t dev_index = 0;
+
+	while ((opt = getopt(argc, argv, "d:s:p::h")) != -1) {
+		switch (opt) {
+		case 'd':
+			dev_index = (uint32_t)atoi(optarg);
+			break;
+		case 's':
+			samp_rate = (uint32_t)atof(optarg);
+			break;
+		case 'p':
+			if (optarg)
+				ppm_duration = atoi(optarg);
+			break;
+		case 'h':
+		default:
+			usage();
+			break;
+		}
+	}
+
+	buffer = malloc(FL2K_BUF_LEN);
+	if (!buffer)
+		goto exit;
+
+	fl2k_open(&dev, (uint32_t)dev_index);
+	if (NULL == dev) {
+	fprintf(stderr, "Failed to open fl2k device #%d.\n", dev_index);
+		exit(1);
+	}
+
+#ifndef _WIN32
+	sigact.sa_handler = sighandler;
+	sigemptyset(&sigact.sa_mask);
+	sigact.sa_flags = 0;
+	sigaction(SIGINT, &sigact, NULL);
+	sigaction(SIGTERM, &sigact, NULL);
+	sigaction(SIGQUIT, &sigact, NULL);
+	sigaction(SIGPIPE, &sigact, NULL);
+#else
+	SetConsoleCtrlHandler( (PHANDLER_ROUTINE) sighandler, TRUE );
+#endif
+
+	/* initialize buffer with rect signal */
+	for (i = 0; i < FL2K_BUF_LEN; i += 2) {
+		buffer[i] = 0x00;
+		buffer[i+1] = 0xff;
+	}
+
+	r = fl2k_start_tx(dev, fl2k_callback, NULL, 0);
+
+	/* Set the sample rate */
+	r = fl2k_set_sample_rate(dev, samp_rate);
+	if (r < 0)
+		fprintf(stderr, "WARNING: Failed to set sample rate.\n");
+
+	samp_rate = fl2k_get_sample_rate(dev);
+
+	fprintf(stderr, "Reporting PPM error measurement every %u seconds...\n", ppm_duration);
+	fprintf(stderr, "Press ^C after a few minutes.\n");
+
+	while (!do_exit) {
+#ifndef _WIN32
+		usleep(500000);
+#else
+		Sleep(0.5);
+#endif
+	}
+
+	if (do_exit) {
+		fprintf(stderr, "\nUser cancel, exiting...\n");
+	}
+
+exit:
+	fl2k_close(dev);
+	free(buffer);
+
+	return 0;
+}