/*! \file gclibo.c
*
* Partial implementation of gclibo.h
*
*/

#include "gclibo.h"

void GCALL GSleep(unsigned int timeout_ms)
{
	GUtility(0, G_UTIL_SLEEP, &timeout_ms, 0);
}

GReturn GCALL GVersion(GCStringOut ver, GSize ver_len)
{
	return GUtility(0, G_UTIL_VERSION, ver, &ver_len);
}

GReturn GCALL GInfo(GCon g, GCStringOut info, GSize info_len)
{
	return GUtility(g, G_UTIL_INFO, info, &info_len);
}

GReturn GCALL GAddresses(GCStringOut addresses, GSize addresses_len)
{
	return GUtility(0, G_UTIL_ADDRESSES, addresses, &addresses_len);
}

GReturn GCALL GTimeout(GCon g, short timeout_ms)
{
	return GUtility(g, G_UTIL_TIMEOUT_OVERRIDE, &timeout_ms, 0);
}

GReturn GCALL GAssign(char* ip, char* mac)
{
	return GUtility(0, G_UTIL_ASSIGN, ip, mac);
}

GReturn GCALL GIpRequests(GCStringOut requests, GSize requests_len)
{
	return GUtility(0, G_UTIL_IPREQUEST, requests, &requests_len);
}

GReturn GCALL GCmd(GCon g, GCStringIn command)
{
	char buf[SMALLBUF]; //response usually brief, e.g. :
	GSize read;
	return GCommand(g, command, buf, SMALLBUF, &read);
}

GReturn GCALL GCmdT(GCon g, GCStringIn command, GCStringOut trimmed_response, GSize response_len, GCStringOut* front)
{
	GSize read;
	GReturn rc;
	int i;
	char c;
	if ((rc = GCommand(g, command, trimmed_response, response_len, &read)) != G_NO_ERROR)
		return rc;
	//if here, the data is already null-terminated, just trim.
	for (i = read - 1; i >= 0; i--) //read does NOT include null terminator.
	{
		c = trimmed_response[i];
		if ((c == ':') || (c == '\n') || (c == '\r'))
			trimmed_response[i] = 0; //trim it
		else
			break; //we hit non-trimmable data, bail out.
	}

	if (front) //null to skip "trim" on front.
	{
		*front = trimmed_response;
		i = 0;
		do
		{
			c = trimmed_response[i++];
			if (c == ' ')
				(*front)++;
			else
				break;
		} while (1); //exit will be any non-space, including null terminator
	}

	return G_NO_ERROR;
}

GReturn GCALL GCmdI(GCon g, GCStringIn command, int* value)
{
	char buf[SMALLBUF]; //response should be ~19 chars
	GSize read;
	GReturn rc;
	if ((rc = GCommand(g, command, buf, SMALLBUF, &read)) != G_NO_ERROR)
		return rc;
	*value = atoi(buf);
	return G_NO_ERROR;
}

GReturn GCALL GCmdD(GCon g, GCStringIn command, double* value)
{
	char buf[SMALLBUF]; //response should be ~19 chars
	GSize read;
	GReturn rc;
	if ((rc = GCommand(g, command, buf, SMALLBUF, &read)) != G_NO_ERROR)
		return rc;
	*value = atof(buf);
	return G_NO_ERROR;
}

GReturn GCALL GMotionComplete(GCon g, GCStringIn axes)
{

	char buf[SMALLBUF]; //response should be ~19 chars.
	char cmd[] = "MG_BGm"; //command for polling the axis' motion status, m is a place holder replaced below.
	GSize read;
	GReturn rc;
	GSize i = 0; //C, not C++
	GSize len = strlen(axes);

	for (i = 0; i < len; i++) //iterate through all chars in axes
	{
		cmd[5] = axes[i]; //set the axis
	poll:
		if ((rc = GCommand(g, cmd, buf, SMALLBUF, &read)) != G_NO_ERROR)
			return rc;
		if (atoi(buf))
		{
			GSleep(POLLINGINTERVAL);
			goto poll;
		}
	}// for

	return G_NO_ERROR;
}

GReturn GCALL GRecordRate(GCon g, double period_ms)
{
	char buf[SMALLBUF];
	double dt;
	double period_arg;

	if (period_ms == 0) //turn off
		return GCmd(g, "DR 0");

	if (GCmdD(g, "TM?", &dt) == G_NO_ERROR)
	{
		dt /= 1024.0; //ms per controller sample
		if (!dt) dt = 1; //don't want to divide by zero below
	}
	else
	{
		dt = 0.9765625; //RIO doesn't have TM
	}

	period_arg = period_ms / dt; //data record specified in samples between records

	if (GCmdT(g, "\x12\x16", buf, sizeof(buf), 0) == G_NO_ERROR) //Revision string, ^R^V
	{
		if (strstr(buf, "DMC18")) //PCI controller
			period_arg = log(period_arg) / log(2.0); //PCI DR arg is 2^n.
		else if ((strstr(buf, "DMC40") != NULL) //4000
			|| (strstr(buf, "DMC500") != NULL) //50000
			|| (strstr(buf, "RIO") != NULL)) // RIO
		{
			if (period_arg < 2) period_arg = 2; //lowest non-zero DR
		}
		else if ((strstr(buf, "DMC41") != NULL) || (strstr(buf, "DMC21") != NULL)) //4103, 2103
		{
			if (period_arg < 8) period_arg = 8; //lowest non-zero DR
		}
		else if ((strstr(buf, "DMC3") != NULL)) //30010, 31010
		{
			if (period_arg < 4) period_arg = 4; //lowest non-zero DR
		}
	}
	
	sprintf(buf, "DR %d", (int)period_arg);
	return GCmd(g, buf);
}

GReturn GCALL GProgramDownloadFile(GCon g, GCStringIn file_path, GCStringIn preprocessor)
{
	FILE *file;
	long file_size;
	char* program_buffer;
	GReturn rc = G_NO_ERROR;

	if (!(file = fopen(file_path, "rb"))) //open file for reading, binary mode
		return G_BAD_FILE;

	fseek(file, 0, SEEK_END); //find end of file
	file_size = ftell(file); //add one to null terminate below
	rewind(file);

	if (file_size) //don't malloc 0.
	{

		if (!(program_buffer = malloc(file_size + 1))) //allocate memory for the data, +1 for null termination below
		{
			fclose(file);
			return G_BAD_FULL_MEMORY;
		}

		if (file_size != fread(program_buffer, 1, file_size, file))
		{
			fclose(file);
			free(program_buffer); //free memory
			return G_BAD_FILE;
		}
		program_buffer[file_size] = 0; //null terminate, malloc was one byte larger for this
	}
	else
	{
		program_buffer = ""; //nullstring
	}

	fclose(file); //done with file, close it

	rc = GProgramDownload(g, program_buffer, preprocessor); //call the gclib downloader
	if (file_size) free(program_buffer); //free memory
	return rc;
}

GReturn GCALL GProgramUploadFile(GCon g, GCStringIn file_path)
{
	FILE *file;
	GReturn rc = G_NO_ERROR;
	char* program_buffer;
	long file_size;

	if (!(file = fopen(file_path, "wb"))) //open file for writing, binary mode
		return G_BAD_FILE;

	if (!(program_buffer = malloc(MAXPROG))) //allocate memory for the data
	{
		fclose(file);
		return G_BAD_FULL_MEMORY;
	}

	if ((rc = GProgramUpload(g, program_buffer, MAXPROG)) == G_NO_ERROR)
	{
		file_size = strlen(program_buffer);
		if (file_size != fwrite(program_buffer, 1, file_size, file))
			rc = G_BAD_FILE;
	}

	fclose(file);
	free(program_buffer);
	return rc;
}


void GCALL GError(GReturn rc, GCStringOut error, GSize error_len)
{
	char* error_message;

	switch (rc)
	{
	case G_NO_ERROR:
		error_message = G_NO_ERROR_S;
		break;

	case G_GCLIB_ERROR:
		error_message = G_GCLIB_ERROR_S;
		break;

	case G_GCLIB_UTILITY_ERROR:
		error_message = G_GCLIB_UTILITY_ERROR_S;
		break;

	case G_GCLIB_UTILITY_IP_TAKEN:
		error_message = G_GCLIB_UTILITY_IP_TAKEN_S;
		break;

	case G_GCLIB_NON_BLOCKING_READ_EMPTY:
		error_message = G_GCLIB_NON_BLOCKING_READ_EMPTY_S;
		break;

	case G_TIMEOUT:
		error_message = G_TIMEOUT_S;
		break;

	case G_OPEN_ERROR:
		error_message = G_OPEN_ERROR_S;
		break;

	case G_COMMAND_CALLED_WITH_ILLEGAL_COMMAND:
		error_message = G_COMMAND_CALLED_WITH_ILLEGAL_COMMAND_S;
		break;

	case G_DATA_RECORD_ERROR:
		error_message = G_DATA_RECORD_ERROR_S;
		break;

	case G_UNSUPPORTED_FUNCTION:
		error_message = G_UNSUPPORTED_FUNCTION_S;
		break;

	case G_BAD_ADDRESS:
		error_message = G_BAD_ADDRESS_S;
		break;

	case G_FIRMWARE_LOAD_NOT_SUPPORTED:
		error_message = G_FIRMWARE_LOAD_NOT_SUPPORTED_S;
		break;

	case G_ARRAY_NOT_DIMENSIONED:
		error_message = G_ARRAY_NOT_DIMENSIONED_S;
		break;

	case G_ILLEGAL_DATA_IN_PROGRAM:
		error_message = G_ILLEGAL_DATA_IN_PROGRAM_S;
		break;

	case G_UNABLE_TO_COMPRESS_PROGRAM_TO_FIT:
		error_message = G_UNABLE_TO_COMPRESS_PROGRAM_TO_FIT_S;
		break;

	case G_INVALID_PREPROCESSOR_OPTIONS:
		error_message = G_INVALID_PREPROCESSOR_OPTIONS_S;
		break;

	case G_BAD_RESPONSE_QUESTION_MARK:
		error_message = G_BAD_RESPONSE_QUESTION_MARK_S;
		break;

	case G_BAD_VALUE_RANGE:
		error_message = G_BAD_VALUE_RANGE_S;
		break;

	case G_BAD_FULL_MEMORY:
		error_message = G_BAD_FULL_MEMORY_S;
		break;

	case G_BAD_LOST_DATA:
		error_message = G_BAD_LOST_DATA_S;
		break;

	case G_BAD_FILE:
		error_message = G_BAD_FILE_S;
		break;

	default:
		error_message = "internal error";
		break;
	}

	strncpy(error, error_message, error_len);
	error[error_len - 1] = 0; //ensure null termination
}