发明名称 随动模式下不稳定平台绝对晃动量测量方法
摘要 本发明给出了一种实时、高精度测量不稳定平台绝对晃动量的方法:在不稳定平台上安装像机,像机随平台运动同时对空间上的平面靶板成像,进而利用位姿估计算法得到当前时刻像机相对初始绝对基准状态的高低角和方位角,由于不稳定平台和像机之间存在一个固连关系,不稳定平台的姿态参数可以由此确定。本发明通过摄像测量技术实时、高精度确定不稳定平台姿态晃动量,角度精度可达10角秒;解决了利用摄像测量方法高精度确定绝对水平基准的工程难题;可以实现在简化配置下对不稳定平台姿态晃动量的误差补偿修正。<!--1-->
申请公布号 CN102829764B 申请公布日期 2014.09.10
申请号 CN201210284173.1 申请日期 2012.08.10
申请人 中国人民解放军国防科学技术大学 发明人 张小虎;刘进博;周剑;于起峰
分类号 G01C11/00(2006.01)I 主分类号 G01C11/00(2006.01)I
代理机构 湖南省国防科技工业局专利中心 43102 代理人 冯青
主权项 随动模式下不稳定平台绝对晃动量测量方法,其特征在于,在不稳定平台上安装像机,像机随不稳定平台一起运动同时对固连在地面的绝对水平靶板成像,进而利用位姿估计算法得到当前时刻像机相对初始绝对基准状态的高低角和方位角,不稳定平台和像机之间存在一个固连关系,不稳定平台的姿态参数由此确定,具体步骤如下:a、初始时刻高精度标定像机内参;b、调平平面靶板和不稳定平台;c、利用位姿估计算法解算绝对水平状态下像机相对水平面的姿态参数;d、通过对比当前时刻和初始状态像机相对水平面的姿态变化量确定像机的旋转角度;e、利用像机和不稳定平台之间的转换关系解算不稳定平台转动的高低角和方位角,所述不稳定平台的姿态参数,具体计算如下:对于绝对水平靶板上的任一点,其在像机坐标系中的坐标<img file="343701dest_path_image001.GIF" wi="23" he="29" />和在绝对基准坐标系中的坐标<img file="136207dest_path_image002.GIF" wi="21" he="29" />存在如下转换关系:<img file="853628dest_path_image003.GIF" wi="119" he="29" />当平面靶板上至少存在6个点时,即<img file="124203dest_path_image004.GIF" wi="38" he="22" />,可解算出像机坐标系与绝对水平坐标系之间的相对姿态关系,因此在初始状态下调平不稳定平台和绝对水平基准,得到像机坐标系<img file="805152dest_path_image005.GIF" wi="49" he="22" />轴与其在水平面上投影的夹角<img file="502981dest_path_image006.GIF" wi="55" he="28" />;根据<img file="645381dest_path_image007.GIF" wi="17" he="32" />时刻像机与平面靶板像点关系同理可解得在当前状态下的夹角<img file="719647dest_path_image008.GIF" wi="50" he="28" />,则当前时刻与初始状态的夹角之差即为不稳定平台在沿局部坐标系<img file="323279dest_path_image005.GIF" wi="49" he="22" />轴方向的姿态变化量:<img file="192009dest_path_image009.GIF" wi="98" he="56" />。
地址 410073 湖南省长沙市砚瓦池正街47号