采用捷联惯导的火炮瞄准稳定系统控制方法专利检索-炮塔Land warfare专利检索查询-专利查询网

积极推动地理标志专门立法

2022-03-10 地理标志，立法，知识产权
保护知识产权是对创新最大的激励

2022-03-10 保护知识产权，创新，激励
谢商华：加快制定知识产权基本法

2022-03-10 知识产权基本法
擦亮“双奥之城”品牌

2022-03-10 双奥，知识产权
让冰雪运动“热”力全开

2022-03-10 冰雪运动，知识产权
携手共奋进　走好强国路

2022-03-10 强国，知识产权
坚持创新引领　方能稳中求进

2022-03-10 创新，稳中求进，知识产权
答好“两张卷” 奋进新征程

2022-03-10 知识产权
专家解读政府工作报告中的创新和知识产权相关部署

2022-03-10 政府工作报告，创新，知识产权
今年政府工作报告指出：加强知识产权保护和运用

2022-03-10 政府工作报告，知识产权保护

采用捷联惯导的火炮瞄准稳定系统控制方法

阅读：817发布：2020-11-30

IPRDB可以提供采用捷联惯导的火炮瞄准稳定系统控制方法专利检索，专利查询，专利分析的服务。并且本发明提供了一种采用捷联惯导的火炮瞄准稳定系统控制方法，首先采集捷联惯导陀螺组所测量的三轴角速率并转换至大地坐标系下的角速率；然后计算车体系下高低和方位调转角速率、炮塔俯仰和横滚角速率以及车体航向角速率；其次，接受稳定控制指令，采集位置反馈，大幅调转时控制驱动器工作于调速模式；进入稳定模式后进行位置、前馈控制，速率稳定、速率干扰补偿控制，控制驱动器工作于电流或力矩模式；当达到稳定精度后上报瞄准好。本发明控制精度高，节约了成本，提高了可靠性。，下面是采用捷联惯导的火炮瞄准稳定系统控制方法专利的具体信息内容。

权利要求

1.一种采用捷联惯导的火炮瞄准稳定系统控制方法，其特征在于包括下述步骤：(1)设定速度环控制补偿的控制步数k的初值为0，k逐一增加；设定速度环控制补偿的控制周期Ts＝1ms；

(2)采集捷联惯导陀螺组所测量的三轴角速率ωp(k)＝[ωpx(k) ωpy(k) ωpz(k)]T；

(3)计算身管在大地坐标下的航向和抚养调转角速率其中，ψ(j),θ(j), 为SINS输出的航向角、俯仰角和横滚角；j为位置环计算步数；

(4)采集方向侧角器和高低侧角器的测量值βb(k),εb(k)；利用非线性观测器提取炮塔在车体上、火炮在炮塔上的调转角速率

其中 e1(k),e2(k)为观测误差，α，δ分别为fal函数的参数

0.01≤α≤1，0.01≤δ≤1，β11,β12,β21,β22分别为方向侧角器和高低侧角器的一阶、二阶增益，z11(k)、z21(k)分别为βb(k),εb(k)的估计值，z12(k)、z22(k)分别为的估计值；

(5)计算炮塔的俯仰和横滚角速率ωhx(k),ωhy(k)：(6)计算车体的航向角速率

(7)设定位置控制的控制步数j的初值为0，j逐一增加，位置控制的控制周期为10ms；判定k值，若k为10的倍数时，执行第(8)步，否则跳转至第(18)步；

(8)接收捷联惯导的航向、姿态和横滚角ψ(j),θ(j),(9)接收大地坐标下的火炮瞄准控制指令ψref(j),θref(j)，包含其中，ψref(j),θref(j)分别为航向和姿态角；

(10)判断调炮控制误差eβ(j)＝ψref(j)-ψ(j)和eε(j)＝θref(j)-θ(j)，若调炮控制误差eβ(j)≥eβmax或eε(j)≥eεmax，转入步骤(11)；否则，转入步骤(14)；

(11)计算大幅调转下的方位随动伺服驱动器的速度控制指令其中：keβ为根号e控制系数；umaxsβ和uminsβ为PI控制器输出的上限和下限；

(12)计算大幅调转下的高低随动伺服驱动器的速度控制指令其中：keε为根号e控制系数；umaxsε和uminsε为控制器输出的上限和下限；

(13)设定驱动器工作在调速模式，通过CAN总线分别向方位和高低伺服驱动器发送速度控制指令

(14)计算方位和高低位置控制系统的前馈控制量ufβ(j),ufε(j)其中，kfβ,kfε分别为方位和高低系统的前馈控制器系数；

(15)计算高低和方位干扰速度补偿量udβ(j),udε(j)：其中，分别为高低和方位随动的干扰速率；kdβ1,kdβ2,kdβ3分别为方位补偿器的综合系数；kdε1,kdε2,kdε3,分别为高低补偿器的综合系数；

(16)计算稳定条件下的方位随动伺服驱动器的速度控制指令upsβ(j)＝Kpsβesβ(j)

upresatsβ(j)＝upsβ(j)+uisβ(j)+ufβ(j)+udβ(j)其中：upsβ(j)为比例控制项；uisβ(j)为积分控制项；uimaxsβ和uiminsβ为积分控制器输出的上限和下限，uimaxsβ＝max(0,umaxsβ-upeβ(j))，uiminsβ＝min(uminsβ-upeβ(j),0)；Kpsβ为PI比例控制系数；Kisβ为积分系数；

(17)计算稳定条件下的高低随动伺服驱动器的速度控制指令upsε(j)＝Kpsεesε(j)

upresatsε(j)＝upsε(j)+uisε(j)+ufε(j)+udε(j)其中：upsε(j)为比例控制项；uisε(j)为积分控制项；uimaxsε和uiminsε为积分控制器输出的上限和下限，uimaxsε＝max(umaxsε-upsε(j),0)，uiminsε＝min(uminsε-upsε(j),0)；Kpsε为PI比例控制系数；Kisε为积分系数；

(18)计算稳定条件下的方位随动伺服驱动器的电流控制指令upcβ(k)＝Kpcβecβ(k)

upresatcβ(k)＝upcβ(k)+uicβ(k)其中：upcβ(j)为比例控制项；uicβ(j)为积分控制项；umaxcβ和umincβ为PI控制器输出的上限和下限，uimaxcβ和uimincβ为积分控制器输出的上限和下限，uimaxcβ＝max(0,umaxcβ-upeβ(k))，uimincβ＝min(umincβ-upeβ(k),0)；Kpcβ为PI比例控制系数；Kicβ为积分系数；iβ为方位传动的减速比；

(19)计算稳定条件下的高低随动伺服驱动器的电流控制指令upcε(k)＝Kpcεecε(k)

upresatcε(k)＝upcε(k)+uicε(k)其中：upcε(j)为比例控制项；uicε(j)为积分控制项；umaxcε和umincε为PI控制器输出的上限和下限，uimaxcε和uimincε为积分控制器输出的上限和下限，uimaxcε＝max(umaxcε-upcε(k),0)，uimincε＝min(umincε-upcε(k),0)；Kpcε为PI比例控制系数；Kicε为积分系数；iε为高低随动传动的减速比；

(20)设定驱动器工作在力矩模式，通过CAN总线向伺服驱动器发送电流指令；

(21)若eβ(j)＜eβmin,eε(j)＜eεmin，通过CAN总线向瞄准手上报瞄准好状态。

说明书全文

采用捷联惯导的火炮瞄准稳定系统控制方法

技术领域

[0001] 本发明属于火炮随动系统领域，主要涉及需要精确稳定、跟踪的火炮随动系统的控制方法。

背景技术

[0002] 随着军事斗争的发展演变，新军事作战需求迫切需要压制武器具备行进间射击的能力，需要自行火炮能够遂行动对静、动对动的作战任务。那么火炮需要在瞄准稳定系统的控制下，一是克服车体由于行走的路面对车体造成的扰动；二是火炮要跟随火控的跟踪瞄准调转指令。此类功能在坦克武器或两栖突击炮的炮控系统早已得到实现。但是，坦克炮控系统采用了摇架组合陀螺组、车体/炮塔陀螺组共同完成火炮的稳定瞄准，并配备惯导系统，安装在车体上，用于行进间的惯性导航。其中，摇架组合陀螺组由两组双轴速率陀螺和两组单轴速率陀螺组成，用于测量坦克炮在空间的运动状态，完成坦克炮高低向和方位向伺服的自动和手动的稳定瞄准控制；车体/炮塔陀螺组为三个单轴速率陀螺组用于测量车体航向、炮塔的俯仰和横滚角速率，用于炮控系统的速率干扰前馈补偿，使炮控系统达到或优于高低向0.8mil和方位向1.5mil的稳定精度。但是，坦克炮控系统所配置的陀螺太多，信息冗余，成本太高，可靠性较低，高价值的捷联惯导没有很好地利用，此类传统的炮控系统方案，不适用于现代压制武器的某自行火炮武器系统中。

[0003] 随着捷联惯导(SINS)的技术进步，其精度提高和成本降低，长期稳定性和抗冲击能力的大幅提高，将SINS安装在自行火炮的身管上直接测量大地坐标系的指向是现代自行火炮的标配。自行火炮的随动系统将SINS方向和姿态值作为随动系统的角度反馈，实现了火炮在大地坐标系下的直接控制，提高了火炮瞄准精度。但是，随动系统的控制坐标与SINS测量坐标不统一，造成控制系统的高低和方位控制系统存在耦合。对于驻停间进行发射的自行火炮采用如四元数、欧拉角法等坐标变换或串级控制来解决。但对于需要行进间的自行火炮需要采用既能抑制车体扰动，又能很好解决控制耦合问题的新方法。

发明内容

[0004] 为了克服现有技术的不足，本发明提供一种采用捷联惯导的火炮瞄准稳定系统控制方法，保留传统火炮随动系统组成的侧角器，利用SINS、高低侧角器和方位侧角器，采用空间坐标变换得到炮塔的俯仰和横贯角速率，以及车体航向的角速率，稳定系统采用复合控制方法实现火炮的高精度稳定跟踪控制。本发明采用SINS作为火炮随动系统的空间角度和惯性空间角速率速度反馈器件，抑制车体姿态对火炮身管指向的扰动以及高低向和方位向随动的控制耦合，实现火炮的高精度稳定跟踪控制方法问题；利用SINS直接测量火炮身管指向，提高指向控制精度，又可以使自行火炮武器系统完成自主定位导航功能。

[0005] 本发明解决其技术问题所采用的技术方案包括以下步骤：

[0006] (1)设定速度环控制补偿的控制步数k的初值为0，k逐一增加；设定速度环控制补偿的控制周期Ts＝1ms；

[0007] (2)采集捷联惯导陀螺组所测量的三轴角速率ωp(k)＝[ωpx(k) ωpy(k) ωpz(k)]T；

[0008] (3)计算身管在大地坐标下的航向和抚养调转角速率

[0009]

[0010] 其中，为SINS输出的航向角、俯仰角和横滚角；j为位置环计算步数；

[0011] (4)采集方向侧角器和高低侧角器的测量值βb(k),εb(k)；利用非线性观测器提取炮塔在车体上、火炮在炮塔上的调转角速率

[0012]

[0013]

[0014]

[0015] 其中 e1(k),e2(k)为观测误差，α，δ分别为fal函数的参数0.01≤α≤1，0.01≤δ≤1，β11,β12,β21,β22分别为方向侧角器和高低侧角器的一阶、二阶增益，z11(k)、z21(k)分别为βb(k),εb(k)的估计值，z12(k)、z22(k)分别为的估计值；

[0016] (5)计算炮塔的俯仰和横滚角速率ωhx(k),ωhy(k)：

[0017]

[0018] (6)计算车体的航向角速率

[0019] (7)设定位置控制的控制步数j的初值为0，j逐一增加，位置控制的控制周期为10ms；判定k值，若k为10的倍数时，执行第(8)步，否则跳转至第(18)步；

[0020] (8)接收捷联惯导的航向、姿态和横滚角

[0021] (9)接收大地坐标下的火炮瞄准控制指令ψref(j),θref(j)，包含其中，ψref(j),θref(j)分别为航向和姿态角；

[0022] (10)判断调炮控制误差eβ(j)＝ψref(j)-ψ(j)和eε(j)＝θref(j)-θ(j)，若调炮控制误差eβ(j)≥eβmax或eε(j)≥eεmax，转入步骤(11)；否则，转入步骤(14)；

[0023] (11)计算大幅调转下的方位随动伺服驱动器的速度控制指令

[0024]

[0025] 其中：keβ为根号e控制系数；umaxsβ和uminsβ为PI控制器输出的上限和下限；

[0026] (12)计算大幅调转下的高低随动伺服驱动器的速度控制指令

[0027]

[0028] 其中：keε为根号e控制系数；umaxsε和uminsε为控制器输出的上限和下限；

[0029] (13)设定驱动器工作在调速模式，通过CAN总线分别向方位和高低伺服驱动器发送速度控制指令

[0030] (14)计算方位和高低位置控制系统的前馈控制量ufβ(j),ufε(j)

[0031]

[0032]

[0033] 其中，kfβ,kfε分别为方位和高低系统的前馈控制器系数；

[0034] (15)计算高低和方位干扰速度补偿量udβ(j),udε(j)：

[0035]

[0036]

[0037]

[0038]

[0039] 其中，分别为高低和方位随动的干扰速率；kdβ1,kdβ2,kdβ3分别为方位补偿器的综合系数；kdε1,kdε2,kdε3,分别为高低补偿器的综合系数；

[0040] (16)计算稳定条件下的方位随动伺服驱动器的速度控制指令

[0041] upsβ(j)＝Kpsβesβ(j)

[0042]

[0043] upresatsβ(j)＝upsβ(j)+uisβ(j)+ufβ(j)+udβ(j)

[0044]

[0045] 其中：upsβ(j)为比例控制项；uisβ(j)为积分控制项；uimaxsβ和uiminsβ为积分控制器输出的上限和下限，uimaxsβ＝max(0,umaxsβ-upeβ(j))，uiminsβ＝min(uminsβ-upeβ(j),0)；Kpsβ为PI比例控制系数；Kisβ为积分系数；

[0046] (17)计算稳定条件下的高低随动伺服驱动器的速度控制指令

[0047] upsε(j)＝Kpsεesε(j)

[0048]

[0049] upresatsε(j)＝upsε(j)+uisε(j)+ufε(j)+udε(j)

[0050]

[0051] 其中：upsε(j)为比例控制项；uisε(j)为积分控制项；uimaxsε和uiminsε为积分控制器输出的上限和下限，uimaxsε＝max(umaxsε-upsε(j),0)，uiminsε＝min(uminsε-upsε(j),0)；Kpsε为PI比例控制系数；Kisε为积分系数；

[0052] (18)计算稳定条件下的方位随动伺服驱动器的电流控制指令

[0053]

[0054] upcβ(k)＝Kpcβecβ(k)

[0055]

[0056] upresatcβ(k)＝upcβ(k)+uicβ(k)

[0057]

[0058] 其中：upcβ(j)为比例控制项；uicβ(j)为积分控制项；umaxcβ和umincβ为PI控制器输出的上限和下限，uimaxcβ和uimincβ为积分控制器输出的上限和下限，uimaxcβ＝max(0,umaxcβ-upeβ(k))，uimincβ＝min(umincβ-upeβ(k),0)；Kpcβ为PI比例控制系数；Kicβ为积分系数；iβ为方位传动的减速比；

[0059] (19)计算稳定条件下的高低随动伺服驱动器的电流控制指令

[0060]

[0061] upcε(k)＝Kpcεecε(k)

[0062]

[0063] upresatcε(k)＝upcε(k)+uicε(k)

[0064]

[0065] 其中：upcε(j)为比例控制项；uicε(j)为积分控制项；umaxcε和umincε为PI控制器输出的上限和下限，uimaxcε和uimincε为积分控制器输出的上限和下限，uimaxcε＝max(umaxcε-upcε(k),0)，uimincε＝min(umincε-upcε(k),0)；Kpcε为PI比例控制系数；Kicε为积分系数；iε为高低随动传动的减速比；

[0066] (20)设定驱动器工作在力矩模式，通过CAN总线向伺服驱动器发送电流指令；

[0067] (21)若eβ(j)＜eβmin,eε(j)＜eεmin，通过CAN总线向瞄准手上报瞄准好状态。

[0068] 本发明的有益效果是：发挥捷联惯导测量火炮身管在大地坐标系下指向的精度高优势，且有效地克服了载体姿态对火炮身管指向控制干扰，以及高低和方位随动的控制耦合问题，实现了高精度的火炮身管指向的稳定、跟踪控制，不易受自行火炮载体运行速度和环境(陆地、海上)的影响，没有额外采用相应的速率陀螺测量身管的调转角速率和干扰的角速率，节约了成本，提高了系统的可靠性。

附图说明

[0069] 图1是本发明的控制原理图；

[0070] 图2是本发明的控制传递函数结构图；

[0071] 图3是本发明的计算流程图。

具体实施方式

[0072] 下面结合附图和实施例对本发明进一步说明，本发明包括但不仅限于下述实施例。

[0073] 本发明实施的步骤是：

[0074] (1)启动控制，控制步数为k，设定速度环控制补偿，即控制周期Ts＝1ms，

[0075] k＝k+1

[0076] 取k的初值为0；

[0077] (2)采集捷联惯导陀螺组所测量的三轴角速率ωp(k)＝[ωpx(k) ωpy(k) ωpz(k)]T；

[0078] (3)计算身管在大地坐标下的调转角速率

[0079]

[0080] 其中：为SINS输出的航向角、俯仰角和横滚角；j为位置环计算步数；

[0081] (4)采集方向侧角器和高低侧角器的测量值βb(k),εb(k)；利用非线性观测器提取炮塔在车体上、火炮在炮塔上的调转角速率

[0082]

[0083]

[0084]

[0085] 其中 e1(k),e2(k)为观测误差，α，δ分别为fal函数的参数，β11,β12,β21,β22分别为观测器的一阶、二阶增益。

[0086] (5)计算炮塔的俯仰和横滚角速率ωhx(k),ωhy(k)：

[0087]

[0088] (6)计算车体的航向角速率r(k)：

[0089]

[0090] (7)若k为10的倍数时，执行第(8)步，否则跳转至第(18)步；

[0091] j＝j+1

[0092] 其中j的初值为0，此为位置控制的周期10ms；

[0093] (8)接收捷联惯导的航向和姿态角

[0094] (9)接收大地坐标下的火炮瞄准控制指令ψref(j),θref(j)，包含

[0095] (10)调炮控制误差判断：

[0096] eβ(j)＝ψref(j)-ψ(j)

[0097] eε(j)＝θref(j)-θ(j)

[0098] 若调炮控制误差eβ(j)≥eβmax或eε(j)≥eεmax，转入(11)；否则，转入(14)；

[0099] (11)计算大幅调转下的方位随动伺服驱动器的速度控制指令

[0100]

[0101] 其中：keβ为根号e控制系数；umaxsβ和uminsβ为PI控制器输出的上限和下限；

[0102] (12)计算大幅调转下的高低随动伺服驱动器的速度控制指令

[0103]

[0104] 其中：keε为根号e控制系数；umaxsε和uminsε为控制器输出的上限和下限；

[0105] (13)设定驱动器工作在调速模式，通过CAN总线分别向方位和高低伺服驱动器发送速度控制指令

[0106] (14)计算方位和高低位置控制系统的前馈控制量ufβ(j),ufε(j)

[0107]

[0108]

[0109] 其中，kfβ,kfε分别为方位和高低系统的前馈控制器系数；

[0110] (15)计算高低和方位干扰速度补偿量udβ(j),udε(j)：

[0111]

[0112]

[0113]

[0114]

[0115] 其中，分别为高低和方位随动的干扰速率；kdβ1,kdβ2,kdβ3,分别为方位补偿器的综合系数；kdε1,kdε2,kdε3,分别为高低补偿器的综合系数；

[0116] (16)计算稳定条件下的方位随动伺服驱动器的速度控制指令

[0117] upsβ(j)＝Kpsβesβ(j)

[0118]

[0119] upresatsβ(j)＝upsβ(j)+uisβ(j)+ufβ(j)+udβ(j)

[0120]

[0121] 其中：upsβ(j)为比例控制项；uisβ(j)为积分控制项；uimaxsβ和uiminsβ为积分控制器输出的上限和下限，uimaxsβ＝max(0,umaxsβ-upeβ(j))，uiminsβ＝min(uminsβ-upeβ(j),0)；Kpsβ为PI比例控制系数；Kisβ为积分系数；

[0122] (17)计算稳定条件下的高低随动伺服驱动器的速度控制指令

[0123] upsε(j)＝Kpsεesε(j)

[0124]

[0125] upresatsε(j)＝upsε(j)+uisε(j)+ufε(j)+udε(j)

[0126]

[0127] 其中：upsε(j)为比例控制项；uisε(j)为积分控制项；uimaxsε和uiminsε为积分控制器输出的上限和下限，uimaxsε＝max(umaxsε-upsε(j),0)，uiminsε＝min(uminsε-upsε(j),0)；Kpsε为PI比例控制系数；Kisε为积分系数；

[0128] (18)计算稳定条件下的方位随动伺服驱动器的电流控制指令

[0129]

[0130] upcβ(k)＝Kpcβecβ(k)

[0131]

[0132] upresatcβ(k)＝upcβ(k)+uicβ(k)

[0133]

[0134] 其中：upcβ(j)为比例控制项；uicβ(j)为积分控制项；umaxcβ和umincβ为PI控制器输出的上限和下限，uimaxcβ和uimincβ为积分控制器输出的上限和下限，uimaxcβ＝max(0,umaxcβ-upeβ(k))，uimincβ＝min(umincβ-upeβ(k),0)；Kpcβ为PI比例控制系数；Kicβ为积分系数；iβ为方位传动的减速比；

[0135] (19)计算稳定条件下的高低随动伺服驱动器的电流控制指令

[0136]

[0137] upcε(k)＝Kpcεecε(k)

[0138]

[0139] upresatcε(k)＝upcε(k)+uicε(k)

[0140]

[0141] 其中：upcε(j)为比例控制项；uicε(j)为积分控制项；umaxcε和umincε为PI控制器输出的上限和下限，uimaxcε和uimincε为积分控制器输出的上限和下限，uimaxcε＝max(umaxcε-upcε(k),0)，uimincε＝min(umincε-upcε(k),0)；Kpcε为PI比例控制系数；Kicε为积分系数；iε为高低随动传动的减速比；

[0142] (20)设定驱动器工作在力矩模式，通过CAN总线向伺服驱动器发送电流指令；

[0143] (21)若eβ(j)＜eβmin,eε(j)＜eεmin，通过CAN总线向瞄准手上报瞄准好状态。

[0144] 本发明的控制原理见图1。图中利用SINS陀螺组测量火炮身管调转的绝对角速率，它是地球自转角速率、车体姿态变化的角速率、火炮身管相对车体调转角速率的总和。而对控制有效的角速率是火炮身管相对车体调转角速率，其它都可以视为干扰。SINS的陀螺组的角速率可以伺服驱动器构成速度稳定闭环，完成瞄准的速率直接稳定。SINS的航向角和姿态角作为瞄准稳定系统位置环的反馈与位置控制器构成大地坐标系下的位置闭环。通过控制环路的串级控制消除高低和方位两个控制通道的干扰，从而达到理想的稳定瞄准精度。由于该瞄准系统具有火炮身高低和方位侧角器，分别测量身管相对炮塔管俯仰角，炮塔相对车体方位角。因此，根据SINS陀螺组的角速率、高低角和方位侧角，即可推算出影响火炮瞄准稳定的炮塔横滚角速率和俯仰角速率，以及车体航向角速率。从而方便根据实际情况应用设计速率干扰补偿器，来提高火炮瞄准稳定精度。

[0145] 该控制方法大致步骤：首先，采集捷联惯导陀螺组所测量的三轴角速率ωp(k)，将其转换至大地坐标系下的角速率然后，采集侧角器，计算车体系下高低和方位调转角速率并计算炮塔俯仰和横滚角速率ωhx(k),ωhy(k)，以及车体航向角速
率r；其次，接受稳定控制指令，采集位置反馈，大幅调转时，控制驱动器工作于调速模式；再再次，进入稳定稳定模式，进行位置、前馈控制，速率稳定、速率干扰补偿控制，控制驱动器工作于电流或力矩模式；最后，当达到稳定精度后，上报瞄准好。

[0146] 本发明的控制传递函数结构见图2。为了简化传递函数，可以将SINS的航向角和俯仰角测量通过简化为将耦合干扰视为各种通过的干扰；将高低和方位伺服驱动的电流控制器、逆变器、电流调理、电流力矩系数等构成的闭环简化为一阶惯性环节方位和高低速度环控制为 Kpsβ,Kpsε分别为比例系数，Kisβ,Kisε为积分
系数；方位和高低位置环控制为 Kpcβ,Kpcε分别为比例系数，Kicβ,Kicε
分别为积分系数；方位和高低前馈控制器为kfβs,kfεs，kfβ,kfε是相应的系数；干扰速率前馈控制器为 fdβ,fdε分别为增益系数，Tdβ,Tdε分别为时间常数，采用双线性变换
将其离散化。

[0147] 实施该控制方法的火炮稳定瞄准系统主要由稳定瞄准控制系统、驱动调速系统、动力电源系统。稳定瞄准控制系统采用基于x86的嵌入式计算机。驱动调速系统以DSP28335+CPLD为核心的控制板，驱动功率电子IPM(智能驱动)控制电机转动。方位永磁同步电机(PMSM)，母线电压为540VDC，极对数np＝3，额定电流为175A，转矩系数为0.46N.m/A，定子电感为0.4mH，定子电阻为3毫欧，额定转速5500RPM，额定转矩79Nm，电机转子及负载的等效转动惯量J总和为0.03kg·m2；高低PMSM，母线电压为540VDC，极对数np＝3，额定电流为38A，转矩系数为0.53N.m/A，定子电感为0.706mH，定子电阻为0.12欧，额定转速为4200RPM，额定转矩38Nm，电机转子及负载的等效转动惯量J总和为0.0068kg·m2。方位负载转动惯量为
5800kg·m2，传动速比为210。高低负载转动惯量为900kg·m2。传动速比为275。SINS的角速率测量范围为±300°/s，航向测量精度不大于0.3mil，姿态测量精度不大于0.1mil。

[0148] 图3为本发明控制方法的计算流程图，下面将结合流程图详述具体实施过程。

[0149] (1)启动控制，控制步数为k，设定速度环控制补偿，即控制周期Ts＝1ms，

[0150] k＝k+1

[0151] 取k的初值为0；

[0152] (2)采集捷联惯导陀螺组所测量的三轴角速率ωp(k)＝[ωpx(k) ωpy(k) ωpz(k)]T；

[0153] (3)计算身管在大地坐标下的调转角速率

[0154]

[0155] 其中：为SINS输出的航向角、俯仰角和横滚角；j为位置环计算步数；

[0156] (4)采集方向侧角器和高低侧角器的测量值βb(k),εb(k)；利用非线性观测器提取炮塔在车体上、火炮在炮塔上的调转角速率

[0157]

[0158]

[0159]

[0160] 其中 e1(k),e2(k)为观测误差，fal函数的参数α＝0.8，δ＝0.1分别为；观测器的一阶、二阶增益β11＝90,β12＝1350,β21＝90,β22＝1350。

[0161] (5)计算炮塔的俯仰和横滚角速率ωhx(k),ωhy(k)：

[0162]

[0163] (6)计算车体的航向角速率r(k)：

[0164]

[0165] (7)若k为10的倍数时，执行第(8)步，否则跳转至第(18)步；

[0166] j＝j+1

[0167] 其中j的初值为0，此为位置控制的周期10ms；

[0168] (8)接收捷联惯导的航向和姿态角

[0169] (9)接收大地坐标下的火炮瞄准控制指令ψref(j),θref(j)，包含

[0170] (10)调炮控制误差判断：

[0171] eβ(j)＝ψref(j)-ψ(j)

[0172] eε(j)＝θref(j)-θ(j)

[0173] 若调炮控制误差eβ(j)≥eβmax或eε(j)≥eεmax，转入步骤(11)；否则，转入步骤(14)；

[0174] (11)计算大幅调转下的方位随动伺服驱动器的速度控制指令

[0175]

[0176] 其中：根号e控制系数keβ＝11.3；控制器输出的上限umaxsβ＝6000和下限uminsβ＝-6000；

[0177] (12)计算大幅调转下的高低随动伺服驱动器的速度控制指令

[0178]

[0179] 其中：根号e控制系数keε＝6.5；控制器输出的上限umaxsε＝4500和下限uminsε＝-4500；

[0180] (13)设定驱动器工作在调速模式，通过CAN总线分别向方位和高低伺服驱动器发送速度控制指令

[0181] (14)计算方位和高低位置控制系统的前馈控制量ufβ(j),ufε(j)

[0182]

[0183]

[0184] 其中，前馈控制器系数kfβ＝2.06,kfε＝2.46，分别与方位调速系统和高调速系统的传递函数关联；

[0185] (15)计算高低和方位干扰速度补偿量udβ(j),udε(j)：

[0186]

[0187]

[0188]

[0189]

[0190] 其中，分别为高低和方位随动的干扰速率；kdβ1＝1.11,kdβ2＝-2.3,kdβ3＝2.3分别为方位补偿器的综合系数；高低补偿器的综合系数kdε1＝1.11,kdε2＝-1.56,kdε3＝
1.56；

[0191] (16)计算稳定条件下的方位随动伺服驱动器的速度控制指令

[0192] upsβ(j)＝Kpsβesβ(j)

[0193]

[0194] upresatsβ(j)＝upsβ(j)+uisβ(j)+ufβ(j)+udβ(j)

[0195]

[0196] 其中：PI控制器输出的上限umaxsβ＝6000和下限uminsβ＝-6000，积分控制器输出的上限uimaxsβ＝1000和下限uiminsβ＝-1000；PI比例控制系数Kpsβ＝400，积分系数Kisβ＝5；

[0197] (17)计算稳定条件下的高低随动伺服驱动器的速度控制指令

[0198] upsε(j)＝Kpsεesε(j)

[0199]

[0200] upresatsε(j)＝upsε(j)+uisε(j)+ufε(j)+udε(j)

[0201]

[0202] 其中：PI控制器输出的上限umaxsε＝4500和下限uminsε＝-4500；积分控制器输出的上限uimaxsε＝1200和下限uiminsε＝-1200；为PI比例控制系数Kpsε＝250，积分系数Kisε＝1；

[0203] (18)计算稳定条件下的方位随动伺服驱动器的电流控制指令

[0204]

[0205] upcβ(k)＝Kpcβecβ(k)

[0206]

[0207] upresatcβ(k)＝upcβ(k)+uicβ(k)

[0208]

[0209] 其中：PI控制器输出的上限umaxcβ＝525和下限umincβ＝-525，积分控制器输出的上限uimaxcβ＝300和下限uimincβ＝-300；PI比例控制系数Kpcβ＝30，积分系数Kicβ＝0.1；方位传动的减速比iβ＝210；

[0210] (19)计算稳定条件下的高低随动伺服驱动器的电流控制指令

[0211]

[0212] upcε(k)＝Kpcεecε(k)

[0213]

[0214] upresatcε(k)＝upcε(k)+uicε(k)

[0215]

[0216] 其中：PI控制器输出的上限umaxcε＝114和下限umincε＝-114，积分控制器输出的上限uimaxcε＝50和下限uimincε＝-50；PI比例控制系数Kpcε＝20；积分系数Kicε＝1；高低随动传动的减速比iε＝275；

[0217] (20)设定驱动器工作在力矩模式，通过CAN总线向伺服驱动器发送电流指令；

[0218] (21)若eβ(j)＜eβmin,eε(j)＜eεmin，通过CAN总线向瞄准手上报瞄准好状态。

[0219] 所用参数的范围取值范围见下表：

[0220]

[0221]

标题	发布/更新时间	阅读量
灭火炮塔-专利编号CN104415485B	2020-05-11	565
步兵战车的炮塔-专利编号CN1260471A	2020-05-14	848
一种炮塔铣床-专利编号CN110449644A	2020-05-14	764
组合式炮塔支架-专利编号CN103196328B	2020-05-13	1005
炮塔支架-专利编号CN103196329A	2020-05-11	203
组合式炮塔支架-专利编号CN103196328A	2020-05-15	177
模块化炮塔-专利编号CN109154487A	2020-05-13	923
灭火炮塔-专利编号CN104415485A	2020-05-12	584
炮塔支架-专利编号CN103196329B	2020-05-12	673
可移动消防炮塔-专利编号CN107754164A	2020-05-15	445

采用捷联惯导的火炮瞄准稳定系统控制方法

采用捷联惯导的火炮瞄准稳定系统控制方法

技术领域

背景技术

发明内容

附图说明

具体实施方式

IPRDB

热门服务

关于我们

友情链接

联系方式