今天实现了第二步的目标:将超声波传感器放在舵机上,随着舵机的转动测量每个角度的距离,并显示在上位机上。原理图如下:
具体连接时,需要将超声波传感器放在舵机上,能够随着舵机的转动同步转动。由于家里材料有限,凑合着绑到了一起,实物连接图如下:
代码方面,在Arduino中增加了超声波测量的函数,其实就是把上上篇记录中的超声波测量代码放到了此处,每次测量结束后,将测量角度和测量距离通过串口发送给上位机。然后上位机按照横坐标为角度,纵坐标为距离的方式绘制坐标点。程序界面如下:
程序代码可以在github中找到:
https://github.com/guochao2299/AutoSonicScan/tree/Version1
程序演示视频如下:
程序运行截图如下:
部分返回的数据如下:
DT:33.60AG:8
DT:48.17AG:7
DT:47.28AG:6
DT:48.67AG:5
DT:47.74AG:4
DT:48.21AG:3
DT:47.84AG:2
DT:48.00AG:1
ROUNDEND
DT:48.45AG:0
DT:65.86AG:1
DT:68.34AG:2
DT:67.84AG:3
DT:67.81AG:4
DT:67.02AG:5
DT:67.74AG:6
DT:68.60AG:7
DT:78.36AG:8
DT:46.40AG:9