发明名称 一种基于贝塞尔曲线的终端定位轨迹拟合方法
摘要 本发明属于卫星导航领域,具体涉及一种终端定位轨迹拟合方法。本发明的一种基于贝塞尔曲线的终端定位轨迹拟合方法,包括:步骤1:三阶贝塞尔曲线的曲线函数如下:<img file="473518DEST_PATH_IMAGE001.GIF" wi="558" he="23" />;取相邻的两个采样点P<sub>n</sub>、P<sub>n+1</sub>作为三阶贝塞尔曲线的起点和终点,即令P<sub>0</sub>=P<sub>n</sub>,P<sub>3</sub>=P<sub>n+1</sub>;步骤2:令P<sub>1</sub>等于采样点P<sub>n</sub>的贝塞尔曲线的控制点P<sub>n</sub>';步骤3:令P<sub>2</sub>等于采样点P<sub>n+1</sub>的贝塞尔曲线的控制点P<sub>n+1</sub>';步骤4:将上述步骤中的采样点P<sub>n</sub>、采样点P<sub>n+1</sub>、采样点P<sub>n</sub>的贝塞尔曲线的控制点P<sub>n</sub>'、采样点P<sub>n+1</sub>的贝塞尔曲线的控制点P<sub>n+1</sub>',代入三阶贝塞尔曲线得到:B(t)=P<sub>n</sub>(1-t)<sup>3</sup>+3P<sub>n</sub>'t(1-t)<sup>2</sup>+3P<sub>n+1</sub>'t<sup>2</sup>(1-t)+P<sub>n+1</sub>t<sup>3</sup>,t∈(0,1),则得到对定位终端的实际轨迹的拟合曲线函数,该函数即为曲线的插值函数。步骤5:重复步骤1-4以计算下一对相邻采样点的拟合曲线函数,直至最后一个采样点。
申请公布号 CN102998684A 申请公布日期 2013.03.27
申请号 CN201210472346.2 申请日期 2012.11.21
申请人 厦门雅迅网络股份有限公司 发明人 郑振贵;彭勇;许宁;刘艺
分类号 G01S19/39(2010.01)I 主分类号 G01S19/39(2010.01)I
代理机构 厦门市诚得知识产权代理事务所(普通合伙) 35209 代理人 赖开慧
主权项 1.一种基于贝塞尔曲线的终端定位轨迹拟合方法,其特征在于:包括:步骤1:三阶贝塞尔曲线的曲线函数如下:<img file="603292DEST_PATH_IMAGE001.GIF" wi="558" he="23" />;取相邻的两个采样点P<sub>n</sub>、P<sub>n+1</sub>作为三阶贝塞尔曲线的起点和终点,即令P<sub>0</sub>=P<sub>n</sub>,P<sub>3</sub>=P<sub>n+1</sub>;步骤2:令P<sub>1</sub>等于采样点P<sub>n</sub>的贝塞尔曲线的控制点P<sub>n</sub>',将采样点P<sub>n</sub>的位置坐标记为P<sub>n</sub>(x<sub>n</sub>,y<sub>n</sub>),将控制点P<sub>n</sub>'的位置坐标记为P<sub>n</sub>'(x<sub>n</sub>',y<sub>n</sub>');P<sub>n</sub>'(x<sub>n</sub>',y<sub>n</sub>')是根据P<sub>n</sub>(x<sub>n</sub>,y<sub>n</sub>)、P<sub>n</sub>的运行方位角度α<sub>n</sub>及P<sub>n</sub>的运行速度大小v<sub>n</sub>来确定的; 步骤3:令P<sub>2</sub>等于采样点P<sub>n+1</sub>的贝塞尔曲线的控制点P<sub>n+1</sub>',将采样点P<sub>n+1</sub>的位置坐标记为P<sub>n+1</sub>(x<sub>n+1</sub>,y<sub>n+1</sub>),将控制点P<sub>n+1</sub>'的位置坐标记为P<sub>n+1</sub>'(x<sub>n+1</sub>',y<sub>n+1</sub>'); P<sub>n+1</sub>'(x<sub>n+1</sub>',y<sub>n+1</sub>')是根据P<sub>n+1</sub>(x<sub>n+1</sub>,y<sub>n+1</sub>)、P<sub>n+1</sub>的运行方位角度α<sub>n+1</sub>及P<sub>n+1</sub>的运行速度大小v<sub>n+1</sub>来确定的;步骤4:将上述步骤中的采样点P<sub>n</sub>、采样点P<sub>n+1</sub>、采样点P<sub>n</sub>的贝塞尔曲线的控制点P<sub>n</sub>'、采样点P<sub>n+1</sub>的贝塞尔曲线的控制点P<sub>n+1</sub>',代入三阶贝塞尔曲线的曲线方程得到:B(t)= P<sub>n</sub>(1-t)<sup>3</sup>+3P<sub>n</sub>'t(1-t)<sup>2</sup>+3P<sub>n+1</sub>'t<sup>2</sup>(1-t)+P<sub>n+1</sub>t<sup>3</sup>,t∈(0,1),则得到对定位终端的实际轨迹的拟合曲线函数,该函数即为曲线的插值函数;步骤5:重复步骤1-步骤4以计算下一对相邻的采样点的拟合曲线函数,直至最后一个采样点;联合所有计算出的相邻采样点的拟合曲线函数,则得到离散采样点的分段插值函数组,该函数组就是定位终端的移动轨迹的拟合曲线方程表达式。
地址 361000 福建省厦门市软件园二期观日路46号