基于四元数的 DR技术
鲁丹丹，翟永翠，周玉芳
(江苏自动化研究所，江苏连云港 222061)
摘 要 :在异地分布式模拟训练中，特别是大规模的异地分布式模拟训练中，船舰、飞机、导弹等运动实体的运动状态的频繁发送给整个系统造成了较大的通信负荷。采用DR算法能降低仿真实体状态发送频率，减少系统通信负荷。为解决标准DR算法中采用欧拉角法进行姿态角外推计算量大等问题，提出了基于四元数的DR姿态角外推法。该方法使用四元数乘法对仿真实体姿态进行外推，在运行时间上较标准方法减少10%左右，在外推精度上较标准方法有了一定的提升。
关键词 :模拟训练；DR技术；DR模型；四元数
随着计算机仿真技术的飞速发展和硬件性能的不断提高，各国不断增加对模拟训练的重视程度。美军从20世纪80年代开始，就致力于异地分布式模拟训练的研究，取得了许多成果，提高了训练效益[1-2]。异地分布式模拟训练是一种能实现战役、战术、平台、武器多级联动的训练。在带动武器的异地分布式训练系统中包含船舰、飞机、导弹等运动实体。训练中这些运动实体的状态(如位置、姿态等)是不断变化的，仿真节点需将这些变化告知系统中其他相关仿真节点，以便了解这些实体目前的状态。当系统中仿真的运动实体数量庞大时，节点之间大量的状态信息发送将给整个系统造成通信负荷，很难保证训练的实时性。
扩大增值税增收范围改革符合经济发展规律，对于我国经济发展具有重要的意义，但是在进行改革的过程中仍然有些问题有待解决。
针对该问题有两种解决办法:一种办法是提高硬件条件、构建高速大容量的通信网络；另一种办法是设法降低训练系统的通信负荷，即减少节点之间交互的信息量，推算定位(Dead Reckoning，简称DR)技术就是降低节点之间信息交互量的一种手段。
1 DR技术
1.1 DR技术基本原理
DR(Dead Reckoning)一词来源于航海。在航海中，为了使船只到达某一地点，需要使船头保持某一方向航行一段时间，当实际航线与期望的方向出现较大的差异时，修正航向，再沿新的航行方向进行[3]。在分布交互仿真中采用DR技术估计仿真实体的位置和姿态，限制仿真节点间实体状态发送频率、减少网络传输数据量。使用DR技术时，对于发送实体，仿真节点维持该实体的一个高精度模型和一个DR模型，当高精度模型计算出的位置、姿态与DR模型计算出的位置、姿态的差值超过设定的值(阈值)时，仿真节点向其相关仿真节点发送该实体的由高精度模型计算出的实际位置和姿态，并用此信息更新该实体的DR模型参数。对于接收实体，仿真节点内部维持其感兴趣的其他实体的DR模型，并使用该模型外推其他实体的位置和姿态，直到接收到状态更新信息，使用接收到的信息更新相关实体的DR模型参数，并继续外推。
1.2 DR模型
表1给出了DIS标准中的9种DR模型(Dead Reckoning Model，简称DRM)。DR模型可表示为DRM(F or R，P or V， W or B)。其中第一个参数表示实体是否有转动运动，F表示无转动运动，R表示有转动运动；第二个参数表示实体是做匀速运动还是变速运动，P表示做匀速运动，V表示做变速运动；第三个参数表示实体运动所选择的坐标系，W表示地心坐标系，B表示实体坐标系。同时第二个参数表明算法是关于位置的一阶算法还是二阶算法。
从图5可以看出，随流速的增加，树脂对花色苷的解吸效果越来越差，可能是流速过快导致乙醇不能与被吸附的花色苷充分作用而将其从树脂上洗脱出来。但是流速太慢会导致解析的时间延长，故选择 1 mL/min作为洗脱流速。
表1 DR模型
9种DRM中第2、3、4、5模型使用地心坐标系计算，第6、7、8、9模型使用实体坐标系计算。
地心坐标系下的位置外推公式为：
P =P 0+V 0×Δt
(1)
(2)
式中，P 0，V 0，A 0分别表示地心坐标系下初始仿真时刻t 0的位置向量、速度向量以及加速度向量，Δt 表示算法外推的时间增量。
综合以上分析可以得出如下结论：1) 偏铝侧1 mm的焊缝断口大部分区域为脆性解理断裂，少数区域为微孔聚合断裂；2) 偏镁侧1 mm的焊缝断口主要为脆性解理断裂，镁铝混合不均匀，孔洞较多。故搅拌头偏向铝合金板1 mm时的焊接效果从断口分析看要优于搅拌头偏向镁合金板1 mm。
实体坐标系下的位置外推公式为：
P =P 0+
([R 1]V b )
(3)
P =P 0+([R 1]V b +[R 2]A b )
一是逆周期监管中通过提高核心资本比率来缓释顺周期性。核心资本是金融企业在金融运行中可以永久使用和支配的自有资本（或者自有资金），也指银行资本中权益资本和公开储备。根据《巴塞尔协议》，银行资本分为核心资本和附属资本，从资本构成来讲，核心资本叫一级资本或者产权资本，是银行资本构成中最重要的部分。核心资本比率是指核心资本与金融运行中加权风险资产总额的比率。在对金融监管的探索进程中依据《巴塞尔协议Ⅲ》等相关条款规定，核心资本在金融运行中要占资本总额的50%以上。在金融实践中，提高核心资本比率，能在金融运行中缓释因为监管带来的顺周期性波动性，起到稳定资本市场的作用。
(4)
P 0表示地心坐标系下初始仿真时刻t 0的位置向量，V b 表示实体坐标系下初始仿真时刻t 0的速度向量，A b 是V b 的导数，是[R 0]w→b 的转置矩阵。
(5)
仿真实体姿态由实体坐标系相对于地心坐标系的欧拉角表示，分别为ψ ，θ ，φ 。9种模型中实体姿态外推公式为
[R ]w→b =[DR ][R 0]w→b
(6)
标准DR模型中，仿真实体的姿态角通过欧拉角法计算得到。由于欧拉角法运算量大，且存在奇异点，可用四元数法求解欧拉角[5]。本文首先对四元数的基本概念进行介绍，再利用四元数方法进行实体姿态外推。
(7)
式中，ω =(ω x ，ω y ，ω z )是实体坐标系下的角速度向量。[R 0]w→b 表示t 0时刻从地心坐标系到实体坐标系的旋转矩阵，可由t 0时刻的欧拉角计算得到。[R ]w→b 表示t 0+Δt 时刻地心坐标系到实体坐标系的旋转矩阵，若：
由于连续的旋转可以通过四元数的乘法来表示[7]。因此仿真实体的姿态可通过四元数进行解算。已知仿真实体t 0时刻的姿态角以及实体绕轴转动的角度，可得到经Δt 时间后实体的姿态角。使用四元数乘法进行姿态外推的公式如下：
θ =arcsin(-A 11)
ψ =arccos(A 11/cosθ )×sgn(A 12)
φ =arccos(A 33/cosθ )×sgn(A 23)
(8)
2 仿真实体状态外推
2) 基于四元数的DR姿态外推
在给定的标准中[4]，DR技术应用于仿真系统中的基本实体(Base Entity)类，包括飞行器(Aircraft)、水面舰艇(Surface Vessel)、潜航器(Surface Vessel)、车辆(Ground Vehicle)、两栖车辆(Amphibious Vehicle)、航天器(Spacecraft)等平台以及传感器(Sensor)、无线电(Radio)等实体。这些实体的主要属性有姿态、速度、加速度、空间位置、角速度。大多数仿真系统中，仿真实体的姿态角由实体坐标系相对于地理坐标系(北东天坐标系)的欧拉角定义，分别为航向角C ，纵摇角φ 以及横摇角β 。仿真实体位置信息为地理(北东天)坐标系下的速度向量V =(V x ，V y V z )，加速度向量a =(a x ，a y ，a z )，以及空间位置向量p ′=(X ，Y ，Z )。
FLUENT模拟中，当颗粒粒径分布要采用Rosin-Rammler分布函数时，其计算方法为利用经验公式对已知入口粒径计算得到的，其表达式见式(2)：
2.1 实体位置外推
由于系统中仿真实体的位置是在地理坐标系下表示的，因此需将地理坐标系下的量转换为地心坐标系下的量进行计算。
其中
为地理坐标系到地心坐标系中的转换矩阵。若仿真实体做匀速运动，使用公式(1)进行位置外推，若仿真实体做变速运动，使用公式(2)进行位置外推。
使用位置外推公式时，若实际位置与推算出的位置的差值超过某一设定值时，需要进行DR模型参数矫正。假设由实体高精度模型计算得到的位置为P =(X k ，Y k ，Z k )，由DR模型外推得到的位置为
为预先设定的位置更新阈值。三个坐标轴上的距离误差分别为：
(9)
q DR 表示实体坐标系下t 0时刻到t 0+Δt 时刻的转动四元数，由实体绕轴转动的角度τ =|ω |Δt 和单位向量
计算得到：
2.2 实体姿态外推
式中，[DR ]表示t 0时刻的实体坐标旋转到t 0+Δt 时刻的实体坐标的旋转矩阵：
1) 四元数介绍
溪花如云水如练，游禽溪上色相乱。孤飞西来落斜电，双入汀芜半隐见。境偏未识春华变，羽毛翻翻若自衒。莫云此地无罗罥，樊中饮啄岂堪羡？(《中峰集》卷十)
四元数(Quaternions)是哈密尔顿(爱尔兰物理学家1805-1865)于1843年提出的数学概念，其指一个实数单位和三个虚数单位组成的实元的数，即
在实践中，学校将课程分为道德、人文、科学、健康、艺术五大学习领域，每一领域又包含基础性、拓展性两类课程。无论是基础性课程，还是拓展性课程，都围绕上面的五个领域落实并强化五种素养。为了提高学生的综合素养，学校还打破学科与学科之间、课内与课外之间、校内与校外之间的壁垒，突破传统课程模式，自主开发了各类综合性课程。目的是通过课程体系的建构、课程方案的落实，实现“为学生的幸福人生奠基”的办学理念。
Q (q 0，q 1，q 2，q 3)=q 0+q 1i +q 2j +q 3k
q 0是四元数的标量部分，q =q 1i +q 2j +q 3k 是四元数的矢量部分。其还具有矢量形式以及矩阵形式:
Q =(q 0，q 1，q 2，q 3)τ
刚体定点转动的欧拉定理：刚体绕固定点的任意转动，可由绕通过此点的某一轴转过一个角度得到。在单位时间ΔT 内假设刚体角速度为ω ，则该转动轴的方向ω 0(转动方向的单位矢量)及绕轴转过的角度φ 分别为：
刚体与该刚体固联的动坐标系与参考坐标系之间的变换可用四元数表示[6]：
(10)
②培训授课的老师较少与新员工互动。培训授课的老师包括院长，党委书记，院感科、人事教育处、医务处、部分临床科室主任或相关负责人，百忙中抽空给新员工培训，通常语速较快，比较威严。新员工对授课的领导也有距离感，难免会觉得敬而远之。笔者观察新员工通常在听讲20分钟左右，开始出现注意力分散，大多各自低头看手机。课堂形成流于形式、公事公办的局面。
原料储罐是用来储存气体原料的装置，常见的有盛装液化石油气、液氨的一般压力容器和盛装液氧、液氮的真空绝热压力容器。为了避免原料储罐超装引发的安全隐患，我国对原料储罐最大充装量有着严格的限制。GB/T 18442.3—2011《固定式真空绝热深冷压力容器 第3部分：设计》规定：充装非易爆介质的液相容积应不大于内容器几何容积的95%，充装易爆介质的液相容积应不大于内容器几何容积的90%。TSG 21—2016《固定式压力容器安全技术监察规程》规定：储存液化气体的压力容器应当规定设计存量，装量系统不得大于0.95%，建议预警液位设置不高于内几何容积的90%。
q A q B =q A0 q B0 +q Ax q Bx +q Ay q By +q Az q Bz
(11)
四元数的点乘可用于计算两个四元数之间的转动角。设ρ 是四元数q A 和q B 之间的转动角。
(12)
仿真训练系统中使用地心坐标系下的DR模型来预测实体的运动状态。当系统中仿真实体做无转动匀速运动时，使用DR(FPW)模型仅对实体位置进行外推；当系统中仿真实体做无转动加速运动时，使用DR(FVW)模型仅对实体位置进行外推。当系统中仿真实体做转动匀速运动时，使用DR(RPW)对实体的位置和姿态进行外推；当系统中仿真实体做转动加速运动时，使用DR(RVW)模型对实体位置和姿态进行外推。在仿真实体的生命周期内，可根据实体的运动状态选取不同的DR模型。同时在仿真系统中使用DR模型对实体状态外推时，需根据仿真系统的精度需求设定仿真实体位置更新阈值和姿态更新阈值。
则t 0+Δt 时刻的姿态角为：
q D(t 0+t )=q D(t 0)q DR
(13)
其中q D(t 0)表示地理坐标系到实体坐标系的转动四元数，由t 0时刻的姿态角C 0，φ 0，β 0计算得到：
从两侧耳后方沿脖颈一直延伸到锁骨的这两条肌肉叫做胸锁乳突肌。有的婴儿生下来一侧肌肉较短，破坏了颈部的左右牵引的平衡力，这就导致颈部始终向较短一侧倾斜，即先天性肌性斜颈。
(14)
当
时，仿真节点需更新该实体实际的状态信息，包括位置和姿态，并向外发送该实体的实际状态。
q DR0 =cos(τ )
q DRx =u x sin(τ )
q DRy =u y sin(τ )
q DRz =u z sin(τ )
(15)
q D(t 0+Δt )表示t 0+Δt 时刻仿真实体从地理坐标系到实体坐标系的转动四元数。
q D(t 0+Δt )=(q 0，q x ，q y ，q z )
根据转动四元数和转动矩阵的关系，可求得t 0+Δt 时刻实体的三个姿态角为：
2.1.3 物品准备 术前了解术式，熟悉手术步骤，做好充分的物品准备。脊柱常规器械、矫正内固定器械1套(压缩棒、撑开棒、预弯器、开路器、螺丝钉、椎板钩和关节钩等)、手控高频电刀、气动磨钻、C臂机和自体血回输机和恒温箱等。检查性能，确保正常使用。预约术中脊髓监测。
φ =arcsin(2(q y q z +q 0q x ))
(16)
同样进行姿态外推时，外推出的姿态与实际姿态存在一定的误差，随着仿真时间的推进，或者仿真实体的随机机动，这个误差可能会很大。较大的姿态误差会影响仿真效果，因此需预先设定姿态更新阈值。假设K 为设定的姿态更新阈值。
对于具有转动运动的仿真实体，节点内部维持两个四元数，一个是使用仿真实体实际姿态角计算得到的四元数q M ，另一个是使用公式(13)计算得到的四元数q D 。定义α 为q M 与q D 之间的旋转角。
(17)
当外推出的姿态角与实际姿态角的差值超过姿态更新阈值，即α >K 时
仿真节点将向外发送该实体的实际状态信息，并更新该实体的DR模型参数,包括位置信息以及姿态信息等。并用当前时刻的四元数q M(t )代替公式(13)中的四元数q D(t )(q A(t )→q D(t ))，继续进行外推，直到下次更新。
3 仿真实验及结果分析
“××体系建模与仿真平台”能支持海上方向战役、战术多级对抗仿真，具有模型开发、想定编辑、分析评估等功能。本文采用该仿真平台进行仿真实验，分别使用标准DR姿态外推模型与基于四元数的DR姿态外推模型对仿真实体的姿态进行外推，同时对仿真实体的位置进行了外推。节点内部的DR运行过程如图1所示。
使用该仿真平台编辑飞机飞行任务想定，飞行轨迹为曲线如图2所示。设定飞机的位置更新阈值为100 m，姿态更新阈值为3°，仿真步长为1 s，仿真运行时间为20 min。飞机做转动、变速运动，飞行平均速度为260.12 m/s。
四元数点乘：
图1 DR技术运行过程图
图2 飞机飞行航迹
下面分别从算法运行时间、飞机姿态角、飞机运行轨迹误差、飞机状态更新时间间隔，来比较两种算法。
两种算法运行时间对比图如图3所示。标准DR姿态外推算法平均运行时间为0.008 466 ms，基于四元数的DR姿态外推算法平均运行时间为0.007 592 ms，较标准姿态外推算法在运行时间上降低了10.32%左右。
图3 姿态外推算法运行时间对比图
两种算法外推出的飞机飞行航向角如图4所示，飞行横摇角如图5所示，飞行纵摇角如图6所示。
图4 航向角对比图
从图4可以看出使用基于四元数的DR外推得到的航向角更接近于实际的航向角。
图5 横摇角对比图
从图5可以看出，仿真过程中飞机的实际横摇角大小变化不明显。标准DR姿态外推方法得到的横滚角大小变化相对明显。基于四元数的DR姿态外推方法得到的横滚角与实际横滚角的大小更加接近。
从图6可以看出，运行的初始阶段飞机飞行的纵摇角出现明显变动，这是由于仿真初始阶段飞机的上升运动而造成的。通过对比可以看出，基于四元数的DR姿态外推方法推算出的纵摇角更符合飞机实际的纵摇角。
通过以上分析可以得到基于四元数的姿态外推算法运行效率更高，且外推出的姿态角的精度更高。下面分析两种方法外推出的轨迹与算法更新频率。
图6 纵摇角对比图
使用基于四元数的DR模型外推得到的飞行轨迹如图7所示，对比图7和图2可以看出，使用该模型能得到较精确的飞行轨迹。
所有患者均接受手术治疗，局部扩大切除者9例，6例接受广泛切除术，1例行区段切除术，全乳切除者1例。术后3例患者行放疗，2例接受化疗，放化疗均接受者1例，化疗方案为阿霉素联合异环磷酰胺及美司钠 。
图7 基于四元数的DR外推飞行轨迹
使用标准DR模型外推，得到的飞机飞行轨迹如图8所示。使用该方法也能得到较为准确的飞机飞行轨迹。
图8 标准DR外推飞机轨迹
飞机飞行的位置误差由每一时刻的实际位置与DR模型外推出的位置的差值得到。两种方法位置误差如图9所示。基于四元数的DR外推平均位置误差为32.2 m，标准DR外推平均位置误差为40.1 m。造成这一现象的原因是，基于四元数的外推方法推算出的姿态角更加精确，使得外推出的仿真实体的位置也更加精确。
图9 位置误差对比图
更新时间间隔由当前的更新时刻减去上次更新时刻得到。更新时间间隔越大，说明模型外推效果越好。两种方法的更新时间间隔如图10所示。基于四元数的DR外推方法实现飞机轨迹外推的平均更新时间间隔为18.9 s，标准DR外推方法实现飞机轨迹外推的平均更新时间间隔为12.5 s。基于四元数的DR外推方法在减少仿真实体的状态更新频率上更加有效。
图10 更新时间间隔对比图
以上实验结果表明本文提出的基于四元数的DR外推算法运行时间更少、运行效率更高，姿态和位置外推精度更高。仿真实体更加精确的位置和姿态推算，一方面能有效减少实体状态发送频率，缓解网络通信负荷，另一方面系统的仿真精度更高，更加符合实际情况。这对于构建大规模的分布式模拟训练是具有重要意义的。
平儿鼻子流血，好像他说到日本子才流血。他向全屋四面张望，就像连一条缝也没寻到似的，他转身要跑，老人捉住，出了后门，盛粪的长形的笼子在门旁，掀起粪笼，老人说：
4 结束语
DR技术是缓解分布式仿真系统中网络通信量的重要手段，本文为减少标准DR模型姿态外推的计算量，提出了基于四元数的姿态外推方法。该方法在运行时间、外推精度等方面较标准方法有了一定的提升。而DR技术还可以从更新阈值、网络传输延迟方面进行研究。
参考文献 :
[1] 王锁平.海军大连舰艇学院学报[J].论海军模拟训练，2011，34(3):100-102．
[2] 韩晓光，吴晞.构建军用航海模拟异地分布式训练模式[J].广州航海学院学报，2014，22(增刊):40-41．
[3] 康凤举.现代仿真技术与应用[M].北京:国防工业出版社，2001．
[4] DRAFT1.0v2-10September，1999.Guidance，Rationale，and Interoperability Modalities for the Real-time Platform Reference Federation Object Model(RPRFOM)[S]. Interoperability Standards Organization Inc， 1999．
[5] 荆学东，潘翔.基于四元数的四轴飞行器姿态控制[J].现代电子技术，2018，41(16):117-119．
[6] 徐国亮，王勇.舰炮反导火控原理[M].北京:北京理工大学出版社，2017．
[7] IEEE std 1278.1TM-2012，IEEE Standard for Distributed Interactive Simulation Application Protocols[S]. 19 December 2012．
DR Technology Based on Quaternion
LU Dan-dan， ZHAI Yong-cui， ZHOU Yu-fang
(Jiangsu Automation Research Institute，Lianyungang 222061，China)
Abstract :In distributed simulation training in different places， especially in large-scale distributed simulation training in different places， the frequent transmission of the motion state of moving entities such as ships， aircraft， missiles and so on cause a large communication load to the whole system. DR algorithm can reduce the transmission frequency of simulation entity state and the communication load of the system. In order to solve the problem of large amount of calculation of attitude angle extrapolation using Euler angle method in standard DR algorithm， a quaternion-based attitude angle extrapolation method for DR is proposed. This method uses quaternion multiplication to extrapolate the attitude of simulation entities， which reduces the running time by about 10% and has higher extrapolation accuracy compared with the standard method．
Key words :simulation training; dead reckoning technology; dead reckoning model; quaternion
中图分类号 :TP391.9
文献标志码: A
DOI: 10.3969/j.issn.1673-3819.2019.02.019
文章编号 ：1673-3819(2019)02-0098-06
收稿日期 ：2018-12-20
修回日期： 2019-01-24
作者简介 ：鲁丹丹(1990-)，女，四川达州人，硕士研究生，研究方向为系统工程。翟永翠(1978-)，女，硕士，研究员。
(责任编辑：张培培)
标签：模拟训练论文; DR技术论文; DR模型论文; 四元数论文; 江苏自动化研究所论文;