• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
    • / 17
    • 下载费用:30 金币  

    重庆时时彩露珠网址: 一种液压支架位姿的实时检测方法.pdf

    关 键 词:
    一种 液压 支架 实时 检测 方法
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    摘要
    申请专利号:

    CN201410137452.4

    申请日:

    2014.04.04

    公开号:

    CN103968856A

    公开日:

    2014.08.06

    当前法律状态:

    授权

    有效性:

    有权

    法律详情: 授权|||实质审查的生效IPC(主分类):G01C 23/00申请日:20140404|||公开
    IPC分类号: G01C23/00 主分类号: G01C23/00
    申请人: 中国矿业大学; 苏州福德保瑞科技发展有限公司
    发明人: 谭超; 王秋实; 闫海峰; 王忠宾; 周晓谋; 姚新港; 刘新华; 刘继东
    地址: 221000 江苏省徐州市大学路1号南湖校区
    优先权:
    专利代理机构: 徐州支点知识产权代理事务所(普通合伙) 32244 代理人: 刘新合
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201410137452.4

    授权公告号:

    ||||||

    法律状态公告日:

    2015.06.24|||2014.09.03|||2014.08.06

    法律状态类型:

    授权|||实质审查的生效|||公开

    摘要

    本发明公开一种液压支架位姿的实时检测方法,尤其涉及一种基于三轴加速度传感器和三轴陀螺仪检测液压支架位姿的方法。随着工作面的推进,支架需要不断移动,支护位置不是固定不变的,在支架移架过程中主要的主动动作包括:降架、拉架、升架。液压支架顶梁直接与顶板接触,是用于支护的主要部件,同时也是主要的运动部件,本发明使用三轴加速度传感器和三轴陀螺仪实时测量支架顶梁位置、倾角的变化量,通过积分的方式获得液压支架任意时刻的位姿。

    权利要求书

    权利要求书
    1.  一种液压支架位姿的实时检测方法,其特征在于:基于三轴加速度传感器以及三轴陀螺仪测量液压支架移架过程中支架顶梁运动的具体实现过程,所述移架过程包括降架、拉架和升架三个过程,在降架和升架过程中支架只有顶梁位姿发生变化,即获得顶梁位姿变化情况便可获得支架姿态;在拉架过程中支架本身姿态不发生变化,顶梁的位姿变化情况就是支架整体位姿的变化情况;
    三轴加速传感器和三轴陀螺仪测量轴重合,在初始状态时两个传感器测量坐标系与参考坐标系OXYZ重合,经过i-1次移架过程后,测量坐标系变更为OXiYiZi,将坐标系OXiYiZi看作由坐标系OXYZ经坐标变换后得到,其变换方法如下:
    由坐标系OXYZ绕Z轴旋转α角,得到OX’Y’Z’;
    由坐标系OX’Y’Z’绕X’轴旋转β角,得到OX”Y”Z”;
    由坐标系OX”Y”Z”绕Z”轴旋转γ角,得到OXiYiZi;
    坐标变换矩阵为T(α,β,γ),且:
    T=cosαcosβcosβsinα-sinβsinγsinβcosα-cosγsinαsinγsinβsinα+cosγcosαsinγcosβcosγsinβcosβ+sinγsinαcosγsinβsinα-sinγcosαcosγcosβ]]>
    下面通过三个步骤,即:降架、拉架和升架来分别对移架过程中顶梁位姿的变化来进行测量获得:
    (1)降架,在降架开始△t1后,顶梁测量坐标系变为OXi1Yi1Zi1:
    a、通过三轴陀螺仪测得顶梁在降架过程中绕Xi1、Yi1、Zi1轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi1ωyi1ωzi1;]]>
    c、降架过程中顶梁只有俯仰角α和翻滚角β发生变化,通过上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,Δγ=0,变化后:α’=α+Δα、β’=β+Δβ、γ’=γ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’);
    e、通过三轴加速度传感器测得顶梁在降架时Xi1、Yi1、Zi1轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi1ayi1azi1;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi1ayi1azi1-00g;]]>
    h、在△t1时间内,顶梁在X、Y、Z方向的位移可以用二 重积分的方法求得△sx1、△sy1、△sz1,Δsx1=∫∫ax1dt、Δsy1=∫∫ay1dt、Δsz1=∫∫az1dt;
    经过上述运算可以求得顶梁在降架结束后,俯仰角变化值α1、翻滚角变化值β1、X方向位移sx1、Y方向位移sy1、Z方向位移sz1;
    (2)拉架,在拉架开始△t2后,顶梁测量坐标系变为OXi2Yi2Zi2:
    a、通过三轴陀螺仪测得顶梁在降架过程中绕Xi2、Yi2、Zi2轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi2ωyi2ωzi2;]]>
    c、拉架过程中顶梁可能俯仰角α、翻滚角β和导航角γ同时发生变化,通上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,变化后:α’=α+Δα、β’=β+Δβ、γ’=γ+Δγ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’)
    e、通过三轴加速度传感器测得顶梁在拉架时Xi2、Yi2、Zi2轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi2ayi2azi2;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi2ayi2azi2-00g;]]>
    h、在△t2时间内,顶梁在X、Y、Z方向的位移可以用二重积分的方法求得△sx2、△sy2、△sz2;
    Δsx2=∫∫ax2dt、Δsy2=∫∫ay2dt、Δsz2=∫∫az2dt;
    经过上述运算可以求得顶梁在拉架结束后,俯仰角变化值α2、翻滚角变化值β2、导航角变化值γ2、X方向位移sx2、Y方向位移sy2、Z方向位移sz2;
    (3)升架,在升架开始△t3后,顶梁测量坐标系变为OXi3Yi3Zi3:
    a、通过三轴陀螺仪测得顶梁在升架过程中绕Xi3、Yi3、Zi3轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi3ωyi3ωzi3;]]>
    c、升架过程中顶梁只有俯仰角α和翻滚角β发生变化, 通上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,Δγ=0,变化后:α’=α+Δα、β’=β+Δβ、γ’=γ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’);
    e、通过三轴加速度传感器测得顶梁在升架时Xi3、Yi3、Zi3轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi3ayi3azi3;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi3ayi3azi3-00g;]]>
    h、在△t3时间内,顶梁在X、Y、Z方向的位移可以用二重积分的方法求得△sx3、△sy3、△sz3;
    Δsx3=∫∫ax3dt、Δsy3=∫∫ay3dt、Δsz3=∫∫az3dt;
    经过上述运算可以求得顶梁升架完成后,俯仰角变化值α3、翻滚角变化值β3、X方向位移sx3、Y方向位移sy3、Z方向位移sz3;
    综上所述:支架在第i次移架过程中,支架顶梁在参考坐标系X方向位移sxi,Y方向位移syi,Z方向位移szi;
    sxi=sx1+sx2+sx3,syi=sy1+sy2+sy3,szi=sz1+sz2+sz3;
    支架在第i次移架过程中,顶梁俯仰角变化αi,横滚角变化βi,航向角变化γi;
    αi=α1+α2+α3、βi=β1+β2+β3、γi=γ1+γ2+γ3;
    支架在第i次移架后,在参考坐标系下,顶梁法向量n=(xn,yn,zn)T;
    xnynzn=T010=cosβsinαsinγsinβsinα+cosγcosαcosγsinβsinα-sinγcosα;]]>
    已知第i次移架前液压支架的姿态,便可以通过上述方法获得第i次移架后液压支架的姿态;已知支架在井下安装完成后的姿态可以通过上述方法检测液压支架任意时刻的姿态。

    说明书

    说明书一种液压支架位姿的实时检测方法
    技术领域
    本发明涉及一种液压支架位姿的实时检测方法,尤其涉及一种基于三轴加速度传感器和三轴陀螺仪测量液压支架位姿的方法。
    背景技术
    煤矿开采环境恶劣,工人工作劳动强度高、健康危害大,有时还会危及生命。随着煤矿行业科技投入,自动化程度逐渐提高,工人工作条件得到了一定程度的改善,但工作面开采时工作环境恶劣的情况,始终无法得到改善,煤尘、水雾以及岩层冲击无时无刻不危害着工人的身体健康。实现工作面无人、少人化开采可以有效的避免上述危害。
    在综采工作面中,液压支架负责支撑顶板,以及对顶板进行有效的控制,保证顶板的稳定性。随着工作面的推进,液压支架需要不断移架,然而在移架过程中,支架顶梁脱离顶板的高度、时间均会影响顶板的稳定性。在实现无人、少人工作面的进程中,液压支架姿态的实时检测是无法回避的问题。
    根据液压支架机械机构,只要测得支架主动油缸的实时长度便可以获得支架姿态,但是在井下的恶劣环境下以及条件限制,无法通过传感器直接测得主动油缸的长度。
    发明内容
    为了克服上述缺陷,本发明提供一种通过测量支架顶梁运 动情况,来获得液压位姿的实时检测方法,尤其涉及一种基于三轴加速度传感器和三轴陀螺仪测量液压支架位姿的方法。
    本发明为了解决其技术问题所采用的技术方案是:一种液压支架位姿的实时检测方法,其基于三轴加速度传感器以及三轴陀螺仪测量液压支架移架过程中支架顶梁运动的具体实现过程,所述移架过程包括降架、拉架和升架三个过程,在降架和升架过程中支架只有顶梁位姿发生变化,即获得顶梁位姿变化情况便可获得支架姿态;在拉架过程中支架本身姿态不发生变化,顶梁的位姿变化情况就是支架整体位姿的变化情况;
    三轴加速传感器和三轴陀螺仪测量轴重合,在初始状态时两个传感器测量坐标系与参考坐标系OXYZ重合,经过i-1次移架过程后,测量坐标系变更为OXiYiZi,将坐标系OXiYiZi看作由坐标系OXYZ经坐标变换后得到,其变换方法如下:
    由坐标系OXYZ绕Z轴旋转α角,得到OX’Y’Z’;
    由坐标系OX’Y’Z’绕X’轴旋转β角,得到OX”Y”Z”;
    由坐标系OX”Y”Z”绕Z”轴旋转γ角,得到OXiYiZi;
    坐标变换矩阵为T(α,β,γ),且:
    T=cosαcosβcosβsinα-sinβsinγsinβcosα-cosγsinαsinγsinβsinα+cosγcosαsinγcosβcosγsinβcosβ+sinγsinαcosγsinβsinα-sinγcosαcosγcosβ]]>
    下面分别通过三个步骤,即:降架、拉架和升架来对移架过程中顶梁位姿的变化来进行测量:
    (1)降架,在降架开始△t1后,顶梁测量坐标系变为OXi1Yi1Zi1:
    a、通过三轴陀螺仪测得顶梁在降架过程中绕Xi1、Yi1、Zi1轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi1ωyi1ωzi1;]]>
    c、降架过程中顶梁只有俯仰角α和翻滚角β发生变化,通过上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,Δγ=0,变化后:α’=α+Δα、β’=β+Δβ、γ’=γ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’);
    e、通过三轴加速度传感器测得顶梁在降架时Xi1、Yi1、Zi1轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi1ayi1azi1;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi1ayi1azi1-00g;]]>
    h、在△t1时间内,顶梁在X、Y、Z方向的位移可以用二 重积分的方法求得△sx1、△sy1、△sz1,Δsx1=∫∫ax1dt、Δsy1=∫∫ay1dt、Δsz1=∫∫az1dt;
    经过上述运算可以求得顶梁在降架结束后,俯仰角变化值α1、翻滚角变化值β1、X方向位移sx1、Y方向位移sy1、Z方向位移sz1;
    (2)拉架,在拉架开始△t2后,顶梁测量坐标系变为OXi2Yi2Zi2:
    a、通过三轴陀螺仪测得顶梁在降架过程中绕Xi2、Yi2、Zi2轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi2ωyi2ωzi2;]]>
    c、拉架过程中顶梁可能俯仰角α、翻滚角β和导航角γ同时发生变化,通上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,Δα=∫α·dt,Δβ=∫β·dt,Δγ=∫γ·dt,]]>变化后:α’=α+Δα、β’=β+Δβ、γ’=γ+Δγ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’)
    e、通过三轴加速度传感器测得顶梁在拉架时Xi2、Yi2、Zi2轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi2ayi2azi2;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi2ayi2azi2-00g;]]>
    h、在△t2时间内,顶梁在X、Y、Z方向的位移可以用二重积分的方法求得△sx2、△sy2、△sz2;
    Δsx2=∫∫ax2dt、Δsy2=∫∫ay2dt、Δsz2=∫∫az2dt;
    经过上述运算可以求得顶梁在拉架结束后,俯仰角变化值α2、翻滚角变化值β2、导航角变化值γ2、X方向位移sx2、Y方向位移sy2、Z方向位移sz2;
    (3)升架,在升架开始△t3后,顶梁测量坐标系变为OXi3Yi3Zi3:
    a、通过三轴陀螺仪测得顶梁在升架过程中绕Xi3、Yi3、Zi3轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi3ωyi3ωzi3;]]>
    c、升架过程中顶梁只有俯仰角α和翻滚角β发生变化, 通上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,Δγ=0,变化后:α’=α+Δα、β’=β+Δβ、γ’=γ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’);
    e、通过三轴加速度传感器测得顶梁在升架时Xi3、Yi3、Zi3轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi3ayi3azi3;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi3ayi3azi3-00g;]]>
    h、在△t3时间内,顶梁在X、Y、Z方向的位移可以用二重积分的方法求得△sx3、△sy3、△sz3;
    Δsx3=∫∫ax3dt、Δsy3=∫∫ay3dt、Δsz3=∫∫az3dt;
    经过上述运算可以求得顶梁升架完成后,俯仰角变化值α3、翻滚角变化值β3、X方向位移sx3、Y方向位移sy3、Z方向位移sz3;
    综上所述:支架在第i次移架过程中,支架顶梁在参考坐标系X方向位移sxi,Y方向位移syi,Z方向位移szi;
    sxi=sx1+sx2+sx3,syi=sy1+sy2+sy3,szi=sz1+sz2+sz3;
    支架在第i次移架过程中,顶梁俯仰角变化αi,横滚角变化βi,航向角变化γi;
    αi=α1+α2+α3、βi=β1+β2+β3、γi=γ1+γ2+γ3;
    支架在第i次移架后,在参考坐标系下,顶梁法向量n=(xn,yn,zn)T;
    xnynzn=T010=cosβsinαsinγsinβsinα+cosγcosαcosγsinβsinα-sinγcosα;]]>
    已知第i次移架前液压支架的姿态,便可以通过上述方法获得第i次移架后液压支架的姿态;已知支架在井下安装完成后的姿态可以通过上述方法检测液压支架任意时刻的姿态。
    本发明的有益效果是:通过安装在顶梁的三轴加速度传感器和三轴陀螺仪传感器,可以实时检测液压支架在进行降架、拉架、升架动作时,液压支架位姿的变化情况,为液压支架的姿态检测提供有效的依据??梢越竦玫淖颂莸既胍貉怪Ъ芗嗫叵低持?,并转换为可视化的图形界面,直观的显示给远程监控操作人员,操作人员根据支架的实时姿态可以更加有效的对其进行控制。
    附图说明
    图1传感器安装位置及测量轴方向的示意图;
    图2顶梁俯仰角、横滚角、航向角的分解示意图;
    图3液压支架位姿实时检测方法流程图。
    具体实施方式
    下面结合附图对本发明进行进一步的阐述。
    如图1至图3所示,一种液压支架位姿的实时检测方法,其基于三轴加速度传感器以及三轴陀螺仪测量液压支架移架过程中支架顶梁运动的具体实现过程,所述移架过程包括降架、拉架和升架三个过程,在降架和升架过程中支架只有顶梁位姿发生变化,即获得顶梁位姿变化情况便可获得支架姿态;在拉架过程中支架本身姿态不发生变化,顶梁的位姿变化情况就是支架整体位姿的变化情况;
    三轴加速传感器和三轴陀螺仪测量轴重合,在初始状态时两个传感器测量坐标系与参考坐标系OXYZ重合,经过i-1次移架过程后,测量坐标系变更为OXiYiZi,将坐标系OXiYiZi看作由坐标系OXYZ经坐标变换后得到,其变换方法如下:
    由坐标系OXYZ绕Z轴旋转α角,得到OX’Y’Z’;
    由坐标系OX’Y’Z’绕X’轴旋转β角,得到OX”Y”Z”;
    由坐标系OX”Y”Z”绕Z”轴旋转γ角,得到OXiYiZi;
    坐标变换矩阵为T(α,β,γ),且:
    T=cosαcosβcosβsinα-sinβsinγsinβcosα-cosγsinαsinγsinβsinα+cosγcosαsinγcosβcosγsinβcosβ+sinγsinαcosγsinβsinα-sinγcosαcosγcosβ]]>
    下面分别通过三个步骤,即:降架、拉架和升架来对移架过程中顶梁位姿的变化来进行测量:
    (1)降架,在降架开始△t1后,顶梁测量坐标系变为OXi1Yi1Zi1:
    a、通过三轴陀螺仪测得顶梁在降架过程中绕Xi1、Yi1、Zi1轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi1ωyi1ωzi1;]]>
    c、降架过程中顶梁只有俯仰角α和翻滚角β发生变化,通过上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,Δγ=0,变化后:α’=α+Δα、β’=β+Δβ、γ’=γ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’);
    e、通过三轴加速度传感器测得顶梁在降架时Xi1、Yi1、Zi1轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi1ayi1azi1;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi1ayi1azi1-00g;]]>
    h、在△t1时间内,顶梁在X、Y、Z方向的位移可以用二重积分的方法求得△sx1、△sy1、△sz1,Δsx1=∫∫ax1dt、Δsy1=∫∫ay1dt、Δsz1=∫∫az1dt;
    经过上述运算可以求得顶梁在降架结束后,俯仰角变化值α1、翻滚角变化值β1、X方向位移sx1、Y方向位移sy1、Z方向位移sz1;
    (2)拉架,在拉架开始△t2后,顶梁测量坐标系变为OXi2Yi2Zi2:
    a、通过三轴陀螺仪测得顶梁在降架过程中绕Xi2、Yi2、Zi2轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi2ωyi2ωzi2;]]>
    c、拉架过程中顶梁可能俯仰角α、翻滚角β和导航角γ同时发生变化,通上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ,Δα=∫α·dt,Δβ=∫β·dt,Δγ=∫γ·dt,]]>变化后:α’=α+Δα、β’=β+Δβ、γ’=γ+Δγ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’)
    e、通过三轴加速度传感器测得顶梁在拉架时Xi2、Yi2、Zi2轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi2ayi2azi2;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi2ayi2azi2-00g;]]>
    h、在△t2时间内,顶梁在X、Y、Z方向的位移可以用二重积分的方法求得△sx2、△sy2、△sz2;
    Δsx2=∫∫ax2dt、Δsy2=∫∫ay2dt、Δsz2=∫∫az2dt;
    经过上述运算可以求得顶梁在拉架结束后,俯仰角变化值α2、翻滚角变化值β2、导航角变化值γ2、X方向位移sx2、Y方向位移sy2、Z方向位移sz2;
    (3)升架,在升架开始△3后,顶梁测量坐标系变为OXi3Yi3Zi3:
    a、通过三轴陀螺仪测得顶梁在升架过程中绕Xi3、Yi3、Zi3轴的瞬时角速率
    b、根据之前设定的坐标变换流程可以获得到与之间的关系:
    α·β·γ·=-sinγsinβcosγ0sinβ01cosγcosβsinγ0-1ωxi3ωyi3ωzi3;]]>
    c、升架过程中顶梁只有俯仰角α和翻滚角β发生变化,通上式积分便可求出降架开始经过任意时间△t后,顶梁转动情况,即俯仰角和翻滚角变化了Δα、Δβ, Δγ=0,变化后:α’=α+Δα、β’=β+Δβ、γ’=γ;
    d、更新坐标变换矩阵T(α,β,γ),新坐标变换矩阵为T’(α’,β’,γ’);
    e、通过三轴加速度传感器测得顶梁在升架时Xi3、Yi3、Zi3轴方向的瞬时加速度
    f、利用坐标变换矩阵将加速度变换到参考坐标系OXYZ,求得X、Y、Z轴方向的瞬时加速度ax、ay、az,
    axayaz=T,-1axi3ayi3azi3;]]>
    g、滤掉重力加速度g,axayaz=T,-1axi3ayi3azi3-00g;]]>
    h、在△t3时间内,顶梁在X、Y、Z方向的位移可以用二重积分的方法求得△sx3、△sy3、△sz3;
    Δsx3=∫∫ax3dt、Δsy3=∫∫ay3dt、Δsz3=∫∫az3dt;
    经过上述运算可以求得顶梁升架完成后,俯仰角变化值α3、翻滚角变化值β3、X方向位移sx3、Y方向位移sy3、Z方向位移sz3;
    综上所述:支架在第i次移架过程中,支架顶梁在参考坐标系X方向位移sxi,Y方向位移syi,Z方向位移szi;
    sxi=sx1+sx2+sx3,syi=sy1+sy2+sy3,szi=sz1+sz2+sz3;
    支架在第i次移架过程中,顶梁俯仰角变化αi,横滚角变化βi,航向角变化γi;
    αi=α1+α2+α3、βi=β1+β2+β3、γi=γ1+γ2+γ3;
    支架在第i次移架后,在参考坐标系下,顶梁法向量n=(xn,yn,zn)T;
    xnynzn=T010=cosβsinαsinγsinβsinα+cosγcosαcosγsinβsinα-sinγcosα;]]>
    已知第i次移架前液压支架的姿态,便可以通过上述方法获得第i次移架后液压支架的姿态;已知支架在井下安装完成后的姿态可以通过上述方法检测液压支架任意时刻的姿态。

    关于本文
    本文标题:一种液压支架位姿的实时检测方法.pdf
    链接地址://www.4mum.com.cn/p-6143935.html
    关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

    [email protected] 2017-2018 www.4mum.com.cn网站版权所有
    经营许可证编号:粤ICP备17046363号-1 
     


    收起
    展开
  • 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
  • 重庆时时龙虎玩法 如何买竞彩稳赚不赔 飞艇pk10一天稳赚5000北京 彩票双面盘1.995 广东十一选5计划软件 中国体育彩票自助机 pk10软件怎么制作 11选5前三定胆技巧 慈善网稳赚六肖 双色球19115期开奖日 稳赚不赔的彩票平台 黑龙江时时暂停 山东十一选五稳赚技巧 赛车计划手机软件 安徽时时单双怎么玩 11选5计划软件哪个好