Guided weapon course and attitude measurement and acquisition system and method based on double rtk and IMU
By integrating dual RTK and IMU modules and laser emission and reception systems on guided weapons, real-time heading and attitude measurement of guided weapons is realized, solving the problem that training data cannot be displayed and saved in real time, providing detailed shooting angle analysis, improving Training data review ability.
Patent Information
- Application Number
- CN202411200970.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-11-12
AI Technical Summary
The guided weapon used in soldier training only has normal strike function. In normal training, there can only be two results: hit or not hit, resulting in the training data that cannot be displayed in real time and cannot be saved and reviewed.
The heading attitude measurement and acquisition system of guided weapons based on dual RTK and IMU is adopted, including the main control device, the first RTK module, the IMU module, the communication module, the MEMS galvanometer and the laser emission module. By collecting positioning information and relative heading angles in real time, the The laser emission and reception achieve the precise positioning and attitude measurement of the target, and combine the casualty judgment device to calculate the strike results and damage effects.
Real-time heading and attitude measurement of guided weapons is realized, accurately restored the shooting angle, convenient for review and analysis after practice, and solve the problem that training data cannot be displayed and saved in real time.
Smart Images

Figure CN118942304A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of guided weapon training, and in particular to a guided weapon heading attitude measurement and acquisition system and method based on dual RTK and IMU. Background Art
[0002] Precision-guided weapons are high-tech weapons developed on the basis of automation technology, with microelectronics, electronic computers and optoelectronic conversion technology as the core. It is a general term for various weapons that control the flight direction, posture, altitude and speed of the weapon according to certain rules to guide the warhead to accurately attack the target.
[0003] Currently, the guided weapons used by soldiers in training only have normal strike functions. In normal training, there are only two results: hit or miss. As a result, the soldiers' training data cannot be displayed in real time, and the training data cannot be saved for review. Summary of the invention
[0004] In view of the problems existing in the prior art, the present invention provides a guided weapon heading and attitude measurement and acquisition system and method based on dual RTK and IMU, so as to solve the technical problems that the guided weapons used for soldier training in the prior art have only normal strike functions, and in normal training there are only two results: hit or miss, resulting in the soldiers' training data cannot be displayed in real time and the training data cannot be saved for review.
[0005] The present invention provides a dual RTK and IMU-based guided weapon heading attitude measurement and acquisition system, comprising:
[0006] The main control device is arranged at one end of the guided weapon and includes a second RTK module, an IMU module, a communication module, a MEMS galvanometer, a laser emission module and a power module;
[0007] A first RTK module, which is provided at the other end of the guided weapon and is used to obtain the positioning information of the guided weapon in real time;
[0008] The IMU module is used to read the relative heading angle, elevation angle and roll angle of the guided weapon;
[0009] The second RTK module and the first RTK device are located on the same axis of the guided weapon, and are used to obtain positioning information of the guided weapon in real time;
[0010] The communication module is communicatively connected to the first RTK module, the second RTK module and the IMU module, and is used to collect the relative heading angle, elevation angle, roll angle and positioning information of the first RTK module, the second RTK module and the IMU module in real time, and realize communication interaction with the casualty determination device;
[0011] The MEMS galvanometer is used to reflect laser light;
[0012] The power supply module is respectively connected to the first RTK module, the second RTK module, the IMU module, the communication module, the MEMS galvanometer and the laser emission module to provide power;
[0013] A laser emission module, which is used to emit laser;
[0014] A trigger device, which is connected to the guided weapon and connected to the laser emission module and the communication module, is used to control the laser emission module to emit laser, and simultaneously control the communication module to upload the current relative heading angle, elevation angle and roll angle, positioning information and timestamp;
[0015] A laser receiving device, which is connected to the target and is used to receive and decode the laser;
[0016] The casualty determination device is connected to the laser receiving device, and is used to receive the relative heading angle, elevation angle and roll angle, positioning information and timestamp, and determine the strike result and damage effect of the target.
[0017] Optionally, the positioning information at least includes:
[0018] The longitude and latitude of the first RTK module, the longitude and latitude of the second RTK module, and the absolute heading angle of the guided weapon are calculated based on them, expressed as:
[0019]
[0020] Δλ)=λ2-λ1
[0021] Among them, Δλ represents the longitude difference, and λ1 represent the latitude and longitude of the first RTK module, respectively, and λ2 represent the latitude and longitude of the second RTK module, respectively.
[0022] Optionally, the first RTK module, the second RTK module, the IMU module, the communication module, the MEMS galvanometer, and the laser emission module include:
[0023] The first RTK module, the second RTK module, the IMU module, the communication module, the MEMS galvanometer, and the laser emission module all run in independent threads.
[0024] The present invention also provides a method for using the aforementioned dual RTK and IMU-based guided weapon heading attitude measurement and acquisition system, comprising:
[0025] S1, real-time acquisition of positioning information of the first RTK module and the second RTK module;
[0026] S2, real-time acquisition IMU module collects the relative heading angle, elevation angle and roll angle of the guided weapon;
[0027] S3, controlling the laser emission module to emit laser in combination with the MEMS galvanometer to form a laser point cloud scanning matrix through the trigger device, and controlling the communication module to upload the current relative heading angle, elevation angle and roll angle, positioning information and timestamp;
[0028] S4, the laser receiving device located in the laser point cloud scanning matrix receives the laser beam, analyzes the laser spatial code of the struck target and records the position information of the struck target;
[0029] S5, the casualty determination device calculates the angle and position of the hit target relative to the launch centerline of the guided weapon by combining the laser spatial coding, position information, positioning information of the first RTK module and the second RTK module, relative heading angle, elevation angle and roll angle;
[0030] S6. The casualty determination device determines whether the laser beam hitting the target is consistent with the firing table through the firing table information. If they are consistent, the guided weapon launch trajectory and the hit damage location are generated. Otherwise, the deviation trajectory is generated according to the firing table information and the laser beam hitting the target, and the flight time of the guided weapon is simulated and calculated.
[0031] Compared with the existing detection technology, the present invention has the following beneficial effects:
[0032] This patented guided weapon heading and attitude measurement and acquisition system based on laser and dual RTK module combined inertial navigation adopts a laser transmitting unit and a dual RTK module combined inertial navigation unit. It can use corresponding algorithms to collect the heading and attitude of guided weapons in real time for both targets equipped with laser receiving devices and targets not equipped with laser devices, accurately restore the firing angle of the weapon, and facilitate post-training review and analysis. BRIEF DESCRIPTION OF THE DRAWINGS
[0033] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the invention and, together with the description, serve to explain the principles of the invention.
[0034] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.
[0035] Figure 1 It is a schematic diagram of the module structure of the present invention;
[0036] Figure 2 It is a schematic diagram of the structure of the system of the present invention installed on a guided weapon;
[0037] Figure 3 It is a schematic diagram of the method flow of the present invention.
[0038] Description of reference numerals:
[0039] 1. First RTK module; 2. Second RTK module; 3. IMU module; 4. Communication module; 5. Trigger device; 6. Fastening device. DETAILED DESCRIPTION
[0040] In order to make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in the present application, all other implementation cases obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application. The functional units with the same labels in the examples of the present invention have the same and similar structures and functions.
[0041] See also Figure 1 The present invention provides a dual RTK and IMU-based guided weapon heading attitude measurement and acquisition system, comprising:
[0042] A main control device, which is arranged at one end of the guided weapon, includes a second RTK module 2, an IMU module 3, a communication module 4, a MEMS galvanometer, a laser emission module and a power supply module;
[0043] The first RTK module 1 is provided at the other end of the guided weapon and is used to obtain the positioning information of the guided weapon in real time;
[0044] The IMU module 3 is used to read the relative heading angle, elevation angle and roll angle of the guided weapon;
[0045] The second RTK module 2 and the first RTK device are located on the same axis of the guided weapon, and are used to obtain positioning information of the guided weapon in real time;
[0046] The communication module 4 is communicatively connected to the first RTK module 1, the second RTK module 2 and the IMU module 3, and is used to collect the relative heading angle, elevation angle, roll angle and positioning information of the first RTK module 1, the second RTK module 2 and the IMU module 3 in real time, and realize communication interaction with the casualty determination device;
[0047] The MEMS galvanometer is used to reflect laser light;
[0048] The power supply module is respectively connected to the first RTK module 1, the second RTK module 2, the IMU module 3, the communication module 4, the MEMS galvanometer and the laser emission module to provide power;
[0049] A laser emission module, which is used to emit laser;
[0050] A trigger device 5, which is connected to the guided weapon and connected to the laser emission module and the communication module 4, is used to control the laser emission module to emit laser, and simultaneously control the communication module 4 to upload the current relative heading angle, elevation angle and roll angle, positioning information and timestamp;
[0051] A laser receiving device, which is connected to the target and is used to receive and decode the laser;
[0052] The casualty determination device is connected to the laser receiving device, and is used to receive the relative heading angle, elevation angle and roll angle, positioning information and timestamp, and determine the strike result and damage effect of the target.
[0053] In this embodiment, see Figure 2 The first RTK module 1 and the second RTK module 2 are respectively installed at the front and rear ends of the weapon through fastening devices, and are used to obtain the positioning information of the guided weapon accurate to the centimeter level in real time. The positioning information at least includes the longitude and latitude of the first RTK module 1 and the longitude and latitude of the second RTK module 2, and the absolute heading angle of the guided weapon is calculated based on the longitude and latitude, which is expressed as:
[0054]
[0055] Δλ)=λ2-λ1
[0056] Among them, Δλ represents the longitude difference, and λ1 represent the latitude and longitude of the first RTK module 1, respectively, and λ2 represent the latitude and longitude of the second RTK module 2, respectively.
[0057] The IMU module 3 is used to read the relative heading angle, elevation angle and roll angle of the guided weapon. When the guided weapon is fired, the first RTK module 1 and the second RTK module 2 determine the true heading of the guided weapon by calculating the absolute heading angle. The heading of the IMU module 3 is a relative heading (the true heading cannot be determined, only the heading deflection amplitude can be determined). When the positioning state is fixed, the RTK module itself is used to calculate the heading. When the positioning state is not fixed, the relative heading of the IMU module 3 is combined to achieve continuous true heading measurement. The pitch angle and roll angle of the IMU module 3 determine the roll and pitch shooting angle of the weapon. The pitch and roll do not need to be calculated. The IMU module 3 is parallel to the barrel. The collected value is how much the barrel pitch and roll angle is, and the positioning and attitude information of the weapon is uploaded in real time through the communication module 4. The real-time heading attitude position information of the weapon can be intuitively viewed on the central control server.
[0058] There are two main working modes of this system. The first is that when the target is equipped with a receiver (laser receiving device), when the weapon is fired, the laser emission module will emit several laser beams with different spatial codes (this laser beam is realized by cooperating with the axis deflection of the MEMS galvanometer to achieve the dot cloud scanning matrix effect. For the specific principle, refer to the laser radar). When the target is within the range of the laser dot cloud scanning matrix, the laser receiving device parses the laser spatial code to determine which specific laser beam hit the target. The target uploads the hit laser spatial code and its own positioning position. At the same time, in conjunction with the weapon's position information, heading, pitch and roll information when the weapon is fired and the galvanometer deflection angle represented by each spatially coded laser beam of the weapon saved in advance by the platform, the target can be reversed on the platform server (casualty judgment device) relative to the launch centerline of the weapon barrel. The angle and position presented are then displayed through the firing table information (this firing table is generated by real weapon experiments, including initial firing rate, distance, firing angle, falling angle, maximum ballistic height, horizontal distance of the highest point of the trajectory, warhead flight time, falling speed, kinetic energy at the landing point, deviation and dispersion distribution, etc. The distance generated by the position of the hit target and the position of the weapon can be used on the platform to generate a ballistic parabola curve at the current distance according to the type of weapon and ammunition, and fit and compare it with the angle generated by the deflection of the laser when the weapon is fired.) and the platform server 3D displays whether the laser beam received by the hit target is consistent with the firing table. If consistent, the target platform displays the weapon launch trajectory and the 3D effect of the hit damage part. If inconsistent, the 3D deviation trajectory is displayed on the platform according to the firing table and the laser beam received by the hit target. The platform calculates the trajectory and damage effect and simulates the real weapon flight time according to the specific weapon model. Among them, the landing point is calculated based on the firing table of various types of ammunition of real weapons. The casualty radius is saved in the platform server in advance through the real data of the ammunition fired by the simulated weapon. The position and posture of the target being hit, including the position and posture of the attacker, are uploaded to the platform server in real time. All physical units in the training venue (people, vehicles, weapons) have positioning and posture determination functions, and the position and posture are uploaded in real time. The platform is always aware of the position information of each unit and displays it in real time on the platform through 3D terrain.
[0059] The second is that the target does not have the ability to receive lasers. In this mode, the weapon's launch centerline needs to be calculated through the heading of the dual RTK module and the pitch and roll of the IMU module 3, and uploaded to the platform at the same time. Similarly, the firing table information of the platform server and the position information of the target are used to calculate whether the target is hit and whether damage is caused. The above two methods can achieve a real simulation of weapon launch and hit effects, thereby achieving the purpose of training.
[0060] See also Figure 3 The present invention also provides a method for using the aforementioned dual RTK and IMU-based guided weapon heading attitude measurement and acquisition system, comprising:
[0061] S1, real-time acquisition of positioning information of the first RTK module 1 and the second RTK module 2;
[0062] S2, real-time acquisition IMU module 3 collects the relative heading angle, elevation angle and roll angle of the guided weapon;
[0063] S3, controlling the laser emission module to emit laser in combination with the MEMS galvanometer to form a laser point cloud scanning matrix through the trigger device 5, and controlling the communication module 4 to upload the current relative heading angle, elevation angle and roll angle, positioning information and timestamp;
[0064] S4, the laser receiving device located in the laser point cloud scanning matrix receives the laser beam, analyzes the laser spatial code of the struck target and records the position information of the struck target;
[0065] S5, the casualty determination device calculates the angle and position of the hit target relative to the launch centerline of the guided weapon by combining the laser spatial coding, position information, positioning information of the first RTK module 1 and the second RTK module, relative heading angle, elevation angle and roll angle;
[0066] S6. The casualty determination device determines whether the laser beam hitting the target is consistent with the firing table through the firing table information. If they are consistent, the guided weapon launch trajectory and the hit damage location are generated. Otherwise, the deviation trajectory is generated according to the firing table information and the laser beam hitting the target, and the flight time of the guided weapon is simulated and calculated.
[0067] This patented guided weapon heading and attitude measurement and acquisition system based on laser and dual RTK module combined inertial navigation adopts a laser transmitting unit and a dual RTK module combined inertial navigation unit. It can use corresponding algorithms to collect the heading and attitude of guided weapons in real time for both targets equipped with laser receiving devices and targets not equipped with laser devices, accurately restore the firing angle of the weapon, and facilitate post-training review and analysis.
[0068] It should be noted that, in this article, relational terms such as "first" and "second" are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.
[0069] The foregoing is merely a specific embodiment of the present invention, which enables those skilled in the art to understand or implement the present invention. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features claimed herein.
Claims
1. A guided weapon heading attitude measurement and acquisition system based on dual RTK and IMU, It is characterized in that include: The main control device is arranged at one end of the guided weapon and includes a second RTK module, an IMU module, a communication module, a MEMS galvanometer, a laser emission module and a power module; A first RTK module, which is provided at the other end of the guided weapon and is used to obtain the positioning information of the guided weapon in real time; The IMU module is used to read the relative heading angle, elevation angle and roll angle of the guided weapon; The second RTK module and the first RTK device are located on the same axis of the guided weapon, and are used to obtain positioning information of the guided weapon in real time; The communication module is communicatively connected to the first RTK module, the second RTK module and the IMU module, and is used to collect the relative heading angle, elevation angle, roll angle and positioning information of the first RTK module, the second RTK module and the IMU module in real time, and realize communication interaction with the casualty determination device; The MEMS galvanometer is used to reflect laser light; The power supply module is respectively connected to the first RTK module, the second RTK module, the IMU module, the communication module, the MEMS galvanometer and the laser emission module to provide power; A laser emission module, which is used to emit laser; A trigger device, which is connected to the guided weapon and connected to the laser emission module and the communication module, is used to control the laser emission module to emit laser, and simultaneously control the communication module to upload the current relative heading angle, elevation angle and roll angle, positioning information and timestamp; A laser receiving device, which is connected to the target and is used to receive and decode the laser; The casualty determination device is connected to the laser receiving device, and is used to receive the relative heading angle, elevation angle and roll angle, positioning information and timestamp, and determine the strike result and damage effect of the target.
2. The guided weapon heading attitude measurement and acquisition system based on dual RTK and IMU as claimed in claim 1, It is characterized in that The positioning information at least includes: The longitude and latitude of the first RTK module, the longitude and latitude of the second RTK module, and the absolute heading angle of the guided weapon are calculated based on them, expressed as: Δλ)=λ2-λ1 Among them, Δλ represents the longitude difference, and λ1 represent the latitude and longitude of the first RTK module, respectively, and λ2 represent the latitude and longitude of the second RTK module, respectively.
3. The guided weapon heading attitude measurement and acquisition system based on dual RTK and IMU as claimed in claim 1, It is characterized in that The first RTK module, the second RTK module, the IMU module, the communication module, the MEMS galvanometer, and the laser emission module include: The first RTK module, the second RTK module, the IMU module, the communication module, the MEMS galvanometer, and the laser emission module all run in independent threads.
4. A method for using the dual RTK and IMU-based guided weapon heading attitude measurement acquisition system as claimed in claim 1, It is characterized in that include: S1, real-time acquisition of positioning information of the first RTK module and the second RTK module; S2, real-time acquisition IMU module collects the relative heading angle, elevation angle and roll angle of the guided weapon; S3, controlling the laser emission module to emit laser in combination with the MEMS galvanometer to form a laser point cloud scanning matrix through the trigger device, and controlling the communication module to upload the current relative heading angle, elevation angle and roll angle, positioning information and timestamp; S4, the laser receiving device located in the laser point cloud scanning matrix receives the laser beam, analyzes the laser spatial code of the struck target and records the position information of the struck target; S5, the casualty determination device calculates the angle and position of the hit target relative to the launch centerline of the guided weapon by combining the laser spatial coding, position information, positioning information of the first RTK module and the second RTK module, relative heading angle, elevation angle and roll angle; S6. The casualty determination device determines whether the laser beam hitting the target is consistent with the firing table through the firing table information. If they are consistent, the guided weapon launch trajectory and the hit damage location are generated. Otherwise, the deviation trajectory is generated according to the firing table information and the laser beam hitting the target, and the flight time of the guided weapon is simulated and calculated.
Citation Information
Patent Citations
Individual soldier shoulder-carrying beyond-visual-range target aiming system and method
CN115420145A
Guidance weapon simulation terminal and simulation method
CN115540679A
Direct aiming weapon simulation system and working method thereof
CN115540684A
Shooting simulation implementation scheme for real soldier battle
CN118111275A
Digital real soldier combat system
CN118506628A
