private void SaveDA()
{
//sleep 500 ms, then reset configuration
Thread.Sleep(600);
DeviceMgr.Action("daoutput", new byte[] { 0x55, 0x64, 0xfc, 0x00, 0x00, 0x00, 0x04 }); //set control
Thread.Sleep(100);
}
private bool ToResistance(Decimal resistance)
{
if (iRange < RangeMin || iRange > RangeMax) //invalide res case
{
ToDAValue(0);
//DeviceMgr.Action("daoutput", new Byte[] { 0x55, 0x64, 0xff, 0x00, 0x00, 0x00, 0x01 }); //just set to 0
return(DeviceMgr.success);
}
double va;
if (!CollectVoltage(out va))
{
return(false);
}
double volt = Convert.ToDouble(resistance);
if (iRange < RangeMin || iRange > RangeMax)
{
return(false);
}
volt = volt * va * FBCurrentScale;
Current = va * FBCurrentScale;
if (Current < -0.1) //current switch to negative
{
if (bPositive != -1)
{
DeviceMgr.Action("defcurrent", 0);
DeviceMgr.Action("negcurrent", 0);
DeviceMgr.Action("defcurrent", 0);
DeviceMgr.Action("negcurrent", 0);
DeviceMgr.Action("defcurrent", 0);
bPositive = -1;
}
}
if (Current > 0.1) //current switch to positive
{
if (bPositive != 1)
{
DeviceMgr.Action("defcurrent", 0);
DeviceMgr.Action("poscurrent", 0);
DeviceMgr.Action("defcurrent", 0);
DeviceMgr.Action("poscurrent", 0);
DeviceMgr.Action("defcurrent", 0);
bPositive = 1;
}
}
return(ToDAValue(Math.Abs(volt)));
}
public void ZeroON()
{
int i = 0;
while (i++ < 5)
{
double va;
if (CollectVoltage(out va))
{
if (Math.Abs(va) < 0.00001) // < 10uV
{
DeviceMgr.Action("navzero", 0);
}
break;
}
System.Threading.Thread.Sleep(1000);
}
}
private bool CollectVoltage(out double reading)
{
int badcount = 0; //count of bad communication
reading = 0;
while (badcount < 3)
{
DeviceMgr.Action("navread", 0);
if (DeviceMgr.reading < -999)
{
if (DeviceMgr.nav_range != "navto1v")
{
badcount++;
if (badcount < 3)
{
Thread.Sleep(500);
continue;
}
badcount = 0;
DeviceMgr.Action("navto1v", "");
Thread.Sleep(3000);
continue;
}
else
{
return(false);
}
}
else
{
}
if ((DeviceMgr.nav_range == "navto1v") && (Math.Abs(DeviceMgr.reading) < 0.10) && bOn)
{
badcount++;
if (badcount < 3)
{
Thread.Sleep(500);
continue;
}
badcount = 0;
DeviceMgr.Action("navto120mv", "");
Thread.Sleep(3000);
continue;
}
if (DeviceMgr.nav_range == "navto120mv")
{
datafilter.Enqueue(DeviceMgr.reading / 1000);
}
else
{
datafilter.Enqueue(DeviceMgr.reading);
}
/*old method
* if (datafilter.Count < 5)
* continue;
* double sqr;
* sqr = GetSqrt3(10);
* datafilter.Dequeue();
* if ((DeviceMgr.nav_range == "navto120mv") && (sqr > 0.05)) //1mV
* {
* badcount++;
* continue;
* }
* if ((DeviceMgr.nav_range == "navto1v") && (sqr > 0.05)) //10mv
* {
* badcount++;
* continue;
* }
* badcount = 0;
* reading = datafilter.Skip(2).Take(2).Average();
*/
if (datafilter.Count < 3)
{
continue;
}
if (datafilter.Count > 3)
{
datafilter.Dequeue();
}
double sqr;
sqr = datafilter.Max() - datafilter.Min();
if ((DeviceMgr.nav_range == "navto120mv") && (sqr > 0.001)) //1mV
{
badcount++;
continue;
}
if ((DeviceMgr.nav_range == "navto1v") && (sqr > 0.01)) //10mv
{
badcount++;
continue;
}
badcount = 0;
reading = datafilter.Average();
return(true);
}
return(false);
}
private bool ToDAValue(double voltage)
{
voltage = voltage; // nouse now / 2.0; //divide by 2 because hardware will multiple it with 2
double vrefp = 20.1; //20.1 volts reference //11;
double vrefn = 0;
// Vout = (Vrefp-Vrefn)*D/(2^20-1)+Vrefn => D= (Vout-Vrefn)*(2^20-1)/(Vrefp-Vrefn)
// when BUF is enabled , Vrefp = 10V; Vrefn = -10V; D = (Vout+10)*(2^20-1)/(20)
// If vrefn = 0 and vrefp = 10 then D = Vout*(2^20-1)/10;
byte[] tosend = new Byte[] { 0x55, 0x64, 0xff, 0x00, 0x00, 0x00, 0x01 };
byte[] tosend2 = new Byte[] { 0x55, 0x64, 0x55, 0xff, 0x00, 0x00, 0x00, 0x01 };//special case for 0x55 leading value
bool changed = false;
double volt = voltage - Convert.ToDouble(daoffset) + OPCurrentOffset;
if (Math.Abs(volt) > vrefp) //turn off output or invalid adreading
{
bOverLoad = true;
return(false);
}
bOverLoad = false;
Int32 d = Convert.ToInt32(Math.Round((volt - vrefn) * (1048576 - 1) / (vrefp - vrefn)));
tosend[5] = Convert.ToByte(d % 256); d = d / 256;
tosend2[6] = tosend[5];
if (tosend[5] != lasttosend[5])
{
lasttosend[5] = tosend[5];
changed = true;
}
tosend[4] = Convert.ToByte(d % 256);
tosend2[5] = tosend[4];
d = d / 256;
if (tosend[4] != lasttosend[4])
{
lasttosend[4] = tosend[4];
changed = true;
}
tosend[3] = Convert.ToByte(d % 256);
tosend2[4] = tosend[3];
if (tosend[3] != lasttosend[3])
{
lasttosend[3] = tosend[3];
changed = true;
}
tosend[2] = Convert.ToByte((256 * 3 - 1 - Convert.ToInt32(tosend[3] + tosend[4] + tosend[5])) % 256);
tosend2[3] = tosend[2];
if (changed)
{
if (tosend[2] == 0x55)
{
DeviceMgr.Action("daoutput", tosend2);
}
else
{
DeviceMgr.Action("daoutput", tosend);
}
return(DeviceMgr.success);
}
else
{
return(true);
}
}
private bool ToDAValue(double voltage)
{
// Vout = (Vrefp-Vrefn)*D/(2^20-1)+Vrefn => D= (Vout-Vrefn)*(2^20-1)/(Vrefp-Vrefn)
// when BUF is enabled , Vrefp = 10V; Vrefn = -10V; D = (Vout+10)*(2^20-1)/(20)
// D = Vout*(2^20-1)/10;
byte[] tosend = new Byte[] { 0x55, 0x64, 0xff, 0x00, 0x00, 0x00, 0x01 };
byte[] tosend2 = new Byte[] { 0x55, 0x64, 0x55, 0xff, 0x00, 0x00, 0x00, 0x01 };//special case for 0x55 leading value
bool changed = false;
double volt = voltage - Convert.ToDouble(daoffset) + OPCurrentOffset;
if (Math.Abs(volt) > 10) //turn off output or invalid adreading
{
return(false);
}
Int32 d = Convert.ToInt32(Math.Round((volt + 10) * (1048576 - 1) / 20.0));
tosend[5] = Convert.ToByte(d % 256); d = d / 256;
tosend2[6] = tosend[5];
if (tosend[5] != lasttosend[5])
{
lasttosend[5] = tosend[5];
changed = true;
}
tosend[4] = Convert.ToByte(d % 256);
tosend2[5] = tosend[4];
d = d / 256;
if (tosend[4] != lasttosend[4])
{
lasttosend[4] = tosend[4];
changed = true;
}
tosend[3] = Convert.ToByte(d % 256);
tosend2[4] = tosend[3];
if (tosend[3] != lasttosend[3])
{
lasttosend[3] = tosend[3];
changed = true;
}
tosend[2] = Convert.ToByte((256 * 3 - 1 - Convert.ToInt32(tosend[3] + tosend[4] + tosend[5])) % 256);
tosend2[3] = tosend[2];
if (changed)
{
if (tosend[2] == 0x55)
{
DeviceMgr.Action("daoutput", tosend2);
}
else
{
DeviceMgr.Action("daoutput", tosend);
}
return(DeviceMgr.success);
}
else
{
return(true);
}
}