航迹预测装置、航迹预测方法及航迹预测程序与流程

文档序号:20012614发布日期:2020-02-22 04:32阅读:来源:国知局

技术特征:

1.一种航迹预测装置,具备:

水平对地速度计算部,根据移动体的姿势角、对地去路及对地船速而计算水平对地速度;

角速度计算部,对所述移动体的角速度进行计测或者计算;以及

预测位置计算部,使用从当前时刻至预测时刻为止的时间和所述水平对地速度,若所述角速度超过转动检测阈值则使用所述角速度的积分运算来计算预测位置。

2.如权利要求1所述的航迹预测装置,

所述预测位置计算部若所述角速度为转动检测阈值以下则不使用所述角速度地计算预测位置。

3.如权利要求1或者权利要求2所述的航迹预测装置,具备:

姿势角计算部,使用定位信号的载波相位,计算所述姿势角。

4.如权利要求1至权利要求3的任一项所述的航迹预测装置,具备:

对地去路计算部,使用定位信号的载波相位,计算所述对地去路。

5.如权利要求3所述的航迹预测装置,

所述姿势角计算部计算所述姿势角中的至少偏航角。

6.如权利要求1至权利要求5的任一项所述的航迹预测装置,

所述角速度计算部使用定位信号的载波相位或者惯性传感器的输出来计算所述角速度。

7.如权利要求1至权利要求6的任一项所述的航迹预测装置,

所述预测位置计算部计算与多个所述预测时刻对应的预测位置,计算对其进行连结的预测航迹。

8.如权利要求7所述的航迹预测装置,具备:

显示部,显示所述预测位置和所述预测航迹。

9.一种航迹预测方法,

根据移动体的姿势角、对地去路及对地船速而计算水平对地速度;

对所述移动体的角速度进行计测或者计算;

使用从当前时刻至预测时刻为止的时间和所述水平对地速度,若所述角速度超过转动检测阈值则使用所述角速度的积分运算来计算预测位置。

10.如权利要求9所述的航迹预测方法,

在计算所述预测位置时,若所述角速度为转动检测阈值以下则不使用所述角速度地计算所述预测位置。

11.如权利要求9或者权利要求10所述的航迹预测方法,

使用定位信号的载波相位,计算所述姿势角。

12.如权利要求9至权利要求11的任一项所述的航迹预测方法,

使用定位信号的载波相位,计算所述对地去路。

13.如权利要求11所述的航迹预测方法,

在计算所述姿势角时,计算所述姿势角中的至少偏航角。

14.如权利要求9至权利要求13的任一项所述的航迹预测方法,

在计算所述角速度时,使用定位信号的载波相位或者惯性传感器的输出来计算所述角速度。

15.一种航迹预测程序,使运算处理器执行以下处理:

根据移动体的姿势角、对地去路及对地船速而计算水平对地速度;

对所述移动体的角速度进行计测或者计算;

使用从当前时刻至预测时刻为止的时间和所述水平对地速度,若所述角速度超过转动检测阈值则使用所述角速度的积分运算来计算预测位置。

16.如权利要求15所述的航迹预测程序,使所述运算处理器执行以下处理:

在计算所述预测位置时,若所述角速度为转动检测阈值以下则不使用所述角速度地计算所述预测位置。

17.如权利要求15或者权利要求16所述的航迹预测程序,使所述运算处理器执行以下处理:

使用定位信号的载波相位,计算所述姿势角。

18.如权利要求15至权利要求17的任一项所述的航迹预测程序,使所述运算处理器执行以下处理:

使用定位信号的载波相位,计算所述对地去路。

19.如权利要求17所述的航迹预测程序,使所述运算处理器执行以下处理:

在计算所述姿势角时,计算所述姿势角中的至少偏航角。

20.如权利要求15至权利要求19的任一项所述的航迹预测程序,使所述运算处理器执行以下处理:

在计算所述角速度时,使用定位信号的载波相位或者惯性传感器的输出来计算所述角速度。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1