一种基于极坐标系的auv曲线运动状态下的协同定位方法
【专利摘要】本发明提供的是一种基于极坐标系的AUV曲线运动状态下的协同定位方法。其中主AUV装备精度较高的惯性测量单元，而子AUV装备较低精度的IMU。首先，子AUV通过融合自身的惯性测量单元测量载体运动信息，并测定相对于主AUV的距离和方位信息，最后利用扩展卡尔曼滤波来实现协同定位。本发明与传统的基于笛卡尔坐标系的算法相比，在AUV做曲线运动时具有较高的定位精度。
【专利说明】—种基于极坐标系的AUV曲线运动状态下的协同定位方法
【技术领域】
[0001]本发明涉及的是一种在曲线运动状态下基于极坐标系的AUV曲线运动状态下的协同定位方法。
【背景技术】
[0002]未来是海洋文明的世纪，海洋领域的探索将成为世界的发展趋势，因此水面船艇作业、应用的研究具有广阔的前景。自主水下载体(Autonomous Underwater Vehicle, AUV)实际上是一种水下无人平台，以其体积小、机动性强和成本低等优势成为研究热点；可以执行各种导航和水下地理勘察等复杂任务[I]。随着人类进一步开发认识海洋，AUV研究、应用的理论价值和实际意义更为凸显。AUV与常规的船艇比较，易于操作、灵活快捷，可以经受住各种复杂环境的考验。AUV在允许侦测区域进行隐蔽及公开作业，要充分利用传感器信息，这就需要多AUV进行协同定位。目前，大多数的AUV协同定位系统都是基于笛卡尔坐标系建立的，且其运动状态大都为匀速直航，而极坐标系是针对曲线运动的，所以提出了一种基于极坐标系的协同定位算法，另外由于在AUV作曲线运动时，单纯的距离信息不能够很好的描述AUV的运动状态，因此提出了一种以距离加方位信息作为观测量的协同导航定位算法并进行了可观性分析。
【发明内容】
[0003]本发明的目的在于提供一种提高精度的基于极坐标系的AUV曲线运动状态下的新协同定位方法。
[0004]本发明的目的是这样实现的:
[0005]步骤一:主、子AUV开始协同导航，实时采集子AUV惯性测量单元测得的加速度和角速度信息，并积分得到子AUV的速度和航向信息；
[0006]步骤二:采集子AUV相对于主AUV的距离和方位信息；
[0007]采集的子AUV与主AUV之间的相对距离为:
[0008]
【权利要求】
1.一种基于极坐标系的AUV曲线运动状态下的协同定位方法，其特征在于，包括以下步骤: 步骤一:主、子AUV开始协同导航，实时采集子AUV惯性测量单元测得的加速度和角速度信息，并积分得到子AUV的速度和航向信息； 步骤二:采集子AUV相对于主AUV的距离和方位信息； 采集的子AUV与主AUV之间的相对距离为:
【文档编号】G01C21/20GK103968838SQ201410195910
【公开日】2014年8月6日 申请日期:2014年5月9日 优先权日:2014年5月9日
【发明者】高伟, 史宏洋, 刘博 , 杨建 , 于春阳, 张丽丽, 张亚, 梁宏, 兰海钰, 夏建忠 申请人:哈尔滨工程大学