CN104132586B - 一种枪械自动瞄准系统及其工作方法 - Google Patents
一种枪械自动瞄准系统及其工作方法 Download PDFInfo
- Publication number
- CN104132586B CN104132586B CN201410225667.1A CN201410225667A CN104132586B CN 104132586 B CN104132586 B CN 104132586B CN 201410225667 A CN201410225667 A CN 201410225667A CN 104132586 B CN104132586 B CN 104132586B
- Authority
- CN
- China
- Prior art keywords
- cloud terrace
- coordinate system
- aiming
- module
- target
- 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.)
- Expired - Fee Related
Links
Landscapes
- Optical Radar Systems And Details Thereof (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
Abstract
本发明公开了一种枪械自动瞄准系统及其工作方法,其中的自动瞄准系统由云台运动模块,控制器模块,视频传输模块和遥控器模块四部分组成,通过云台的转动带动其上搭载的枪械的转动,用以实现枪械对目标的自动瞄准;通过控制器模块实现瞄准云台上的枪械对目标的自动瞄准;通过视频传输模块实现操作人员对现场的实时监控;通过遥控器模块实现无线遥控功能。本发明瞄准系统可以临时移动或事先放置在需要打击目标的伏击场所,代替武警或狙击手在伏击地待命,不但避免了武警或狙击手因长期设伏对身体带来的生理极限挑战,而且克服了人直接操控武器,因呼吸而影响瞄准精度的缺陷。
Description
技术领域
本发明涉及枪械瞄准技术,尤其涉及反恐防暴机器人枪械装备和狙击枪的自动化瞄准系统。
背景技术
目前,有各式各样的反恐防暴机器人,但是,它们多数以完成对各种危险物品的操作为主要任务。虽然有些也配备了某种武器装备,如,霰弹枪或催泪弹等,但是其针对具体目标的精准性往往不高。
另外,部队或武警里都配备了一些狙击手,但是他们都是以人作为武器的直接操控者来实现对狙击目标的瞄准与射击,由人直接操控武器,具有呼吸会影响瞄准精度、长期设伏的话会挑战人的生理极限等系列问题。
由于反恐防暴及狙击手任务现场具有很大的复杂性与危险性,所以,如何最大限度地保护反恐防暴队员或狙击手的安全,而又能有效地完成对歹徒或着狙击目标的打击,这是需要亟待解决的一个问题。
发明内容
为了提高反恐防暴机器人的功能,或代替狙击手完成相应的工作任务,有效地完成对歹徒或着狙击目标的打击,最大限度地保护反恐防暴队员或狙击手的安全,本发明提供一种枪械自动瞄准系统,该系统通过人的遥控观察与引导,实现对攻击目标的锁定,并实现枪械等武器对目标的自动瞄准。
本发明同时提供这种枪械自动瞄准系统的工作方法。
为达上述目的,本发明的枪械自动瞄准系统采取的技术方案是:
它由云台运动模块,控制器模块,视频传输模块和遥控器模块四部分组成,其中:
所述的云台运动模块,是在基座两端对称安装有两个云台,分别称为引导云台和瞄准云台,其中:每个云台都包括一个固定在基座上的云台座,云台座内固定有立式电机,立式电机轴上安装有水平旋转云台架,在水平旋转云台架上还安装有卧式电机,卧式电机上安装有仰俯旋转云台架;在引导云台的仰俯旋转云台架上安装有激光测距传感器和视频传输模块的摄像头;在瞄准云台的仰俯旋转云台架上搭载有枪械。通过引导云台的的立式电机和卧式电机的驱动,分别实现引导云台的两个云台架的转动,以对现场情况进行实时视频监控和对目标的激光测距,并将所测得的距离信息发送至控制器模块;通过瞄准云台的立式电机和卧式电机的驱动,分别实现瞄准云台的两个云台架的转动,从而带动其上搭载的枪械的转动,用以实现枪械对目标的自动瞄准。
所述的控制器模块由无线接收模块、嵌入式微控制器、串口通讯模块和供电电源模块组成,信号传输关系是:一方面经无线接收模块接收遥控器模块发来的控制信号,再经嵌入式微控制器对控制信号进行检测,然后经串口通讯模块向引导云台的引导俯仰旋转驱动电机和引导水平旋转驱动电机发送运动命令;一方面经串口通讯模块接收引导俯仰旋转驱动电机和引导水平旋转驱动电机反馈回的旋转角度信息和激光测距传感器探测到的目标距离信息,再通过嵌入式微控制器进行云台关节空间坐标关系的正逆解计算,得出瞄准云台的瞄准俯仰旋转驱动电机和瞄准水平旋转驱动电机应该运动的旋转角度信息,再经串口通讯模块向瞄准俯仰旋转驱动电机和瞄准水平旋转驱动电机发送相应的运动指令,以实现瞄准云台上的枪械对目标的自动瞄准。
所述的视频传输模块由摄像头、无线视频传输模块和显示终端组成,摄像头搭载在引导云台上,用以采集现场图像,并通过无线视频传输模块发送至显示终端,以实现操作人员对现场的实时监控。
所述遥控器模块由操作模块、处理器和无线发送模块组成,操作模块将作业人员的操作动作转换成电信号传输至处理器,经过处理器对操作信号进行处理,再通过无线发送模块发送至控制器模块,实现无线遥控功能。
利用上述枪械自动瞄准系统实施瞄准的方法主要包含如下步骤:
步骤一、通过视频传输模块的摄像头采集现场图像,并经过无线视频模块将图像发送至显示终端;
步骤二、操作者通过显示终端的图像,观察测距激光束是否指向打击目标,若是,转向步骤五,若否,继续步骤三;
步骤三、操作者通过遥控器模块的操作模块发出引导云台相应关节的转动操作信号,以去调整激光测距传感器的测距激光束指向目标,操作信号经处理器处理后,通过无线发送模块发送给控制器模块;
步骤四、控制器模块通过其无线接收模块接受遥控器模块的无线发送模块发来的操作信号,经嵌入式微控制器处理后,由串口通讯模块发送指令给云台运动模块,去驱动引导云台的立式电机和卧式电机进行相应转动,以将激光测距传感器的测距激光束对准目标并实时测量目标距离;
步骤五、控制器模块的串口通讯模块采集引导云台的立式电机和卧式电机的旋转角度信息及激光测距传感器测量的目标距离信息,并将这些信息传回嵌入式微控制器;
步骤六、控制器模块的嵌入式微控制器根据传回的电机旋转角度信息及目标距离信息进行云台关节空间坐标关系的正逆解计算,得到瞄准云台的立式电机转角β1、卧式电机转角β2以及枪械瞄准具到目标间的瞄准线长度Rx3数值;
步骤七、控制器模块的嵌入式微控制器将云台关节空间坐标关系的正逆解计算结果,转换成对瞄准云台的立式电机和卧式电机的控制指令,再经串口通讯模块发送给云台运动模块,去驱动瞄准云台的立式电机和卧式电机进行相应转动,以将枪械的瞄准线自动对准目标,实现本次瞄准任务;
步骤八、操作者判断瞄准系统是否需要继续工作,若是,则转向步骤一,若否,则退出工作关机。
上述步骤六中正逆解计算方法包含如下步骤:
步骤6.1、在引导云台上分别建立O0-X0Y0Z0坐标系,O1-X1Y1Z1坐标系,O2-X2Y2Z2坐标系和O3-X3Y3Z3坐标系,分别简称为O0、O1、O2、O3坐标系(下同),初始时,各个坐标系的X轴方向朝向正前方,Y轴方向朝向左方,Z轴方向朝向正上方,构成一个右手系,其中:
O0坐标系建在引导云台的水平旋转关节的底端中心平面上,为引导云台的基础坐标系;
O1坐标系建在引导云台水平旋转关节轴线的正上方,绑定在引导云台的水平旋转云台架上,其原点正好在引导云台的水平旋转关节轴线与俯仰运动关节轴线交叉点上,O1坐标系跟随着引导云台的水平旋转云台架的转动而转动,其转角用θ1表示;
O2坐标系绑定在引导云台的俯仰旋转云台架上,其原点与O1坐标系原点重合,O2坐标系不仅跟随着引导云台的水平旋转云台架的水平转动而转动,还跟随着引导云台的俯仰旋转云台架的俯仰转动而转动,其随引导云台的俯仰旋转云台架俯仰转动的转角用θ2表示;
O3坐标系建在O2坐标系的Z2轴方向某高度上,与激光测距传感器绑定在一起,且激光测距传感器的测距激光束方向与X3轴的方向重合,O3同O2一样,随着引导云台的水平旋转云台架和引导云台的俯仰旋转云台架的转动而做两个方向的转动,O3坐标系与O2坐标系保持平动关系,用来表示激光测距传感器的测距激光束所指向的目标在O2坐标系中的矢量描述。
步骤6.2、进行云台关节空间坐标关系的正解计算:
将O0坐标系对瞄准云台的基础坐标系的平动关系用A0描述,将O1坐标系对O0坐标系的水平旋转关系用A1描述,将O2坐标系对O1坐标系的俯仰旋转关系用A2描述,将激光测距传感器所指目标相对O2坐标系的矢量关系用A3描述,那么,可将激光测距传感器所指目标在瞄准云台的基础坐标系中的矢量描述表示为T,则有:
T=A0·A1·A2·A3 (1)
根据前述描述可得如下系列矩阵:
其中:
Py为引导云台与瞄准云台之间的中心距离,为已知
Pz1为O1坐标系相对O0坐标系的高度,为已知
θ1为引导云台的立式电机的转角,从上方看,逆时针为正,顺时针为负,可以实时测量得到;
θ2为引导云台的卧式电机的转角,从侧面看,下俯为正,上仰为负,可以实时测量得到;
Px3为激光测距传感器所指目标的测量距离,可以实时测量得到;
Py3=0;
Pz3为激光测距传感器在Z2轴上方的高度描述,为已知;
Px0,Py0,Pz0分别为目标在瞄准云台的基础坐标系中的三维坐标计算值;
对T的求解过程就是云台关节空间坐标关系的正解计算,这是通过所测得的引导云台的立式电机转角θ1,引导云台的水平旋转驱动电机转角θ2以及激光测距传感器测得的目标距离Px3的数值,来定位目标在瞄准云台的基础坐标系中位置的过程。
步骤6.3、在瞄准云台上分别建立坐标系,坐标系,坐标系和坐标系,分别简称为坐标系(下同),初始时,各个坐标系的X轴方向朝向正前方,Y轴方向朝向左方,Z轴方向朝向正上方,构成一个右手系,其中:
坐标系建在瞄准云台的水平旋转关节的底端中心平面上,为瞄准云台的基础坐标系;
坐标系建在瞄准云台的水平旋转关节轴线的正上方,绑定在瞄准水平旋转云台架上,其原点正好在瞄准云台的水平旋转关节轴线与俯仰运动关节轴线交叉点上,坐标系跟随着瞄准云台的水平旋转云台架的转动而转动,其转角用β1表示;
坐标系绑定在瞄准云台的俯仰旋转云台架上,其原点与坐标系原点重合,坐标系不仅跟随着瞄准云台的水平旋转云台架的水平转动而转动,还跟随着瞄准云台的俯仰旋转云台架的俯仰转动而转动,其随着瞄准云台的俯仰旋转云台架俯仰转动的转角用β2表示;
坐标系建在坐标系的轴方向某高度上,与枪械绑定在一起,且枪械的瞄准具瞄准线的方向与轴的方向重合,和一样,随着瞄准水平旋转云台架和瞄准俯仰旋转云台架的转动而做两个方向的转动,坐标系与坐标系保持平动关系,用来表示枪械的瞄准线所指向的目标在坐标系中的矢量描述。
步骤6.4、进行云台关节空间坐标关系的逆解计算:
将坐标系对瞄准云台的基础坐标系的水平旋转关系用B1描述,将坐标系对坐标系的俯仰旋转关系用B2表述,将枪械的瞄准线所指目标相对坐标系的矢量关系用B3描述,那么,可以将枪械的瞄准线所指目标在瞄准云台的基础坐标系中的矢量描述表示为S,则有:
S=B1·B2·B3 (3)
因为激光测距传感器所指目标与枪械的瞄准线所指目标是同一个点,所以有:
S=T (4)
而且根据前述描述可得如下系列矩阵:
其中:Rz1为坐标系相对坐标系的高度,为已知
β1为瞄准云台的立式电机的转角,从上方看,逆时针为正,顺时针为负,是需求解量
β2为瞄准云台的卧式电机的转角,从侧面看,下俯为正,上仰为负,是需求解量
Rx3为枪械瞄准具到目标间的瞄准线长度,是需求解量
Ry3=0
Rz3为枪械瞄准具在轴上方的高度描述,为已知
通过前述公式(1)-(5)及已知条件可以推导获得:
其中:
上述公式(6)、(7)即为对云台关节空间坐标关系的逆解计算,这是通过目标在瞄准云台的基础坐标系中位置,来求导出瞄准云台的卧式电机转角β2,瞄准云台的立式电机转角β1以及枪械瞄准具到目标间的瞄准线长度Rx3数值,是落实如何调整枪口去对准目标的过程。
本发明的优点在于:
本发明的瞄准系统可以临时移动或事先放置在需要打击目标的伏击场所,代替武警或狙击手在伏击地待命,而武警或狙击手只需远距离监控,当目标出现时,操作人员通过遥控模块发出指令,瞄准系统开始工作,瞄准打击目标,这样不但避免了武警或狙击手因长期设伏对身体带来的生理极限挑战,而且克服了人直接操控武器,因呼吸而影响瞄准精度的缺陷;达到了在充分保证武警和狙击手安全情况下,远距离实现对打击目标的瞄准攻击目的。
附图说明
图1为本发明的系统总体框图;
图2为本发明云台运动模块的整体结构图;
图3为本发明云台运动模块的分解结构图;
图4为本发明云台运动模块运动原理与初始位置时的各坐标系位置示意图;
图5为本发明控制器模块框图;
图6为本发明视频传输模块框图;
图7为本发明遥控器模块框图;
图8为本发明系统工作流程图。
图中:
001-云台运动模块,002-控制器模块,003-视频传输模块,004-遥控器模块;
100-引导云台,101-引导俯仰旋转驱动电机,102-引导俯仰旋转云台架,103-引导水平旋转云台架,104-引导云台座,105-引导水平旋转驱动电机,106-摄像头,107-激光测距传感器;
200-瞄准云台,201-瞄准俯仰旋转驱动电机,202-瞄准俯仰旋转云台架,203-瞄准水平旋转云台架,204-瞄准云台座,205-瞄准水平旋转驱动电机,206-枪械;
300-云台基座;
L1-测距激光束,L2-瞄准线,L3-枪膛线。
具体实施方式
下面结合附图1-8,说明本发明的枪械自动瞄准系统及其工作方法。
如图1所示,本发明的系统包含:云台运动模块001,控制器模块002,视频传输模块003,遥控器模块004,其中:
所述的云台运动模块001,如图2、图3所示,在云台基座300上安装有引导云台100和瞄准云台200,其中引导云台100,主要由引导俯仰旋转驱动电机101、引导俯仰旋转云台架102、引导水平旋转云台架103、引导云台座104和引导水平旋转驱动电机105等组成,在引导俯仰旋转云台架102上安装有激光测距传感器107和视频传输模块的摄像头106,通过引导俯仰旋转驱动电机101和引导水平旋转驱动电机105的驱动,分别实现引导俯仰旋转云台架102和引导水平旋转云台架103的转动,从而带动其上搭载的摄像头106和激光测距传感器107的转动,以对现场情况进行实时视频监控和对目标的激光测距,并将所测得的距离信息发送至控制器模块002;其中的瞄准云台200,主要由瞄准俯仰旋转驱动电机201,瞄准俯仰旋转云台架202,瞄准水平旋转云台架203,瞄准云台座204,瞄准水平旋转驱动电机205等组成,在瞄准俯仰旋转云台架202上安装枪械206,通过瞄准俯仰旋转驱动电机201和瞄准水平旋转驱动电机205的驱动,分别实现瞄准俯仰旋转云台架202和瞄准水平旋转云台架203的转动,从而带动其上搭载的枪械206的转动,用以实现枪械206对目标的自动瞄准。
所述的控制器模块002,如图1、图5所示,由无线接收模块、嵌入式微控制器、串口通讯模块和供电电源模块组成,一方面经无线接收模块接收遥控器模块004发来的控制信号,再经嵌入式微控制器对控制信号进行检测,然后经串口通讯模块向引导云台100的引导俯仰旋转驱动电机101和引导水平旋转驱动电机105发送运动命令;一方面经串口通讯模块接收引导俯仰旋转驱动电机101和引导水平旋转驱动电机105反馈回的旋转角度信息和激光测距传感器107探测到的目标距离信息,再通过嵌入式微控制器进行云台关节空间坐标关系的正逆解计算,得出瞄准云台200的瞄准俯仰旋转驱动电机201和瞄准水平旋转驱动电机205应该运动的旋转角度信息,再经串口通讯模块向瞄准俯仰旋转驱动电机201和瞄准水平旋转驱动电机205发送相应的运动指令,以实现瞄准云台200上的枪械206对目标的自动瞄准。
所述的视频传输模块003,如图1、图6所示,由摄像头、无线视频传输模块和显示终端组成,摄像头搭载在引导云台上,用以采集现场图像,并通过无线视频传输模块发送至显示终端,以实现操作人员对现场的实时监控。
所述遥控器模块004,如图1、图7所示,由操作模块、处理器和无线发送模块组成,操作模块将作业人员的操作动作转换成电信号传输至处理器,经过处理器对操作信号进行处理,再通过无线发送模块发送至控制器模块002,实现无线遥控功能。
基于上述系统的枪械自动瞄准系统的工作方法主要包含如下步骤:
步骤一、通过视频传输模块003的摄像头采集现场图像,并经过无线视频模块将图像发送至显示终端;
步骤二、操作者通过显示终端的图像,观察测距激光束L1是否指向打击目标,若是,转向步骤五,若否,继续步骤三;
步骤三、操作者通过遥控器模块004的操作模块发出引导云台100相应关节的转动操作信号,以去调整激光测距传感器107的测距激光束L1指向目标,操作信号经处理器处理后,通过无线发送模块发送给控制器模块002;
步骤四、控制器模块002通过自身的无线接收模块接受遥控器模块004的无线发送模块发来的操作信号,经嵌入式微控制器处理后,由串口通讯模块发送指令给云台运动模块001,去驱动引导云台100的引导俯仰旋转驱动电机101和引导水平旋转驱动电机105进行相应转动,以将激光测距传感器107的测距激光束L1对准目标并实时测量目标距离;
步骤五、控制器模块002的串口通讯模块采集引导云台100的引导俯仰旋转驱动电机101和引导水平旋转驱动电机105的旋转角度信息及激光测距传感器107测量的目标距离信息,并将这些信息传回嵌入式微控制器;
步骤六、控制器模块002的嵌入式微控制器根据传回的电机旋转角度信息及目标距离信息进行云台关节空间坐标关系的正逆解计算,得到瞄准云台200的瞄准俯仰旋转驱动电机201转角β2和瞄准水平旋转驱动电机205转角β1以及枪械瞄准具到目标间的瞄准线长度Rx3数值;
步骤七、控制器模块002的嵌入式微控制器将引导云台100的关节空间坐标关系的正逆解计算结果,转换成对瞄准云台200的瞄准俯仰旋转驱动电机201和瞄准水平旋转驱动电机205的控制指令,再经串口通讯模块发送给云台运动模块001,去驱动瞄准云台200的瞄准俯仰旋转驱动电机201和瞄准水平旋转驱动电机205进行相应转动,以将枪械206的瞄准线L2自动对准目标,实现本次瞄准任务;
步骤八、操作者判断瞄准系统是否需要继续工作,若是,则转向步骤一,若否,则退出工作关机。
上述步骤六中,关于云台关节空间坐标关系的正逆解计算方法包含如下步骤,如图2-图4所示:
步骤1、在引导云台100上分别建立O0-X0Y0Z0坐标系,O1-X1Y1Z1坐标系,O2-X2Y2Z2坐标系和O3-X3Y3Z3坐标系,分别简称为O0、O1、O2、O3坐标系(下同),其中:
O0坐标系建在引导云台100的水平旋转关节的底端中心平面上,为引导云台100的基础坐标系,其方向如图4所示;
O1坐标系建在引导云台100水平旋转关节轴线的正上方,绑定在引导水平旋转云台架103上,其原点正好在引导云台100的水平旋转关节轴线与俯仰运动关节轴线交叉点上,当引导云台100处于初始位置时(各关节未做任何方向转动),其方向如图4所示,O1坐标系跟随着引导水平旋转云台架103的转动而转动,其转角用θ1表示;
O2坐标系绑定在引导俯仰旋转云台架102上,其原点与O1坐标系原点重合,其初始方向如图4所示,O2坐标系不仅跟随着引导水平旋转云台架103的水平转动而转动,还跟随着引导俯仰旋转云台架102的俯仰转动而转动,其随引导俯仰旋转云台架102俯仰转动的转角用θ2表示;
O3坐标系建在O2坐标系的Z2轴方向某高度上,与激光测距传感器107绑定在一起,其初始方向如图4所示,且激光测距传感器107的测距激光束L1方向与X3轴的方向重合,O3同O2一样,随着引导水平旋转云台架103和引导俯仰旋转云台架102的转动而做两个方向的转动,O3坐标系与O2坐标系保持平动关系,用来表示激光测距传感器107的测距激光束L1所指向的目标在O2坐标系中的矢量描述。
步骤2、进行云台关节空间坐标关系的正解计算:
将O0坐标系对瞄准云台200的基础坐标系(见图4,其位置与方向将在后面解释)的平动关系用A0描述,将O1坐标系对O0坐标系的水平旋转关系用A1描述,将O2坐标系对O1坐标系的俯仰旋转关系用A2描述,将激光测距传感器107的测距激光束L1所指目标相对O2坐标系的矢量关系用A3描述,那么,可将激光测距传感器107的测距激光束L1所指目标在瞄准云台200的基础坐标系中的矢量描述表示为T,则有:
T=A0·A1·A2·A3 (1)
根据前述描述可得如下系列矩阵:
其中:
Py为引导云台100与瞄准云台200之间的中心距离,为已知;
Pz1为O1坐标系相对O0坐标系的高度,为已知;
θ1为引导水平旋转驱动电机105的转角,从上方看,逆时针为正,顺时针为负,可以实时测量得到;
θ2为引导俯仰旋转驱动电机101的转角,从侧面看,下俯为正,上仰为负,可以实时测量得到;
Px3为激光测距传感器107的测距激光束L1所指目标的测量距离,可以实时测量得到
Py3=0;
Pz3为激光测距传感器107在Z2轴上方的高度描述,为已知
Px0,Py0,Pz0分别为目标在瞄准云台200的基础坐标系中的三维坐标计算值
公式(1)即为云台关节空间坐标关系的正解计算,这是通过所测得的引导俯仰旋转驱动电机101转角θ1,引导水平旋转驱动电机105转角θ2以及激光测距传感器107测得的目标距离Px3的数值,来定位目标在瞄准云台200的基础坐标系中位置的过程。
步骤3、在瞄准云台200上分别建立坐标系,坐标系,坐标系和坐标系,分别简称为坐标系(下同),其中:
坐标系建在瞄准云台200的水平旋转关节的底端中心平面上,为瞄准云台200的基础坐标系,其方向如图4所示;
坐标系建在瞄准云台200的水平旋转关节轴线的正上方,绑定在瞄准水平旋转云台架203上,其原点正好在瞄准云台200的水平旋转关节轴线与俯仰运动关节轴线交叉点上,当瞄准云台200处于初始位置时(各关节未做任何方向转动),其方向如图4所示,坐标系跟随着瞄准水平旋转云台架203的转动而转动,其转角用β1表示;
坐标系绑定在瞄准俯仰旋转云台架202上,其原点与坐标系原点重合,其初始方向如图4所示,坐标系不仅跟随着瞄准水平旋转云台架203的水平转动而转动,还跟随着瞄准俯仰旋转云台架202的俯仰转动而转动,其随着瞄准俯仰旋转云台架202俯仰转动的转角用β2表示;
坐标系建在坐标系的轴方向某高度上,与枪械206绑定在一起,其初始方向如图4所示,且枪械206的瞄准具瞄准线的方向与轴的方向重合,和一样,随着瞄准水平旋转云台架203和瞄准俯仰旋转云台架202的转动而做两个方向的转动,坐标系与坐标系保持平动关系,用来表示枪械206的瞄准线所指向的目标在坐标系中的矢量描述。
步骤4、进行云台关节空间坐标关系的逆解计算:
将坐标系对瞄准云台200的基础坐标系的水平旋转关系用B1描述,将坐标系对坐标系的俯仰旋转关系用B2表述,将枪械206的瞄准线L2所指目标相对坐标系的矢量关系用B3描述,那么,可以将枪械206的瞄准线L2所指目标在瞄准云台200的基础坐标系中的矢量描述表示为S,则有:
S=B1·B2·B3 (3)
因为激光测距传感器107的测距激光束L1所指目标与枪械206的瞄准线L2所指目标是同一个点,故有:
S=T (4)
而且根据前述描述可得如下系列矩阵:
其中:
Rz1为坐标系相对坐标系的高度,为已知
β1为瞄准水平旋转驱动电机205的转角,从上方看,逆时针为正,顺时针为负,是需求解量
β2为瞄准俯仰旋转驱动电机201的转角,从侧面看,下俯为正,上仰为负,是需求解量
Rx3为枪械206瞄准具到目标间的瞄准线L2的长度,是需求解量
Ry3=0
Rz3为枪械206瞄准具在轴上方的高度描述,为已知
通过前述公式(1)-(5)及已知条件可以推导获得:
其中:
公式(6)、(7)即为云台关节空间坐标关系的逆解计算,这是通过目标在瞄准云台200的基础坐标系中位置,来求导出瞄准俯仰旋转驱动电机201转角β2,瞄准水平旋转驱动电机205转角β1以及枪械206瞄准具到目标间的瞄准线L2长度Rx3数值,是落实如何调整枪口去对准目标的过程。
需要说明的是:在具体实施方式中,瞄准云台200上瞄准目标的是枪械206瞄准具的瞄准线L2而非其枪膛线L3,参见图2,由于弹道曲线的影响,枪膛线L3实际应该相对瞄准线L2上仰一个小角度,该角度即为瞄准角,而瞄准角的大小与武器的不同、弹丸运动参数及目标距离等有关系,若要采用本发明直接实现对枪膛线L3方向的调整与控制,可以在前述方法基础上,按照弹道曲线理论增加对武器瞄准角的计算,然后将枪膛线L3按照前述求解的瞄准线L2俯仰角度值β2,再上仰一个瞄准角,即可使得其弹丸的弹道经过激光测距传感器107的测距激光束L1指向的目标点。
所以,以上所述实施例仅表达了本发明的具体实施方式,其描述较为具体详细,但并不能理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思原理的前提下,还可以作出若干变形和改进,这些都属于本发明的保护范围均应涵盖在本发明专利权利要求的保护范围以内。
Claims (2)
1.一种枪械自动瞄准系统,其特征在于,它由云台运动模块,控制器模块,视频传输模块和遥控器模块四部分组成,其中:
所述的云台运动模块,是在基座两端对称安装有两个云台,分别称为引导云台和瞄准云台,其中:每个云台都包括一个固定在基座上的云台座,云台座内固定有立式电机,立式电机轴上安装有水平旋转云台架,在水平旋转云台架上还安装有卧式电机,卧式电机上安装有仰俯旋转云台架;在引导云台的仰俯旋转云台架上安装有激光测距传感器和视频传输模块的摄像头;在瞄准云台的仰俯旋转云台架上搭载有枪械;通过引导云台的立式电机和卧式电机的驱动,分别实现引导云台的两个云台架的转动,以对现场情况进行实时视频监控和对目标的激光测距,并将所测得的距离信息发送至控制器模块;通过瞄准云台的立式电机和卧式电机的驱动,分别实现瞄准云台的两个云台架的转动,从而带动其上搭载的枪械的转动,用以实现枪械对目标的自动瞄准;
所述的控制器模块由无线接收模块、嵌入式微控制器、串口通讯模块和供电电源模块组成,信号传输关系是:一方面经无线接收模块接收遥控器模块发来的控制信号,再经嵌入式微控制器对控制信号进行检测,然后经串口通讯模块向引导云台的卧式电机和立式电机发送运动命令;一方面经串口通讯模块接收引导云台的卧式电机和立式电机反馈回的旋转角度信息和激光测距传感器探测到的目标距离信息,再通过嵌入式微控制器进行云台关节空间坐标关系的正逆解计算,得出瞄准云台的卧式电机和立式电机应该运动的旋转角度信息,再经串口通讯模块向瞄准云台的卧式电机和立式电机发送相应的运动指令,以实现瞄准云台上的枪械对目标的自动瞄准;
所述的视频传输模块由摄像头、无线视频传输模块和显示终端组成,摄像头搭载在引导云台上,用以采集现场图像,并通过无线视频传输模块发送至显示终端,以实现操作人员对现场的实时监控;
所述的遥控器模块由操作模块、处理器和无线发送模块组成,操作模块将作业人员的操作动作转换成电信号传输至处理器,经过处理器对操作信号进行处理,再通过无线发送模块发送至控制器模块,实现无线遥控功能。
2.一种如权利要求1所述的枪械自动瞄准系统的工作方法,其特征在于,
步骤一、通过视频传输模块的摄像头采集现场图像,并经过无线视频传输模块将图像发送至显示终端;
步骤二、操作者通过显示终端的图像,观察测距激光束是否指向打击目标,若是,转向步骤五,若否,继续步骤三;
步骤三、操作者通过遥控器模块的操作模块发出引导云台相应关节的转动操作信号,以去调整激光测距传感器的测距激光束指向目标,操作信号经处理器处理后,通过无线发送模块发送给控制器模块;
步骤四、控制器模块通过其无线接收模块接受遥控器模块的无线发送模块发来的操作信号,经嵌入式微控制器处理后,由串口通讯模块发送指令给云台运动模块,去驱动引导云台的立式电机和卧式电机进行相应转动,以将激光测距传感器的测距激光束对准目标并实时测量目标距离;
步骤五、控制器模块的串口通讯模块采集引导云台的立式电机和卧式电机的旋转角度信息及激光测距传感器测量的目标距离信息,并将这些信息传回嵌入式微控制器;
步骤六、控制器模块的嵌入式微控制器根据传回的电机旋转角度信息及目标距离信息进行云台关节空间坐标关系的正逆解计算,得到瞄准云台的立式电机转角β1、卧式电机转角β2以及枪械瞄准具到目标间的瞄准线长度Rx3数值;
步骤七、控制器模块的嵌入式微控制器将云台关节空间坐标关系的正逆解计算结果,转换成对瞄准云台的立式电机和卧式电机的控制指令,再经串口通讯模块发送给云台运动模块,去驱动瞄准云台的立式电机和卧式电机进行相应转动,以将枪械的瞄准线自动对准目标,实现本次瞄准任务;
步骤八、操作者判断瞄准系统是否需要继续工作,若是,则转向步骤一,若否,则退出工作关机;
上述步骤六中正逆解计算方法包含如下步骤:
步骤6.1、在引导云台上分别建立O0-X0Y0Z0坐标系,O1-X1Y1Z1坐标系,O2-X2Y2Z2坐标系和O3-X3Y3Z3坐标系,分别简称为O0、O1、O2、O3坐标系,初始时,各个坐标系的X轴方向朝向正前方,Y轴方向朝向左方,Z轴方向朝向正上方,构成一个右手系,其中:
O0坐标系建在引导云台的水平旋转关节的底端中心平面上,为引导云台的基础坐标系;
O1坐标系建在引导云台水平旋转关节轴线的正上方,绑定在引导云台的水平旋转云台架上,其原点正好在引导云台的水平旋转关节轴线与俯仰运动关节轴线交叉点上,O1坐标系跟随着引导云台的水平旋转云台架的转动而转动,其转角用θ1表示;
O2坐标系绑定在引导云台的俯仰旋转云台架上,其原点与O1坐标系原点重合,O2坐标系不仅跟随着引导云台的水平旋转云台架的水平转动而转动,还跟随着引导云台的俯仰旋转云台架的俯仰转动而转动,其随引导云台的俯仰旋转云台架俯仰转动的转角用θ2表示;
O3坐标系建在O2坐标系的Z2轴方向某高度上,与激光测距传感器绑定在一起,且激光测距传感器的测距激光束方向与X3轴的方向重合,O3同O2一样,随着引导云台的水平旋转云台架和引导云台的俯仰旋转云台架的转动而做两个方向的转动,O3坐标系与O2坐标系保持平动关系,用来表示激光测距传感器的测距激光束所指向的目标在O2坐标系中的矢量描述;
步骤6.2、进行云台关节空间坐标关系的正解计算:
将O0坐标系对瞄准云台的基础坐标系O’0的平动关系用A0描述,将O1坐标系对O0坐标系的水平旋转关系用A1描述,将O2坐标系对O1坐标系的俯仰旋转关系用A2描述,将激光测距传感器所指目标相对O2坐标系的矢量关系用A3描述,那么,可将激光测距传感器所指目标在瞄准云台的基础坐标系O’0中的矢量描述表示为T,则有:
T=A0·A1·A2·A3 (1)
根据前述描述得如下系列矩阵:
其中:
Py为引导云台与瞄准云台之间的中心距离,为已知
Pz1为O1坐标系相对O0坐标系的高度,为已知
θ1为引导云台的立式电机的转角,从上方看,逆时针为正,顺时针为负,可以实时测量得到;
θ2为引导云台的卧式电机的转角,从侧面看,下俯为正,上仰为负,可以实时测量得到;
Px3为激光测距传感器所指目标的测量距离,通过实时测量得到;
Py3=0;
Pz3为激光测距传感器在Z2轴上方的高度描述,为已知;
Px0,Py0,Pz0分别为目标在瞄准云台的基础坐标系O’0中的三维坐标计算值;
对T的求解过程就是云台关节空间坐标关系的正解计算,这是通过所测得的引导云台的立式电机转角θ1,引导云台的卧式电机转角θ2以及激光测距传感器测得的目标距离Px3的数值,来定位目标在瞄准云台的基础坐标系O’0中位置的过程;
步骤6.3、在瞄准云台上分别建立O’0-X’0Y’0Z’0坐标系,O’1-X’1Y’1Z’1坐标系,O’2-X’2Y’2Z’2坐标系和O’3-X’3Y’3Z’3坐标系,分别简称为O’0、O’1、O’2、O’3坐标系,初始时,各个坐标系的X轴方向朝向正前方,Y轴方向朝向左方,Z轴方向朝向正上方,构成一个右手系,其中:
O’0坐标系建在瞄准云台的水平旋转关节的底端中心平面上,为瞄准云台的基础坐标系;
O’1坐标系建在瞄准云台的水平旋转关节轴线的正上方,绑定在瞄准水平旋转云台架上,其原点正好在瞄准云台的水平旋转关节轴线与俯仰运动关节轴线交叉点上,O’1坐标系跟随着瞄准云台的水平旋转云台架的转动而转动,其转角用β1表示;
O’2坐标系绑定在瞄准云台的俯仰旋转云台架上,其原点与O’1坐标系原点重合,O’2坐标系不仅跟随着瞄准云台的水平旋转云台架的水平转动而转动,还跟随着瞄准云台的俯仰旋转云台架的俯仰转动而转动,其随着瞄准云台的俯仰旋转云台架俯仰转动的转角用β2表示;
O’3坐标系建在O’2坐标系的Z’2轴方向某高度上,与枪械绑定在一起,且枪械的瞄准具瞄准线的方向与X’3轴的方向重合,O’3和O’2一样,随着瞄准水平旋转云台架和瞄准俯仰旋转云台架的转动而做两个方向的转动,O’3坐标系与O’2坐标系保持平动关系,用来表示枪械的瞄准线所指向的目标在O’2坐标系中的矢量描述;
步骤6.4、进行云台关节空间坐标关系的逆解计算:
将O’1坐标系对瞄准云台的基础坐标系O’0的水平旋转关系用B1描述,将O’2坐标系对O’1坐标系的俯仰旋转关系用B2表述,将枪械的瞄准线所指目标相对O’2坐标系的矢量关系用B3描述,那么,可以将枪械的瞄准线所指目标在瞄准云台的基础坐标系O’0中的矢量描述表示为S,则有:
S=B1·B2·B3 (3)
因为激光测距传感器所指目标与枪械的瞄准线所指目标是同一个点,所以有:
S=T (4)
而且根据前述描述可得如下系列矩阵:
其中:Rz1为O’1坐标系相对O’0坐标系的高度,为已知
β1为瞄准云台的立式电机的转角,从上方看,逆时针为正,顺时针为负,是需求解量
β2为瞄准云台的卧式电机的转角,从侧面看,下俯为正,上仰为负,是需求解量
Rx3为枪械瞄准具到目标间的瞄准线长度,是需求解量
Ry3=0
Rz3为枪械瞄准具在Z’2轴上方的高度描述,为已知
通过前述公式(1)-(5)及已知条件推导获得:
其中:
上述公式(6)、(7)即为对云台关节空间坐标关系的逆解计算,这是通过目标在瞄准云台的基础坐标系O’0中位置,来求导出瞄准云台的卧式电机转角β2,瞄准云台的立式电机转角β1以及枪械瞄准具到目标间的瞄准线长度Rx3数值,是落实如何调整枪口去对准目标的过程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410225667.1A CN104132586B (zh) | 2014-05-26 | 2014-05-26 | 一种枪械自动瞄准系统及其工作方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410225667.1A CN104132586B (zh) | 2014-05-26 | 2014-05-26 | 一种枪械自动瞄准系统及其工作方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104132586A CN104132586A (zh) | 2014-11-05 |
CN104132586B true CN104132586B (zh) | 2015-08-05 |
Family
ID=51805361
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410225667.1A Expired - Fee Related CN104132586B (zh) | 2014-05-26 | 2014-05-26 | 一种枪械自动瞄准系统及其工作方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104132586B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104501657B (zh) * | 2014-12-18 | 2016-03-16 | 扬州天目光电科技有限公司 | 遥控型激光测距目标指示器 |
CN106017216B (zh) * | 2015-02-11 | 2018-09-18 | 贵州景浩科技有限公司 | 一种可自动瞄准的电子瞄准器 |
CN105072421A (zh) * | 2015-08-31 | 2015-11-18 | 中山市神剑警用器材科技有限公司 | 轮式战车自动观瞄系统 |
CN105547046A (zh) * | 2015-12-30 | 2016-05-04 | 南京理工大学 | 一种基于视频的狙击机器人快速精确瞄准方法 |
CN105700565B (zh) * | 2016-03-18 | 2018-08-07 | 山东科技大学 | 一种演员灯光实时自动跟踪系统和方法 |
CN107084644B (zh) * | 2017-04-06 | 2019-04-02 | 江苏科技大学海洋装备研究院 | 一种枪械自动瞄准跟踪系统及方法 |
CN107747910A (zh) * | 2017-09-19 | 2018-03-02 | 浙江大学 | 一种视觉引导的隧道标志点坐标激光测量系统及方法 |
WO2019237724A1 (zh) * | 2018-06-12 | 2019-12-19 | 贺磊 | 一种人工及智能反恐制止现场犯罪的打击装置 |
CN109483548B (zh) * | 2018-12-21 | 2021-03-30 | 华南理工大学广州学院 | 一种智能跟踪对抗射击机器人及其控制方法 |
CN111830494A (zh) * | 2020-05-18 | 2020-10-27 | 陕西金蝌蚪智能科技有限公司 | 基于声阵列的枪声定位及反击方法、装置、终端及介质 |
CN113608233B (zh) * | 2021-06-30 | 2024-05-31 | 湖南宏动光电有限公司 | 一种基于坐标变换的虚拟瞄具实现方法及系统 |
CN113848992B (zh) * | 2021-08-26 | 2024-03-19 | 上海合时智能科技有限公司 | 一种基于无人机和武装打击机器人的目标检测定位与自动射击系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1203976A (en) * | 1966-11-25 | 1970-09-03 | Bofors Ab | A system for parallelling a weapon and a sight from which the weapon can be laid by remote control |
US3981010A (en) * | 1972-07-03 | 1976-09-14 | Rmc Research Corporation | Object locating system |
CN200989749Y (zh) * | 2006-12-22 | 2007-12-12 | 潍坊学院 | 狙击步枪遥控瞄准装置 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6237462B1 (en) * | 1998-05-21 | 2001-05-29 | Tactical Telepresent Technolgies, Inc. | Portable telepresent aiming system |
KR100819801B1 (ko) * | 2006-03-03 | 2008-04-07 | 삼성테크윈 주식회사 | 자동 격발 기구 및 이를 구비한 경계 로봇 |
KR101472445B1 (ko) * | 2010-12-09 | 2014-12-12 | 삼성테크윈 주식회사 | 무장 시스템 및 무장 유니트의 제어방법 |
-
2014
- 2014-05-26 CN CN201410225667.1A patent/CN104132586B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1203976A (en) * | 1966-11-25 | 1970-09-03 | Bofors Ab | A system for parallelling a weapon and a sight from which the weapon can be laid by remote control |
US3981010A (en) * | 1972-07-03 | 1976-09-14 | Rmc Research Corporation | Object locating system |
CN200989749Y (zh) * | 2006-12-22 | 2007-12-12 | 潍坊学院 | 狙击步枪遥控瞄准装置 |
Also Published As
Publication number | Publication date |
---|---|
CN104132586A (zh) | 2014-11-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104132586B (zh) | 一种枪械自动瞄准系统及其工作方法 | |
CN203557388U (zh) | 一种排爆机器人的目标位姿获取机构及目标抓取系统 | |
CN103522291B (zh) | 一种排爆机器人的目标抓取系统及方法 | |
US9488442B2 (en) | Anti-sniper targeting and detection system | |
EP2623921B1 (en) | Low-altitude low-speed small target intercepting method | |
KR100963681B1 (ko) | 원격 화기 사격 제어시스템 및 방법 | |
DE3790614C2 (zh) | ||
US20080276473A1 (en) | Method of projecting zero-convergence aiming beam on a target and zero-convergence laser aiming system | |
KR101578028B1 (ko) | 무장 장치 및 이의 조준 각도 보상 방법 | |
RU136148U1 (ru) | Система управления огнем | |
CN105547046A (zh) | 一种基于视频的狙击机器人快速精确瞄准方法 | |
CN105259929A (zh) | 一种自动跟踪观瞄系统及其实现自动跟踪观瞄的方法 | |
CN110180114A (zh) | 消防机器人协同定位、侦察、火源识别与瞄准灭火方法 | |
RU2403526C2 (ru) | Система для ведения прицельного огня из укрытия | |
RU2386920C2 (ru) | Автоматизированный дистанционно управляемый комплекс огневого поражения | |
CN104111663A (zh) | 火箭惯组目标棱镜自动准直的三维闭环反馈控制方法 | |
CN111981903A (zh) | 一种迫击炮快速射击装置、方法及训练检测方法 | |
CN111076612A (zh) | 一种智能化无人车巷战武器站 | |
RU2564051C1 (ru) | Способ стрельбы по движущейся цели противотанковой управляемой ракетой | |
RU2723700C1 (ru) | Система дистанционного управления самозарядной винтовкой | |
CN209570077U (zh) | 一种通用型转管机枪武器站 | |
CN109084626B (zh) | 一种反蛙人武器系统的控制终端及控制方法 | |
RU2797935C1 (ru) | Роботизированная оружейная установка | |
RU2010100521A (ru) | Способ стрельбы боевой машины с закрытых позиций по ненаблюдаемой цели и система управления огнем для ее осуществления | |
KR20120027772A (ko) | 곡사화기 훈련용 정보처리단말기 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150805 |
|
CF01 | Termination of patent right due to non-payment of annual fee |