CN105243263B - 二子样旋转矢量姿态算法ip核 - Google Patents
二子样旋转矢量姿态算法ip核 Download PDFInfo
- Publication number
- CN105243263B CN105243263B CN201510572048.4A CN201510572048A CN105243263B CN 105243263 B CN105243263 B CN 105243263B CN 201510572048 A CN201510572048 A CN 201510572048A CN 105243263 B CN105243263 B CN 105243263B
- Authority
- CN
- China
- Prior art keywords
- module
- attitude
- quaternion
- angle
- rotation vector
- 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.)
- Active
Links
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 46
- 238000003860 storage Methods 0.000 claims abstract description 22
- 230000009466 transformation Effects 0.000 claims abstract description 8
- 238000004364 calculation method Methods 0.000 claims description 23
- 238000000354 decomposition reaction Methods 0.000 claims description 22
- 230000005540 biological transmission Effects 0.000 claims description 21
- 238000006243 chemical reaction Methods 0.000 claims description 16
- 238000000034 method Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 5
- 241000159433 Luma chequen Species 0.000 claims description 4
- 230000001360 synchronised effect Effects 0.000 claims description 4
- 230000006870 function Effects 0.000 claims description 3
- 238000012795 verification Methods 0.000 claims description 3
- XEBWQGVWTUSTLN-UHFFFAOYSA-M phenylmercury acetate Chemical compound CC(=O)O[Hg]C1=CC=CC=C1 XEBWQGVWTUSTLN-UHFFFAOYSA-M 0.000 claims description 2
- 238000005096 rolling process Methods 0.000 claims description 2
- 230000010354 integration Effects 0.000 claims 1
- 238000005259 measurement Methods 0.000 abstract description 8
- 230000014759 maintenance of location Effects 0.000 abstract 1
- 230000007704 transition Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 230000007613 environmental effect Effects 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 238000005457 optimization Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000013139 quantization Methods 0.000 description 1
Landscapes
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种二子样旋转矢量姿态算法IP核,包括422接口模块、角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块,其中422接口模块又包括分频模块、422接收模块、帧校验模块、FIFO存储发送模块、姿态角输出模块、运算结果分解模块、422输出模块;所述分频模块分别与422接收模块、运算结果分解模块、422输出模块相连;422接收模块通过帧校验模块、FIFO存储发送模块接入角增量模块;角增量模块与等效旋转矢量模块、变换四元数模块、四元数更新模块顺次连接,四元数更新模块分别接入计算姿态角模块和角增量模块;计算姿态角模块依次通过姿态角输出模块、运算结果分解模块接入422输出模块。本发明运行周期短、精度高,为高速姿态测量组件的实现提供可行性。
Description
技术领域
本发明属于姿态测量组件技术领域,特别是一种二子样旋转矢量姿态算法IP核。
背景技术
在研制姿态测量组件原理样机时,对所采用的姿态解算算法通常会考虑其在圆锥运动时产生的误差。对捷联惯导姿态更新算法来说,圆锥运动是最恶劣的环境条件,它会诱发数学平台的严重漂移,所以在旋转矢量优化算法中常以锥运动作为环境条件。如果能确保锥运动环境条件下的算法漂移最小,就一定能确保在其余环境条件下的算法漂移最小。引起圆锥误差的因素很多,对于陀螺带宽、量化误差、安装误差等引起的锥误差,可以通过提高陀螺相应性能来克服。对于姿态更新率过低,理应通过提高更新率来解决,但算法的实时性又制约着更新率的提高,解决这一矛盾的有效途径是采用等效旋转矢量法实现姿态更新。传统的使用DSP作为处理器实现该算法运算时间接近1ms,如处理器为TMS320VC5509A时,算法运行时间为0.77ms。这个速度不能满足对速度要求较高的姿态测量组件的设计。
目前,二子样旋转矢量姿态算法在通用MCU或者DSP中运行周期过长,导致运算时间不能进一步减少,无法实现高速和高精度。
发明内容
本发明的目的在于提供一种速度快、精度高的二子样旋转矢量姿态算法IP核,为高速姿态测量组件的实现提供可行性。
实现本发明目的的技术解决方案为:一种二子样旋转矢量姿态算法IP核,包括422接口模块、角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块,其中422接口模块又包括分频模块、422接收模块、帧校验模块、FIFO存储发送模块、姿态角输出模块、运算结果分解模块、422输出模块;所述分频模块分别与422接收模块、运算结果分解模块、422输出模块相连;422接收模块通过帧校验模块与FIFO存储发送模块相连,FIFO存储发送模块接入角增量模块;角增量模块与等效旋转矢量模块、变换四元数模块、四元数更新模块顺次连接,四元数更新模块分别接入计算姿态角模块和角增量模块;计算姿态角模块依次通过姿态角输出模块、运算结果分解模块接入422输出模块;
所述422接口模块负责从外部读取422串口数据及各个时刻的轴向角速度,并将经过二子样旋转矢量姿态算法运算的结果按422串口标准输出到外部存储;
所述角增量模块根据FIFO存储发送模块输入的三组数据格式为IEEE 754单精度浮点的三个轴向的角速度Thetai(i=1,2,3),按照积分公式求得两组二子样姿态角增量θ1,θ2作为等效旋转矢量模块的输入信号;
所述等效旋转矢量模块将二子样姿态角增量θ1,θ2根据优化的二子样旋转矢量公式处理得到等效旋转矢量Φ作为变换四元数模块的输入信号;
所述变换四元数模块将等效旋转矢量Φ按照四元数变换公式进行处理得到四元数作为四元数更新模块的输入信号;
所述四元数更新模块将四元数按照姿态更新方程进行处理得到更新后的四元数作为计算姿态角模块的输入信号;
所述计算姿态角模块根据更新后的四元数构建姿态矩阵,求得姿态角即俯仰角横滚角航向角输出至422接口模块的姿态角输出模块。
本发明与现有技术相比,其显著优点为:(1)采用等效旋转矢量的二子样优化算法进行算法IP核的设计,减少了姿态解算算法在圆锥运动时的漂移;(2)采用FPGA作为处理器,使用Xilinx提供的算法IP核搭建,全程并行处理,使得实现该算法只需要十几微秒,大大提高姿态测量组件的运行速度,为高速姿态测量组件的实现提供了可能性;(3)采用422进行串口通信,以差动方式发送和接收,并且全双工工作模式使得收发不影响,使得它传输距离远,速度快。
附图说明
图1本发明二子样旋转矢量姿态算法IP核的模块结构示意图。
图2为本发明二子样旋转矢量姿态算法的流程图。
图3为本发明二子样旋转矢量姿态算法IP核中422接收模块状态转换图。
图4为本发明二子样旋转矢量姿态算法IP核中帧校验模块状态转换图。
图5为本发明二子样旋转矢量姿态算法IP核中运算结果分解模块状态转换图。
图6为本发明二子样旋转矢量姿态算法IP核中422输出模块状态转换图。
图7为本发明二子样旋转矢量姿态算法IP核总体模块电路封装符号图。
具体实施方式
结合图1,本发明二子样旋转矢量姿态算法IP核,包括422接口模块、角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块,其中422接口模块又包括分频模块、422接收模块、帧校验模块、FIFO存储发送模块、姿态角输出模块、运算结果分解模块、422输出模块;所述分频模块分别与422接收模块、运算结果分解模块、422输出模块相连;422接收模块通过帧校验模块与FIFO存储发送模块相连,FIFO存储发送模块接入角增量模块;角增量模块与等效旋转矢量模块、变换四元数模块、四元数更新模块顺次连接,四元数更新模块分别接入计算姿态角模块和角增量模块;计算姿态角模块依次通过姿态角输出模块、运算结果分解模块接入422输出模块;所述角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块均由Xilinx提供的CORDIC IP核、浮点操作器IP核、加/减法器IP核、乘法器IP核和除法器IP核搭建而成,整个算法的流程如图2,各个模块的功能如下:
一、422接口模块
所述422接口模块负责从外部读取422串口数据及各个时刻的轴向角速度,将其进行和校验后,并将经过二子样旋转矢量姿态算法运算的结果按422串口标准输出到外部存储。
所述422接口模块中的分频模块作用是将***时钟分为422接收模块、运算结果分解模块和422发送模块所需的时钟;422接收模块采用16倍频采样接收,设计采用状态机,分为5个状态:等待起始位、求中点,等待采样,采样,停止位接收,422接收模块的状态转换如图3所示;帧校验模块设计采用状态机,分为4个状态:接收同步字其中字节0xaa、接收同步字其中字节0x55、接收保留字节、接收一组角速度,帧校验模块的状态转换如图4所示;FIFO存储发送模块用于存储转发接收的角速度数据;运算结果分解模块设计采用状态机,分为8个状态:空闲发送同步字字节0xaa、发送同步字字节0x55、等待、422使能信号归’0’、分解航向角、分解横滚角、分解俯仰角、停止发送校验字节,运算结果分解模块状态转换如图5所示;422输出模块设计采用状态机,分为5个状态:空闲、发送起始位、移位等待、移位、发送停止位,422输出模块的状态转移如图6所示。
所述422接口模块中分频模块、422接收模块、帧校验模块、FIFO存储发送模块、姿态角输出模块、运算结果分解模块、422输出模块,具体功能如下:
(1)分频模块根据所需波特率将***时钟进行分频处理获得所需的422接收模块的输入时钟,422接收模块在输入时钟上升沿时接收422接收端传来的比特,接收到一个字节后输入帧校验模块;
(2)帧校验模块接收到同步字0x55aa时开始接收新的一帧数据,该帧的最后一个字节为前面所有数据和较验的低八位数据,通过和校验的一组数据将输出口使能信号cheken置’1’作为FIFO存储发送模块的敏感信号,一帧数据包括该时刻的三个轴向角速度;
(3)FIFO存储发送模块当使能信号cheken上升沿时存入一组数据,在存储数据大于3时同时输出三组数据用于二子样旋转矢量姿态算法IP核的运算,下面每新存入两组新数据,加上之前最近时刻的一组数据为角增量模块提供输入信号;
(4)运算结果分解模块将最近更新的姿态角包括俯仰角、横滚角、航向角分解成一个个字节并加上同步字0x55aa以及和校验的低八位按时钟周期输出;
(5)422输出模块按照一定的波特率将运算结果分解模块输出的字节按顺序发送出去,422输出模块的时钟由分频模块分频得到。
二、角增量模块
所述角增量模块根据FIFO存储发送模块输入的三组数据格式为IEEE 754单精度浮点的三个轴向的角速度Thetai(i=1,2,3),按照积分公式求得两组二子样姿态角增量θ1,θ2作为等效旋转矢量模块的输入信号;所述积分公式如式(1)所示:
其中,h为姿态更新周期,在二子样旋转矢量姿态算法中取0.02,Thetai(i=1,2,3)为三个轴向角速度。
三、等效旋转矢量模块
所述等效旋转矢量模块将二子样姿态角增量θ1,θ2根据优化的二子样旋转矢量公式处理得到等效旋转矢量Φ作为变换四元数模块的输入信号;优化的二子样旋转矢量公式如式(2)所示:
其中Φ为等效旋转矢量。
四、变换四元数模块
所述变换四元数模块将等效旋转矢量Φ按照四元数变换公式通过CORDIC IP核、浮点操作器IP核、加/减法器IP核、乘法器IP核和除法器IP核进行处理得到四元数作为四元数更新模块的输入信号;四元数变换公式如式(3)所示:
其中,Φx,Φy,Φz分别为等效旋转矢量Φ的三个轴向分量值,为所求四元数。
五、四元数更新模块
所述四元数更新模块将四元数按照姿态更新方程通过浮点操作器IP核进行处理得到更新后的四元数作为计算姿态角模块的输入信号;姿态更新方程如式(4)所示:
其中Q(t)为当前时刻的姿态四元数,Q(t+h)为下一时刻的姿态四元数。
六、计算姿态角模块
所述计算姿态角模块根据更新后的四元数构建姿态矩阵,求得姿态角即俯仰角横滚角航向角输出至422接口模块的姿态角输出模块。所述计算姿态角模块中,姿态矩阵如式(5)所示,求姿态角的公式如式(6)所示:
其中,为俯仰角、为横滚角、为航向角。
本发明二子样旋转矢量姿态算法IP核的工作过程为:分频模块将100Mhz(可更换)的***时钟分成422接收发送所需的时钟,以及运算结果分解所需的时钟;422接收模块通过识别起始位0按字节接收角速度;帧校验模块当接收一组角速度后进行和校验,如通过校验则将使能信号置’1’;FIFO存储发送模块在帧校验使能信号为’1’时,存储一组角速度数据,当存储的角速度组数大于3时,输出3组角速度用于姿态解算,之后每更新两组角速度保留前一次输出角速度的最后一组数据加上更新的两组输出用于姿态解算;运算结果分解模块用于将从姿态解算模块输出的的俯仰角,航向角,横滚角按字节输出另加上其和校验低八位数据,并在每输出一个字节时将一个信号置一个脉冲,用于422输出模块的发送信号。422输出模块根据输出使能信号将每个字节加上起始位和停止位按波特率发送出去。
本算法IP核上电烧写前先根据实际所需的发送与接收数据波特率修改分频模块的分频数。总体模块电路封装符号图如图7所示,烧写前的管脚配置为:[CLKIN]接***时钟管脚;[RESET]接一个基本I/O,做复位开发;[RXDR]接422接收端;[TXD]接422发送端;[TXD_DONE]接一个基本I/O,为发送指示灯;[FIFOEMPTY]和[FIFOFULL]接基本I/O,用于运行状态指示和运行出错指示。
运行时按一定数据格式进行数据发送,每个轴向的角速度采用的格式为IEEE 754浮点,采用单精度,数据位为32位。接收到一组三个轴向角速度后进行和校验,通过校验后将这组角速度组合成一个96位的数据存储在FIFO存储器中。采用的FIFO存储深度为6(可以调节),宽度为96位。当存储地址位置偏移大于3时读出三组数据,并且四元数输出模块输出初始四元数值用于姿态解算,在经历过角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块后输出此次四元数更新值将其缓存在四元数输出模块用于下一次计算,输出的俯仰角,航向角,横滚角至运算结果分解模块;运算结果分解模块的时钟来自于***时钟分频所得。因为每次运算产生的输出数据量为3个32位的角度数据共24字节,加上发送时添加的同步字0x55aa以及一个帧字节的帧校验和则每计算一次需要产生分解的字节数为27个,所以它的频率要求不少于运算一次的频率的27倍。最后将分解的字节按发送波特率发送出去及完成第一次运算。下面计算频率为每更新两组数据运行一次。
综上所述,本发明解决了二子样旋转矢量姿态算法在通用MCU或者DSP中运行周期过长,导致运算时间不能进一步减少,无法实现高速和高精度的问题。本发明采用IP核方式提供,以VHDL硬件描述语言软核形式实现二子样旋转矢量姿态算法,可在FPGA中实现,典型工作频率为100MHZ,为高速姿态测量组件的实现提供可行性。
Claims (8)
1.一种二子样旋转矢量姿态算法IP核,其特征在于,包括422接口模块、角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块,其中422接口模块又包括分频模块、422接收模块、帧校验模块、FIFO存储发送模块、姿态角输出模块、运算结果分解模块、422输出模块;所述分频模块分别与422接收模块、运算结果分解模块、422输出模块相连;422接收模块通过帧校验模块与FIFO存储发送模块相连,FIFO存储发送模块接入角增量模块;角增量模块与等效旋转矢量模块、变换四元数模块、四元数更新模块顺次连接,四元数更新模块分别接入计算姿态角模块和角增量模块;计算姿态角模块依次通过姿态角输出模块、运算结果分解模块接入422输出模块;
所述422接口模块负责从外部读取422串口数据及各个时刻的轴向角速度,并将经过二子样旋转矢量姿态算法运算的结果按422串口标准输出到外部存储;
所述角增量模块根据FIFO存储发送模块输入的三组数据格式为IEEE 754单精度浮点的三个轴向的角速度Thetai,i=1,2,3,按照积分公式求得两组二子样姿态角增量θ1,θ2作为等效旋转矢量模块的输入信号;
所述等效旋转矢量模块将二子样姿态角增量θ1,θ2根据优化的二子样旋转矢量公式处理得到等效旋转矢量Φ作为变换四元数模块的输入信号;
所述变换四元数模块将等效旋转矢量Φ按照四元数变换公式进行处理得到四元数作为四元数更新模块的输入信号;
所述四元数更新模块将四元数按照姿态更新方程进行处理得到更新后的四元数作为计算姿态角模块的输入信号;
所述计算姿态角模块根据更新后的四元数构建姿态矩阵,求得姿态角即俯仰角横滚角航向角输出至422接口模块的姿态角输出模块。
2.根据权利要求1所述的二子样旋转矢量姿态算法IP核,其特征在于,所述422接口模块又包括分频模块、422接收模块、帧校验模块、FIFO存储发送模块、姿态角输出模块、运算结果分解模块、422输出模块,具体功能如下:
(1)分频模块根据所需波特率将***时钟进行分频处理获得所需的422接收模块的输入时钟,422接收模块在输入时钟上升沿时接收422接收端传来的比特,接收到一个字节后输入帧校验模块;
(2)帧校验模块接收到同步字0x55aa时开始接收新的一帧数据,该帧的最后一个字节为前面所有数据和校验的低八位数据,通过和校验的一组数据将输出口使能信号cheken置’1’作为FIFO存储发送模块的敏感信号,一帧数据包括该时刻的三个轴向角速度;
(3)FIFO存储发送模块当使能信号cheken上升沿时存入一组数据,在存储数据大于3时同时输出三组数据用于二子样旋转矢量姿态算法IP核的运算,下面每新存入两组新数据,加上之前最近时刻的一组数据为角增量模块提供输入信号;
(4)运算结果分解模块将最近更新的姿态角包括俯仰角、横滚角、航向角分解成一个个字节并加上同步字0x55aa以及和校验的低八位按时钟周期输出;
(5)422输出模块按照一定的波特率将运算结果分解模块输出的字节按顺序发送出去,422输出模块的时钟由分频模块分频得到。
3.根据权利要求1所述的二子样旋转矢量姿态算法IP核,其特征在于,所述角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块均由Xilinx提供的CORDIC IP核、浮点操作器IP核、加/减法器IP核、乘法器IP核和除法器IP核搭建而成。
4.根据权利要求1所述的二子样旋转矢量姿态算法IP核,其特征在于,所述角增量模块中,求得两组二子样姿态角增量θ1,θ2所使用的积分公式如式(1)所示:
其中,h为姿态更新周期,Thetai,i=1,2,3,为三个轴向角速度。
5.根据权利要求1所述的二子样旋转矢量姿态算法IP核,其特征在于,所述等效旋转矢量模块中,优化的二子样旋转矢量公式如式(2)所示:
其中Φ为等效旋转矢量。
6.根据权利要求1所述的二子样旋转矢量姿态算法IP核,其特征在于,所述变换四元数模块中,四元数变换公式如式(3)所示:
其中,Φx,Φy,Φz分别为等效旋转矢量Φ的三个轴向分量值,q(h)为所求四元数。
7.根据权利要求1所述的二子样旋转矢量姿态算法IP核,其特征在于,所述四元数更新模块中,姿态更新方程如式(4)所示:
其中Q(t)为当前时刻的姿态四元数,Q(t+h)为下一时刻的姿态四元数,q(h)为四元数变换公式。
8.根据权利要求1所述的二子样旋转矢量姿态算法IP核,其特征在于,所述计算姿态角模块中,姿态矩阵如式(5)所示,求姿态角的公式如式(6)所示:
其中,q0,q1,q2,q3为四元数,并记
其中,为俯仰角、为横滚角、为航向角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510572048.4A CN105243263B (zh) | 2015-09-09 | 2015-09-09 | 二子样旋转矢量姿态算法ip核 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510572048.4A CN105243263B (zh) | 2015-09-09 | 2015-09-09 | 二子样旋转矢量姿态算法ip核 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105243263A CN105243263A (zh) | 2016-01-13 |
CN105243263B true CN105243263B (zh) | 2018-07-31 |
Family
ID=55040911
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510572048.4A Active CN105243263B (zh) | 2015-09-09 | 2015-09-09 | 二子样旋转矢量姿态算法ip核 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105243263B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6219616B1 (en) * | 1998-04-23 | 2001-04-17 | Litton Systems Inc. | Method and apparatus for obtaining attitude updates in a strapdown inertial navigation system |
CN101462598A (zh) * | 2009-01-12 | 2009-06-24 | 徐国栋 | 一种卫星姿态定向***及方法 |
CN102109349A (zh) * | 2010-12-13 | 2011-06-29 | 北京航空航天大学 | 一种具有ecef模型的mimu*** |
CN102128624A (zh) * | 2010-12-28 | 2011-07-20 | 浙江大学 | 一种高动态捷联惯性导航并行计算装置 |
CN103743400A (zh) * | 2013-09-05 | 2014-04-23 | 新乡学院 | 一种磁航向解算装置 |
CN104407617A (zh) * | 2014-12-22 | 2015-03-11 | 大连理工大学 | 可编程飞行器姿态控制ip核 |
CN104880190A (zh) * | 2015-06-02 | 2015-09-02 | 无锡北微传感科技有限公司 | 一种用于惯导姿态融合加速的智能芯片 |
-
2015
- 2015-09-09 CN CN201510572048.4A patent/CN105243263B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6219616B1 (en) * | 1998-04-23 | 2001-04-17 | Litton Systems Inc. | Method and apparatus for obtaining attitude updates in a strapdown inertial navigation system |
CN101462598A (zh) * | 2009-01-12 | 2009-06-24 | 徐国栋 | 一种卫星姿态定向***及方法 |
CN102109349A (zh) * | 2010-12-13 | 2011-06-29 | 北京航空航天大学 | 一种具有ecef模型的mimu*** |
CN102128624A (zh) * | 2010-12-28 | 2011-07-20 | 浙江大学 | 一种高动态捷联惯性导航并行计算装置 |
CN103743400A (zh) * | 2013-09-05 | 2014-04-23 | 新乡学院 | 一种磁航向解算装置 |
CN104407617A (zh) * | 2014-12-22 | 2015-03-11 | 大连理工大学 | 可编程飞行器姿态控制ip核 |
CN104880190A (zh) * | 2015-06-02 | 2015-09-02 | 无锡北微传感科技有限公司 | 一种用于惯导姿态融合加速的智能芯片 |
Non-Patent Citations (5)
Title |
---|
Optimization for Four-sample Rotation Vector Attitude Estimation Algorithm;Shuyuan Yang等;《2013 Fourth International Conference on Intelligent Control and Information Processing (ICICIP)》;20130611;第672-676页 * |
一种单子样旋转矢量姿态算法;杨胜等;《宇航学报》;20100331;第31卷(第3期);第780-785页 * |
一种新的捷联惯导***对准方法;王岩等;《鱼雷技术》;20100831;第18卷(第4期);第282-286页 * |
基于FPGA/DSP的捷联惯导***设计;彭荆明等;《计算机测量与控制》;20080229;第16卷(第2期);第179-180页 * |
基于优化旋转矢量双子样算法的捷联惯导姿态解算;唐炜等;《江苏科技大学学报(自然科学版)》;20131031;第27卷(第5期);第471-477页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105243263A (zh) | 2016-01-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7093061B2 (en) | FIFO module, deskew circuit and rate matching circuit having the same | |
CN107547574B (zh) | 一种基于通用协议的通信***及方法 | |
CN103116175A (zh) | 基于dsp和fpga的嵌入式导航信息处理器 | |
CN104132663A (zh) | 一种基于fpga的导航计算机协处理器 | |
CN109506656B (zh) | 一种高精度在轨姿态信息下传还原方法 | |
CN201878182U (zh) | 一种基于fpga的总线型通信*** | |
KR102586073B1 (ko) | Spi 통신 효율성을 개선한 카메라 장치 및 그 통신 방법 | |
CN105243263B (zh) | 二子样旋转矢量姿态算法ip核 | |
CN113672030B (zh) | 数据传输速率发生器和相关装置及方法 | |
CN102538953A (zh) | 一种电线塔振动频率监测方法及*** | |
CN104614737B (zh) | 一种qpsk扩频卫星动态信号模拟方法 | |
CN104048658B (zh) | 一种使用基于姿态生成的设备来降低数据速率和功率消耗的方法 | |
CN111181559B (zh) | 一种旋***解码方法、装置、设备和存储介质 | |
CN115037703B (zh) | 数据处理方法、装置、计算机存储介质及计算机程序产品 | |
CN105974837B (zh) | 基于1553b总线防读写冲突的数据产生及传输方法 | |
CN112256617B (zh) | 一种提升设备串口通信效率的方法及终端 | |
CN105653390A (zh) | 一种SoC***的校验方法 | |
CN110442542B (zh) | 一种箭载计算机 | |
CN103063215B (zh) | 一种高动态环境下针对设定频点优化的sins划摇补偿方法 | |
CN110879066A (zh) | 一种姿态解算算法、装置及车载惯性导航*** | |
CN112729284B (zh) | 一种捷联惯导解算信号与外部***时钟同步方法 | |
CN116248232A (zh) | 一种用于惯性导航***的陀螺加表原始数据传输方法 | |
Dantam et al. | Multiprocess communication and control software for humanoid robots | |
CN113343448B (zh) | 控制效果评估方法、装置、电子设备及存储介质 | |
CN110427634B (zh) | 基于fpga实现反应***的通信***及其构建方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |