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;

//----------------------
const Int32 I2C_ID =  2;
//const Int32 I2C_Slave_Add = 0x46; //must be 0x40, 0x44 or 0x46
//----------------------

private const string FILE_PATH = "D:\\MidTankPressurelog.txt";

int adc_configuration(uint I2C_Slave_Add,uint channel ) 
	{
	StubI2CWriteBytesRequest stubI2CWriteBytesRequest = new StubI2CWriteBytesRequest();
	stubI2CWriteBytesRequest.I2CId = I2C_ID;
	stubI2CWriteBytesRequest.SlaveAddress = I2C_Slave_Add;
	
	UInt32 uInt32 = new UInt32();
	stubI2CWriteBytesRequest.BytesTWrite.Add(0x00);//Byte 0 to write
	stubI2CWriteBytesRequest.BytesTWrite.Add(channel);//Byte 1 to Write, must be 0x80, 0x40, 0x20, 0x10, 0x08, 0x04, 0x02 or 0x01 for different channels
	stubI2CWriteBytesRequest.BytesTWrite.Add(0x80);//Byte 2 to Write
	
	var response = stubManager.Run<StubI2CWriteBytesResponse>(stubI2CWriteBytesRequest);
	
	return 1;
	}




int adc_set_for_read_temp(uint I2C_Slave_Add) 
	{
	StubI2CWriteBytesRequest stubI2CWriteBytesRequest = new StubI2CWriteBytesRequest();
	stubI2CWriteBytesRequest.I2CId = I2C_ID;
	stubI2CWriteBytesRequest.SlaveAddress = I2C_Slave_Add;
	
	UInt32 uInt32 = new UInt32();
	stubI2CWriteBytesRequest.BytesTWrite.Add(0x02);//Byte 0 to write

	var response = stubManager.Run<StubI2CWriteBytesResponse>(stubI2CWriteBytesRequest);
	
	return 1;
	}




int adc_read_temp(uint I2C_Slave_Add) 
	{

	StubI2CReadBytesRequest stubI2CReadBytesRequest = new StubI2CReadBytesRequest();
	stubI2CReadBytesRequest.I2CId = I2C_ID;
	stubI2CReadBytesRequest.SlaveAddress = I2C_Slave_Add;
	stubI2CReadBytesRequest.NumberOfBytesToRead = 2; // Number of bytes to read

	var response1 = stubManager.Run<StubI2CReadBytesResponse>(stubI2CReadBytesRequest);
	
	for(int i=0; i<stubI2CReadBytesRequest.NumberOfBytesToRead;i++)
			{
				stubManager.WriteLineHex(response1.ReadBytes[i],2);
			}
	
	
	return 1;
	}




int adc_set_for_read_ch(uint I2C_Slave_Add) 
	{
	StubI2CWriteBytesRequest stubI2CWriteBytesRequest = new StubI2CWriteBytesRequest();
	stubI2CWriteBytesRequest.I2CId = I2C_ID;
	stubI2CWriteBytesRequest.SlaveAddress = I2C_Slave_Add;
	
	UInt32 uInt32 = new UInt32();
	stubI2CWriteBytesRequest.BytesTWrite.Add(0x01);//Byte 0 to write

	var response = stubManager.Run<StubI2CWriteBytesResponse>(stubI2CWriteBytesRequest);
	
	return 1;
	}


int adc_read_ch(uint ID, uint I2C_Slave_Add) 
	{
	StubI2CReadBytesRequest stubI2CReadBytesRequest = new StubI2CReadBytesRequest();
	stubI2CReadBytesRequest.I2CId = I2C_ID;
	stubI2CReadBytesRequest.SlaveAddress = I2C_Slave_Add;
	stubI2CReadBytesRequest.NumberOfBytesToRead = 2; // Number of bytes to read

	var response1 = stubManager.Run<StubI2CReadBytesResponse>(stubI2CReadBytesRequest);
	uint temph=0;
	uint templ=0;
	uint temp;
	double calc;
	double calc1;
	double calc2;
	double calc3;
	double calc4;
	
	
	for(int i=0; i<stubI2CReadBytesRequest.NumberOfBytesToRead;i=i+2)
			{
								
				temph=response1.ReadBytes[i];
				templ=response1.ReadBytes[i+1];
				temp = (temph << 8) | templ;
				temp=temp & 0x0fff;
				stubManager.WriteHex(temp,4);
				
				calc = (double)temp *2.5 / 4096.0;
				stubManager.Write("ADC [volts]:              ");
				stubManager.WriteLine(calc);
		
				calc1 = (1.96- calc) * 4.64 + 1.96;
				stubManager.Write("Vsensor [volts]:          ");
				stubManager.WriteLine(calc1);
		
				calc2 = ((calc1/5)-0.5)/(0.16/1);
				stubManager.Write("Pressure [pka]:          ");
				stubManager.WriteLine(calc2);
		
				calc3 = (calc2 * 1000.0) / (1060.0 *9.81);
				stubManager.Write("Liquid High [meter]:     ");
				stubManager.WriteLine(calc3);
		
				calc4 = 3.1415*((0.11 - 0.0126) / 2.0) * ((0.11 - 0.0126) / 2.0) * calc3 * 1000.0;
				stubManager.Write("Liquid volume [litter]:  ");
				stubManager.WriteLine(calc4);
				
				stubManager.AppendToFile(FILE_PATH,ID.ToString()+ "     "+temp.ToString("X4") + "         "+calc.ToString("F4")+ "        "+ calc1.ToString("F4")+ "           "+calc2.ToString("F4")+ "          "+calc3.ToString("F4")+ "               "+calc4.ToString("F4"));
			}
	
	return 1;
	}


public void OnExecute(StubManager stubManager)
{
	stubManager.WriteToFile(FILE_PATH, "\n-----------MIDTANK_PRESSESENS----------- \n\n");	
	stubManager.AppendToFile(FILE_PATH, "ID    ADC[bits]    ADC[volts]    Vsensor[volts]    Pressure[pka]    Liquid High[meter]    Liquid volume[litter]");	
	//for (int i = 0; i<3000; i++)
	while(true)
	{
	

		stubManager.Write("\n-----------MIDTANK_PRESSESENS----------- ");
		

		stubManager.Write("\n1_1= "); 
		adc_configuration(0x44,0x20);		//a2d_address 0x44 channel channel 2
		adc_set_for_read_ch(0x44);
		adc_read_ch(1,0x44);
	
		stubManager.Write("\n1_2= "); 
		adc_configuration(0x44,0x10);		//a2d_address 0x44 channel channel 3
		adc_set_for_read_ch(0x44);
		adc_read_ch(5,0x44);

		stubManager.Write("\n2_1= "); 
		adc_configuration(0x44,0x08);		//a2d_address 0x44 channel channel 4
		adc_set_for_read_ch(0x44);
		adc_read_ch(2,0x44);

		stubManager.Write("\n2_2= "); 
		adc_configuration(0x44,0x04);		//a2d_address 0x44 channel channel 5
		adc_set_for_read_ch(0x44);
		adc_read_ch(6,0x44);

		stubManager.Write("\n3_1= "); 
		adc_configuration(0x46,0x80);		//a2d_address 0x46 channel channel 0
		adc_set_for_read_ch(0x46);
		adc_read_ch(3,0x46);

		stubManager.Write("\n3_2= "); 
		adc_configuration(0x46,0x40);		//a2d_address 0x46 channel channel 1
		adc_set_for_read_ch(0x46);
		adc_read_ch(7,0x46);

		stubManager.Write("\n4_1= "); 
		adc_configuration(0x46,0x20);		//a2d_address 0x46 channel channel 2
		adc_set_for_read_ch(0x46);
		adc_read_ch(4,0x46);


		stubManager.Write("\n4_2= "); 
		adc_configuration(0x46,0x10);		//a2d_address 0x46 channel channel 3
		adc_set_for_read_ch(0x46);
		adc_read_ch(8,0x46);
		
		stubManager.AppendToFile(FILE_PATH, "" );
		
		Thread.Sleep(5000);		

	}
}