public void AsyncReceiveData(KObject data)
{
GoDataSet dataset = (GoDataSet)data;
for (UInt32 i = 0; i < dataset.Count; i++)
{
GoDataMsg dataObj = (GoDataMsg)dataset.Get(i);
switch (dataObj.MessageType)
{
case GoDataMessageType.Stamp:
{
GoStampMsg stampMsg = (GoStampMsg)dataObj;
for (UInt32 j = 0; j < stampMsg.Count; j++)
{
GoStamp stamp = stampMsg.Get(j);
getStamp.FrameIndex = stamp.FrameIndex;
getStamp.Timestamp = stamp.Timestamp;
getStamp.Encoder = stamp.Encoder;
get_stamp_FrameIndex.Add(stamp.FrameIndex);
get_stamp_TimeStamp.Add(stamp.Timestamp);
get_stamp_EncoderValue.Add(stamp.Encoder);
}
dataReceivedFlag.Stamp = 1;
}
break;
case GoDataMessageType.Measurement:
{
GoMeasurementMsg measurementMsg = (GoMeasurementMsg)dataObj;
for (UInt32 k = 0; k < measurementMsg.Count; k++)
{
GoMeasurementData measurementData = measurementMsg.Get(k);
getMeasurement.Id = measurementMsg.Id;
getMeasurement.value = measurementData.Value;
getMeasurement.decison = measurementData.Decision;
get_measurementMsg_Id.Add(measurementMsg.Id);
get_measurementMsg_Value.Add(measurementData.Value);
get_measurementMsg_Decison.Add(measurementData.Decision);
}
dataReceivedFlag.Measurement = 1;
}
break;
case GoDataMessageType.Alignment:
{
GoAlignMsg dataItem = (GoAlignMsg)dataSet.Get(i);
if (dataItem.Status == KStatus.Ok)
{
calibrationSuccessfulBl = true;
}
else
{
calibrationSuccessfulBl = false;
}
}
break;
}
}
}
public void onData(KObject data)
{
GoDataSet dataSet = (GoDataSet)data;
//var dataWithID = new Dictionary<string, string>();
for (UInt32 i = 0; i < dataSet.Count; i++)
{
GoDataMsg dataObj = (GoDataMsg)dataSet.Get(i);
switch (dataObj.MessageType)
{
case GoDataMessageType.Stamp:
{
GoStampMsg stampMsg = (GoStampMsg)dataObj;
for (UInt32 j = 0; j < stampMsg.Count; j++)
{
GoStamp stamp = stampMsg.Get(j);
//Console.WriteLine("Frame Index = {0}", stamp.FrameIndex);
//Console.WriteLine("Time Stamp = {0}", stamp.Timestamp);
//Console.WriteLine("Encoder Value = {0}", stamp.Encoder);
}
}
break;
case GoDataMessageType.Measurement:
{
GoMeasurementMsg measurementMsg = (GoMeasurementMsg)dataObj;
for (UInt32 k = 0; k < measurementMsg.Count; ++k)
{
GoMeasurementData measurementData = measurementMsg.Get(k);
//Console.WriteLine("ID: {0}", measurementMsg.Id);
//Console.WriteLine("Value: {0}", measurementData.Value);
//Console.WriteLine("Decision: {0}", measurementData.Decision);
//dataWithID.Add(measurementMsg.Id.ToString(), measurementData.Value.ToString());
}
}
break;
}
}
Publish(new LMIData()); //TODO Data Shell
}
public void onData(KObject data)
{
bDataSaved = false;
double yPoint = 1;
string strWrite = "";
bool length_incr = true;
GoDataSet dataSet = (GoDataSet)data;
DataContext context = new DataContext();
for (UInt32 i = 0; i < dataSet.Count; i++)
{
GoDataMsg dataObj = (GoDataMsg)dataSet.Get(i);
switch (dataObj.MessageType)
{
case GoDataMessageType.Stamp:
{
GoStampMsg stampMsg = (GoStampMsg)dataObj;
for (UInt32 j = 0; j < stampMsg.Count; j++)
{
GoStamp stamp = stampMsg.Get(j);
//Console.WriteLine("Frame Index = {0}", stamp.FrameIndex);
//Console.WriteLine("Time Stamp = {0}", stamp.Timestamp);
//Console.WriteLine("Encoder Value = {0}", stamp.Encoder);
}
}
break;
case GoDataMessageType.Surface: // Surface
{
GoSurfaceMsg surfaceMsg = (GoSurfaceMsg)dataObj;
long width = surfaceMsg.Width;
long height = surfaceMsg.Length;
long bufferSize = width * height;
IntPtr bufferPointer = surfaceMsg.Data;
short[] ranges = new short[bufferSize];
Marshal.Copy(bufferPointer, ranges, 0, ranges.Length);
context.xResolution = (double)surfaceMsg.XResolution / 1000000.0;
context.zResolution = (double)surfaceMsg.ZResolution / 1000000.0;
context.yResolution = (double)surfaceMsg.YResolution / 1000000.0;
context.yOffset = (double)surfaceMsg.YOffset / 1000.0;
context.xOffset = (double)surfaceMsg.XOffset / 1000.0;
context.zOffset = (double)surfaceMsg.ZOffset / 1000.0;
double phy_x;
double phy_y;
double phy_z;
FileStream fs = new FileStream(strFileSave, FileMode.Create);
StreamWriter sw = new StreamWriter(fs);
for (int m = 0; m < height; m++)
{
for (int j = 0; j < width; j++)
{
phy_z = ranges[m * width + j] * context.zResolution + context.zOffset;
if (/*phy_z > 20*/ true) //这个过滤阈值根据实际情况选取
{
phy_x = j * context.xResolution + context.xOffset;
phy_y = m * context.yResolution + context.yOffset;
strWrite = string.Format("{0} {1} {2}", phy_x, phy_y, phy_z);
sw.WriteLine(strWrite);
}
}
}
sw.Flush();
//关闭流
sw.Close();
fs.Close();
}
break;
case GoDataMessageType.Profile:
{
StreamWriter write = new StreamWriter(strFileSave, true);
GoProfileMsg profileMsg = (GoProfileMsg)dataObj;
Console.WriteLine(" Profile Message batch count: {0}", profileMsg.Count);
for (UInt32 k = 0; k < profileMsg.Count; ++k)
{
int validPointCount = 0;
long profilePointCount = profileMsg.Width;
Console.WriteLine(" Item[{0}]: Profile data ({1} points)", i, profileMsg.Width);
context.xResolution = (profileMsg.XResolution / 1000000.0);
context.zResolution = profileMsg.ZResolution / 1000000.0;
context.xOffset = profileMsg.XOffset / 1000.0;
context.zOffset = profileMsg.ZOffset / 1000.0;
GoPoints[] points = new GoPoints[profilePointCount];
point[] point111 = new point[profilePointCount];
ProfilePoint[] profileBuffer = new ProfilePoint[profilePointCount];
int structSize = Marshal.SizeOf(typeof(GoPoints));
IntPtr pointsPtr = profileMsg.Data;
for (UInt32 array = 0; array < profilePointCount; ++array)
{
IntPtr incPtr = new IntPtr(pointsPtr.ToInt64() + array * structSize);
points[array] = (GoPoints)Marshal.PtrToStructure(incPtr, typeof(GoPoints));
double real_x = (context.xOffset + context.xResolution * points[array].x);
double real_z = (context.zOffset + context.zResolution * points[array].y);
if (length_incr == true)
{
length += 1; //ReadIniSettings.ReadIni.objIniValue.iniScanner.step;
length_incr = false;
}
if (real_z > 60 && real_z < 800)
{
write.WriteLine(real_x + " " + length + " " + real_z);
}
}
write.Flush();
}
write.Close();
}
break;
case GoDataMessageType.ProfileIntensity:
{
GoProfileIntensityMsg profileMsg = (GoProfileIntensityMsg)dataObj;
Console.WriteLine(" Profile Intensity Message batch count: {0}", profileMsg.Count);
for (UInt32 k = 0; k < profileMsg.Count; ++k)
{
byte[] intensity = new byte[profileMsg.Width];
IntPtr intensityPtr = profileMsg.Data;
Marshal.Copy(intensityPtr, intensity, 0, intensity.Length);
}
}
break;
case GoDataMessageType.Measurement: // Measurement
{
GoMeasurementMsg measurementMsg = (GoMeasurementMsg)dataObj;
}
break;
}
}
bDataSaved = true;
}
static int Main(string[] args)
{
try
{
KApiLib.Construct();
GoSdkLib.Construct();
GoSystem system = new GoSystem();
GoSensor sensor;
KIpAddress ipAddress = KIpAddress.Parse(Constants.SENSOR_IP);
GoDataSet dataSet = new GoDataSet();
sensor = system.FindSensorByIpAddress(ipAddress);
sensor.Connect();
system.EnableData(true);
system.Start();
// refer to SetupMeasurement.cs for setting up of the measurement tools
dataSet = system.ReceiveData(30000000);
for (UInt32 i = 0; i < dataSet.Count; i++)
{
GoDataMsg dataObj = (GoDataMsg)dataSet.Get(i);
switch (dataObj.MessageType)
{
case GoDataMessageType.Stamp:
{
GoStampMsg stampMsg = (GoStampMsg)dataObj;
for (UInt32 j = 0; j < stampMsg.Count; j++)
{
GoStamp stamp = stampMsg.Get(j);
Console.WriteLine("Frame Index = {0}", stamp.FrameIndex);
Console.WriteLine("Time Stamp = {0}", stamp.Timestamp);
Console.WriteLine("Encoder Value = {0}", stamp.Encoder);
}
}
break;
case GoDataMessageType.Measurement:
{
GoMeasurementMsg measurementMsg = (GoMeasurementMsg)dataObj;
for (UInt32 k = 0; k < measurementMsg.Count; ++k)
{
GoMeasurementData measurementData = measurementMsg.Get(k);
Console.WriteLine("ID: {0}", measurementMsg.Id);
Console.WriteLine("Value: {0}", measurementData.Value);
Console.WriteLine("Decision: {0}", measurementData.Decision);
}
}
break;
}
}
system.Stop();
}
catch (KException ex)
{
Console.WriteLine("Error: {0}", ex.Status);
}
// wait for ESC key
Console.WriteLine("\nPress ENTER to continue");
do
{
System.Threading.Thread.Sleep(100);
} while (Console.Read() != (int)ConsoleKey.Enter);
return(1);
}
