CN111816023A - 一种新型四轴载人离心机的运动学方法 - Google Patents
一种新型四轴载人离心机的运动学方法 Download PDFInfo
- Publication number
- CN111816023A CN111816023A CN202010734741.8A CN202010734741A CN111816023A CN 111816023 A CN111816023 A CN 111816023A CN 202010734741 A CN202010734741 A CN 202010734741A CN 111816023 A CN111816023 A CN 111816023A
- Authority
- CN
- China
- Prior art keywords
- acceleration
- cabin
- motion
- axis
- angular
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G09—EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
- G09B—EDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
- G09B9/00—Simulators for teaching or training purposes
- G09B9/02—Simulators for teaching or training purposes for teaching control of vehicles or other craft
- G09B9/08—Simulators for teaching or training purposes for teaching control of vehicles or other craft for teaching control of aircraft, e.g. Link trainer
- G09B9/10—Simulators for teaching or training purposes for teaching control of vehicles or other craft for teaching control of aircraft, e.g. Link trainer with simulated flight- or engine-generated force being applied to aircraft occupant
Landscapes
- Engineering & Computer Science (AREA)
- Theoretical Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Business, Economics & Management (AREA)
- Physics & Mathematics (AREA)
- Educational Administration (AREA)
- Educational Technology (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
开了一种新型四轴载人离心机的运动学方法,四轴载人离心机由外而内旋转顺序依次是主轴偏航运动、座舱滚转运动、座舱俯仰运动、座舱偏航运动;根据离心机各转轴的运动获取座舱中人体相对于座舱的运动,通过新型四轴载人离心机的运动学D‑H参数;根据飞行中飞行员承受的3个线加速度Gxa、Gya、Gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线,反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线,使座舱中飞行员随体坐标系上的加速度与实际飞行一致。通过本发明,可以实现降低四轴载人离心机的控制难度,提高了其在飞行训练方面的应用前景。
Description
技术领域
本发明涉及飞行训练领域,具体是一种新型四轴载人离心机的运动学方法。
背景技术
四轴载人离心机是训练飞行员定向认知能力并且克服定向障碍的重要设备,基于离心运动平台的模拟器通过转臂的转动产生持续的过载,可在地面以较低的代价和更安全的方式对飞行员进行训练,提高飞行员在过载环境下的空间定向障碍防御。
典型的四轴载人离心机可实现主轴、偏航、滚转与俯仰四轴360°连续转动,可用于多种空间定向障碍飞行动作等训练。在结构设计上,其由外而内旋转顺序依次是主轴偏航运动、座舱偏航运动(Z)、座舱滚转运动(X)、座舱俯仰运动(Y),即ZXY旋转配置模式。
针对典型四轴载人离心机的运动学逆问题,已分别实现“3个线加速度与实际飞行一致”(Vladimir M.K.,2014)、“3个角运动与实际飞行一致”(茅坪,2019)的2种逆问题求解方法。三轴载人离心机可以在物理量上实现3个线加速度与实际飞行一致(Vladimir M.K.,2014)。典型四轴载人离心机在运动学上仅能实现3个物理量与实际飞行一致。
发明内容
本发明的目的在于克服现有技术的不足,提供一种新型四轴载人离心机的运动学方法,四轴载人离心机由外而内旋转顺序依次是主轴偏航运动、座舱滚转运动、座舱俯仰运动、座舱偏航运动,包括如下步骤:
步骤一:四轴载人离心机的主轴用于大臂转动从而产生离心加速度,大臂绕主轴的转动角度为q1,角速度为角加速度为滚转、俯仰、偏航3个旋转轴用于座舱的姿态调整,滚转轴与大臂末端相连,滚转轴的转动角度为q2,角速度为角加速度为俯仰轴在滚转框的内部,俯仰轴的转动角度为q3,角速度为角加速度为偏航轴在俯仰轴的内部,与座舱相连,偏航轴的转动角度为q4,角速度为角加速度为飞行员位于座舱内,飞行员头部位于3个姿态转动轴的中心,即飞行员的加速度与座舱的加速度一致;
步骤二:根据离心机各转轴的运动获取座舱中人体相对于座舱的运动,通过新型四轴载人离心机的运动学D-H参数;座舱相对于全局坐标系的旋转矩阵、线加速度、角加速度;得到座舱中人体相对于座舱的运动。
步骤三:根据飞行中飞行员承受的3个线加速度Gxa、Gya、Gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线,反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线,使座舱中飞行员随体坐标系上的加速度与实际飞行一致。
进一步的,获得座舱相对于全局坐标系的旋转矩阵,末端执行器相对于全局的旋转矩阵为:
获得座舱的线加速度为:
式中:
Gxc、Gyc、Gzc分别为沿X、Y、Z向的线加速度;r为主旋臂距旋转轴心的距离;g为重力加速度;
进一步的,获得座舱的角加速度,座舱的角加速度为:
在座舱坐标下的角加速度公式为:
式中:
4arotxc、4arotyc、4arotzc分别为在座舱坐标系下绕X、Y、Z轴的角加速度;
其中偏航角加速度公式为:
进一步的,所述的根据飞行中飞行员承受的3个线加速度Gxa、Gya、Gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线,反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线,使座舱中飞行员随体坐标系上的加速度与实际飞行一致,包括如下过程:
获得主轴角运动,已知座舱随体坐标系上的线加速度Gx、Gy、Gz,可计算得到座舱线加速度矢量的大小为:
在大臂末端产生的加速度矢量大小为:
获得姿态平台偏航运动,大臂末端的线加速度矢量:
偏航轴的角加速度:
偏航轴q4求出后,对飞行数据进行坐标转换:
获得姿态平台滚运动,通过下式得到滚转轴的转动角度:
式中:
获得姿态平台俯仰运动;通过下式得到俯仰轴转动角度:
本发明的有益效果是:本发明充分利用了四轴载人离心机多了偏航轴的优势,可以在运动学逆问题求解上实现4个物理量与实际飞行一致,从而降低了四轴载人离心机的控制难度,提高了其在飞行训练方面的应用前景。
附图说明
图1为一种新型四轴载人离心机的运动学方法的流程图;
图2为空间定向障碍模拟器Gz数据修正示意图。
具体实施方式
下面结合附图进一步详细描述本发明的技术方案,但本发明的保护范围不局限于以下所述。
如图1所示,本发明,所提供的一种新型四轴载人离心机的运动学方法包括,步骤一,新型四轴载人离心机的主轴用于大臂转动从而产生离心加速度,定义大臂绕主轴的转动角度为q1,角速度为角加速度为滚转、俯仰、偏航3个旋转轴用于座舱的姿态调整,滚转轴与大臂末端相连,定义滚转轴的转动角度为q2,角速度为角加速度为俯仰轴在滚转框的内部,定义俯仰轴轴的转动角度为q3,角速度为角加速度为偏航轴在俯仰轴的内部,与座舱相连,定义偏航轴的转动角度为q4,角速度为角加速度为飞行员位于座舱内,飞行员头部位于3个姿态转动轴的中心,即飞行员的加速度与座舱的加速度一致。
步骤二:运动学正问题计算。即根据离心机各转轴的运动获取座舱中人体相对于座舱的运动。
(2.1)获取新型四轴载人离心机的运动学D-H法参数。新型四轴载人离心机的运动学D-H法参数如表1所示。
表1四轴载人离心机的D-H参数表
(2.2)获得座舱相对于全局坐标系的旋转矩阵。末端执行器(座舱)相对于全局的旋转矩阵为:
(2.3)获得座舱的线加速度。可计算得到座舱的线加速度(座舱坐标系)为:
式中:
Gxc、Gyc、Gzc—沿X、Y、Z向的线加速度;
r—主旋臂距旋转轴心的距离;
g—重力加速度。
(2.4)获得座舱的角加速度。座舱的角加速度(全局坐标系)为:
在座舱坐标下的角加速度公式为:
式中:
4arotxc、4arotyc、4arotzc—分别为在座舱坐标系下绕X、Y、Z轴的角加速度;
其中偏航角加速度公式为:
步骤三:运动学逆问题计算。四轴载人离心机的运动学逆问题求解,即已知实际飞行中飞行员承受的3个线加速度Gxa、Gya、Gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线,希望座舱中飞行员随体坐标系上的加速度与实际飞行一致,反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线。座舱中飞行员要满足的加速度包括3个线加速度和3个角加速度共6个自由度,而可控制的转轴自由度只有q1、q2、q3、q4共4个自由度,因此无法同时满足离心机座舱中飞行员6个自由度的加速度与实际飞行一致,通常根据飞行模拟需要,使得部分自由度加速度与实际飞行一致。
新型四轴载人离心机可以实现4个物理量与实际飞行一致,即要求3个线加速度、以及偏航角加速度与实际飞行一致。比原来的四轴载人机多实现了偏航角加速度与实际飞行一致。
(3.1)初步获得主轴角运动。已知座舱随体坐标系上的线加速度Gx、Gy、Gz,可计算得到座舱线加速度矢量的大小为:
在实际飞行中存在失重(|Ga|值小于1g,1g即1个重力加速度)现象,而在地面上由于重力的作用,空间定向障碍模拟器产生的G值必定大于1g,因此需要对|Ga|值进行处理,通常采用如图2所示的1.4g基础G水平的方式修正Gz数据。
由于主轴转动,在大臂末端产生的加速度矢量大小为:
(3.2)获得姿态平台偏航运动。主轴的角运动求解完成后,即可得到大臂末端的线加速度矢量:
主轴的角运动求解完成之后,首先在偏航角加速度物理量上实现与实际飞行一致,再调整滚转轴和俯仰轴实现3个线加速度物理量的一致性。
根据公式(5),可以得到偏航轴的角加速度:
偏航轴q4求出后,不能直接求解滚转轴q2和俯仰轴q3的角度,需要对飞行数据进行坐标转换:
(3.3)获得姿态平台滚运动。通过下式可计算得到滚转轴的转动角度:
式中:
(3.4)获得姿态平台俯仰运动。通过下式可计算得到俯仰轴转动角度:
式中:
以上所述仅是本发明的优选实施方式,应当理解本发明并非局限于本文所披露的形式,不应看作是对其他实施例的排除,而可用于各种其他组合、修改和环境,并能够在本文所述构想范围内,通过上述教导或相关领域的技术或知识进行改动。而本领域人员所进行的改动和变化不脱离本发明的精神和范围,则都应在本发明所附权利要求的保护范围内。
Claims (4)
1.一种新型四轴载人离心机的运动学方法,四轴载人离心机由外而内旋转顺序依次是主轴偏航运动、座舱滚转运动、座舱俯仰运动、座舱偏航运动,其特征在于,包括如下步骤:
步骤一:四轴载人离心机的主轴用于大臂转动从而产生离心加速度,大臂绕主轴的转动角度为q1,角速度为角加速度为滚转、俯仰、偏航3个旋转轴用于座舱的姿态调整,滚转轴与大臂末端相连,滚转轴的转动角度为q2,角速度为角加速度为俯仰轴在滚转框的内部,俯仰轴的转动角度为q3,角速度为角加速度为偏航轴在俯仰轴的内部,与座舱相连,偏航轴的转动角度为q4,角速度为角加速度为飞行员位于座舱内,飞行员头部位于3个姿态转动轴的中心,即飞行员的加速度与座舱的加速度一致;
步骤二:根据离心机各转轴的运动获取座舱中人体相对于座舱的运动,通过新型四轴载人离心机的运动学D-H参数;座舱相对于全局坐标系的旋转矩阵、线加速度、角加速度;得到座舱中人体相对于座舱的运动。
步骤三:根据飞行中飞行员承受的3个线加速度Gxa、Gya、Gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线,反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线,使座舱中飞行员随体坐标系上的加速度与实际飞行一致。
4.根据权利要求1所述的一种新型四轴载人离心机的运动学方法,其特征在于,所述的根据飞行中飞行员承受的3个线加速度Gxa、Gya、Gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线,反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线,使座舱中飞行员随体坐标系上的加速度与实际飞行一致,包括如下过程:
获得主轴角运动,已知座舱随体坐标系上的线加速度Gx、Gy、Gz,可计算得到座舱线加速度矢量的大小为:
在大臂末端产生的加速度矢量大小为:
获得姿态平台偏航运动,大臂末端的线加速度矢量:
偏航轴的角加速度:
偏航轴q4求出后,对飞行数据进行坐标转换:
获得姿态平台滚运动,通过下式得到滚转轴的转动角度:
式中:
获得姿态平台俯仰运动;通过下式得到俯仰轴转动角度:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010734741.8A CN111816023B (zh) | 2020-07-27 | 2020-07-27 | 一种四轴载人离心机的运动学方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010734741.8A CN111816023B (zh) | 2020-07-27 | 2020-07-27 | 一种四轴载人离心机的运动学方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111816023A true CN111816023A (zh) | 2020-10-23 |
CN111816023B CN111816023B (zh) | 2022-05-03 |
Family
ID=72862753
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010734741.8A Active CN111816023B (zh) | 2020-07-27 | 2020-07-27 | 一种四轴载人离心机的运动学方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111816023B (zh) |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19640730A1 (de) * | 1996-10-02 | 1998-04-09 | Dietmar Dr Ing Wuensche | Flugsimulator |
CN101305328A (zh) * | 2005-10-12 | 2008-11-12 | 菲利普·范比尔夫列特 | 控制飞行模拟器运动的方法以及实现该方法的飞行模拟器 |
CN103149927A (zh) * | 2013-03-24 | 2013-06-12 | 西安费斯达自动化工程有限公司 | 飞行器大迎角运动四元数模型的故障诊断和容错控制方法 |
CN104160435A (zh) * | 2012-01-18 | 2014-11-19 | 环境构造公司 | 基于离心机的飞行模拟器 |
CN104200715A (zh) * | 2014-09-23 | 2014-12-10 | 北京控制工程研究所 | 一种空间飞行器绕飞接近运动模拟器 |
CN105630048A (zh) * | 2016-03-29 | 2016-06-01 | 中国工程物理研究院总体工程研究所 | 三轴加速度与温度同步控制系统及其控制方法 |
CN107424473A (zh) * | 2017-08-14 | 2017-12-01 | 徐舒青 | 单座全动飞机模拟驾驶设备 |
CN108766101A (zh) * | 2018-09-07 | 2018-11-06 | 中国工程物理研究院总体工程研究所 | 用于直升机动态飞行模拟器的三自由度转框系统 |
CN208327096U (zh) * | 2018-06-12 | 2019-01-04 | 杭州西奥电梯有限公司 | 一种进出摩天轮座舱的自动步道 |
CN209000276U (zh) * | 2018-09-07 | 2019-06-18 | 中国工程物理研究院总体工程研究所 | 四自由度直升机动态飞行模拟器 |
CN110347186A (zh) * | 2019-07-17 | 2019-10-18 | 中国人民解放军国防科技大学 | 基于仿生双目联动的地面运动目标自主跟踪系统 |
CN110703791A (zh) * | 2019-10-22 | 2020-01-17 | 中国人民解放军海军工程大学 | 一种复杂条件下潜艇x舵智能模糊控制方法 |
CN111212787A (zh) * | 2019-02-28 | 2020-05-29 | 深圳市大疆创新科技有限公司 | 一种飞行模拟系统、方法及飞行模拟设备 |
-
2020
- 2020-07-27 CN CN202010734741.8A patent/CN111816023B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19640730A1 (de) * | 1996-10-02 | 1998-04-09 | Dietmar Dr Ing Wuensche | Flugsimulator |
CN101305328A (zh) * | 2005-10-12 | 2008-11-12 | 菲利普·范比尔夫列特 | 控制飞行模拟器运动的方法以及实现该方法的飞行模拟器 |
CN104160435A (zh) * | 2012-01-18 | 2014-11-19 | 环境构造公司 | 基于离心机的飞行模拟器 |
CN103149927A (zh) * | 2013-03-24 | 2013-06-12 | 西安费斯达自动化工程有限公司 | 飞行器大迎角运动四元数模型的故障诊断和容错控制方法 |
CN104200715A (zh) * | 2014-09-23 | 2014-12-10 | 北京控制工程研究所 | 一种空间飞行器绕飞接近运动模拟器 |
CN105630048A (zh) * | 2016-03-29 | 2016-06-01 | 中国工程物理研究院总体工程研究所 | 三轴加速度与温度同步控制系统及其控制方法 |
CN107424473A (zh) * | 2017-08-14 | 2017-12-01 | 徐舒青 | 单座全动飞机模拟驾驶设备 |
CN208327096U (zh) * | 2018-06-12 | 2019-01-04 | 杭州西奥电梯有限公司 | 一种进出摩天轮座舱的自动步道 |
CN108766101A (zh) * | 2018-09-07 | 2018-11-06 | 中国工程物理研究院总体工程研究所 | 用于直升机动态飞行模拟器的三自由度转框系统 |
CN209000276U (zh) * | 2018-09-07 | 2019-06-18 | 中国工程物理研究院总体工程研究所 | 四自由度直升机动态飞行模拟器 |
CN111212787A (zh) * | 2019-02-28 | 2020-05-29 | 深圳市大疆创新科技有限公司 | 一种飞行模拟系统、方法及飞行模拟设备 |
CN110347186A (zh) * | 2019-07-17 | 2019-10-18 | 中国人民解放军国防科技大学 | 基于仿生双目联动的地面运动目标自主跟踪系统 |
CN110703791A (zh) * | 2019-10-22 | 2020-01-17 | 中国人民解放军海军工程大学 | 一种复杂条件下潜艇x舵智能模糊控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111816023B (zh) | 2022-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108958289B (zh) | 基于相对速度障碍的集群无人机避碰方法 | |
CN106249745B (zh) | 四轴无人机的控制方法 | |
CN109240331B (zh) | 一种无人机-无人车集群模型时变编队控制方法及系统 | |
CN107957730B (zh) | 一种无人飞行器稳定飞行控制方法 | |
CN104760695B (zh) | 一种利用矢量旋转法来进行四旋翼飞机控制的方法 | |
CN112241125B (zh) | 一种基于微分平坦特性的无人机轨迹跟踪方法 | |
CN107145071B (zh) | 一种空间系绳系统的拉格朗日动力模型及控制器 | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN106892094A (zh) | 一种空间六自由度独立可控四旋翼无人飞行器及其控制方法 | |
CN112394739B (zh) | 主动变形四旋翼飞行器自抗扰飞行控制方法 | |
CN115639841B (zh) | 一种基于鲁棒牵制的无人机集群编队控制系统及控制方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂系统 | |
CN108638068B (zh) | 一种携带冗余度机械臂的飞行机器人控制系统设计方法 | |
CN108214519B (zh) | 一种空中任意姿态至落地姿态自调整的四足机器人 | |
CN207450247U (zh) | 一种可折叠可滚动的球形无人机 | |
CN112684705A (zh) | 一种四旋翼飞行器编队追踪控制方法 | |
CN115097856A (zh) | 一种基于导航向量场的四旋翼无人机目标跟踪动态反馈控制方法 | |
CN112541225A (zh) | 一种面向火箭回收大姿态翻转的虚实结合仿真模拟方法 | |
CN114879739A (zh) | 一种基于零空间的可倾转四旋翼无人机控制分配方法及系统 | |
CN111816023B (zh) | 一种四轴载人离心机的运动学方法 | |
CN111857182A (zh) | 一种四自由度空间定向障碍模拟器人体运动感知控制方法 | |
CN113759706B (zh) | 基于轴角矢量的多旋翼姿态自抗扰控制方法及系统 | |
CN117018494A (zh) | 一种高空灭火飞行机器人、控制系统及控制方法 | |
CN116301009A (zh) | 一种变构型无人机的抗干扰安全控制方法 | |
Kannan et al. | Control of aerial manipulation vehicle in operational space |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |