运动障碍环境中UUV三维航路规划方法
基本信息
申请号 | CN201410011297.1 | 申请日 | - |
公开(公告)号 | CN103777639B | 公开(公告)日 | 2015-06-24 |
申请公布号 | CN103777639B | 申请公布日 | 2015-06-24 |
分类号 | G05D1/10(2006.01)I | 分类 | 控制;调节; |
发明人 | 严浙平;邓超;李聪聪;赵玉飞;徐健;陈涛 | 申请(专利权)人 | 哈尔滨船海智能技术合伙企业(有限合伙) |
代理机构 | 哈尔滨市船大专利事务所 | 代理人 | 哈尔滨工程大学;哈尔滨船海智能装备科技有限公司 |
地址 | 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及一种运动障碍环境中UUV三维航路规划方法,其特征在于:步骤一:通过计算UUV遭遇固定障碍与运动障碍的时间,建立UUV三维避障代价函数;步骤二:通过计算UUV艏向与目标方向角度关系,建立UUV三维趋向目标代价函数;步骤三:结合UUV三维避障代价函数和三维趋向目标代价函数,建立UUV三维航路规划代价函数。 |
