CN114594695A - 一种基于fpga和dsp的惯性器件仿真控制*** - Google Patents
一种基于fpga和dsp的惯性器件仿真控制*** Download PDFInfo
- Publication number
- CN114594695A CN114594695A CN202210059010.7A CN202210059010A CN114594695A CN 114594695 A CN114594695 A CN 114594695A CN 202210059010 A CN202210059010 A CN 202210059010A CN 114594695 A CN114594695 A CN 114594695A
- Authority
- CN
- China
- Prior art keywords
- chip
- dsp
- fpga
- control system
- module
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems involving the use of models or simulators of said systems electric
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明公开了一种基于FPGA和DSP的惯性器件仿真控制***,涉及惯性测试仿真***控制领域。本发明包括硬件部分和与之配套的软件部分,其硬件部分包括:HMI上位机、DSP芯片、DDR寄存器、FLASH寄存器1、FPGA芯片、FLASH寄存器2、差分接口芯片、角度传感器、RS232串口芯片、DA转换芯片、驱动器、电机,其软件部分包括:HMI上位机应用程序模块、DSP数据读取模块、DSP数据处理模块、DSP数据传输模块、FPGA传感器数据采集模块,HMI上位机与DSP芯片之间通过RS232串口进行连接,DSP芯片的型号为TMS320F28377SPTP,DSP芯片内部集成了DSP数据读取模块、DSP数据处理模块、DSP数据传输模块。该控制***采用HMI作为人机交互界面,通过组态编程实现,设计简单,成本低、体积小、界面维护方便。
Description
技术领域
本发明属于惯性测试仿真***控制领域,特别是涉及一种基于FPGA和DSP的惯性器件仿真控制***。
背景技术
伴随着现代的光学陀螺仪、振动陀螺仪、微机电陀螺仪和加速度等惯性器件的性能提升和制造成本的降低,惯性器件的使用范围和领域得到进一步扩展。目前,由惯性器件设计制造的惯性导航***、惯性测量***等已经广泛应用于太空试验平台、飞行器导航、船舶导航、导弹制导、大地测量、无人驾驶等领域。
由于惯性器件存在零漂,其精度会随着使用的时间和温度变化而变化,因此,惯性器件需要用到惯性测试仿真***对其进行标定和校准,惯性测试仿真***的控制精度就直接影响到了惯性器件的标定和校准精度,最终影响到惯性***的精度。
目前市场上的惯性测试仿真***大都采用PC上位机+RT实时操作***的组合方式,通过PCI板卡进行控制,其成本高、体积大、工程实现方式和拆装相对复杂。
发明内容
本发明的目的在于提供一种基于FPGA和DSP的惯性器件仿真控制***,该控制***采用HMI作为人机交互界面,通过组态编程实现,设计简单,成本低、体积小、界面维护方便,解决了通过PCI板卡进行控制,其成本高、体积大、工程实现方式和拆装相对复杂的问题。
为解决上述技术问题,本发明是通过以下技术方案实现的:
本发明为一种基于FPGA和DSP的惯性器件仿真控制***,包括硬件部分和与之配套的软件部分;
其硬件部分包括:HMI上位机、DSP芯片、DDR寄存器、FLASH寄存器1、FPGA芯片、FLASH寄存器2、差分接口芯片、角度传感器、RS232串口芯片、DA转换芯片、驱动器、电机;
其软件部分包括:HMI上位机应用程序模块、DSP数据读取模块、DSP数据处理模块、DSP数据传输模块、FPGA传感器数据采集模块。
进一步地,所述HMI上位机与DSP芯片之间通过RS232串口进行连接,所述DSP芯片的型号为TMS320F28377SPTP,DSP芯片内部集成了DSP数据读取模块、DSP数据处理模块、DSP数据传输模块。
进一步地,所述DDR寄存器采用IS61LV25616-8TI型SRAM芯片,所述DDR寄存器与DSP芯片之间双向连接;
所述FLASH寄存器1采用SST39VF800-70-4I-EK型FLASH芯片,该寄存器与DSP芯片之间双向连接。
进一步地,所述FPGA芯片采用Spartan-3E系列芯片XC3S500E-4PQ208I,该芯片与DSP芯片之间通过数据总线、地址总线、控制总线进行连接;
所述FLASH寄存器2选用FLASH XCF04S作为FPGA的配置芯片。
进一步地,所述差分接口芯片采用SN65HVD78D型接口芯片,该芯片与FPGA芯片之间通过串口连接;
所述角度传感器选用型号为ECN225的旋转编码器。
进一步地,所述RS232串口芯片选用RSM232D型双路隔离RS232收发器,该芯片与DSP芯片之间通过串口UART连接;
所述DA转换芯片选用AD5754R型多通道电压输出数模转换器,该芯片与DSP芯片之间通过SPI连接。
进一步地,所述驱动器选用ISF5AK60型直流电机驱动器,所述驱动器与DA转换芯片通过电压模拟量信号连接;
所述电机选用160LYX15型直流有刷力矩电机,所述电机与驱动器通过电流模拟量信号连接。
本发明具有以下有益效果:
1、该控制***采用HMI作为人机交互界面,通过组态编程实现,设计简单,成本低、体积小、界面维护方便。
2、该控制***采用DSP作为控制中心,FPGA用于数据采集,其成本低,体积小,设计时可以集成到一块电路板上,使控制***的控制箱体积设计得结构简单紧凑,从而拆卸方便,便于维护和推广应用。
3、该控制***中的DSP控制程序采用嵌入式C语言实现,FPGA采集程序通过Verilog HDL语言实现,编程、调试方便,设计时间短。
4、该控制***可靠性高,抛弃了传统的PC上位机+RT实时操作***的组合方式,传统控制方式下,存在操作***死机、RT软件与操作***不兼容的问题,可靠性较低。
当然,实施本发明的任一产品并不一定需要同时达到以上所述的所有优点。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明的***控制框图;
图2为本发明的***电气原理图;
图3为本发明的双闭环控制框图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
请参阅图1-3所示,本发明为一种基于FPGA和DSP的惯性器件仿真控制***,包括硬件部分和与之配套的软件部分;
其硬件部分包括:HMI上位机、DSP芯片、DDR寄存器、FLASH寄存器1、FPGA芯片、FLASH寄存器2、差分接口芯片、角度传感器、RS232串口芯片、DA转换芯片、驱动器、电机;
其软件部分包括:HMI上位机应用程序模块、DSP数据读取模块、DSP数据处理模块、DSP数据传输模块、FPGA传感器数据采集模块。
其中,HMI上位机与DSP芯片之间通过RS232串口进行连接,HMI上位机同HMI上位机应用程序模块共同完成数据显示以及人机交互操作;DSP芯片的型号为TMS320F28377SPTP,DSP芯片内部集成了DSP数据读取模块、DSP数据处理模块、DSP数据传输模块,结合上述***中的各软件模块,该芯片可以实现***传感器数据采集、数据运算处理、控制信号输出、数据结果显示功能,是整个***的核心。
其中,DDR寄存器选用IS61LV25616-8TI型SRAM芯片,DDR寄存器与DSP芯片之间双向连接,用于存储DSP运算过程中的中间数据;
FLASH寄存器1选用SST39VF800-70-4I-EK型FLASH芯片,该寄存器与DSP芯片之间双向连接,用于存储DSP的初始运行程序。
其中,FPGA芯片采用Spartan-3E系列芯片XC3S500E-4PQ208I,该芯片与DSP芯片之间通过数据总线、地址总线、控制总线进行连接,FPGA芯片结合差分接口芯片、FPGA传感器数据采集模块用于实现外部角度传感器的数据采集;
FLASH寄存器2选用FLASH XCF04S作为FPGA的配置芯片,FLASH寄存器2与FPGA芯片之间双向连接,用于存放程序和数据。
其中,差分接口芯片采用SN65HVD78D型接口芯片,该芯片与FPGA芯片之间通过串口连接,用于FPGA读取角度传感器的当前角度;
角度传感器选用型号为ECN225的旋转编码器,用于感知当前***角度位置。
其中,RS232串口芯片选用RSM232D型双路隔离RS232收发器,该芯片与DSP芯片之间通过串口UART连接,用于DSP与HMI之间的数据传输;
DA转换芯片选用AD5754R型多通道电压输出数模转换器,该芯片与DSP芯片之间通过SPI连接,用于DSP向驱动器发送控制指令。
其中,驱动器选用ISF5AK60型直流电机驱动器,驱动器与DA转换芯片通过电压模拟量信号连接,用于接收DSP发送的控制指令;
电机选用160LYX15型直流有刷力矩电机,电机与驱动器通过电流模拟量信号连接,用于执行驱动器控制指令。
其中,HMI上位机应用程序模块用于提供人机交互功能;其软件编程部分分为发送进程、接收进程和显示进程;发送进程获取屏幕上输入的控制指令信息,并按照通信协议下传给DSP数据传输模块;接收进程通过通信协议接收DSP数据传输模块上传的***数据;显示进程显示接收进程获取的***数据和响应应用程序上的屏幕操作;
DSP数据读取模块用于读取FPGA中的角度传感器数据信息,并存放到SRAM中,当满足一定条件时,DSP数据处理模块调用此数据进行数据解算;DSP数据处理模块根据屏幕上输入的控制指令信息和采集到的当前角度信息进行PID解算,得出控制指令,通过DA芯片传送给驱动器;
DSP数据传输模块一是用于接收屏幕上输入的控制指令信息;二是用于将传感器数据、计算结果实时上传到HMI进行显示;
FPGA传感器数据采集模块通过通信协议实时采集角度传感器的当前角度信息,并上传给DSP数据读取模块。
本发明的工作原理为:
控制***硬件由一个控制柜组成,按功能模块细分为测角***模块、数字控制***模块、电机驱动模块、指令输入输出***及与外部通信接口***模块等组成,如图1所示。
1.测角***
测角***是转台角位置的测量装置,主要由角度传感器组成。对轴的角位置进行测量,并且输出实时测量数据,作为控制***的反馈参数。
2.指令输入输出***
指令输入输出***由HMI组成,与数字控制***中的DSP芯片之间通过RS232串口进行连接,HMI主要用于完成目标控制指令输入(目标位置、目标速率)和运算结果显示。
3.数字控制***
数字控制***主要由DSP芯片、DDR寄存器、FLASH寄存器1、FPGA芯片、FLASH寄存器2、差分接口芯片、角度传感器、RS232串口芯片、DA转换芯片等组成,其集成在一块电路板上,体积小,成本低,安装、维护方便。
控制上采用了数字PID调节算法,PID(比例-积分-微分)调节是控制***中技术成熟,应用广泛的一种控制技术,因此被广泛地应用于各种控制***中。它的特点是形成了典型的结构,参数整定及调节方便,结构改变灵活,适应性强。
PID调节器的数学模型为:
其中的Kp、Ki、Kd分别为比例,积分和微分系数。
在控制算法中采用位置式算式,e(t)由采样点的值代替,积分与微分由数值积分与差分算法来实现,采用后向矩形积分与后向差分,所得到的位置算式为:
为了减小***的超调量,对以上算式进行改造,采用积分分离的PID算法。此算法引入逻辑功能,调节器输出采样点值为:
式中
其中,A为门限,大偏差时,积分项不起作用,偏差在门限之内时,引入积分算法,这样既可以减少超调量,又可以使积分控制达到预期的效果。
本控制***采用双闭环(位置环和速度环)数字PID控制,其结构图如图3所示。在这个***框图中,位置环控制器、速率环控制器均由DSP来实现。
在本说明书的描述中,参考术语“一个实施例”、“示例”、“具体示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
以上公开的本发明优选实施例只是用于帮助阐述本发明。优选实施例并没有详尽叙述所有的细节,也不限制本发明仅为所述的具体实施方式。显然,根据本说明书的内容,可作很多的修改和变化。本说明书选取并具体描述这些实施例,是为了更好地解释本发明的原理和实际应用,从而使所属技术领域技术人员能很好地理解和利用本发明。本发明仅受权利要求书及其全部范围和等效物的限制。
Claims (7)
1.一种基于FPGA和DSP的惯性器件仿真控制***,其特征在于:包括硬件部分和与之配套的软件部分;
其硬件部分包括:HMI上位机、DSP芯片、DDR寄存器、FLASH寄存器1、FPGA芯片、FLASH寄存器2、差分接口芯片、角度传感器、RS232串口芯片、DA转换芯片、驱动器、电机;
其软件部分包括:HMI上位机应用程序模块、DSP数据读取模块、DSP数据处理模块、DSP数据传输模块、FPGA传感器数据采集模块。
2.根据权利要求1所述的一种基于FPGA和DSP的惯性器件仿真控制***,其特征在于,所述HMI上位机与DSP芯片之间通过RS232串口进行连接,所述DSP芯片的型号为TMS320F28377SPTP,DSP芯片内部集成了DSP数据读取模块、DSP数据处理模块、DSP数据传输模块。
3.根据权利要求1所述的一种基于FPGA和DSP的惯性器件仿真控制***,其特征在于,所述DDR寄存器采用IS61LV25616-8TI型SRAM芯片,所述DDR寄存器与DSP芯片之间双向连接;
所述FLASH寄存器1采用SST39VF800-70-4I-EK型FLASH芯片,该寄存器与DSP芯片之间双向连接。
4.根据权利要求1所述的一种基于FPGA和DSP的惯性器件仿真控制***,其特征在于,所述FPGA芯片采用Spartan-3E系列芯片XC3S500E-4PQ208I,该芯片与DSP芯片之间通过数据总线、地址总线、控制总线进行连接;
所述FLASH寄存器2选用FLASH XCF04S作为FPGA的配置芯片。
5.根据权利要求1所述的一种基于FPGA和DSP的惯性器件仿真控制***,其特征在于,所述差分接口芯片采用SN65HVD78D型接口芯片,该芯片与FPGA芯片之间通过串口连接;
所述角度传感器选用型号为ECN225的旋转编码器。
6.根据权利要求1所述的一种基于FPGA和DSP的惯性器件仿真控制***,其特征在于,所述RS232串口芯片选用RSM232D型双路隔离RS232收发器,该芯片与DSP芯片之间通过串口UART连接;
所述DA转换芯片选用AD5754R型多通道电压输出数模转换器,该芯片与DSP芯片之间通过SPI连接。
7.根据权利要求1所述的一种基于FPGA和DSP的惯性器件仿真控制***,其特征在于,所述驱动器选用ISF5AK60型直流电机驱动器,所述驱动器与DA转换芯片通过电压模拟量信号连接;
所述电机选用160LYX15型直流有刷力矩电机,所述电机与驱动器通过电流模拟量信号连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210059010.7A CN114594695A (zh) | 2022-01-19 | 2022-01-19 | 一种基于fpga和dsp的惯性器件仿真控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210059010.7A CN114594695A (zh) | 2022-01-19 | 2022-01-19 | 一种基于fpga和dsp的惯性器件仿真控制*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114594695A true CN114594695A (zh) | 2022-06-07 |
Family
ID=81805116
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210059010.7A Pending CN114594695A (zh) | 2022-01-19 | 2022-01-19 | 一种基于fpga和dsp的惯性器件仿真控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114594695A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115685864A (zh) * | 2022-09-15 | 2023-02-03 | 江苏亚威机床股份有限公司 | 一种折弯机控制方法 |
-
2022
- 2022-01-19 CN CN202210059010.7A patent/CN114594695A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115685864A (zh) * | 2022-09-15 | 2023-02-03 | 江苏亚威机床股份有限公司 | 一种折弯机控制方法 |
CN115685864B (zh) * | 2022-09-15 | 2023-08-25 | 江苏亚威机床股份有限公司 | 一种折弯机控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102426458B (zh) | 一种适用于旋翼无人机的地面控制*** | |
CN101515178B (zh) | 基于can总线的主从负担式余度无人飞机自动驾驶仪 | |
CN102620719B (zh) | 具备高精度、温度补偿的倾角传感器及其动态补偿方法 | |
CN103644915A (zh) | 一种直驱光纤陀螺稳定平台结构及其控制方法 | |
CN104260093A (zh) | 一种delta并联机械手控制*** | |
CN114594695A (zh) | 一种基于fpga和dsp的惯性器件仿真控制*** | |
CN106052689A (zh) | 基于c8051f064单片机的imu信号采集*** | |
CN103984327B (zh) | 一种基于模糊控制的小型数字舵机*** | |
CN111323045A (zh) | 一种光电稳定平台通用测试平台及方法 | |
CN115202271A (zh) | 一种微小型无人机嵌入式飞行控制器 | |
CN205068169U (zh) | 基于双余度姿态传感器的六旋翼无人机 | |
CN109029548A (zh) | 一种实时精确反馈运行电流和输出力矩的舵机***及方法 | |
CN211928441U (zh) | 一种激光定高低空作业无人机控制*** | |
CN109189099A (zh) | 一种四旋翼无人机的图形化控制组态方法 | |
CN109029459B (zh) | 一种运动目标轨迹追踪***及基于该***的计算方法 | |
CN107315340A (zh) | 一种基于微机电式imu测量反馈的稳像装置及控制方法 | |
Wei | Autonomous control system for the quadrotor unmanned aerial vehicle | |
CN108731668A (zh) | 一种稳定平台惯导模拟***及其数据传输方法 | |
CN110940352B (zh) | 微机电***惯性测量单元自动校准***及其校准验证方法 | |
CN204347615U (zh) | 一种基于Edison的无人机自动驾驶仪 | |
CN2935226Y (zh) | 以设定角度和周期往复摇摆运动的控制装置 | |
CN206133313U (zh) | 基于瑞萨r5f100lea主控的四旋翼飞行控制器 | |
CN204278019U (zh) | 一种delta并联机械手控制*** | |
CN207833330U (zh) | 一种室内服务机器人 | |
CN111256685A (zh) | 一种用于agv的惯性导航传感器 |
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 |