/* FXAnalise data provider which directly interfaces with the KK FX80E counter */

#include <ansi_c.h>
#include <userint.h>
#include <formatio.h>
#include <utility.h>
#include <inifile.h>

#include "data-provider.h"
#include "KKFX80E.h"

#define CONFIGFILE "FXAnalise.ini"
#define DEFAULTPORT "COM4:115200"
#define TIMEOUT 1 /* seconds */

#define strneq(a, b, len) (strncmp((a), (b), (len)) == 0)

int CVICALLBACK KKDataProvider (void *functionData)
{
	int mainThreadId;
	int rv;
	char *resp;
	struct event event;
	char port[256];
	
	/* get main thread id to post messages to it */
	mainThreadId = CmtGetMainThreadID();
	
	/* construct configuration file path */ 
	char pathname[MAX_PATHNAME_LEN];
	char project[MAX_PATHNAME_LEN];
	GetProjectDir(project); 
	MakePathname(project, CONFIGFILE, pathname);

	/* load configuration file */ 
	IniText configuration = Ini_New(TRUE);
	Ini_ReadFromFile(configuration, pathname);

	/* get serial port name configuration */
	rv = Ini_GetStringIntoBuffer(configuration, "KK", "port", port, sizeof(port));
	if (! rv)
		strncpy(port, DEFAULTPORT, sizeof(port));
	
	/* free */ 
	Ini_Dispose(configuration);

	/* initialize library */
	FX_Init();
	
	/* connect to KK FX80E counter */
	rv = FX_Open(port);
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	
	/* clear transmit buffer */
	rv = FX_Send("\x80");
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	rv = FX_Recv(&resp, TIMEOUT);
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	
	/* set report interval 1sec */
	rv = FX_Send("\x29");
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	rv = FX_Recv(&resp, TIMEOUT);
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	
	/* read 4 channels */
	rv = FX_Send("\x34");
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	rv = FX_Recv(&resp, TIMEOUT);
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	
	/* set mode to instantaneous frequency measurement */
	rv = FX_Send("\x42");
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	rv = FX_Recv(&resp, TIMEOUT);
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	
	/* switch scrambler off */
	rv = FX_Send("\x50");
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	rv = FX_Recv(&resp, TIMEOUT);
	if (! rv) {
		SendMessage(mainThreadId, FX_Error());
		goto error;
	}
	
	while (acquiring) {
		/* receive data from counter */
		FX_Recv(&resp, TIMEOUT);
		if (! resp) {
			SendMessage(mainThreadId, FX_Error());
			break;
		}
		
		if (strneq(resp, "2900", 4)) {
			
			/* timestamp */
			gettimeofday(&event.time, NULL);
			
			/* parse received data */
			Scan(resp, "2900; %f; %f; %f; %f",
				&event.data[0], &event.data[1], &event.data[2], &event.data[3]);
			
			/* convert from kHz to Hz */
			event.data[0] *= 1000.0;
			event.data[1] *= 1000.0;
			event.data[2] *= 1000.0;
			event.data[3] *= 1000.0;
			
			/* push data into the data queue */
			CmtWriteTSQData(dataQueue, &event, 1, TSQ_INFINITE_TIMEOUT, 0);
		
		} else if (strneq(resp, "7000", 4)) {
			/* ignore heart beat packet */
		} else if (strneq(resp, "7015", 4)) {
			/* ignore undocumented packet. it is sent by newer kk counters
			   for each data packet. it probably contains a sample count along
			   with some other information */
		} else if (strneq(resp, "7020", 4)) {
			/* undocumented packet. it probably reports the header for
			   subsequent data packets. match it against expected value  */
			if (strcmp(resp + 6, "$2900")) {
				SendMessage(mainThreadId, "KK Counter: %s", resp);
			}
		} else {
			/* send message to the main thread */
			SendMessage(mainThreadId, "KK Counter: %s", resp);
		}
	}
	
error:
	/* close serial port */
	FX_Close();
	/* free allocated resources */
	FX_Free();
	
	return 0;
}