CN108731668B - 一种稳定平台惯导模拟系统及其数据传输方法 - Google Patents
一种稳定平台惯导模拟系统及其数据传输方法 Download PDFInfo
- Publication number
- CN108731668B CN108731668B CN201810076769.XA CN201810076769A CN108731668B CN 108731668 B CN108731668 B CN 108731668B CN 201810076769 A CN201810076769 A CN 201810076769A CN 108731668 B CN108731668 B CN 108731668B
- Authority
- CN
- China
- Prior art keywords
- module
- signal
- data
- inertial navigation
- differential
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明涉及一种稳定平台惯导模拟系统,包括:信号发生模块、信号传输模块、信号调理模块、信号处理模块、电机驱动模块、电机以及稳定平台,所述信号发生模块包括:信号输入模块,用于设定惯导参数信息;信号显示模块,用于接收并呈现信号输入模块的惯导数据;所述信号传输模块包括:串口转换模块,用于接收信号输入模块的惯导数据,并将其转化为差分输出信号;差分长线驱动模块,用于接收、传递串口转换模块的差分信号,并将其转换为单端输出。本系统适用于多种稳定平台状态监测,试验成本低;数据传输方法便捷,可用芯片搭建硬件电路,也可在EPLD或FPGA搭建软件电路,使用器件种类少、工作可靠。
Description
技术领域
本发明涉及SINS和GNSS/INS仿真系统技术领域,尤其是一种稳定平台惯导模拟系统及其数据传输方法。
背景技术
捷联惯导系统是一种依靠固联在载体上的惯性器件来获得绝对加速度,然后通过两次积分得到载体在一个相对坐标系中的位置,从而达到导航目的的一种“自主式导航系统”。
目前,国内涉及惯导模拟系统的发明专利有96项,实用新型专利有14件,内容包括惯导误差模型仿真方法、基于单片机的平台惯导模拟器、船载惯导组合导航系统、惯导空中初始位置对准方法等。与稳定平台惯导模拟系统及其数据传输方法的专利有2件,分别是“一种基于捷联惯导系统的双AD信号采集方法及电路(CN200810305871.9)”、“一种捷联惯导系统中及速度计信号转换装置(CN201210036336.4)”。其中,前者“一种基于捷联惯导系统的双AD信号采集方法及电路”设计了高精度、高速的A//D转换器,将导弹的角运动参数和线运动参数转化为数字信号,经过误差补偿后稳定控制。而后者“一种捷联惯导系统中及速度计信号转换装置”主要利用积分电路、A/D转换器、FPGA完成加速度计信号的转换。上述两个专利并没有传输信号的波特率及传送数据帧数进行详细地研究。
发明内容
本发明的首要目的在于提供一种利用时钟匹配模块匹配传输信号的波特率,利用数据寄存模块匹配数据帧数,将惯导数据按字节顺序逐一传送至CPU控制模块,进而对电机进行控制的稳定平台惯导模拟系统。
为实现上述目的,本发明采用了以下技术方案:一种稳定平台惯导模拟系统,包括:信号发生模块、信号传输模块、信号调理模块、信号处理模块、电机驱动模块、电机以及稳定平台,其中:
所述信号发生模块包括:
信号输入模块,用于设定惯导参数信息;
信号显示模块,用于接收并呈现信号输入模块的惯导数据;
所述信号传输模块包括:
串口转换模块,用于接收信号输入模块的惯导数据,并将其转化为差分输出信号;
差分长线驱动模块,用于接收、传递串口转换模块的差分信号,并将其转换为单端输出;
所述信号调理模块包括:
时钟匹配模块,用于分频晶振信号,产生与惯导信号波特率相符的第一时钟信号;用于八分频第一时钟信号,产生第二时钟信号;
数据寄存模块,用于接收时钟匹配模块的第一时钟信号,将差分长线驱动模块输出的串行信号转换为并行信号;
数据锁存模块,用于接收时钟匹配模块的第二时钟信号,依次锁存数据寄存模块的输出信号;
数据缓冲模块,用于缓存数据锁存模块的输出信号;
所述信号处理模块包括:
CPU控制模块,用于读取数据缓冲模块中的惯导信号,并与设定的位置、速度求差,根据差值获取补偿数字信息;
D/A转换模块,将补偿数字信息转换为补偿模拟信息;
所述电机驱动模块包括:
PID控制模块,用于接收D/A转换模块输出的补偿模拟信息,将位置、速度的PID控制信号配置于功率放大模块;
保护模块,用于监控电路中的电流值与短路现象;
功率放大模块,用于放大PID控制信号的功率,以驱动电机运转,修正稳定平台位置状态。
所述数据寄存模块中寄存器的数量与一帧数据的字节数相同。
本发明的另一目的在于提供一种稳定平台惯导模拟系统的数据传输方法,该方法包括下列顺序的步骤:
(1)开始,设定第一时钟信号与第二时钟信号;
(2)设定并显示惯导数据;
(3)将惯导信号差分输入、单端输出至数据寄存模块的数据输入端;
(4)由低到高将8位数据即1个字节从数据寄存模块并行输出;
(5)数据锁存模块中锁存器的时钟引脚得到上升沿信号,将1字节数据传至下一个锁存器的输入端;
(6)后一帧的第一个字节进行传输后,前一帧的第一个字节数据传至数据缓冲模块中缓冲器的输入端;
(7)CPU控制模块输出读指令,作为缓冲器使能信号,读取惯导数据;
(8)与设定的位置、速度求差,获取补偿数字信息;
(9)将补偿数字信息转换为补偿模拟信息;
(10)依次配置位置、速度的PID控制信号;
(11)将控制信号反馈给电机,修正电机的运动,调整稳定平台位置状态。
由上述技术方案可知,本发明的优点在于:第一,时钟匹配模块的设计可适用于各种波特率的数据传输;第二,数据寄存模块的设计可适用于各帧数据的传输,第三,本系统适用于多种稳定平台状态监测,试验成本低;第四,数据传输方法便捷,可用芯片搭建硬件电路,也可在EPLD或FPGA搭建软件电路,使用器件种类少、工作可靠。
附图说明
图1为本发明的系统结构示意图。
图2为本发明的方法流程图。
具体实施方式
如图1所示,一种稳定平台惯导模拟系统,包括:信号发生模块、信号传输模块、信号调理模块、信号处理模块、电机驱动模块、电机以及稳定平台,其中:
所述信号发生模块包括:
信号输入模块,用于设定惯导参数信息;
信号显示模块,用于接收并呈现信号输入模块的惯导数据;
所述信号传输模块包括:
串口转换模块,用于接收信号输入模块的惯导数据,并将其转化为差分输出信号;
差分长线驱动模块,用于接收、传递串口转换模块的差分信号,并将其转换为单端输出;
所述信号调理模块包括:
时钟匹配模块,用于分频晶振信号,产生与惯导信号波特率相符的第一时钟信号;用于八分频第一时钟信号,产生第二时钟信号;
数据寄存模块,用于接收时钟匹配模块的第一时钟信号,将差分长线驱动模块输出的串行信号转换为并行信号;
数据锁存模块,用于接收时钟匹配模块的第二时钟信号,依次锁存数据寄存模块的输出信号;
数据缓冲模块,用于缓存数据锁存模块的输出信号;
所述信号处理模块包括:
CPU控制模块,用于读取数据缓冲模块中的惯导信号,并与设定的位置、速度求差,根据差值获取补偿数字信息;
D/A转换模块,将补偿数字信息转换为补偿模拟信息;
所述电机驱动模块包括:
PID控制模块,用于接收D/A转换模块输出的补偿模拟信息,将位置、速度的PID控制信号配置于功率放大模块;
保护模块,用于监控电路中的电流值与短路现象;
功率放大模块,用于放大PID控制信号的功率,以驱动电机运转,修正稳定平台位置状态。
所述数据寄存模块中寄存器的数量与一帧数据的字节数相同。
如图2所示,本方法包括下列顺序的步骤:
(1)开始,设定第一时钟信号与第二时钟信号;
(2)设定并显示惯导数据;
(3)将惯导信号差分输入、单端输出至数据寄存模块的数据输入端;
(4)由低到高将8位数据即1个字节从数据寄存模块并行输出;
(5)数据锁存模块中锁存器的时钟引脚得到上升沿信号,将1字节数据传至下一个锁存器的输入端;
(6)后一帧的第一个字节进行传输后,前一帧的第一个字节数据传至数据缓冲模块中缓冲器的输入端;
(7)CPU控制模块输出读指令,作为缓冲器使能信号,读取惯导数据;
(8)与设定的位置、速度求差,获取补偿数字信息;
(9)将补偿数字信息转换为补偿模拟信息;
(10)依次配置位置、速度的PID控制信号;
(11)将控制信号反馈给电机,修正电机的运动,调整稳定平台位置状态。
如图2所示,首先,利用时钟匹配模块设定第一时钟信号与第二时钟信号;通过信号输入模块、信号显示模块设定并显示惯导数据,将惯导信号差分输入、单端输出至移位寄存器模块数据输入端;其次,由低到高将8位数据即1字节从数据寄存模块中的寄存器并行输出,数据锁存模块中的锁存器时钟引脚得到上升沿信号,将1字节数据传至下一个锁存器的输入端;后一帧的第一个字节进行传输后,前一帧的第一个字节数据传至数据缓冲模块中的缓冲器的输入端;再次,CPU控制模块输出读指令,作为缓冲器使能信号,读取惯导数据;与设定的位置、速度求差,获取补偿数字信息;将补偿数字信息转换为补偿模拟信息;依次配置位置、速度的PID控制信号;最后,将控制信号反馈给电机,修正电机的运动。
综上所述,本发明中的时钟匹配模块的设计可适用于各种波特率的数据传输;数据寄存模块的设计可适用于各帧数据的传输,本系统适用于多种稳定平台状态监测,试验成本低;数据传输方法便捷,可用芯片搭建硬件电路,也可在EPLD或FPGA搭建软件电路,使用器件种类少、工作可靠。
Claims (3)
1.一种稳定平台惯导模拟系统,其特征在于:包括:信号发生模块、信号传输模块、信号调理模块、信号处理模块、电机驱动模块、电机以及稳定平台,其中:
所述信号发生模块包括:
信号输入模块,用于设定惯导参数信息;
信号显示模块,用于接收并呈现信号输入模块的惯导数据;
所述信号传输模块包括:
串口转换模块,用于接收信号输入模块的惯导数据,并将其转化为差分输出信号;
差分长线驱动模块,用于接收、传递串口转换模块的差分信号,并将其转换为单端输出;
所述信号调理模块包括:
时钟匹配模块,用于分频晶振信号,产生与惯导信号波特率相符的第一时钟信号;用于八分频第一时钟信号,产生第二时钟信号;
数据寄存模块,用于接收时钟匹配模块的第一时钟信号,将差分长线驱动模块输出的串行信号转换为并行信号;
数据锁存模块,用于接收时钟匹配模块的第二时钟信号,依次锁存数据寄存模块的输出信号;
数据缓冲模块,用于缓存数据锁存模块的输出信号;
所述信号处理模块包括:
CPU控制模块,用于读取数据缓冲模块中的惯导信号,并与设定的位置、速度求差,根据差值获取补偿数字信息;
D/A转换模块,将补偿数字信息转换为补偿模拟信息;
所述电机驱动模块包括:
PID控制模块,用于接收D/A转换模块输出的补偿模拟信息,将位置、速度的PID控制信号配置于功率放大模块;
保护模块,用于监控电路中的电流值与短路现象;
功率放大模块,用于放大PID控制信号的功率,以驱动电机运转,修正稳定平台位置状态。
2.根据权利要求1所述的稳定平台惯导模拟系统,其特征在于:所述数据寄存模块中寄存器的数量与一帧数据的字节数相同。
3.根据权利要求1至2中任一项所述的稳定平台惯导模拟系统的数据传输方法,其特征在于:该方法包括下列顺序的步骤:
(1)开始,设定第一时钟信号与第二时钟信号;
(2)设定并显示惯导数据;
(3)将惯导信号差分输入、单端输出至数据寄存模块的数据输入端;
(4)由低到高将8位数据即1个字节从数据寄存模块并行输出;
(5)数据锁存模块中锁存器的时钟引脚得到上升沿信号,将1字节数据传至下一个锁存器的输入端;
(6)后一帧的第一个字节进行传输后,前一帧的第一个字节数据传至数据缓冲模块中缓冲器的输入端;
(7)CPU控制模块输出读指令,作为缓冲器使能信号,读取惯导数据;
(8)与设定的位置、速度求差,获取补偿数字信息;
(9)将补偿数字信息转换为补偿模拟信息;
(10)依次配置位置、速度的PID控制信号;
(11)将控制信号反馈给电机,修正电机的运动,调整稳定平台位置状态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810076769.XA CN108731668B (zh) | 2018-01-26 | 2018-01-26 | 一种稳定平台惯导模拟系统及其数据传输方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810076769.XA CN108731668B (zh) | 2018-01-26 | 2018-01-26 | 一种稳定平台惯导模拟系统及其数据传输方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108731668A CN108731668A (zh) | 2018-11-02 |
CN108731668B true CN108731668B (zh) | 2021-03-30 |
Family
ID=63940455
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810076769.XA Active CN108731668B (zh) | 2018-01-26 | 2018-01-26 | 一种稳定平台惯导模拟系统及其数据传输方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108731668B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111610745B (zh) * | 2020-05-08 | 2023-03-21 | 中国人民解放军海军潜艇学院 | 一种载人潜水器模拟训练平台控制方法及模拟训练平台 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102645217A (zh) * | 2012-04-20 | 2012-08-22 | 武汉大学 | 一种gnss中频数据与惯性测量数据联合采集器 |
CN102916914A (zh) * | 2012-09-21 | 2013-02-06 | 北京空间机电研究所 | 一种模拟前端的数据接收处理系统 |
CN104008078A (zh) * | 2014-05-27 | 2014-08-27 | 安徽中兴继远信息技术股份有限公司 | 一种基于fpga的数据传输板之间进行高速传输的方法 |
CN104132663A (zh) * | 2014-05-27 | 2014-11-05 | 北京遥测技术研究所 | 一种基于fpga的导航计算机协处理器 |
CN104730541A (zh) * | 2015-04-21 | 2015-06-24 | 中国电子科技集团公司第五十四研究所 | 一种基于pxi总线的通航实时gnss/ins组合导航信号模拟器 |
CN105027444A (zh) * | 2013-03-15 | 2015-11-04 | 英特尔公司 | 集成时钟差分缓冲 |
WO2016133867A1 (en) * | 2015-02-16 | 2016-08-25 | Invensense, Inc. | System and method for aligning sensor data to screen refresh rate |
CN107356250A (zh) * | 2017-07-10 | 2017-11-17 | 嘉兴市纳杰微电子技术有限公司 | 适用于单片微型定位导航授时系统的分时复用集成电路 |
-
2018
- 2018-01-26 CN CN201810076769.XA patent/CN108731668B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102645217A (zh) * | 2012-04-20 | 2012-08-22 | 武汉大学 | 一种gnss中频数据与惯性测量数据联合采集器 |
CN102916914A (zh) * | 2012-09-21 | 2013-02-06 | 北京空间机电研究所 | 一种模拟前端的数据接收处理系统 |
CN105027444A (zh) * | 2013-03-15 | 2015-11-04 | 英特尔公司 | 集成时钟差分缓冲 |
CN104008078A (zh) * | 2014-05-27 | 2014-08-27 | 安徽中兴继远信息技术股份有限公司 | 一种基于fpga的数据传输板之间进行高速传输的方法 |
CN104132663A (zh) * | 2014-05-27 | 2014-11-05 | 北京遥测技术研究所 | 一种基于fpga的导航计算机协处理器 |
WO2016133867A1 (en) * | 2015-02-16 | 2016-08-25 | Invensense, Inc. | System and method for aligning sensor data to screen refresh rate |
CN104730541A (zh) * | 2015-04-21 | 2015-06-24 | 中国电子科技集团公司第五十四研究所 | 一种基于pxi总线的通航实时gnss/ins组合导航信号模拟器 |
CN107356250A (zh) * | 2017-07-10 | 2017-11-17 | 嘉兴市纳杰微电子技术有限公司 | 适用于单片微型定位导航授时系统的分时复用集成电路 |
Non-Patent Citations (1)
Title |
---|
高精度惯导系统信号处理平台的设计与实现;马幸等;《电子测量技术》;20110831;第34卷(第8期);第36-40,71页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108731668A (zh) | 2018-11-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110133999B (zh) | 一种基于星云激光点云数采平台的时间同步方法及系统 | |
US20210223408A1 (en) | Point cloud data acquisition method and device under situation of no gnss signal | |
CN107544467B (zh) | 整星条件下的双星编队控制闭环测试系统及方法 | |
CN102128624B (zh) | 一种高动态捷联惯性导航并行计算装置 | |
CN103616710A (zh) | 基于fpga的多传感器组合导航时间同步系统 | |
CN107677293B (zh) | 一种惯组通用测试平台系统 | |
CN105607093A (zh) | 一种组合导航系统及获取导航坐标的方法 | |
CN102736591A (zh) | 一种分布式pos子imu数据同步采集系统 | |
CN103616037B (zh) | 一种imu标定系统的自检自校方法 | |
CN103592881A (zh) | 一种基于fpga的多路信号同步采样控制电路 | |
CN108731668B (zh) | 一种稳定平台惯导模拟系统及其数据传输方法 | |
CN107270902B (zh) | 一种带有交叉轴耦合误差补偿的mems惯性测量单元 | |
CN110849359B (zh) | 一种捷联式光纤陀螺惯导系统内部时序和对外同步设计方法 | |
CN105487489A (zh) | 一种带被试件同步功能的三通道编码器细分及位置信息采集装置 | |
EP3244382A1 (en) | Dynamically integrated navigation tester | |
CN104614737B (zh) | 一种qpsk扩频卫星动态信号模拟方法 | |
CN103743411A (zh) | 一种捷联惯性导航系统标定的方法 | |
CN112505409A (zh) | 一种多通道的高精度传感器采集系统及其频率测量方法 | |
CN101109638B (zh) | 具有调零功能的光纤陀螺模拟量角速度输出电路 | |
CN116068912A (zh) | 一种半实物仿真高精度时钟同步系统及方法 | |
CN116255979A (zh) | 一种一体化导航系统、方法和飞行器 | |
CN201216001Y (zh) | 图像采集、传输和记录一体化设备 | |
CN205192475U (zh) | 用于无人机的横滚角测量装置 | |
CN105137753A (zh) | 北斗多功能时统系统 | |
CN102495824B (zh) | 在同一模拟输出卡上产生多路不同频率模拟信号的方法 |
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 |