logo资料库

水下机器人的定位系统.doc

发布时间：2022-05-29 发布人：admin 分类：说明书 资料大小：0.13M 资料格式：doc 举报 版权申诉
第1页 / 共6页
第2页 / 共6页
第3页 / 共6页
第4页 / 共6页
第5页 / 共6页
第6页 / 共6页
资料共6页，全文预览结束
    摘要：水下机器人的定位系统利用超声波传感器获取距离信息,同时采用三点定 位法计算出位置坐标。利用单片机存储时间信息和温度信息,并将这些信息实时 传送到工控机程序完成定位。最后,通过实验获取了超声波的定位数据,并采用非 线性优化的方法对数据进行了分析,得到两种不同发射传感器的定位精度,对以后 改进系统和提高定位精度都有参考价值。 关键词：超声波;水下定位系统;单片机;测距 本课题研究的机器人工作在大约 40 m 深的浆液下，为了防止水煤浆由于长时间 的存贮而沉淀，他能在按照预先规划的轨迹行走时完成搅拌功能。在这种条件下， 一个很重要的问题就是机器人定位功能的实现，用来实时了解其具体位置。本机 器人定位系统采用多路超声波传感器测距，然后采用三点定位法，把测距信息转 化为机器人的位置信息。超声波作为一种无接触检测方式，与激光、红外以及无 线电测距相比，在水煤浆中可以比较容易地穿透水煤浆达到测距的目的，且精度 较高。 l 超声波测距系统 1.1 超声波测距原理 超声波测距原理一般采用时间度量法，计算公式为： 式中 D(m)为超声波传播的距离，v(m／s)为超声波在介质中传播的速度，t(s)为超 声波在介质中传播的时间。而超声波在介质中传播的速度由介质的性质和温度 T (℃)决定，由此可得到水中超声波的波速为：
    1.2 超声波测距的硬件系统 系统硬件框图如图 1 所示，其设计为分布式控制系统。在本系统中 USR1 为超声 波发射传感器，USR2，USR3，USR4 为接收传感器，他是型号为 JSS-03 的液下 专用超声波传感器，该传感器既可做接收用同时也可做发射用，其灵敏度高，额 定脉冲工作电压高，瞬时输出功率大。温度传感器选用 DS18B20，该传感器具 有单总线、抗干扰、测温范围宽(-55～+125℃)、适合远距离恶劣环境测温的特点。 在本系统中使用的单片机(MCU0，MCU1，…MCU4)均选用 51 系列单片机 AT8 9C52。 当系统处于工作状态，由 MCU0 每隔 3 s 产生一个脉冲，信号经过放大激发信 号发生器 ST-3A，然后触发超声波发生器 USR1；同时给 MCU2，MCU3，MCU 4 的中断 INT0 一个低电平，使他们开始计时。当接收超声波传感器接收到发射 超声波传感器发出的信号后，立即把产生的接收信号传给单片机，中间的信号调 理过程为一级放大(放大 100 倍)、带通滤波、二级放大(放大 50 倍)、电压比较、 光电隔离，其中电压比较的基准电压可调，当信号电压高于基准电压时使 MCU 的 INT1 中断。INT0 中断和 INT1 中断的时间间隔即为发射与接收传感器间的时 间，他存储在单片机固定的 RAM 中。而温度传感器 DS18B20 是分时完成对环
    境温度的测量的，采用严格的时序单片机进行双向通讯。单片机把温度信息存在 他的固定 RAM 中。 1.3 超声波测距的软件系统 要完成对机器人的位置信息的测量就要求把存储在单片机 RAM 内的时间信息和 温度信息采集到上位机中，然后把这些信息融合起来得到机器人的确切坐标。工 控机与下位机采用串口通讯方式，通讯协议为 MODBUS 协议。同时上位机采用 VC 6.0 作为开发工具，工控机的软件程序采用模块化编程，程序主要由串口通 讯模块、三点定位模块、数据库模块及界面模块组成，其循环通讯的流程如图 2 所示。 2 实 验 2.1 实验准备
    为了验证程序的可靠性和对比两种超声波发射传感器在定位过程中的效果，做了 水下定位实验，该实验是在 9 m×7 m 的长方形水池中进行的，水深 25 cm 左右。 在实验之前在水平面内建立直角坐标系，同时在 r=3 300 mm 的圆周上均匀放置 三个超声波接收传感器，其坐标(单位：mm)分别为(3 300，0)、(-1 650，2 858)、 (-1 650，2 858)，在实验过程中超声波发射传感器在此圆周内移动。 根据以前一系列的实验结果，在本次实验的软件系统中对测距程序按下式进行了 修正：(单位：mm) 2.2 实验结果 (1)JSS-03 型超声波发射传感器 该传感器的最佳发射频率为 10 kHz，发射面为一个平面，波束角为 60°，其指向 性很强，在此定位系统中，3 个接收传感器都能够收到该发射传感器的信号，但 在其波束角内的接收传感器接收的信号比其他两个强，这就影响了接收传感器触 发时的灵敏性。 如图 3 所示，中间的实线圆为经过非线性优化过的发射传感器的移动轨迹，半径 为 3 204 mm，这些定位点分散在轨迹圆的周围，外侧的虚线圆为偏离原点最远 点所在的圆，内侧的虚线圆为距离原点最近的点所在的圆，最大误差为 8.08％， 这些误差主要来自于发射中心产生的误差和测距产生的误差。
    (2)LYF-20 型圆周发射传感器 复制的最佳发射频率为 22 kHz，发射面为圆柱面，他的优点就是对于三个接收 传感器而言发射中心是固定的，并且他们接收的信号强弱一致，但他的指向性不 强，由于信号分散，故其发射的信号弱于 JSS-03 型传感器。如图 4 所示。由于 从发射源头就避免了发射中心产生的误差，所以他的定位精度较高，主要误差来 自于测距误差，其优化后的轨迹圆半径为 3 154 mm，最大误差为 3.78％。在此 可以看出，频率对超声波的测距是有很大影响的，频率越大，精度越高。 3 结 语
    从实验结果看出，定位系统是可行的，有较高的可靠性，并且本系统的实时性可 达 1 s，其精度也可以达到我们预期的效果，但是硬件系统还有提升的空间。研 究内容对水下机器人的定位，信号的采集，数据的远距离传输等都有参考价值。 参考文献： [1]俞竹青.那须康雄.超声波网络导航中移动机器人的位置计算[J].机器人技术及 应用,2002(3):36-39. [2]桑金.水深测量中的声速改正问题研究[J].海洋测绘,2006,26(3):17-20. [3]赵红旗,王云景.DS18820 在 16 路测温系统中的应用[J].仪表技术,2006(1):69-71.
    分享到：
    赞 收藏

    相关推荐

    资料库

    开发技术

    共收录19306份资料，累计14个分类，关注成员有19位，主要包括：Actionscript,Javascript,PHP,VB,Perl,Delphi,Python,C#,C,Java,C++,Web开发,硬件开发,其它

    热门标签

    Actionscript Javascript PHP VB Perl Delphi Python C# C Java C++ Web开发 硬件开发 其它

    最新资料