【技术实现步骤摘要】
复杂环境下多功能调试台的水平倾角的测量方法及装置
本专利技术涉及惯性测试领域,特别是涉及一种复杂环境下多功能调试台的水平倾角的测量方法及装置。
技术介绍
多功能调试台是一种用于大型设备进行组装和调试的多功能操作平台,主要部分为机械平台和控制系统。机械平台可以承载大型待组装和调试的设备,并能够垂直升降和水平旋转。控制系统通过多功能调试台上的传感器输出进行监测和控制机械平台按照操作指令正常运转,并精确到达指令位置和高度。为了精确控制机械平台,我们需要精确知道平台每一时刻的位置,其中很关键的便是机械平台的水平倾角。水平倾角测量的精度直接影响控制系统对平台的控制精度。目前,现有的多功能调试台水平倾角测量方式为基于双轴加速度计输出的测量方法。这是因为大部分多功能调试台的工作环境相对良好,基本处于准静态条件,环境干扰较小可以忽略,可以直接采用加速度计对重力加速度的敏感原理来测量水平倾角。但是,当多功能调试台处于比较恶劣的动态复杂环境中时,旋转运动产生的干扰向心加速度和线加速运动产生的干扰线加速度会对加速度计的输出产生影响,导致加速度计的输出误差增大。这进一步导致多功能调试台的 ...
【技术保护点】
一种复杂环境下多功能调试台的水平倾角的测量方法,其特征在于,所述测量方法包括:获取设置在调试台上的陀螺仪采集的角速度和加速度计采集的加速度;根据加速度计相对于调试台的旋转轴的距离、所述角速度及加速度计算基于加速度计的水平倾角;根据所述角速度确定计算基于陀螺仪的水平倾角;根据所述基于加速度计的水平倾角和基于陀螺仪的水平倾角确定所述调试台的线加速运行时的干扰情况及当前水平倾角;如果线加速运行的干扰大,则所述基于陀螺仪的水平倾角为当前水平倾角;否则,根据所述基于加速度计的水平倾角和基于陀螺仪的水平倾角确定当前水平倾角。
【技术特征摘要】
1.一种复杂环境下多功能调试台的水平倾角的测量方法,其特征在于,所述测量方法包括:获取设置在调试台上的陀螺仪采集的角速度和加速度计采集的加速度;根据加速度计相对于调试台的旋转轴的距离、所述角速度及加速度计算基于加速度计的水平倾角;根据所述角速度确定计算基于陀螺仪的水平倾角;根据所述基于加速度计的水平倾角和基于陀螺仪的水平倾角确定所述调试台的线加速运行时的干扰情况及当前水平倾角;如果线加速运行的干扰大,则所述基于陀螺仪的水平倾角为当前水平倾角;否则,根据所述基于加速度计的水平倾角和基于陀螺仪的水平倾角确定当前水平倾角。2.根据权利要求1所述的复杂环境下多功能调试台的水平倾角的测量方法,其特征在于,所述基于加速度计的水平倾角的计算方法包括:根据所述角速度和所述加速度计相对调试台的旋转轴的距离计算旋转运动导致的干扰向心加速度;根据所述加速度对所述干扰向心加速度进行补偿,获得补偿向心加速度;根据所述补偿向心加速度确定基于加速度计的水平倾角。3.根据权利要求1所述的复杂环境下多功能调试台的水平倾角的测量方法,其特征在于,所述基于陀螺仪的水平倾角的计算方法包括:对所述陀螺仪输出的角速度进行积分。4.根据权利要求1所述的复杂环境下多功能调试台的水平倾角的测量方法,其特征在于,所述确定所述调试台的线加速运行的干扰情况的方法包括:分别计算所述基于加速度计的水平倾角的角度增量及所述基于陀螺仪的水平倾角的角度增量;计算所述基于加速度计的水平倾角的角度增量与所述基于陀螺仪的水平倾角的角度增量的角度增量差值;比较所述角度增量差值与设定阈值的大小确定干扰情况,当所述角度增量差值大于设定阈值时,则确定线加速运行的干扰大;否则确定线加速运行的干扰小。5.根据权利要求4所述的复杂环境下多功能调试台的水平倾角的测量方法,其特征在于,根据以下公式确定当前水平倾角:当前的水平倾角=基于陀螺仪的水平倾角,线加速运行的干扰大;当前的水平倾角=α×基于加速度计的水平倾角+(1-α)×基于陀螺仪的水平倾角,线加速运行的干扰小;其中,α表示所述基于加速度计的水平倾角的权值。6.根据权利要求5所述的复杂环境下多功能调...
【专利技术属性】
技术研发人员:张延顺,杨旭,郗小鹏,张国平,张建斌,王建,汪湛清,陈涛,李雪玲,
申请(专利权)人:北京航空航天大学,天津航天中为数据系统科技有限公司,北京瑞尔天天科技有限公司,
类型:发明
国别省市:北京,11
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。