基于多项式的UUV空间轨迹规划方法
基本信息
申请号 | CN201410264172.X | 申请日 | - |
公开(公告)号 | CN104020770B | 公开(公告)日 | 2015-07-22 |
申请公布号 | CN104020770B | 申请公布日 | 2015-07-22 |
分类号 | G05D1/02(2006.01)I | 分类 | 控制;调节; |
发明人 | 张伟;陈海田;徐达;张明臣;严浙平 | 申请(专利权)人 | 哈尔滨船海智能技术合伙企业(有限合伙) |
代理机构 | - | 代理人 | - |
地址 | 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室 | ||
法律状态 | - |
摘要
摘要 | 本发明公开了一种能够规划出三维空间曲线的基于多项式的UUV空间轨迹规划方法。包括以下几个步骤:UUV利用传感器获得当前自身位姿、速度信息作为轨迹规划的起点信息,接收轨迹规划的终点信息,接收障碍物信息;利用多项式参数化空间轨迹方程;求解空间轨迹方程的固定系数;求解空间轨迹方程的可调系数的最优值;判断空间轨迹是否满足无碰条件,如果满足无碰条件,将可调系数的最优值代入空间轨迹方程,并输出空间轨迹,如果不满足无碰条件,求解可调系数的次优值,并将可调系数的次优值代入空间轨迹方程,并输出空间轨迹。本发明通过可调系数的选取来获得一条空间无碰的、最优的空间曲线轨迹。 |
