-
公开(公告)号:CN104483975A
公开(公告)日:2015-04-01
申请号:CN201410617653.4
申请日:2014-11-05
Applicant: 哈尔滨工程大学
IPC: G05D1/10
Abstract: 本发明公开了一种基于航路点的UUV转弯速度自适应调整方法。从使命文本读取UUV的前一航路点、当前航路点、下一航路点以及规划速度,将规划速度作为速度指令输出;计算出当前航路角;计算当前航路的转弯半径;惯性导航仪实时采集UUV的实际位置;判断UUV是否满足启用转弯速度的条件,如果满足条件,计算并输出转弯速度指令;光纤罗经实时采集UUV的实际航向;判断UUV是否到达当前航路点,如果到达当前航路点,判断使命文本中的航路点是否都已到达,如果都到达,任务结束。本发明可以减少UUV转弯时的航路超调,改善航路跟踪效果。
-
公开(公告)号:CN104020776A
公开(公告)日:2014-09-03
申请号:CN201410264213.5
申请日:2014-06-13
Applicant: 哈尔滨工程大学
IPC: G05D1/10
Abstract: 本发明公开了一种UUV对拥有多个禁航区的运动母船的跟踪方法。包括以下几个步骤:UUV利用通讯声纳探测运动母船的位置ptar和速度vtar,将预设的母船禁航区信息输送给UUV,得到N个禁航区的位置pobs_i和速度vobs_i;建立UUV和运动母船以及禁航区的相对运动;规划UUV下一步的速度和航向;UUV执行下一步的速度和航向指令,判断UUV到运动母船的距离是否小于阈值K,如果不小于阈值,重复步骤一~步骤四,如果小于阈值,完成UUV对运动母船的跟踪。本发明将UUV、母船和禁航区的位置信息作为规划要素外,加入了三者的速度信息,以达到UUV跟踪运动母船的同时规避运动的禁航区的目的,具有良好的控制性能和实时性。
-
公开(公告)号:CN110580057B
公开(公告)日:2023-03-31
申请号:CN201910917112.6
申请日:2019-09-26
Applicant: 哈尔滨工程大学
IPC: G05D1/10
Abstract: 本发明公开了一种基于圆周分层规划的UUV集群编队队形形成方法,包括初始化设置UUV主从身份指令,设置队形形成参数,期望队形指令;队形形成后,UUV保持定点、定艏向,并确定主从身份;UUV集群进行位置和艏向信息交互;主UUV对从UUV进行分散机动规划,并发送分散机动目标点;从UUV分散机动,机动完成后告知主UUV;主UUV对从UUV先后进行径向和周向机动规划,并先后发送径向机动和周向机动目标点;从UUV先后进行径向机动和周向机动,机动完成后告知主UUV;主UUV向从UUV发送队形形成成功指令,UUV集群编队队形形成。本发明可使UUV集群从初始随机分布、杂乱无序的形态,快速、安全的形成期望队形。
-
公开(公告)号:CN110580057A
公开(公告)日:2019-12-17
申请号:CN201910917112.6
申请日:2019-09-26
Applicant: 哈尔滨工程大学
IPC: G05D1/10
Abstract: 本发明公开了一种基于圆周分层规划的UUV集群编队队形形成方法,包括初始化设置UUV主从身份指令,设置队形形成参数,期望队形指令;队形形成后,UUV保持定点、定艏向,并确定主从身份;UUV集群进行位置和艏向信息交互;主UUV对从UUV进行分散机动规划,并发送分散机动目标点;从UUV分散机动,机动完成后告知主UUV;主UUV对从UUV先后进行径向和周向机动规划,并先后发送径向机动和周向机动目标点;从UUV先后进行径向机动和周向机动,机动完成后告知主UUV;主UUV向从UUV发送队形形成成功指令,UUV集群编队队形形成。本发明可使UUV集群从初始随机分布、杂乱无序的形态,快速、安全的形成期望队形。
-
公开(公告)号:CN107168312B
公开(公告)日:2019-12-06
申请号:CN201710347913.4
申请日:2017-05-17
Applicant: 哈尔滨工程大学
IPC: G05D1/02
Abstract: 本发明公开了一种补偿UUV运动学和动力学干扰的空间轨迹跟踪控制方法,包括以下几个步骤,步骤一,给定平滑有界的期望轨迹yd;步骤二,通过UUV搭载的惯性导航仪、深度计、姿态传感器和多普勒采集UUV当前的位姿信息和速度信息;步骤三:选取UUV前端的虚拟控制点的位置;步骤四,建立轨迹跟踪误差,进行滤波处理;步骤五,利用神经网络,得到估计后UUV运动学和动力学干扰项得到能够补偿干扰项自适应控制律ul;步骤六,得到执行机构控制信号τa=[τu,τq,τr]T;步骤七,判断UUV前端的虚拟控制点的位置是否到达给定期望轨迹的终点,如果是,则结束运行;否则返回步骤二。本发明能够有效补偿因UUV运行学与动力学干扰,提高控制效果及控制精度。
-
公开(公告)号:CN110456786A
公开(公告)日:2019-11-15
申请号:CN201910618905.8
申请日:2019-07-10
Applicant: 哈尔滨工程大学
IPC: G05D1/02
Abstract: 本发明提供的是一种基于地形特征提取的UUV海底地形跟踪系统及跟踪方法。海底地形特征提取模块根据三个测距声呐的安装角度及海底距离、姿态传感器测量的纵倾角和艏向角、深度计测量的实际航行深度、惯性导航仪测量的经度和纬度,提取当前所处的海底地形的特征,并解算出距海底的实际高度;高度指令生成模块根据提海底地形特征、多普勒测量的航行速度,结合期望航行高度,生成指令航行高度;高度指令转深度指令模块将指令航行高度转换成指令航行深度;深度控制器根据PID控制算法产生水平舵角控制指令。本发明可以使UUV具备对局部海底地形的在线构建能力和变化趋势的预判能力,在保证航行安全性的前提下,实现对未知海底地形的良好跟踪。
-
公开(公告)号:CN106020213B
公开(公告)日:2018-12-11
申请号:CN201610312413.2
申请日:2016-05-12
Applicant: 哈尔滨工程大学
IPC: G05D1/06
Abstract: 本发明提供的是一种UUV对矩形障碍物几何绕行的二维航路规划方法。一:从使命文本读取航路起点Ob、航路终点Oe和各矩形障碍物的参数;二:对矩形障碍物进行膨胀处理,计算膨胀后的各矩形障碍物的参数;三:建立绕行点集合S,令规划当前点Oc为起点Ob,并放入绕行点集合S中;四:如果规划当前点Oc是航路终点Oe,或者规划当前点Oc和航路终点Oe可视,转步骤六,否则执行步骤五;五:对距规划当前点Oc最近的矩形障碍物进行几何绕行,得到绕行点并放入绕行点集合S中,更新规划当前点Oc,转步骤四;六:将航路终点Oe放入绕行点集合S中,规划结束。本发明通过简单的几何原理实现对矩形障碍物的绕行,可以使UUV在复杂多矩形障碍环境中快速、高效的获得一条安全无碰的二维航路。
-
公开(公告)号:CN107168344A
公开(公告)日:2017-09-15
申请号:CN201710347926.1
申请日:2017-05-17
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了一种UUV抵近海底作业过程中航路生成方法。包括以下步骤,步骤一:UUV利用传感器采集当前自身信息,UUV接收任务目标点,UUV接收障碍物信息;步骤二:构建栅格地图,根据UUV的几何约束对障碍物进行膨胀处理,表示在相应的栅格地图中;步骤三:根据每个栅格障碍属性将栅格地图分为可行区和不可行区;步骤四:根据障碍物位置误差和UUV导航误差计算可行区S1中每一栅格的潜在危险性步骤五:根据每个栅格的潜在危险性利用逆向A*算法生成航路。本发明能够提高航路精度,提高UUV抵近海底作业安全性与可靠性。
-
公开(公告)号:CN104020770A
公开(公告)日:2014-09-03
申请号:CN201410264172.X
申请日:2014-06-13
Applicant: 哈尔滨工程大学
IPC: G05D1/02
Abstract: 本发明公开了一种能够规划出三维空间曲线的基于多项式的UUV空间轨迹规划方法。包括以下几个步骤:UUV利用传感器获得当前自身位姿、速度信息作为轨迹规划的起点信息,接收轨迹规划的终点信息,接收障碍物信息;利用多项式参数化空间轨迹方程;求解空间轨迹方程的固定系数;求解空间轨迹方程的可调系数的最优值;判断空间轨迹是否满足无碰条件,如果满足无碰条件,将可调系数的最优值代入空间轨迹方程,并输出空间轨迹,如果不满足无碰条件,求解可调系数的次优值,并将可调系数的次优值代入空间轨迹方程,并输出空间轨迹。本发明通过可调系数的选取来获得一条空间无碰的、最优的空间曲线轨迹。
-
公开(公告)号:CN103455037A
公开(公告)日:2013-12-18
申请号:CN201310433161.5
申请日:2013-09-23
Applicant: 哈尔滨工程大学
Abstract: 本发明提供的是一种基于自适应算法的UUV水下回收控制系统及控制方法。包括水面监控计算机、使命管理计算机、动态控制计算机、视觉传感器、短基线定位声呐、姿态传感器、多普勒测速仪、主推进器和槽道辅助推进器,水面监控计算机、使命管理计算机及动态控制计算机之间通过网络进行通讯,UUV自适应回收控制系统嵌入在使命管理计算机中,视觉传感器、短基线定位声呐、姿态传感器、多普勒测速仪通过串口通信将采集到的信息送入动态控制计算机,动态控制计算机通过电信号来控制主推进器和槽道辅助推进器。本发明能够实现UUV安全、准确地回收到水下工作站上的搭载平台。
-
-
-
-
-
-
-
-
-