CN112484563A - 火力线稳定系统的半物理实验方法 - Google Patents

火力线稳定系统的半物理实验方法 Download PDF

Info

Publication number
CN112484563A
CN112484563A CN202011331244.XA CN202011331244A CN112484563A CN 112484563 A CN112484563 A CN 112484563A CN 202011331244 A CN202011331244 A CN 202011331244A CN 112484563 A CN112484563 A CN 112484563A
Authority
CN
China
Prior art keywords
semi
follow
fire line
stabilization system
line stabilization
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
Application number
CN202011331244.XA
Other languages
English (en)
Other versions
CN112484563B (zh
Inventor
占昌恒
韩磊
李忠
王君
潘军
邵兴齐
位红军
姜明
李红丽
孔祥宣
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwest Institute Of Mechanical & Electrical Engineering
Original Assignee
Northwest Institute Of Mechanical & Electrical Engineering
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Northwest Institute Of Mechanical & Electrical Engineering filed Critical Northwest Institute Of Mechanical & Electrical Engineering
Priority to CN202011331244.XA priority Critical patent/CN112484563B/zh
Priority claimed from CN202011331244.XA external-priority patent/CN112484563B/zh
Publication of CN112484563A publication Critical patent/CN112484563A/zh
Application granted granted Critical
Publication of CN112484563B publication Critical patent/CN112484563B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F41WEAPONS
    • F41AFUNCTIONAL FEATURES OR DETAILS COMMON TO BOTH SMALLARMS AND ORDNANCE, e.g. CANNONS; MOUNTINGS FOR SMALLARMS OR ORDNANCE
    • F41A31/00Testing arrangements

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明属于火炮随动系统火力线稳定技术领域,具体涉及一种火力线稳定系统的半物理实验方法。该方法中,随动控制器接收位置主令和位置反馈,输出速度主令,伺服驱动器接收速度主令,输出电压主令,永磁同步电机受到电压驱动,开始运动,通过传动装置将电机的转动转化为方位和高低方向位置的运动。受信仪安装在方位和高低运动的炮塔和耳轴上,采集方位和高低的位置信息作为位置反馈传递给随动控制器。从而完成一个完成一个完整的随动系统功能。使用半物理试验方法进行随动系统的开发,既能节约成本,又能缩短开发周期,能有效地提高随动稳定系统设计的效率。

Description

火力线稳定系统的半物理实验方法
技术领域
本发明属于火炮随动系统火力线稳定技术领域,具体涉及一种火力线稳定系统的半物理实验方法,其应用于大口径自行火炮和火箭炮随动系统。
背景技术
自行火炮随动系统作为火力控制系统的末端执行装置,接收火控计算机发出的调炮主令信号,快速驱动炮塔回转和身管俯仰运动,定位在火控计算机要求的位置上。火力线稳定系统需要火力线系统能快速响应调炮主令,具有良好的定位和跟踪功能,稳定精度要求高。传统的自行火炮火力线稳定系统采用受信仪采集方位角和高低角的反馈信息,为了实现稳定功能,需要考虑火炮载体的位置信息,当车体的姿态信息发生变化时能够及时调整火炮方位角和高低角,实现火力线的稳定。目前采用的火力线稳定系统采集受信仪和惯导装置的位置信息,通过控制算法来实现火力线的稳定,但惯导装置价格昂贵,与随动系统是两个独立的单体,给随动系统火力线稳定系统的设计带来了不便。
发明内容
(一)要解决的技术问题
本发明要解决的技术问题是:如何实现火力线的稳定。
(二)技术方案
为解决上述技术问题,本发明提供一种火力线稳定系统的半物理实验方法,所述方法包括:
步骤一:LabVIEW界面发出载体姿态信息ψ,θ,γ;
步骤二:随动控制器接收位置主令α**和位置反馈α,β;得到位置误差αieie,根据载体姿态信息ψ,θ,γ,按照从炮塔坐标系到大地坐标系的坐标变换公式,得到大地坐标系下的位置误差αoeoe
步骤三:随动控制器根据大地坐标系下的位置误差αoeoe,输出速度命令uout
步骤四:驱动器接收随动控制器输出的速度命令uout,将其作为速度主令,驱动电机开始运动,输出转速v;
步骤五:将电机连接传动装置,传动装置的末端带有受信仪,受信仪采集炮塔坐标系下的方位和高低信息α,β,作为位置反馈送给随动控制器,转入步骤二,进行火力线稳定系统的闭环控制。
其中,所述α*为方位位置主令。
其中,所述β*为高低位置主令。
其中,所述α*为方位位置反馈。
其中,所述β*为高低位置反馈。
其中,所述受信仪安装在方位和高低运动的炮塔和耳轴上。
其中,所述火力线稳定系统包括随动控制器、伺服驱动器、电机、传动装置、受信仪。
其中,所述火力线稳定系统通过CAN总线实现数据的通信。
其中,所述方法中,采用LabVIEW模拟惯导装置。
其中,所述方法可实现火力线稳定。
(三)有益效果
与现有技术相比较,本发明根据传统随动系统的工作特点,采用LabVIEW模拟惯导装置的功能,通过CAN总线发送和惯导装置相同协议的数据,随动系统接收姿态信息,在随动系统中实现火力线稳定的设计。使用半物理试验方法进行随动系统的开发,既能节约成本,又能缩短开发周期,能有效地提高随动稳定系统设计的效率。
附图说明
图1为本发明的组织结构图。
图2为本发明的控制方法流程图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
火力线稳定系统要求能快速响应调炮主令,具有良好的定位和跟踪功能,稳定精度要求高。传统的自行火炮火力线稳定系统采用受信仪采集方位角和高低角的反馈信息,采用惯性导航仪测量火炮载体的姿态信息,当火炮位置发生变化时,及时调整炮管的位置,实现火力线在大地坐标系下的稳定。
本发明根据传统随动系统的工作特点,采用LabVIEW模拟惯导装置的功能,在随动系统中来实现火力线稳定的设计。使用半物理试验方法进行随动系统的开发,既能节约成本,又能缩短开发周期,能有效地提高随动稳定系统设计的效率。
具体而言,传统的火力线稳定系统由随动控制器,伺服驱动器、电机、传动装置、受信仪和惯导装置组成,通过控制炮塔和身管的位置,实现随动系统的火力线稳定功能。本发明根据传统随动系统的工作特点,采用LabVIEW模拟惯导装置的功能,在随动系统中来实现火力线稳定的设计。
本发明火炮随动系统由随动控制器、伺服驱动器、电机、传动装置、受信仪组成,通过CAN总线实现数据的通信。随动控制器接收位置主令和位置反馈,输出速度主令,伺服驱动器接收速度主令,输出电压主令,永磁同步电机受到电压驱动,开始运动,通过传动装置将电机的转动转化为方位和高低方向位置的运动。受信仪安装在方位和高低运动的炮塔和耳轴上,采集方位和高低的位置信息作为位置反馈传递给随动控制器。从而完成一个完成一个完整的随动系统功能。
火力线稳定系统的半物理实验方法的实施方案是按下述步骤实现:
步骤一:LabVIEW界面发出载体姿态信息ψ,θ,γ;
步骤二:随动控制器接收位置主令α**和位置反馈α,β;得到位置误差αieie,根据载体姿态信息ψ,θ,γ,按照从炮塔坐标系到大地坐标系的坐标变换公式,得到大地坐标系下的位置误差αoeoe
步骤三:随动控制器根据大地坐标系下的位置误差αoeoe和控制算法,输出速度命令uout
步骤四:驱动器接收随动控制器的输出uout,将其作为速度主令,驱动电机开始运动,输出转速v;
步骤五:将电机连接传动装置,传动装置的末端带有受信仪,受信仪采集炮塔坐标系下的方位和高低信息α,β,作为位置反馈送给随动控制器,转入步骤二,进行火力线稳定系统的闭环控制。
本发明的优点是,采用LabVIEW模拟惯导装置,采用实际的随动控制器,伺服驱动器、电机、传动装置、受信仪作为随动系统,在随动系统的设计过程中充分考虑到了传动过程中的非线性因素,和实际系统保持一致。使用模拟的惯导装置可以有效地减少采购惯导装置的成本,能够在系统联调前实现火力线稳定的设计。
本发明方法可适用于大口径自行火炮和火箭炮随动系统和其它以驱动器驱动电机的伺服系统。
实施例1
本实施例中,某压制火炮随动系统,车体停在左右倾斜50密位的斜坡上,要求能实现火力线在高低方向上±0.5密位的稳定。
根据本发明,其实施过程如下:
(1)LabVIEW发送车体的姿态信息ψ=0,θ=0,γ=50。
(2)随动控制器接收位置主令α*=300,β*=500和位置反馈α=0,β=0。得到位置误差αie=300,βie=500,根据车体姿态信息ψ=0,θ=0,γ=50,按照从炮塔坐标系到大地坐标系的坐标变换公式,得到大地坐标系下的位置误差αoe=326.8,βoe=483.9。
(3)随动控制器根据大地坐标系下的位置误差αoe=326.8,βoe=483.9和控制算法,输出速度命令uout
(4)驱动器接收随动控制器的输出uout,将其作为速度主令,驱动电机开始运动,输出转速v;
(5)将电机连接传动装置,传动装置的末端带有受信仪,受信仪采集炮塔坐标系下的方位和高低信息αieie,将位置反馈送给随动控制器,转入步骤(2)
按照上述实施例,随动系统循环执行(2)至(5)步,最终稳定在大地坐标系下的αoe=326.8±0.5,βoe=483.9±0.5位置。
实施例2
某舰载火箭炮随动系统,舰体在海中有摇摆,要求在舰体摇摆实现火力线系统在高低方向上±1密位的稳定。
根据本发明,其实施过程如下:
(1)LabVIEW发送车体的姿态信息:
ψ=0,θ=10sin0.05t,γ=20sin0.1t。
(2)随动控制器接收位置主令α*=200,β*=350和位置反馈α=0,β=0。得到位置误差αie=200,βie=350,根据车体姿态信息ψ=0,θ=10sin0.05t,γ=20sin0.1t,按照从炮塔坐标系到大地坐标系的坐标变换公式,得到大地坐标系下的位置误差αoeoe
(3)随动控制器根据大地坐标系下的位置误差αoeoe和控制算法,输出速度命令uout
(4)驱动器接收随动控制器的输出uout,将其作为速度主令,驱动电机开始运动,输出转速v;
(5)将电机连接传动装置,传动装置的末端带有受信仪,受信仪采集炮塔坐标系下的方位和高低信息αieie,将位置反馈送给随动控制器,转入步骤(2)
按照上述实施例,随动系统循环执行(2)至(5)步,最终实现大地坐标系下火力线系统在方位和高低方向上±1密位的稳定。
实施例3
本实施例提供一种火力线稳定系统的半物理实验方法,所述方法包括:
步骤一:LabVIEW界面发出载体姿态信息ψ,θ,γ;
步骤二:随动控制器接收位置主令α**和位置反馈α,β;得到位置误差αieie,根据载体姿态信息ψ,θ,γ,按照从炮塔坐标系到大地坐标系的坐标变换公式,得到大地坐标系下的位置误差αoeoe
步骤三:随动控制器根据大地坐标系下的位置误差αoeoe和控制算法,输出速度命令uout
步骤四:驱动器接收随动控制器输出的速度命令uout,将其作为速度主令,驱动电机开始运动,输出转速v;
步骤五:将电机连接传动装置,传动装置的末端带有受信仪,受信仪采集炮塔坐标系下的方位和高低信息α,β,作为位置反馈送给随动控制器,转入步骤二,进行火力线稳定系统的闭环控制。
其中,所述α*为方位位置主令。
其中,所述β*为高低位置主令。
其中,所述α*为方位位置反馈。
其中,所述β*为高低位置反馈。
其中,所述受信仪安装在方位和高低运动的炮塔和耳轴上。
其中,所述火力线稳定系统包括随动控制器、伺服驱动器、电机、传动装置、受信仪。
其中,所述火力线稳定系统通过CAN总线实现数据的通信。
其中,所述方法中,采用LabVIEW模拟惯导装置。
其中,所述方法可实现火力线稳定。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。

Claims (10)

1.一种火力线稳定系统的半物理实验方法,其特征在于,所述方法包括:
步骤一:LabVIEW界面发出载体姿态信息ψ,θ,γ;
步骤二:随动控制器接收位置主令α**和位置反馈α,β;得到位置误差αieie,根据载体姿态信息ψ,θ,γ,按照从炮塔坐标系到大地坐标系的坐标变换公式,得到大地坐标系下的位置误差αoeoe
步骤三:随动控制器根据大地坐标系下的位置误差αoeoe,输出速度命令uout
步骤四:驱动器接收随动控制器输出的速度命令uout,将其作为速度主令,驱动电机开始运动,输出转速v;
步骤五:将电机连接传动装置,传动装置的末端带有受信仪,受信仪采集炮塔坐标系下的方位和高低信息α,β,作为位置反馈送给随动控制器,转入步骤二,进行火力线稳定系统的闭环控制。
2.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述α*为方位位置主令。
3.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述β*为高低位置主令。
4.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述α*为方位位置反馈。
5.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述β*为高低位置反馈。
6.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述受信仪安装在方位和高低运动的炮塔和耳轴上。
7.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述火力线稳定系统包括随动控制器、伺服驱动器、电机、传动装置、受信仪。
8.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述火力线稳定系统通过CAN总线实现数据的通信。
9.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述方法中,采用LabVIEW模拟惯导装置。
10.如权利要求1所述的火力线稳定系统的半物理实验方法,其特征在于,所述方法可实现火力线稳定。
CN202011331244.XA 2020-11-24 火力线稳定系统的半物理实验方法 Active CN112484563B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011331244.XA CN112484563B (zh) 2020-11-24 火力线稳定系统的半物理实验方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011331244.XA CN112484563B (zh) 2020-11-24 火力线稳定系统的半物理实验方法

Publications (2)

Publication Number Publication Date
CN112484563A true CN112484563A (zh) 2021-03-12
CN112484563B CN112484563B (zh) 2024-06-28

Family

ID=

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5224860A (en) * 1991-03-01 1993-07-06 Electronics & Space Corp. Hardware-in-the-loop tow missile system simulator
CN101794527A (zh) * 2009-12-30 2010-08-04 北京控制工程研究所 人控交会对接半物理仿真试验系统
KR101062226B1 (ko) * 2011-04-25 2011-09-05 삼성탈레스 주식회사 자주포 관성 항법 장치의 시뮬레이터 및 이를 이용한 시뮬레이션 방법
KR20120067464A (ko) * 2010-12-16 2012-06-26 국방과학연구소 관성항법장치를 이용한 짐발의 좌표 지향 장치 및 이를 이용한 좌표 지향 방법
CN104950688A (zh) * 2014-03-27 2015-09-30 南京理工大学 分布式传递对准半实物仿真系统及其方法
CN105259787A (zh) * 2015-11-03 2016-01-20 中国电子科技集团公司第五十四研究所 一种组合导航半物理仿真测试同步控制方法
CN107783422A (zh) * 2017-10-20 2018-03-09 西北机电工程研究所 采用捷联惯导的火炮瞄准稳定系统控制方法
CN108731668A (zh) * 2018-01-26 2018-11-02 中国电子科技集团公司第三十八研究所 一种稳定平台惯导模拟系统及其数据传输方法
CN111208849A (zh) * 2019-12-30 2020-05-29 南京工程学院 一种基于电机减速机驱动的高精度定位控制系统及方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5224860A (en) * 1991-03-01 1993-07-06 Electronics & Space Corp. Hardware-in-the-loop tow missile system simulator
CN101794527A (zh) * 2009-12-30 2010-08-04 北京控制工程研究所 人控交会对接半物理仿真试验系统
KR20120067464A (ko) * 2010-12-16 2012-06-26 국방과학연구소 관성항법장치를 이용한 짐발의 좌표 지향 장치 및 이를 이용한 좌표 지향 방법
KR101062226B1 (ko) * 2011-04-25 2011-09-05 삼성탈레스 주식회사 자주포 관성 항법 장치의 시뮬레이터 및 이를 이용한 시뮬레이션 방법
CN104950688A (zh) * 2014-03-27 2015-09-30 南京理工大学 分布式传递对准半实物仿真系统及其方法
CN105259787A (zh) * 2015-11-03 2016-01-20 中国电子科技集团公司第五十四研究所 一种组合导航半物理仿真测试同步控制方法
CN107783422A (zh) * 2017-10-20 2018-03-09 西北机电工程研究所 采用捷联惯导的火炮瞄准稳定系统控制方法
CN108731668A (zh) * 2018-01-26 2018-11-02 中国电子科技集团公司第三十八研究所 一种稳定平台惯导模拟系统及其数据传输方法
CN111208849A (zh) * 2019-12-30 2020-05-29 南京工程学院 一种基于电机减速机驱动的高精度定位控制系统及方法

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
吴金荣: "一种箱式火箭炮自动调炮控制方法研究", 《中国优秀硕士学位论文全文数据库》, 31 July 2014 (2014-07-31) *
张文青;于正林;: "基于LabWindows/CVI的随动系统传动比模拟方法研究", 长春理工大学学报(自然科学版), no. 04 *
王伟: "捷联式惯导系统在自行火炮上的应用", 兵工自动化, vol. 27, no. 3, pages 1 - 3 *
白宏阳;段江锋;熊凯;苏文杰;: "空地制导武器传递对准及组合导航半实物实时仿真系统设计", 中国惯性技术学报, no. 02 *
蒋黎星: "捷联惯性导航算法及半实物仿真系统研究", 《中国优秀硕士学位论文全文数据库》, 31 January 2008 (2008-01-31) *
解向军;王海青;王怡达;: "综合火控半实物仿真系统研究", 飞机设计, no. 02, 15 April 2017 (2017-04-15) *
雷凌毅;张毅;李璀;: "某自行火炮模拟训练器随动系统", 兵工自动化, no. 11 *

Similar Documents

Publication Publication Date Title
CN112987763B (zh) 一种基于ros的自主导航机器人控制系统的智能小车
CN107102641B (zh) 一种基于激光引导双轮差速agv的原地偏航旋转方法
CN109491364B (zh) 一种用于车辆测试的驾驶机器人系统及控制方法
CN108594869B (zh) 一种基于谐振点实时估算的微镜控制方法及其系统
CN102129250B (zh) 运动载体光电设备惯性稳定瞄准线扫描方法
CN108189034B (zh) 一种机器人连续轨迹实现方法
CN104503473B (zh) 一种惯性稳定控制器
CN110808447A (zh) 基于三轴动态跟踪技术的船载卫星天线系统
CN111308470A (zh) 一种无人船载雷达设备的电子稳定方法及系统
CN113703320A (zh) 一种抗干扰和饱和特性的飞行机械臂位姿控制方法
CN102353512A (zh) 基于多台电机同步运行的攻角控制方法和多功能支撑装置
CN112484563A (zh) 火力线稳定系统的半物理实验方法
CN109850173A (zh) 基于六自由度并联调姿机构的多功能车载模式平台装置
CN112484563B (zh) 火力线稳定系统的半物理实验方法
CN110007599B (zh) 一种激光雷达扫描机构的自适应积分滑模控制方法及系统
CN114089761A (zh) 一种基于ros的领航跟随者多无人船编队控制系统及其方法
CN211478963U (zh) 基于虚拟队形的编队靶车
US6499699B1 (en) Satellite attitude control system and method
CN111176292A (zh) 一种基于侧边距的波浪滑翔器路径跟踪控制方法
CN215043817U (zh) 小型六自由度甲板运动模拟系统
Huang et al. Design and implementation of PLC-based autonomous construction system of unmanned vibratory roller
CN110562084B (zh) 一种伸缩摆臂式充电机构运动控制系统及方法
CN111498150B (zh) 一种星载大惯量旋转载荷角动量和力矩补偿方法及系统
US20230315103A1 (en) Perception and control system of autonomous snowfield-roaming robot and operation and path planning method thereof
CN112643678A (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