一种三轴目标跟踪系统姿态解算装置制造方法
【专利摘要】本发明涉及一种三轴目标跟踪系统姿态解算装置。包括电机驱动的三轴框架结构、陀螺、加表和电路板，采用内回路速度环和外回路位置环构成的二环伺服系统对三轴框架进行稳定，采用可见光视频跟踪的方法对目标进行跟踪，在视轴跟踪目标的同时，采集当前陀螺和加表的信息进行姿态和航向的解算，为运载体提供实时的姿态和航向信息。
【专利说明】一种三轴目标跟踪系统姿态解算装置
【技术领域】
[0001 ] 本发明涉及一种目标跟踪系统姿态解算装置，利用三轴稳定平台在跟踪目标的同时，利用稳定平台中的陀螺和加表信息通过姿态解算，实时为运载体提供姿态和航向信息。
【背景技术】
[0002]现阶段通过陀螺和加表信息为运载体提供姿态、航向信息即为罗经，除了在航天、航空、航海广泛应用外，还在其他民用领域，诸如地质勘探、石油钻井、矿山开采、地铁施工、车辆动态性能检测等领域得到应用，是较为成熟技术。现有技术根据可见光光轴的运动范围不能够在全方位进行解算，出现死区。并且在结算过程中要求运动目标要速度受限制。
【发明内容】
[0003]为了克服现有技术的缺点，本发明提供一种三轴目标跟踪系统姿态解算装置，它能够实时输出解算数据，精度高、实时性强、可解算出任何方位姿态，不受方位和载体运动速度限制。
[0004]本发明解决其技术问题所采取的技术方案是:包括电机驱动的三轴框架结构、陀螺、加表和电路板，采用内回路速度环和外回路位置环构成的二环伺服系统对三轴框架进行稳定，采用可见光视频跟踪的方法对目标进行跟踪，在视轴跟踪目标的同时，采集当前陀螺和加表的信息进行姿态和航向的解算，为运载体提供实时的姿态和航向信息。
[0005]本发明能够实时输出解算数据，精度高、实时性强、可解算出任何方位姿态，不受方位和载体运动速度限制。
【具体实施方式】
[0006]本发明包括电机驱动的三轴框架结构、陀螺、加表和电路板，采用内回路速度环和外回路位置环构成的二环伺服系统对三轴框架进行稳定，采用可见光视频跟踪的方法对目标进行跟踪，在视轴跟踪目标的同时，采集当前陀螺和加表的信息进行姿态和航向的解算，为运载体提供实时的姿态和航向信息。
[0007]所述姿态和航向的解算采用下述解算模型:设观测坐标系为0gXgygZg，Og为目标点，a b为传感器视轴目标相对载体坐标系0bXbybzb俯仰角，β b为视轴相对载体纵向偏移夹角，载体三轴角速度为ωχ、ωY、coz，D为观测点到目标斜距离，d为D在0bxbybzb坐标系水平
投影，黾为目标俯仰角速& &为目标横滚角速度，鬲为目标围绕瞄准线滚动的角速度。
[0008]cof、ων即为速率陀螺输出量，其中在瞄准线上，为瞄准线滚动角速度。其中不仅含有目标运动的因素.tg ε b,而且还有载体运动造成的角速度分量々:
[0009]P = ων-Wf- tgab
[0010]角速度ω ' f为..[0011]
【权利要求】
1.一种三轴目标跟踪系统姿态解算装置，其特征在于:包括电机驱动的三轴框架结构、陀螺、加表和电路板，采用内回路速度环和外回路位置环构成的二环伺服系统对三轴框架进行稳定，采用可见光视频跟踪的方法对目标进行跟踪，在视轴跟踪目标的同时，采集当前陀螺和加表的信息进行姿态和航向的解算，为运载体提供实时的姿态和航向信息。
【文档编号】G05B13/04GK103744287SQ201310711893
【公开日】2014年4月23日 申请日期:2013年12月20日 优先权日:2013年12月20日
【发明者】井世丽 申请人:河北汉光重工有限责任公司