一种无人机和无人船协同的水面漂浮垃圾清除装备及运行方法技术

本发明专利技术提供了一种无人机和无人船协同的水面漂浮垃圾清除装备及运行方法，它包括无人机和无人船；所述无人机对目标水域建图，并对水面垃圾进行识别，地面工作站将垃圾坐标信息传送给各艘无人船，无人船对自己负责水域进行全局路径规划到达垃圾点，通过机械臂对垃圾拾取；还包括控制系统，所述控制系统分为三层：管理层、通讯层、控制执行层；管理层为地面工作站，用于无人机整体结构和无人船整体结构的控制，可视化，运行状态；通讯层主要通过WIFI数传，传送无人机无人船的运行状态给地面工作站；控制层主要是获取环境数据，接收管理层控制指令。制指令。制指令。

【技术实现步骤摘要】
一种无人机和无人船协同的水面漂浮垃圾清除装备及运行方法


[0001]本专利技术属于城市内河湖泊漂浮垃圾清理领域，尤其涉及一种使用无人机无人船协同清理水面漂浮垃圾的自动化垃圾清除装备。

技术介绍

[0002]城市河道及湖泊的水域面积大，漂浮在水面的垃圾蓝藻等，对生态环境影响大，且清除困难。因此针对水面垃圾的清理，成为环境治理的一大环节。每年都要花费大量人力专门清理，工作效率较低，且水面人工作业还需要考虑安全性等问题，并非河道垃圾清理的最佳选择。相比人工作业，水面无人船可以实现全天候、自主化作业，同时可以在一些人工难以到达的危险区域进行作业，能有效地提升清洁效率。随着移动互联网，大数据的飞速发展，无人机在航空测绘，农业植保，森林消防等方面运用越来越广泛。因其具有广阔的视野，机动性强等优点正是水面无人船所欠缺的。将无人机和无人船二者相结合，可以大大提高大范围水域垃圾的搜索能力，提高垃圾清理效率。

技术实现思路

[0003]本专利技术主要解决人工清理水面垃圾效率不高，成本大，不安全等问题。为了提高水面垃圾的清理能力，为此提供了一种无人机和无人船协同的水面漂浮垃圾清除装备及使用方法，本专利技术实现框架基于开源机器人操作系统ROS进行构建，主要技术方案为：通过无人机对目标水域建图并对水面垃圾进行识别，地面工作站将垃圾坐标信息传送给各艘无人船，无人船对自己负责水域进行全局路径规划到达垃圾点，通过机械臂对垃圾拾取。
[0004]为了实现上述的技术特征，本专利技术的目的是这样实现的：一种无人机和无人船协同的水面漂浮垃圾清除装备，它包括无人机和无人船；所述无人机对目标水域建图，并对水面垃圾进行识别，地面工作站将垃圾坐标信息传送给各艘无人船，无人船对自己负责水域进行全局路径规划到达垃圾点，通过机械臂对垃圾拾取；还包括控制系统，所述控制系统分为三层：管理层、通讯层、控制执行层；管理层为地面工作站，用于无人机整体结构和无人船整体结构的控制，可视化，运行状态；通讯层主要通过WIFI数传，传送无人机无人船的运行状态给地面工作站；控制层主要是获取环境数据，接收管理层控制指令。
[0005]所述无人机上搭载有机载计算机、第一深度相机、第一激光雷达、GPS模块、PX4开源飞控、WIFI数传和充放电装置；所述机载计算机接收第一深度相机和第一激光雷达信息，以及控制指令；第一深度相机获取水面漂浮垃圾信息，包括垃圾类别和位置信息；第一激光雷达获取周围环境信息，配合SLAM算法进行定位建图；GPS模块实现无人机的定位；WIFI数传用于无人机整体结构与无人船整体结构之间通讯。
[0006]所述无人船上搭载有机械臂、垃圾存储装置、驱动装置、WIFI数传、高精度惯性导航模块、第二激光雷达、GPS模块、机载计算机和第二深度相机；机械臂对垃圾进行拾取；高精度惯性导航模块和GPS模块通过扩展的卡尔曼滤波松耦合方式进行位置和速度的融合，其中高精度惯性导航模块包括速度加速度、角速度、偏航角通过惯性系统解算得出位置、速度，GPS模块通过导航系统解算出位置、速度，通过扩展的卡尔曼滤波进行数据融合，最后输出结果通过反馈校正后输出位置、速度；第二激光雷达获取周围环境信息，配合SLAM算法进行定位导航；GPS模块为无人船提供定位；深度相机识别垃圾信息，包括垃圾类别和位置信息。
[0007]无人机的定位建图和垃圾识别包括：无人机通过SLAM技术进行建图定位，采用基于图优化的SLAM框架Cartographer算法建立目标水域二维栅格地图，建图过程中，使用深度学习YOLOV3算法对水域漂浮垃圾进行识别，对识别框内点云信息计算XYZ坐标，将其转换到世界坐标系，通过工作站发送给无人船。
[0008]无人机与无人船的坐标转换，无人机的运动为三维空间刚性运动，将无人机第一深度相机坐标转化到无人机的基座标下，最后将其转换到世界坐标系下；无人船在平面内的运动可以看作刚体运动，通过齐次坐标变换转换到世界坐标系下，无人机无人船都处于世界坐标系下。
[0009]无人机、无人船与工作站的通信，在这个通信系统中无人机、无人船和工作站构成，工作站属于主控机，无人机和无人船作为从机，三者之间通过WIFI局域网连接，主控机负责控制无人机和无人船，主要实现：无人机与无人船运动参数的传输和运动命令的控制，无人机与无人船实现图像的传输，实现二者环境信息的交互。
[0010]无人船的定位，主要获取无人船在地图中的位置，由于无人船在水面航行，受到风速波浪的影响，导致无人船的定位发生偏移，采用高精度惯性导航模块和GPS模块组合来进行全局定位，采用扩展的卡尔曼滤波松耦合方式来估计惯性导航和GPS模块的状态误差通过状态误差的估计通过反馈去校正各个导航系统，提升定位的精度。
[0011]无人船的路径规划，地面工作站将二维栅格地图，区域划分，获取各艘无人船的世界坐标系，通过坐标变换获得无人船负责水域的垃圾坐标关系；无人船根据接收自己负责水域的垃圾坐标信息，按照由近及远进行路径规划，在导航中，使用A*算法进行全局路径规划，并计算无人船到目标位置的最优路线。
[0012]机械臂的垃圾拾取，主要包括到达位置后使用第二深度相机生成的点云，对水面漂浮垃圾进行目标检测，计算识别框内点云坐标，将获取垃圾坐标转换到机械臂坐标系下，机械臂开始运动规划抓取。
[0013]所述一种无人机和无人船协同的水面漂浮垃圾清除装备的运行方法，包括以下步骤：S1为开始；S2为无人机无人船到达目标水域；S3为无人机无人船静停，与地面工作站建立无线通讯；S4为按照拟定航线对目标水域SLAM建图，并进行垃圾识别；S5为无人机返回；S6为地面站按照无人船数量对目标水域划分，其中一艘船负责一片水域；
S7为将识别到的垃圾坐标，每艘船的坐标转换到世界坐标系下；S8为对每艘船负责水域的垃圾坐标遍历，进行全局路径规划；S9为无人船到达目标点；S10为识别垃圾如果没识别到原地旋转搜索目标；S11为机械臂抓取；S12为前往未扫描区域；S13为结束；所述S2具体过程：步骤A1：无人船无人机到达目标水域；步骤A2：查看目标水域周边环境；所述S3具体过程：步骤B1：无人船、无人机、地面工作站开机；步骤B2：检查设备运行状况；步骤B3：输入IP地址通过WIFI数传建立三者之间通讯；所述S4具体过程：步骤C1：无人机竖直升到合适高度；步骤C2：开始SLAM建图，采用Cartographer算法建立二维栅格地图；步骤C3：在建图的同时，使用深度学习YOLOV3算法，通过第一深度相机识别水面漂浮垃圾；所述S5具体过程：步骤D1：无人机携带采集的垃圾坐标信息和二维地图返回地面工作站；所述S6具体过程：步骤E1：处理无人机建立的二维地图和垃圾坐标信息；步骤E2：根据地图、船只数量、水域环境进行合理划分每艘船的负责水域；所述S7具体过程：步骤F1：地面工作站将无人机计算得到的垃圾坐标转换到世界坐标系；步骤F2：地面工作站将无人船的坐标系转换到世界坐标系；步骤F3：将每块区域下的垃圾坐标传给负责该区域的无人船；所述S8具体过程：步骤G1：无人船接收在世界坐标本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种无人机和无人船协同的水面漂浮垃圾清除装备，其特征在于：它包括无人机和无人船；所述无人机对目标水域建图，并对水面垃圾进行识别，地面工作站将垃圾坐标信息传送给各艘无人船，无人船对自己负责水域进行全局路径规划到达垃圾点，通过机械臂对垃圾拾取；还包括控制系统，所述控制系统分为三层：管理层、通讯层、控制执行层；管理层为地面工作站，用于无人机整体结构和无人船整体结构的控制，可视化，运行状态；通讯层主要通过WIFI数传，传送无人机无人船的运行状态给地面工作站；控制层主要是获取环境数据，接收管理层控制指令。2.根据权利要求1所述的一种无人机和无人船协同的水面漂浮垃圾清除装备，其特征在于：所述无人机上搭载有机载计算机（103）、第一深度相机（104）、第一激光雷达（105）、GPS模块（101）、PX4开源飞控、WIFI数传和充放电装置；所述机载计算机（103）接收第一深度相机（104）和第一激光雷达（105）信息，以及控制指令；第一深度相机（104）获取水面漂浮垃圾信息，包括垃圾类别和位置信息；第一激光雷达（105）获取周围环境信息，配合SLAM算法进行定位建图；GPS模块（101）实现无人机的定位；WIFI数传用于无人机整体结构与无人船整体结构之间通讯。3.根据权利要求1所述的一种无人机和无人船协同的水面漂浮垃圾清除装备，其特征在于：所述无人船上搭载有机械臂（201）、垃圾存储装置、驱动装置、WIFI数传、高精度惯性导航模块、第二激光雷达（203）、GPS模块、机载计算机和第二深度相机（204）；机械臂（201）对垃圾进行拾取；高精度惯性导航模块和GPS模块通过扩展的卡尔曼滤波松耦合方式进行位置和速度的融合，其中高精度惯性导航模块包括速度加速度、角速度、偏航角通过惯性系统解算得出位置、速度，GPS模块通过导航系统解算出位置、速度，通过扩展的卡尔曼滤波进行数据融合，最后输出结果通过反馈校正后输出位置、速度；第二激光雷达（203）获取周围环境信息，配合SLAM算法进行定位导航；GPS模块为无人船提供定位；深度相机识别垃圾信息，包括垃圾类别和位置信息。4.根据权利要求2所述的一种无人机和无人船协同的水面漂浮垃圾清除装备，其特征在于：无人机的定位建图和垃圾识别包括：无人机通过SLAM技术进行建图定位，采用基于图优化的SLAM框架Cartographer算法建立目标水域二维栅格地图，建图过程中，使用深度学习YOLOV3算法对水域漂浮垃圾进行识别，对识别框内点云信息计算XYZ坐标，将其转换到世界坐标系，通过工作站发送给无人船。5.根据权利要求4所述的一种无人机和无人船协同的水面漂浮垃圾清除装备，其特征在于：无人机与无人船的坐标转换，无人机的运动为三维空间刚性运动，将无人机第一深度相机（104）坐标转化到无人机的基座标下，最后将其转换到世界坐标系下；无人船在平面内的运动可以看作刚体运动，通过齐次坐标变换转换到世界坐标系下，无人机无人船都处于世界坐标系下。6.根据权利要求1所述的一种无人机和无人船协同的水面漂浮垃圾清除装备，其特征在于：无人机、无人船与工作站的通信，在这个通信系统中无人机、无人船和工作站构成，工作站属于主控机，无人机和无人船作为从机，三者之间通过WIFI局域网连接，主控机负责控制无人机和无人船，主要实现：无人机与无人船运动参数的传输和运动命令的控制，无人机
与无人船实现图像的传输，实现二者环境信息的交互。7.根据权利要求1所述的一种无人机和无人船协同的水面漂浮垃圾清除装备，其特征在于：无人船的定位，主要获取无人船在地图中的位置，由于无人船在水面航行，受到风速波浪的影响，导致无人船的定位发生偏移，采用高精度惯性导航模块和GPS模块组合来进行...

【专利技术属性】
技术研发人员：杜轩，吕金迟，李宝万，
申请(专利权)人：三峡大学，
类型：发明
国别省市：