买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

申请/专利权人：南京信息工程大学

摘要：本发明公开了一种基于环境感知的无人船编队协同作业方法，包括以下步骤：（1）多艘无人船协同构建养殖水域地图；（2）设置各艘无人船的编队初始位置和编队的拓扑结构；（3）设定领航船并规划领航轨迹；（4）跟随船计算期望位置和期望航向角；计算跟随船实际位置与期望位置之间的位置误差，以及实际航向与期望航向之间的角度误差；（5）提取回声信号的强度、频率和时间延迟计算鱼群的精确位置和密度；（6）计算每艘跟随船与设定的投喂目标点之间的欧式距离，并从小到大排序；（7）结合基于人工势场法改进的动态虚拟障碍势场法执行投喂任务；（8）跟随领航船返回编队位置；本发明提升了无人船在复杂水域环境中的任务执行能力和避障性能。

主权项：1.一种基于环境感知的无人船编队协同作业方法，其特征在于，包括以下步骤：（1）多艘无人船协同构建养殖水域地图；（2）根据建立的养殖水域地图，设置各艘无人船的编队初始位置和编队的拓扑结构，无人船从岸边基地航行至编队初始位置；其中，无人船包括：领航船和跟随船；（3）设定领航船并规划领航轨迹，通过GPS和传感器实时获取自身的位置、航向角和速度信息并通过无线数传模块发送给其他跟随船；其中，领航船负责导航整个编队，不执行投喂任务；（4）跟随船计算期望位置和期望航向角；接着计算跟随船实际位置与期望位置之间的位置误差，以及实际航向与期望航向之间的角度误差；跟随船通过PID控制器调整其推进器和舵的输出；（5）无人船的声纳模块通过发射声波并接收反射回来的声波回声探测鱼群位置；其中，声波信号首先被放大，然后转换成数字形式进行滤波和噪声去除，并提取回声信号的强度、频率和时间延迟，最后计算鱼群的精确位置和密度；若鱼群密度达到预设的阈值，并且该位置不在其他投喂圆域内，则该位置坐标被设定为投喂目标点；并且以目标点为圆心，半径为的圆形区域设置为投喂圆域；已经设定的投喂圆域内不再设置其他投喂目标点；（6）计算每艘跟随船与设定的投喂目标点之间的欧式距离，并从小到大排序；然后，根据预设的K值，选择距离最近的K艘跟随船作为执行投喂任务的任务船；（7）执行投喂任务的任务船脱离编队，根据投喂目标点规划新的路径，利用基于改进的人工势场法即动态虚拟障碍势场法使无人船自主导航和避障，最终航行到达投喂目标点执行投喂任务；（8）任务船航行经过投喂目标点完成投喂任务后，跟随领航船返回编队位置；若领航船到达领航轨迹终点，并且所有任务船到达编队位置，则无人船返回岸边基地，结束任务；否则，返回到步骤（4）。

全文数据：

权利要求：

百度查询： 南京信息工程大学 一种基于环境感知的无人船编队协同作业方法