因工作需要,近期对SICK进行了数据提取与分析,将过程描述如下(最后有代码下载地址):
提取:LMS511有网络接口,通过发送命令的方式即可提取数据,提取的数据可以保存到记事本中。具体网上搜一下即可。
推荐使用有人的串口、网口调试助手,还是很好用的。这个公司竟然和我同城
提取后的数据放到记事本中,如下图所示:
关于数据的格式,网上有说明,可以去查询详细了解下,引用关键部分如下:
下一步开始写程序,对数据转换和分析。用C#写了段分析代码。写的过程中参考了网上一段python的代码。解析代码还是很简单的,就几行,涉及到了数据转换和极坐标转换。这里最终分析的其实就是那些距离数据。
private void button2_Click(object sender, EventArgs e)
{
string s = File.ReadAllText("d:\\123.txt");
var ss = s.Split('@');
for (int j = 1; j < ss.Count(); j++)
{
string s1 = "";
string s2 = "";
var data = ss[j].Split(' ');
int factors = 1;
if (data[21] == "40000000")
factors = 2;
var startangle = Convert.ToInt32(data[23], 16) / 10000;
// '''角度分辨率'''
double ang = Convert.ToInt32(data[24], 16);
double anglestep = ang / 10000;
// '''数据总量'''
int datanum = Convert.ToInt32(data[25], 16);
PointF[] pts = new PointF[datanum];
s1 += "数据总量:" + datanum+"\t\n"+"起始角度:"+startangle+"\t\n"+"角度分辨率:"+anglestep+"\t\n"+"数据内容:\t\n";
s2 += "数据总量:" + datanum + "\t\n" + "起始角度:" + startangle + "\t\n" + "角度分辨率:" + anglestep + "\t\n" + "数据内容:\t\n"; ;
for (int i = 0; i < datanum; i++)
{
var dd = Convert.ToInt32(data[26 + i], 16);
s1 +=dd.ToString()+ " ";
double x = Convert.ToInt32(data[26 + i], 16) * factors * Math.Cos((startangle + i * anglestep) / 180 * Math.PI) / 1000;
double y = Convert.ToInt32(data[26 + i], 16) * factors * Math.Sin((startangle + i * anglestep) / 180 * Math.PI) / 1000;
s2 += x+" "+y+"\t\n";
pts[i].X = (float)x * 100;
pts[i].Y = (float)y * 100;
}
richTextBox1.AppendText(s1+"\t\n");
richTextBox2.AppendText(s2 + "\t\n");
}
}
需要注意的是代码里用@进行了分割,实际提取出来的数据是不包含@的,我为了处理方便,将开头的sRA替换成了@,另存为了一个记事本。分析后的数据如下:
看解析后的数据什么都看不出来,我们还是选取其中的几帧,用图形表示出来比较好。再写一段绘制的代码,根据转换后的坐标直接绘制即可了 。绘制后的图形如下:
对比实际的地形图,还是有那么点意思的,哈哈 。当然要想数据准确,还需要进行帧间匹配算法再处理。