#include <utility.h>

//==============================================================================
//
// Title:       DDS4xAD9912.c
// Purpose:     
//
// Created on:  by Volodimer Laurent, modified by YLC
// Copyright:   syrte. All Rights Reserved.
//
//==============================================================================

//==============================================================================
// Include files

#include "DDS4xAD9912.h"
#include <userint.h>
#include <tcpsupp.h>
#include <ansi_c.h>

//==============================================================================
// Global functions

static int OnTCPEvent(unsigned handle, int xType, int errCode, void *callbackData)
	{
	switch(xType)
		{
		case TCP_DISCONNECT :
			break;
		case TCP_DATAREADY :
			ClientTCPRead (handle, Response, sizeof(Response), 0);
			break;
		}
		return 0;
	}


//==============================================================================
// DDS4xAD9912_SendCmd
//
// FUNC   : envoie une chaine de caracteres sur un port du serveur TCP/IP de la foxboard
// PARAM  : DDSNum contient le numero de la DDS (1,2,3 ou 4)
// PARAM  : Buffer contenant la chaîne de caractères à envoyer
// RETURN : 0 si la connexion et l'ecriture sur le serveur TCP/IP sont OK
//==============================================================================


static int DDS4xAD9912_SendCmd(int DDSNum, char * Buffer)
{
	int port = 0;
	int rv;

	switch (DDSNum) {
		case 1:
			port = Port1;
			break;
		case 2:
			port = Port2;
			break;
		case 3:
			port = Port3;
			break;
		case 4:
			port = Port4;
			break;
		default:
			return -1;
	}
	
	rv = ConnectToTCPServer(&hConv, port, Adress, OnTCPEvent, 0, 0);
	if (rv < 0) {
		MessagePopup("DDS4xAD9912", "Connection to server failed!");
		return rv;
	}
	
	rv = ClientTCPWrite(hConv, Buffer, strlen(Buffer)+1, 0);
	if (rv < 0) {
		MessagePopup("DDS Serveur", "Write to server failed!");
	}
	
	DisconnectFromTCPServer(hConv);
	
	return rv;
}


//==============================================================================
// DDS4xAD9912_Reset
//
// FUNC   : reset des 4 DDS
// PARAM  :
// RETURN : 0 si le reset de la DDS 1 , DDS 2, DDS3 et DDS4 est OK
//==============================================================================

 int DDS4xAD9912_Reset(DDS4xAD9912_Data * Instance)
 	{
	int res_1,res_2;
	
	sprintf(Request,"set;%i;%i",1,17);
	res_1 = DDS4xAD9912_SendCmd(1,Request) ;
	if(res_1 <0) {
		MessagePopup("DDS Serveur", "DDS4xAD9912_1 Reset failed !") ;
		}
	else Instance->Frequency1 = 0.0 ;
	
	sprintf(Request,"set;%i;%i",1,17);
	res_2 = DDS4xAD9912_SendCmd(2,Request) ; 	 
	if(res_2 <0) {
		MessagePopup("DDS Serveur", "DDS4xAD9912_2 Reset failed !") ;
		}
	else Instance->Frequency2 = 0.0;

	 sprintf(Request,"set;%i;%i",1,17);
	res_2 = DDS4xAD9912_SendCmd(3,Request) ; 	 
	if(res_2 <0) {
		MessagePopup("DDS Serveur", "DDS4xAD9912_3 Reset failed !") ;
		}
	else Instance->Frequency3 = 0.0;
	
	 sprintf(Request,"set;%i;%i",1,17);
	res_2 = DDS4xAD9912_SendCmd(4,Request) ; 	 
	if(res_2 <0) {
		MessagePopup("DDS Serveur", "DDS4xAD9912_4 Reset failed !") ;
		}
	else Instance->Frequency4 = 0.0;
	
	
	return (res_1+res_2);	 
 	}	 


//==============================================================================
// DDS4xAD9912_SetFreq
//
// FUNC   : sort une fréquence sur la DDS1 ,DDS2, DDS3 ou DDS4
// PARAM  : DDSNum contient le numero de la DDS (1, 2 , 3 ou 4)
// RETURN : 0 si la connexion et l'ecriture sur le serveur TCP/IP sont OK
//============================================================================== 
int DDS4xAD9912_SetFrequency(DDS4xAD9912_Data * Instance, int DDSNum, double Freq)
	{
		
	double Word=WORD(Freq,Clk) ;
	double reste ;
	int res_0 ;
	unsigned char b5,b4,b3,b2,b1,b0 ; 

	b5=(unsigned char)(Word/E40);		
	b4=(unsigned char)((Word - E40*b5)/E32);
	b3=(unsigned char)((Word - E40*b5 - E32*b4)/E24);
	b2=(unsigned char)((Word - E40*b5 - E32*b4 - E24*b3)/E16); 
	b1=(unsigned char)((Word - E40*b5 - E32*b4 - E24*b3 - E16*b2)/E8);
	b0=(unsigned char)((Word - E40*b5 - E32*b4 - E24*b3 - E16*b2 - E8*b1)/1.0);
	reste = (Word - E40*b5 -E32*b4 -E24*b3 -E16*b2 -E8*b1-1.0*b0) ;

	sprintf(Request,"set;%i;%i;%i;%i;%i;%i;%i;%i",0,10,b5,b4,b3,b2,b1,b0); 
	res_0 = DDS4xAD9912_SendCmd(DDSNum, Request) ;
	if (res_0 <0) {
		MessagePopup("DDS Serveur", "SetFrequency function failed !") ;
		}
	else {
		if (DDSNum==1) Instance->Frequency1 = Freq - reste*Clk/E48 ;
		if (DDSNum==2) Instance->Frequency2 = Freq - reste*Clk/E48 ;
		if (DDSNum==3) Instance->Frequency3 = Freq - reste*Clk/E48 ;
		if (DDSNum==4) Instance->Frequency4 = Freq - reste*Clk/E48 ;
		} ;
	  	
	sprintf(Request,"set;%i;%i",0,18); // IO_Update logiciel 
	res_0 = DDS4xAD9912_SendCmd(DDSNum, Request) ;
	if (res_0 <0) {
		MessagePopup("DDS Serveur", "IO_Update function failed !") ;
		}
	return(res_0) ;
	
	} 

 
/* 
 * ramp DDS frequency from `f1` to `f2` in steps of `fstep` 
 * with a delay of 0.01 seoconds after each step
 */
int DDS4xAD9912_RampFrequency2(DDS4xAD9912_Data *dds, int channel, double f1, double f2, double fstep)
{
	const double delay = 0.01;
	
	/* f2 > f1 */
	while ((f2 - f1) > fstep) {
		f1 += fstep;
		DDS4xAD9912_SetFrequency(dds, channel, f1);
		Delay(delay);
	}
	
	/* f2 < f1 */
	while ((f1 - f2) > fstep) {
		f1 -= fstep;
		DDS4xAD9912_SetFrequency(dds, channel, f1);
		Delay(delay);
	}
	
	/* final adjustment */
	DDS4xAD9912_SetFrequency(dds, channel, f2);
	return 0;
}


/* 
 * ramp DDS frequency from the current frequency to `f2` in steps
 * of `fstep` with a delay of 0.01 seoconds after each step
 */
int DDS4xAD9912_RampFrequency(DDS4xAD9912_Data *dds, int channel, double f2, double fstep)
{
	double f1 = DDS4xAD9912_GetFrequency(dds, channel);
	return DDS4xAD9912_RampFrequency2(dds, channel, f1, f2, fstep);
}


double DDS4xAD9912_GetFrequency(DDS4xAD9912_Data *dds, int channel)
{
	switch (channel) {
		case 1:
			return dds->Frequency1;
		case 2:
			return dds->Frequency2;
		case 3:
			return dds->Frequency3;
		case 4:
			return dds->Frequency4;
		default:
			return 0.0;
	}
}