利用外观测信息的双轴旋转惯导系统对准及误差修正方法

    公开(公告)号:CN103575299B

    公开(公告)日:2016-09-21

    申请号:CN201310565455.3

    申请日:2013-11-13

    Abstract: 本发明提供一种利用外观测信息的双轴旋转惯导系统对准及误差修正方法,根据滤波的估计值可以实时修正导航系统的输出参数。第一步:静基座旋转式捷联惯导系统进行系统初始化;第二步:利用粗对准确定的姿态矩阵进行静基座导航解算;第三步:利用卡尔曼滤波估计载体姿态失准角、加速度计零偏、陀螺零偏、陀螺标度因数误差;第四步:将用各状态量估计值修正载体姿态矩阵和惯性器件参数,实现初始对准;第五步:使旋转式惯导系统的双轴按预定旋转方案周期性地旋转;第六步:利用卫星导航系统或地图匹配的位置信息作为外观测量信息进行卡尔曼滤波;第七步:以滤波估计结果实时修正惯导系统输出的导航参数。

    一种旋转调制惯性导航系统中隔离载体角运动的方法

    公开(公告)号:CN105588562A

    公开(公告)日:2016-05-18

    申请号:CN201510945920.5

    申请日:2015-12-16

    CPC classification number: G01C21/16 G01C21/20

    Abstract: 本发明公开了一种旋转调制惯性导航系统中隔离载体角运动的方法,其包括:根据旋转平台的旋转方案计算出第k个控制时刻旋转平台相对导航坐标系的旋转角速度;控制旋转平台旋转,使得IMU坐标系p同载体坐标系b重合;旋转调制惯性导航系统进入导航状态,获得第一个控制周期内旋转平台内环轴、外环轴的控制角速度;预测第k+1个控制周期内载体相对导航坐标系的运动角速度,以及旋转平台相对载体坐标系的旋转控制角速度;求得旋转平台内环轴、外环轴的控制角速度;控制内环轴、外环轴的控制角速度,消除载体角运动的影响,实现载体角运动的隔离。本发明保证了旋转调制的效果,提高了导航系统的精度。

    一种双轴旋转惯导系统自标定方法

    公开(公告)号:CN103575296B

    公开(公告)日:2016-04-20

    申请号:CN201310463644.X

    申请日:2013-10-08

    Abstract: 本发明提供一种双轴旋转惯导系统自标定方法,利用遗传算法对自标定方案进行优化,以提高标定精度。步骤1:选取双轴旋转惯导系统的误差模型和导航误差方程;步骤2、根据步骤1得到的误差模型和导航误差方程,利用遗传算法找出八位置标定方案的七个最优转动角度;步骤3、预热陀螺仪和加速度计组件,进行粗对准;步骤4、根据粗对准结果转动环架,调整IMU位置到近似与导航坐标系重合;步骤5、开始导航解算并根据角度转动环架到对应的位置,在每个位置采集导航解算得到的速度误差,计算得观测量;步骤6、根据每个位置的导航结果利用最小二乘计算出需要标定的误差参数。

    一种针对参数不确定性及观测丢失的鲁棒滤波方法

    公开(公告)号:CN103575278B

    公开(公告)日:2016-04-06

    申请号:CN201310464002.1

    申请日:2013-10-08

    Abstract: 本发明提出一种针对参数不确定性及观测丢失的鲁棒滤波方法。步骤一、通过数学模型对问题进行描述,包括对范数有界的参数不确定性及观测丢失的建模:步骤二、根据步骤一建立的数学模型给出包含待定参数的滤波器模型;步骤三、对原状态方程进行扩维,并求出扩维后的状态协方差阵,构造一个新状态向量;步骤四、根据步骤三得到的扩维后状态协方差阵寻找原状态向量的估计误差协方差;步骤五、对滤波器参数进行设置使得步骤四得到的估计误差协方差上界取得最小值;至此,得到一个滤波器在具有范数有界参数不确定性及观测丢失的情况下,实现状态估计误差协方差上界的最小化。

    一种应用于飞行器姿态估计的扩展卡尔曼滤波方法

    公开(公告)号:CN103414451B

    公开(公告)日:2015-11-25

    申请号:CN201310306788.4

    申请日:2013-07-22

    Abstract: 本发明提出一种应用于飞行器姿态估计的扩展卡尔曼滤波方法,能够处理各种复杂干扰的非线性系统姿态估计。第一步:建立基于观测器的飞行器的动力学模型;第二步:根据第一步建立的模型方程,对加速度计和陀螺仪所测量三轴的姿态角θ加和三轴姿态角速度ω陀进行互补滤波,滤除高频和低频干扰,得到较纯净的信息值θ,去除可能系统内部及外部的扰动;第三步:利用第二步得到的信息值θ,采用扩展Kalman滤波方法对状态变量进行估计,得到的值即为姿态的估计值,从而完成了对飞行器状态的估计。

    一种针对过程噪声协方差矩阵Q未知情况下的Kalman滤波方法

    公开(公告)号:CN104868876A

    公开(公告)日:2015-08-26

    申请号:CN201510239254.3

    申请日:2015-05-12

    Abstract: 本发明提供一种针对过程噪声协方差矩阵Q未知情况下的Kalman滤波方法,具体过程为:步骤一,判断系统模型是否满足预设条件,若满足,则进入步骤二,否则结束该方法;步骤二,构建系统广义输出矩阵E;步骤三,利用所述矩阵E确定系统输出的耦合向量δi;步骤四、根据耦合向量δi构建系统输出的线性耦合;基于所述线性耦合,利用大数定律对过程噪声的协方差矩阵Q进行估计,将估计的结果记为步骤五、将过程噪声的协方差矩阵的实时估计结果带入到标准Kalman滤波器中,获得滤波结果。本发明方法可以实现过程噪声协方差矩阵Q未知情况下的Kalman滤波。

    一种基于核函数的实时地形估计方法

    公开(公告)号:CN104820982A

    公开(公告)日:2015-08-05

    申请号:CN201510199728.6

    申请日:2015-04-23

    Abstract: 本发明提供一种基于核函数的实时地形估计方法,具体过程为:获取实时点云数据和车辆当前状态相对于绝对空间的旋转平移矩阵;利用所述旋转平移矩阵对实时点云数据进行配准,并对配准后的点云数据采用基于体素的降采样处理;遍历历史点云库中的每一点,采用点约束建立描述被估计区域地形的地形矩阵MAP;利用实时点云数据对所述地形矩阵MAP进行点约束和光线约束,将此时获得的地形矩阵MAP作为当前无人车周围的地形估计;将所述配准后的实时点云数据添加到历史点云库中,更新历史点云数据。该方法能适用于无人车高实时性、海量数据的地形估计,解决运动中盲区的补偿,并给出可以在线更新的显式估计结果。

    一种应用于特征点标定算法中的热像仪-3D激光雷达的温控标定靶

    公开(公告)号:CN103149556B

    公开(公告)日:2014-12-17

    申请号:CN201310033891.6

    申请日:2013-01-29

    Abstract: 本发明公开一种用于特征点标定算法的热像仪与3D激光雷达温控标定靶。该标定装置利用热像仪与3D激光雷达分别采集标定靶上的同一组特征点,得到图像及3D点云数据,使得基于特征点的标定算法得以实现。包括发热网、发热网框架、激光挡片、俯仰转轴、水平转轴、高度调节器、温度控制器和温度传感器等。其中水平转轴和俯仰转轴调整标定靶的姿态和朝向;高度调节器调节标定靶的高度;温度控制器通过将发热网当前温度与设定的目标温度进行比较,从而调节发热网的温度。发热网交叉处的点为热像仪提供红外特征角点;当将黑色激光挡片间隔地镶嵌在发热网格中时,激光挡片为激光雷达提供深度特征角点,也可在可见光摄像机进行标定时为摄像机提供图像特征角点。

    一种双轴旋转惯导系统多位置自主标定方法

    公开(公告)号:CN104165638A

    公开(公告)日:2014-11-26

    申请号:CN201410386915.0

    申请日:2014-08-07

    CPC classification number: G01C25/005

    Abstract: 本发明提供一种双轴旋转惯导系统多位置自主标定方法,适用于双轴旋转惯导系统,避免系统组件定期拆卸,能够提高长航时导航自主性的在线标定方法。包括以下步骤:步骤1:建立双轴旋转惯导系统的器件误差模型和导航误差方程;步骤2:预热陀螺仪和加速度计组件,进行基于卡尔曼滤波的单位置精对准;步骤3:根据精对准结果转动载体,调整载体位置到近似与导航坐标系重合;步骤4:按照十位置转位方法转动环架,在每个位置采集导航解算得到的速度误差并计算姿态误差变化量,得到观测量;步骤5:根据每个位置的导航结果利用最小二乘计算出需要标定的误差。

    一种旋转式捷联惯性导航系统静基座初始对准方法

    公开(公告)号:CN102679978B

    公开(公告)日:2014-10-29

    申请号:CN201210148310.9

    申请日:2012-05-14

    Abstract: 本发明属于惯性导航技术领域,为了克服现有的初始对准方法中存在的计算量大、收敛速度和精度不理想的问题,本发明提出了一种旋转式捷联惯性导航系统静基座初始对准方法,该方法采用低阶的卡尔曼滤波状态方程模型和相应的自对准外观测量获取方法有效的降低了对准计算过程中的计算量,此外通过旋转IMU(惯性测量单元)优化了卡尔曼滤波性能,从而改善了惯导系统静基座初始对准性能。

Patent Agency Ranking