因工作需要,近期对SICK进行了数据提取与分析,将过程描述如下(最后有代码下载地址):
提取:LMS511有网络接口,通过发送命令的方式即可提取数据,提取的数据可以保存到记事本中。具体网上搜一下即可。
推荐使用有人的串口、网口调试助手,还是很好用的。这个公司竟然和我同城
提取后的数据放到记事本中,如下图所示:
关于数据的格式,网上有说明,可以去查询详细了解下,引用关键部分如下:
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替换成了@,另存为了一个记事本。分析后的数据如下:
看解析后的数据什么都看不出来,我们还是选取其中的几帧,用图形表示出来比较好。再写一段绘制的代码,根据转换后的坐标直接绘制即可了 。绘制后的图形如下:
对比实际的地形图,还是有那么点意思的,哈哈 。当然要想数据准确,还需要进行帧间匹配算法再处理。
代码下载链接