超声波成像，求优化，求改错

prairiewolf

各位大拿们，小弟刚入手arduino，搞了个超声波成像的小程序。由于编程功底不到家，程序运行不是很好，丢数据，还请各位前辈指导。
用的是MEGA2560,刚才排故用了nano3.0，所以图上是nano的。
问题如下：
1、下位机来回扫描后，回不到初始位置。应该是循环没搞好，实在找不出具体原因.截图中的亮红圈是第一次扫描后留的，第二次扫描同一区域的时候，由于回不到初始位置而没能刷新掉。
正常是从左向右扫描，近的区域用亮红色，远的区域用暗红色圈指示。
2、上位机收到数据处理代码写的不好，会丢数据，导致漏掉扫描结果。这一次程序启动没漏掉扫描结果，漏掉的情况，就是没有红色后一次扫描的结果，屏幕上某个圆圈依旧是上一次的圆圈。又上传一张，绿方框是我手工标出一的漏掉的亮红圈。
现在附上程序源文件{:soso_e129:}

zzzddd9000

得放个你扫描出来的数据形成的图像

prairiewolf

zzzddd9000 发表于 2014-7-13 19:40
得放个你扫描出来的数据形成的图像

又上传新图了

ioiomi

能够扫到蚊子吗