水下机器人的水下本体装置及自主避障方法
【技术领域】
[0001]本发明涉及一种水下作业设备，具体涉及一种水下机器人的水下本体装置及自主避障方法。
【背景技术】
[0002]作为人类研宄和开发海洋的得力助手，水下机器人在海洋工程领域正扮演着越来越重要的角色，尤其在海底电缆铺设、海底搜救和海底军事设施维护等工程领域。水下机器人能够在潜水员不可能到达的深度进行综合考察和研宄，并能完成各种作业任务，在海洋开发中发挥着极其重要的作用。
[0003]但是未知多变的海洋环境比陆地环境要复杂得多，加上水下机器人自身存在强耦合、非线性、欠驱动及模型不确定性，使得有效控制成为技术难点。按控制方式来分，主要有遥控水下机器人ROV (Remotely Operated Vehicle)和自治水下机器人AUV (AutonomousUnderwater Vehicle)。凭借遥控水下机器人的低成本、控制简便性和信息交互实时性好，以及能满足作业机械手和复杂水下探测设备的电力需求，从而在决策和作业水平上，仍是当今使用最广且最为重要的水下勘探和侦查设备。而水下机器人的重要组成部分-水下机器人本体装置的设计显得特别重要。水下机器人本体装置就是水下机器人的水下潜水器本体，负责水下机器人水下作业时的具体任务的执行，主要用于执行水面操作人员的手动操控，并将水下环境的局部信息和自身的所有状态信息上传至水面。而目前国外和国内的水下机器人本体装置，通讯多采用双绞线传输，通讯质量不高，尤其对于高清水下视频，往往达不到比较好的效果。
【发明内容】
[0004]本发明提供一种水下机器人的水下本体装置及自主避障方法，具有四自由度运动，能进行自主避障，具有高质量的实时高清视频、遥测数据和操控灵活性。
[0005]为实现上述目的，本发明提供一种水下机器人的水下本体装置，其固定于水下机器人框架中，其特点是，该水下本体装置包含:
主控系统，其通过光电复合缆通信连接水面的控制中心，接收水面的远程控制指令，并上传水下的视频信息和传感数据；
旋转云台，其上设有视频接收设备，旋转云台的输入端通信连接主控系统，主控系统根据远程控制指令控制旋转云台带动视频接收设备旋转；
传感器系统，其包含声纳组件，声纳组件实时探测水下环境，传送水下环境信息至主控系统，主控系统根据水下环境信息向水下本体装置的运动机构输出运动控制指令。
[0006]上述主控系统包含:
嵌入式主控板，其上传传感器系统的传感数据至水面的控制中心，接收水面的远程控制指令，进行解析后输出水下本体装置的运动控制指令；
数据采集板，其通信连接嵌入式主控板，接收传感器系统的数字和模拟的传感数据并传送至嵌入式主控板，并将运动控制指令输出至水下本体装置的运动机构；
多串口板，其通信连接嵌入式主控板，接收传感器系统的RS485和RS232的传感数据并传送至嵌入式主控板；多串口板还连接光电复合缆，嵌入式主控板通过多串口板通信连接水面的控制中心。
[0007]上述主控系统通过光端机通信连接光电缆接口板，并通过光电缆接口板与光电复合缆连接，以通过光电复合缆与水面的控制中心建立通信连接。
[0008]上述水下本体装置还包含动力驱动系统，动力驱动系统作为水下本体装置的运动机构，接收主控系统输出的运动控制指令，驱动水下机器人进行运动。
[0009]上述动力驱动系统包含:
垂向推进器，其设置于水下机器人框架纵剖面的艏艉端，控制水下机器人进行潜浮和纵倾运动；
艉部推进器，其设置于水下机器人框架艉部的左右两侧，控制水下机器人进行进退和艏向运动。
[0010]上述水下本体装置还包含功率分配板，其输入端电路连接光电缆接口板，接收光电缆接口板输出的电源，并分配至光端机、主控系统、旋转云台、传感器系统和水下本体装置的运动机构。
[0011]上述声纳组件包含:
测距声纳，其设置于水下机器人前端上方，水下作业时测量前方目标或障碍物的距离，将所得的距离数据传送至主控系统和水面的控制中心进行处理；
前视声纳，其设置于水下机器人前端上方，水下作业时测量同一水平面周围目标或障碍物的状况，将所得的图像数据上传至主控系统和水面的控制中心进行处理。
[0012]上述传感器系统还包含:
摄像机，其作为视频接收设备设置于水下机器人前方并与旋转云台机械连接，摄像机由旋转云台带动旋转，采集图像数据通过主控系统上传至水面的控制中心；
压力传感器，其设置于水下本体装置的后端下方，检测水下机器人所处深度，将深度数据通过主控系统上传至水面的控制中心；
高度计，其实时测量水下机器人所处高度，将高度数据通过主控系统上传至水面的控制中心；
陀螺仪，其设置于水下本体装置的舱体内部，测量水下机器人的艏向角速度，并将所获得的角速度数据通过主控系统上传至水面的控制中心；
电子罗盘，其设置于水下本体装置的舱体内部，测量水下机器人的艏向角、纵倾角和横摇角，并将所获得的方位数据通过主控系统上传至水面的控制中心；
电压电流传感器，其设置于水下本体装置的舱体内部，实时测量水下机器人各部分工作的电压和电流信息，通过主控系统上传至水面的控制中心。
[0013]一种水下机器人的水下本体装置的自主避障方法，其特点是，该自主避障方法包含:
步骤1、前视声纳和测距声纳实时对水下机器人周围的环境进行扫描，形成图像和距离数据传送至主控系统；
步骤2、主控系统对前视声纳和测距声纳的图像和距离数据进行处理，获得水下机器人与周围障碍物的方位与距离关系；
步骤3、主控系统根据水下机器人与周围障碍物的方位与距离关系，调整运动参量，输出运动控制指令至动力驱动系统；
步骤4、动力驱动系统驱动水下机器人避开障碍物，跳转到步骤1，循环进行自主避障。
[0014]本发明水下机器人的水下本体装置及自主避障方法和现有技术的水下机器人本体装置相比，其优点在于，本发明水下本体装置的主控系统通过光电复合缆通信连接水面的控制中心，采用了光纤传输技术，可实现远距离获得高质量的实时高清视频和遥测数据，以及具有较高的操控灵活性；
本发明设有前视声纳和测距声纳进行配合，可以更好完成水下作业操作，同时主控系统根据前视声纳和测距声纳所探测的图像和距离数据，判断出水下机器人在水下作业时周围环境的障碍物分布，从而输出运动控制指令，具有实现自主避障的能力，这是一般遥控水下机器人不具备的；
本发明采用旋转云台转动摄像机，便于对摄像机进行远程操控，最大程度扩大摄像机的观察方位，避免传统固定安装或集成云台的缺点，效果优于集成的云台摄像机，可大大扩大水下观察视角范围。
【附图说明】
[0015]图1为本发明水下机器人的水下本体装置的系统模块图；
图2为本发明水下机器人的水下本体装置的功率分配板上连接示意图；
图3为本发明水下机器人的水下本体装置的自主避障方法的流程图。
【具体实施方式】
[0016]以下结合附图，进一步说明本发明的具体实施例。
[0017]本发明公开了一种水下机器人的水下本体装置的实施例，水下本体装置固定于水下机器人的铝合金框架中，该水下本体装置的外部设有一个用于放置控制电路及电气设备的密封电子舱体。
[0018]如图1所示，水下本体装置包含:光电缆接口板1、光端机2、主控系统3、功率分配板4、LED照明5、旋转云台6、动力驱动系统7及传感器系统8。
[0019]其中光电缆接口板1、光端机2、主控系统3、功率分配板4、动力驱动系统7和部分传感器系统8安装在水下机器人电子舱体内。LED照明5、旋转云台6和传感器系统8的部分传感设备安装在水下机器人铝合金框架上。
[0020]光电缆接口板I的输出端通信连接光端机2和功率分配板4的输入端，光电缆接口板I的输入端通过光电复合缆通信连接水面的控制中心的输出端。光端机2的输入端与主控系统3的输出端通信连接，光端机2的输出端与光电缆接口板I的输入端通信连接。从而使主控系统3通过光端机2、光电缆接口板I与光电复合缆通信连接水面的控制中心，接收水面的远程控制指令，并上传水下的视频信息和传感数据。另外，光电缆接口板I还通过光电复合缆为水下机器人提供动力电源，并输送至功率分配板4。
[0021]主控系统3包含:嵌入式主控板31、数据采集板32、多串口板33和电源板34。数据采集板32、多串口板33和电源板34分别与嵌入式主控板31通信连接。
[0022]嵌入式主控板31设置于水下机器人的水下本体装置的电子舱体内部，用于接收传感器系统8中所有传感设备的传感数据，并按通讯协议经由光端机2、光电缆接口板I和光电复合缆上传至水面的控制中心；同时经由光端机2、光电缆接口板I和光电复合缆接收水面的控制中心发送过来的运动控制指令，进行解析并传送给动力驱动系统7，以改变水下机器人的运动状态。
[0023]数据采集板32设置于水下机器人的水下本体装置的电子舱体内部，用于接收传感器系统8的数字和模拟传感数据，并将所获得的传感数据传送至嵌入式主控板31，经嵌入式主控板31处理并传至水面的控制中心进行处理显示，同时将运动控制指令输出至动力驱动系统7。
[0024]多串口板33设置于水下机器人的水下本体装置的电子舱体内部，用于接收传感器系统8的RS485和RS232的传感数据，并将所获得的传感数据传送至嵌入式主控板31，经嵌入式主控板31处理并传至水面的控制中心进行处理显示。
[0025]电源板34设置于水下机器人本体电子舱体内部，用于嵌入式主控板31和传感器系统8中部分传感设备的供电。
[0026]如图2并结合图1所示，功率分配板4的输出端分别与光端机2、主控系统3、LED照明5、旋转云台6、动力驱动系统7及传感器系统8连接，其输入端与光电缆接口板I的输出端连接。