一种地形剖面跟踪路径的形成方法技术

本发明专利技术公开一种地形剖面跟踪路径的形成方法，包括如下过程：对于任一地形剖面线，将所述地形剖面线上的所有离散点进行法向偏移得到对应的偏移点；删除所有偏移点中不满足拟合条件的偏移点，将剩余偏移点进行样条曲线拟合得到极限跟踪测量路径；以所述极限跟踪测量路径上连续的三个点为一组将所述极限跟踪测量路径划分为若干曲线段；根据探测器的运动约束对每个曲线段中不满足约束条件的点进行调整，得到地形剖面跟踪测量路径；所述约束条件为上浮和下潜过程中对应的极限潜浮角、极限运动路径的曲率极限以及斜率跟踪极限。本发明专利技术通过跟踪地形的剖面信息进行快速而精确的底跟踪路径生成，从而有助于对海底探测的深入研究。

A method to form the trace path of terrain section

【技术实现步骤摘要】
一种地形剖面跟踪路径的形成方法
本专利技术属于水下地形测绘
，具体涉及一种地形剖面跟踪路径的形成方法。
技术介绍
随着海底探测任务需求的增加，AUV的近海底定高跟踪能力越来越得到重视。由于水下探测传感器的感知范围约束，AUV必须保持距海底一定高度航行才能保证自身安全性和对底观测的精度，而且水下地形具有随机性且水下地形的探测范围有限，因此AUV需要根据地形剖面的局部探测信息和自身状态实时的、动态的规划底跟踪路径。而现有技术中，AUV规划跟踪路径存在误差较大，不够精确的问题，因此制约了对海底探测的更深一步的研究。
技术实现思路
本专利技术的目的在于克服现有技术中的不足，提供一种地形剖面跟踪路径的形成方法，通过跟踪地形的剖面信息进行快速而精确的底跟踪路径生成。为解决现有技术问题，本专利技术公开了一种地形剖面跟踪路径的形成方法，包括如下过程：对于任一地形剖面线，将所述地形剖面线上的所有离散点进行法向偏移得到对应的偏移点；删除所有偏移点中不满足拟合条件的偏移点，将剩余偏移点进行样条曲线拟合得到极限跟踪测量路径；以所述极限跟踪测量路径上连续的三个点为一组将所述极限跟踪测量路径划分为若干曲线段；根据探测器的运动约束对每个曲线段中不满足约束条件的点进行调整，得到地形剖面跟踪测量路径；所述约束条件为上浮和下潜过程中对应的极限潜浮角、极限运动路径的曲率极限以及斜率跟踪极限。进一步地，所述拟合条件为：对于任一偏移点，该偏移点与地形剖面线之间最小距离不小于该偏移点的偏移距离。进一步地，所述根据探测器的运动约束对每个曲线段中不满足约束条件的点进行调整的过程具体为：当曲线段为凸曲线且中间点的曲率不符合曲率极限约束条件时，则对两个端点进行调整；当曲线段为凹曲线且两个端点的曲率不符合曲率极限约束条件时，则对中间点进行调整；当曲线段中相邻两个点的连线的斜率为负值且斜率不满足斜率跟踪约束条件时，则对后一个点进行调整；当曲线段中相邻两个点的连线的斜率为正值且斜率不满足斜率跟踪约束条件时，则对前一个点进行调整。进一步地，所述当曲线段为凸曲线且中间点的曲率不符合曲率极限约束条件时，则对两个端点和进行调整的具体过程为：对于平面坐标系x0y内的曲线段，其两个端点和的调整量分别为：其中，mi表示端点的调整量；mi+2表示端点的调整量；ni+1表示曲线段在点的二阶导数；sign(ni+1)表示二阶导数ni+1的符号，表明曲线段在点的凹凸性；λκ表示控制点位置调整权重；表示曲线段满足约束条件时控制点的位置；表示点与点之间的距离；表示曲线段满足约束条件时控制点的位置；表示点与点之间的距离，平面坐标系x0y的x轴为地形剖面线的水平面投影轴，y轴为地形剖面线的高度轴。进一步地，所述当曲线段为凹曲线且两个端点的曲率不符合曲率极限约束条件时，则对中间点进行调整的具体过程为：对于平面坐标系x0y内的曲线段，其中间点的调整量为：其中，ni+1表示曲线段在点的二阶导数；sign(ni+1)表示二阶导数ni+1的符号，表明曲线段在点的凹凸性；λκ表示控制点位置调整权重；表示曲线段满足约束条件时的控制点位置；表示与控制点之间的距离，平面坐标系x0y的x轴为地形剖面线的水平面投影轴，y轴为地形剖面线的高度轴。进一步地，所述当曲线段中相邻两个点的连线的斜率为负值且斜率不满足斜率跟踪约束条件时，则对后一个点进行调整的具体过程为：对于平面坐标系x0y内的曲线段，其后一个点的调整量为：其中，zi+1表示曲线段在后一个点的y方向的分量，z方向为高度方向；d表示曲线段上相邻两个点和在x方向的距离，x方向为横坐标方向；λk表示控制点位置调整权重，平面坐标系x0y的x轴为地形剖面线的水平面投影轴，y轴为地形剖面线的高度轴。进一步地，所述当曲线段中相邻两个点的连线的斜率为正值且斜率不满足斜率跟踪约束条件时，则对前一个点进行调整的具体过程为：对于平面坐标系x0y内的曲线段，其前一个点的调整量为：其中，zi表示曲线段C在点的y方向的分量，z方向为高度方向；d表示曲线段上相邻两个点和在x方向的距离，x方向为横坐标方向；λk表示控制点位置调整权重，平面坐标系x0y的x轴为地形剖面线的水平面投影轴，y轴为地形剖面线的高度轴。进一步地，还包括如下步骤：若所述极限跟踪测量路径上的任一极点与其相邻的拐点之间的间距超过设定值则在两者之间增加一个划分点，然后将划分后的得到的所有点以连续的三个点为一组将所述极限跟踪测量路径划分为若干曲线段。本专利技术具有的有益效果：通过跟踪地形的剖面信息进行快速而精确的底跟踪路径生成，从而有助于对海底探测的深入研究。附图说明图1为本专利技术中极限跟踪测量路径的形成示意图；图2为本专利技术中极限跟踪测量路径的进行等间距划分的示意图；图3为本专利技术中极限跟踪测量路径的进行曲线段划分的示意图；图4为AUV在初始平衡状态下下潜或上浮运动中的极限示意图；图5为本专利技术中凸曲线的调整过程图；图6为本专利技术中凹曲线的调整过程图；图7为本专利技术中正斜率曲线的调整过程图；图8为本专利技术中负斜率曲线的调整过程图；图9为本专利技术中跟踪路径与地形剖面线的对比图。具体实施方式下面结合附图对本专利技术作进一步描述。以下实施例仅用于更加清楚地说明本专利技术的技术方案，而不能以此来限制本专利技术的保护范围。如图1至8所示，一种地形剖面跟踪路径的形成方法，包括如下过程：以地形剖面线的水平面投影轴作为横坐标，高度作为纵坐标建立平面坐标系x0y，对于平面坐标系x0y内的任一地形剖面线C0作出如下处理：S1、如图1所示，将地形剖面线C0上的所有离散点进行法向偏移得到对应的偏移点以及其表达式。以地形剖面线C0上的三个连续的离散点pi，pi+1，pi+2为例，离散点pi+1偏移后得到的对应的偏移点Xi+1的表达式为：其中，dopt表示偏移量，表示单位向量，由和合成得到，表示垂直方向上且位于地形剖面外侧的单位向量，表示垂直方向上且位于地形剖面外侧的单位向量，表示离散点pi和pi+1连线的斜率，表示离散点pi+1和pi+2连线的斜率。S2、对于偏移后得到的任一离散点Xi＝[xi,yi]，若不满足拟合条件dm≥dopt，则将不满足该拟合条件的偏移点删除，将剩余偏移点计为通过样条曲线拟合方法拟合得到曲线即为极限跟踪测量路径。S3、如图2所示，若极限跟踪测量路径上的任一极点与其相邻的拐点之间的间距超过设定值时则在两者之间增加一个划分点，例如超过其它任一相邻两个点之间的距离时，具体地，在划分时，按照等间距方式进行划分。这样做的目的是提高最终的规划路径的精度。如图3所示，将划分后的得到的所有点以连续的三个点为一组将极限跟踪测量路径划分为若干曲线段S4本文档来自技高网...

【技术保护点】
1.一种地形剖面跟踪路径的形成方法，其特征在于：包括如下过程：/n对于任一地形剖面线，/n将所述地形剖面线上的所有离散点进行法向偏移得到对应的偏移点；/n删除所有偏移点中不满足拟合条件的偏移点，将剩余偏移点进行样条曲线拟合得到极限跟踪测量路径；/n以所述极限跟踪测量路径上连续的三个点为一组将所述极限跟踪测量路径划分为若干曲线段；/n根据探测器的运动约束对每个曲线段中不满足约束条件的点进行调整，得到地形剖面跟踪测量路径；所述约束条件为上浮和下潜过程中对应的极限潜浮角、极限运动路径的曲率极限以及斜率跟踪极限。/n

【技术特征摘要】
1.一种地形剖面跟踪路径的形成方法，其特征在于：包括如下过程：
对于任一地形剖面线，
将所述地形剖面线上的所有离散点进行法向偏移得到对应的偏移点；
删除所有偏移点中不满足拟合条件的偏移点，将剩余偏移点进行样条曲线拟合得到极限跟踪测量路径；
以所述极限跟踪测量路径上连续的三个点为一组将所述极限跟踪测量路径划分为若干曲线段；
根据探测器的运动约束对每个曲线段中不满足约束条件的点进行调整，得到地形剖面跟踪测量路径；所述约束条件为上浮和下潜过程中对应的极限潜浮角、极限运动路径的曲率极限以及斜率跟踪极限。


2.根据权利要求1所述的一种地形剖面跟踪路径的形成方法，其特征在于：
所述拟合条件为：对于任一偏移点，该偏移点与地形剖面线之间最小距离不小于该偏移点的偏移距离。


3.根据权利要求1所述的一种地形剖面跟踪路径的形成方法，其特征在于：
所述根据探测器的运动约束对每个曲线段中不满足约束条件的点进行调整的过程具体为：
当曲线段为凸曲线且中间点的曲率不符合曲率极限约束条件时，则对两个端点进行调整；
当曲线段为凹曲线且两个端点的曲率不符合曲率极限约束条件时，则对中间点进行调整；
当曲线段中相邻两个点的连线的斜率为负值且斜率不满足斜率跟踪约束条件时，则对后一个点进行调整；
当曲线段中相邻两个点的连线的斜率为正值且斜率不满足斜率跟踪约束条件时，则对前一个点进行调整。


4.根据权利要求3所述的一种地形剖面跟踪路径的形成方法，其特征在于：
所述当曲线段为凸曲线且中间点的曲率不符合曲率极限约束条件时，则对两个端点和进行调整的具体过程为：
对于平面坐标系x0y内的曲线段，其两个端点和的调整量分别为：



其中，mi表示端点的调整量；mi+2表示端点的调整量；ni+1表示曲线段在点的二阶导数；sign(ni+1)表示二阶导数ni+1的符号，表明曲线段在点的凹凸性；λκ表示控制点位置调整权重；表示曲线段满足约束条件时控制点的位置；表示点与点之间的距离；表示曲线段满足约束条件时控制点的位置；表示点与点之间的距离，平面坐标系x0y的x轴为地形剖面线的水平面投影轴，y轴为地形剖面线的...

【专利技术属性】
技术研发人员：王汝鹏，徐鹏飞，骆佳成，程红霞，张弛，
申请(专利权)人：河海大学，
类型：发明
国别省市：江苏;32