using System;
using System.Text;
using System.Linq;
using System.Drawing;
using System.Diagnostics;
using System.Windows.Forms;
using System.Threading;
using System.Threading.Tasks;
using System.Collections.Generic;
using Tango.PMR.Stubs;
using Tango.Stubs;

include "..\..\Defines\Tango_Defines_Basic.cs"
include "Tango_Defines_SSI.cs"
//include "C:\To_Backup\Mulberry\Mulberry_current\Customers\Twine\Tango\LAB_Tests\Main_PCB\ATP_Test\Scripts\Defines\Tango_Defines_Basic.cs"
//include "C:\To_Backup\Mulberry\Mulberry_current\Customers\Twine\Tango\LAB_Tests\Main_PCB\ATP_Test\Scripts\Defines\Tango_Defines_SSI.cs"


public void OnExecute(StubManager stubManager)
{
	int k = 0;
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg1, 0);
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg2, 0);	
	
	//Set output clock frequency to about 200 kHz
	Fpga_Write_Reg(FPGA1, F1_Prescaler1_reg1, 0x0024, 0);
	Fpga_Write_Reg(FPGA1, F1_Prescaler1_reg2, 0x0024, 0);
	
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg1, 0);
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg2, 0);

	for (int i = 0; i < 1000; i++)
	{

		stubManager.Write(ReadEncoder_Dryer() +"\n");

		Thread.Sleep(100);
	}
	
	
}

Int32 ReadEncoder_Dryer()
{
	Int32 temp;
	Int32 temp1;
	stubManager.Run<StubFpgaWriteRegResponse>("StubFpgaWriteRegRequest" ,0x6000019e, 0x0000);		//triggers a TX transmission

	var response = stubManager.Run<StubFpgaReadRegResponse>("StubFpgaReadRegRequest" ,0x60000190);
	var response1 = stubManager.Run<StubFpgaReadRegResponse>("StubFpgaReadRegRequest" ,0x60000192);		 

	temp =  Convert.ToInt32 (((((response1.Value <<16) + 	response.Value)>>10 ) & 0x3fff));

	return temp;
}