Trajectory generation method, device, electronic device and medium for navigation simulation system
By adjusting the trajectory of flight equipment in real time in the navigation simulation system, the flight trajectory simulation problem in the location error and deception situations in complex environments is solved, and the generation and analysis of real dynamic trajectory is realized, which improves the authenticity and use value of the simulation system. .
Patent Information
- Application Number
- CN202410571699.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-05-10
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-05-10
AI Technical Summary
The existing navigation simulation system cannot truly simulate the actual operation effect of target flight equipment under various interference situations in complex environments, especially in positioning errors and deceptions, resulting in inconsistent flight trajectory with the predetermined trajectory, and cannot effectively analyze interference for flight. The impact of the line.
By obtaining the positioning solution results of the combined navigation receiver in the navigation simulation system in real time, predicting the positioning position, and adjusting the flight direction and speed according to the predetermined navigation point trajectory, the real trajectory points of the target flight equipment are generated in real time, including position, speed, and acceleration of the target flight equipment in real time. and attitude angle to ensure second-order smoothing of the trajectory with 6 degrees of freedom.
It realizes that the real dynamic trajectory of the target flight equipment is simulated under the situation of inertial navigation sensor error, suppression interference, deception interference and positioning deviation, and improves the authenticity and use value of the simulation system, and can analyze the impact of different factors on the flight trajectory. Help avoid interference and lure.
Smart Images

Figure CN118171490B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of navigation simulation technology, and in particular, to a trajectory generation method, device, electronic device and medium of a navigation simulation system. Background Art
[0002] In the current navigation simulation system, the target flight equipment equipped with satellite navigation receivers and inertial navigation receivers is deployed and simulated in a real three-dimensional battlefield environment with suppression interference, deception interference, multipath error and occlusion effects. In this complex environment, the target flight equipment runs in space according to the set trajectory, and the combined navigation receiver on it receives satellite navigation signals, inertial navigation signals and suppression and deception interference signals with errors. The positioning output result must be different from its real position. In the real world, the deviation of the navigation positioning output result will cause the actual flight trajectory of the equipment to be inconsistent with the original planned trajectory. The current navigation deduction simulation system does not use the output positioning of the receiver, so this simulation method is quite different from the real situation, and it is impossible to truly simulate the actual operation effect of the equipment under various interference conditions. For example, when there is an error in positioning or when the positioning is deceived, how will the flight line be affected? At this time, a trajectory dynamic generation technology is needed to generate the real dynamic trajectory of the target flight equipment in real time according to the positioning output of the receiver. Due to the need to simulate the inertial navigation sensor, the generated trajectory of the target flight equipment is required to be smooth in the second-order derivative, that is, acceleration smooth. Summary of the invention
[0003] On the one hand, the present application provides a trajectory generation method for a navigation simulation system to solve the technical problem that the existing navigation simulation system cannot truly simulate the actual operating effects of target flight equipment under various interference conditions.
[0004] The technical solutions adopted in this application are as follows:
[0005] A trajectory generation method for a navigation simulation system comprises the steps of:
[0006] S1. Continuously calculate the predetermined navigation point trajectory of the target flight equipment according to the preset parameters of the navigation point trajectory of the scene;
[0007] S2, real-time acquisition of positioning solution results reported by the integrated navigation receiver device deployed on the target flight equipment and prediction of the positioning position;
[0008] S3, adjusting the flight direction and speed of the target flight equipment itself in real time according to the predicted positioning position and the predetermined navigation point trajectory, and generating real trajectory points of the target flight equipment in real time, including position, speed, acceleration, attitude angle, and attitude angular velocity;
[0009] S4. At each simulation update time during the simulation, the above steps are repeated recursively to obtain all the real trajectory points of the target flight equipment, and finally a 6-DOF second-order smooth real dynamic trajectory of the target flight equipment is generated in real time.
[0010] Furthermore, the step S1 specifically comprises the following steps:
[0011] S11, setting navigation point trajectory parameters in the scene, wherein the navigation point trajectory is composed of multiple navigation points, and each navigation point includes the following information: position, speed, and turning radius;
[0012] S12. When calculating the predetermined navigation point trajectory of the target flight equipment, the current trajectory position moves forward at a set speed along the geodetic line from the first navigation point position to the second navigation point position. When reaching the second navigation point, it turns according to the set turning radius, and after the forward direction points to the third navigation point, it stops turning and moves forward to the third navigation point position in the same way, and so on, thereby continuously generating a position, speed, and acceleration of a predetermined navigation point trajectory at each simulation update moment.
[0013] Furthermore, the step S1 specifically further includes the steps of:
[0014] S13. During the simulation process, the navigation point trajectory parameters allow for real-time control modification by humans in the loop, including a navigation point position, speed, turning radius, deletion of navigation points, and addition of new navigation points. The trajectory parameters of navigation points that have already passed through the navigation point position are prohibited from being modified.
[0015] Furthermore, the step S2 specifically includes:
[0016] S21, at each simulation update time, after performing noise elimination and trajectory smoothing on the position and speed reported by the integrated navigation receiver device through the Kalman trajectory prediction algorithm, the predicted position of the integrated navigation receiver device is calculated tp , prediction speed tv , get the predicted positioning position of the integrated navigation receiver at the current moment p r .
[0017] Furthermore, the step S2 specifically includes the steps of:
[0018] S22: predicting the current position of the integrated navigation receiver device p r To make corrections: in, d is the control delay between the simulation time of the entire simulation system and the time of the hardware signal generation system, d The smaller it is, the higher the prediction accuracy is.
[0019] Furthermore, the step S3 specifically includes the steps of:
[0020] S31, in order to simulate the target flight equipment to adjust its own flight direction and speed in real time according to its own positioning state and the predetermined navigation point trajectory, the next follow position of the trajectory is set to: , the time to reach the next follow position is estimated as: , establish the trajectory polynomial:
[0021]
[0022]
[0023] in: are 7 unknown three-dimensional vectors, Represent position, velocity, and acceleration respectively, which are three-dimensional vectors. At the initial simulation moment, the real trajectory point coincides with the corresponding predetermined navigation point trajectory. At the subsequent simulation moments, the state of the real trajectory point at the previous simulation moment is recursively deduced. Let t1 be the time of the previous simulation moment. dt is the simulation interval, and the position of the actual running trajectory of the target flight equipment at the previous moment t1 is calculated as , the speed is , the acceleration is , calculate the position of the predetermined navigation point trajectory at the current time t1+dt as , the speed is , the acceleration is ; The predicted positioning position reported by the corresponding integrated navigation receiver device is p r ;
[0024] S32, to ensure that the position, velocity and acceleration of the trajectory polynomial are Moment and Overlap, in Moment and Overlap and establish the system of equations:
[0025]
[0026] The matrix can be obtained
[0027]
[0028] Solve the equation:
[0029] Solve the equation:
[0030] Solve the equation:
[0031] Among them, the subscript Represents a vector Component, W Combining the components, we can get the solution to the equation: ;
[0032] S33. Substitute the solution of the equation into the polynomial: , then the position of the real dynamic trajectory of the target flight equipment at the current moment is , the speed is , the acceleration is ;
[0033] S34, calculating the attitude of the real dynamic trajectory of the target flight equipment at the current moment, including: and upward Calculate the attitude angle of the target flight equipment in the northeast celestial coordinate system, and calculate the attitude angular velocity by the second-order central difference method of the attitude angle. In the body coordinate system of the target flight equipment, set the forward direction of the target flight equipment Always point in the direction of speed; the upward direction of the target flight equipment Calculate it in the following way: Calculate the celestial direction of the real dynamic trajectory position in ECEF coordinates at the current moment as , In The projection onto the plane with φ as the normal direction is the upward direction of the target flight equipment.
[0034] Furthermore, the method further comprises the steps of:
[0035] S5, during the simulation, the predetermined navigation point trajectory, the real dynamic trajectory, and the predicted positioning position of the target flight equipment are visualized and drawn respectively to facilitate the observation of the influence of various interference factors on the trajectory of the target flight equipment.
[0036] On the other hand, the present application also provides a trajectory generation device for a navigation simulation system, comprising:
[0037] A predetermined navigation point trajectory calculation module is used to continuously calculate the predetermined navigation point trajectory of the target flight equipment according to the preset parameters of the navigation point trajectory of the scene;
[0038] The predicted positioning position calculation module is used to obtain the positioning solution results reported by the integrated navigation receiver device deployed on the target flight equipment in real time and predict the positioning position;
[0039] A real trajectory point generation module is used to adjust the flight direction and speed of the target flight equipment in real time according to the predicted positioning position and the predetermined navigation point trajectory, and to generate the real trajectory points of the target flight equipment in real time, including position, speed, acceleration, attitude angle, and attitude angular velocity;
[0040] The real dynamic trajectory generation module is used to repeat the above steps to recursively obtain all the real trajectory points of the target flight equipment at each simulation update moment during the simulation, and finally generate a 6-DOF second-order smooth real dynamic trajectory of the target flight equipment in real time.
[0041] On the other hand, the present application also provides an electronic device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of the trajectory generation method of the navigation simulation system when executing the computer program.
[0042] On the other hand, the present application further provides a storage medium, which includes a stored program, and when the program is running, controls the device where the storage medium is located to execute the steps of the trajectory generation method of the navigation simulation system.
[0043] This application has the following beneficial effects:
[0044] The present application provides a trajectory generation method, device, electronic device and medium of a navigation simulation system. The method estimates the positioning of a combined navigation receiver device of the target flight equipment, and then obtains the real dynamic trajectory of the target flight equipment according to the dynamic correction of the actual flight trajectory of the predetermined navigation point trajectory. The generated trajectory and attitude are smooth and can be used for the control generation of real-time signals. This method can be used in the navigation simulation system to simulate the deviation between the real dynamic trajectory of the target flight equipment and the predetermined navigation point trajectory when the target flight equipment has an inertial navigation sensor error, an inertial navigation cumulative error, suppression interference, deception interference, and the positioning performance of the combined navigation receiver device itself. By setting different forms of interference, inertial navigation error, and the positioning performance of the combined navigation receiver device, it is convenient to analyze the influence of different factors and combinations of different factors on the deviation of the flight trajectory of the target flight equipment, which is conducive to analyzing how to make the opponent's target flight equipment have a trajectory deviation and lure the opponent's target flight equipment to a specified trajectory in a complex navigation environment, and how to avoid being affected by the opponent's interference, etc., thereby improving the use value and authenticity of the entire simulation system.
[0045] In addition to the above-described purposes, features and advantages, the present application also has other purposes, features and advantages. The present application will be further described in detail with reference to the drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0046] The drawings constituting a part of the present application are used to provide a further understanding of the present application. The illustrative embodiments and descriptions of the present application are used to explain the present application and do not constitute an improper limitation on the present application. In the drawings:
[0047] Figure 1It is a schematic diagram of the composition principle of the navigation simulation system.
[0048] Figure 2 It is a flow chart of a trajectory generation method of a navigation simulation system according to a preferred embodiment of the present application.
[0049] Figure 3 It is a schematic diagram of the sub-steps of step S1 of another preferred embodiment of the present application.
[0050] Figure 4 It is a schematic diagram of the sub-steps of step S1 of another preferred embodiment of the present application.
[0051] Figure 5 It is a schematic diagram of the sub-steps of step S2 of another preferred embodiment of the present application.
[0052] Figure 6 It is a schematic diagram of the sub-steps of step S2 of another preferred embodiment of the present application.
[0053] Figure 7 It is a flow chart of a trajectory generation method of a navigation simulation system according to another preferred embodiment of the present application.
[0054] Figure 8 It is a schematic diagram of a trajectory generation device module of a navigation simulation system in a preferred embodiment of the present application.
[0055] Fig. 9 It is a schematic block diagram of an electronic device entity of a preferred embodiment of the present application.
[0056] Fig.10 It is a diagram of the internal structure of a computer device according to a preferred embodiment of the present application. DETAILED DESCRIPTION
[0057] The embodiments of the present application are described in detail below in conjunction with the accompanying drawings, but the present application can be implemented in a variety of different ways defined and covered below.
[0058] like Figure 1As shown, in the navigation deduction simulation system, it is composed of several signal processing units and a navigation deduction simulation software. Each signal processing unit includes an interference signal generating device, a navigation signal generating device, an inertial navigation signal generating device, and a combined navigation receiver device. The above-mentioned signal generating device can be a hardware device or a software module for simulating the device. Each signal generating device and the combined navigation receiver device establish a communication connection with the simulation software. The simulation software can perform real-time signal generation control on them by sending control instructions. The signal output of each signal generating device in the same signal processing unit is connected to the corresponding combined navigation receiver device, so that it can perform satellite navigation and inertial navigation solution on the input signal. The positioning result of the combined navigation receiver device is reported to the simulation software in real time. One signal processing unit can simulate a target flight equipment.
[0059] In the virtual scene of the simulation software, several target flight equipment and jamming equipment are deployed and set. A combined navigation receiver is deployed on the target flight equipment, and a jamming transmitter is deployed on the jamming equipment. The navigation point trajectory of the target flight equipment is set, the error of the inertial navigation sensor is set, the trajectory of the jamming equipment is set, the jamming parameters and transmission power of the jamming transmitter (including suppression jamming and deception jamming) of the jamming equipment are set, and the deception trajectory and transmission power of the deception jamming are set.
[0060] After the simulation starts, the simulation program updates the simulation at a fixed simulation time interval, and calculates the simulation data of the target flight equipment and each device on the equipment in the virtual scene at each simulation update moment. In this complex environment, the target flight equipment runs in space according to the set trajectory, and the combined navigation receiver on it receives satellite navigation signals, inertial navigation signals, and suppression and deception interference signals with errors. The positioning output result is bound to deviate from its actual position.
[0061] In response to the above technical issues, such as Figure 2 As shown, a preferred embodiment of the present application provides a trajectory generation method for a navigation simulation system, comprising the steps of:
[0062] S1. Continuously calculate the predetermined navigation point trajectory of the target flight equipment according to the preset parameters of the navigation point trajectory of the scene;
[0063] S2, real-time acquisition of positioning solution results reported by the integrated navigation receiver device deployed on the target flight equipment and prediction of the positioning position;
[0064] S3, adjusting the flight direction and speed of the target flight equipment itself in real time according to the predicted positioning position and the predetermined navigation point trajectory, and generating real trajectory points of the target flight equipment in real time, including position, speed, acceleration, attitude angle, and attitude angular velocity;
[0065] S4. At each simulation update time during the simulation, the above steps are repeated recursively to obtain all the real trajectory points of the target flight equipment, and finally a 6-DOF second-order smooth real dynamic trajectory of the target flight equipment is generated in real time.
[0066] The method provided in this embodiment estimates the positioning of the combined navigation receiver device of the target flight equipment, and then obtains the real dynamic trajectory of the target flight equipment according to the dynamic correction of the actual flight trajectory of the predetermined navigation point trajectory. The generated trajectory and attitude are smooth and can be used for the control generation of real-time signals. This method can be used in the navigation simulation system to simulate the deviation between the real dynamic trajectory of the target flight equipment and the predetermined navigation point trajectory when the target flight equipment has inertial navigation sensor errors, inertial navigation cumulative errors, suppression interference, deception interference, and positioning deviations caused by the combined navigation receiver device itself. By setting different forms of interference, inertial navigation errors, and positioning performance of the combined navigation receiver device, it is convenient to analyze the influence of different factors and combinations of different factors on the deviation of the flight trajectory of the target flight equipment, which is conducive to analyzing how to make the opponent's target flight equipment have trajectory deviations and lure the opponent's target flight equipment to a specified trajectory in a complex navigation environment, and how to avoid being affected by the opponent's interference, thereby improving the use value and authenticity of the entire simulation system.
[0067] like Figure 3 As shown, in another preferred embodiment of the present application, the step S1 comprises the following specific steps:
[0068] S11, setting navigation point trajectory parameters in the scene, wherein the navigation point trajectory is composed of multiple navigation points, and each navigation point includes the following information: position, speed, and turning radius;
[0069] S12. When calculating the predetermined navigation point trajectory of the target flight equipment, the current trajectory position moves forward at a set speed along the geodetic line from the first navigation point position to the second navigation point position. When reaching the second navigation point, it turns according to the set turning radius, and after the forward direction points to the third navigation point, it stops turning and moves forward to the third navigation point position in the same way, and so on, thereby continuously generating a position, speed, and acceleration of a predetermined navigation point trajectory at each simulation update moment.
[0070] This embodiment continuously calculates the predetermined navigation point trajectory of the target flight equipment through steps S11 and S12, and continuously generates the position, speed, and acceleration of a predetermined navigation point trajectory. The advantage is that using the turning radius for calculation can make the trajectory turns smooth.
[0071] like Figure 4As shown, in another preferred embodiment of the present application, the step S1 specifically further includes the steps of:
[0072] S13. During the simulation process, the navigation point trajectory parameters allow for real-time control modification by humans in the loop, including a navigation point position, speed, turning radius, deletion of navigation points, and addition of new navigation points. The trajectory parameters of navigation points that have already passed through the navigation point position are prohibited from being modified.
[0073] The navigation point trajectory parameters in this embodiment allow for real-time control modification by humans in the loop. The humans in the loop means that the operator still has the opportunity to make a second or uninterrupted instruction correction after the first instruction input. Therefore, in the simulation process, the relevant parameters can still be adjusted as needed in this embodiment to improve the flexibility and adaptability of the simulation. Of course, the trajectory parameters of the navigation points that have already passed the navigation point position cannot be modified, because the navigation points that have already passed cannot affect the calculation of subsequent trajectories.
[0074] like Figure 5 In another preferred embodiment of the present application, step S2 specifically includes:
[0075] S21, at each simulation update time, after performing noise elimination and trajectory smoothing on the position and speed reported by the integrated navigation receiver device through the Kalman trajectory prediction algorithm, the predicted position of the integrated navigation receiver device is calculated tp , prediction speed tv , get the predicted positioning position of the integrated navigation receiver at the current moment p r .
[0076] In this embodiment, the Kalman trajectory prediction algorithm is used to eliminate noise and smooth the trajectory of the position and speed reported by the integrated navigation receiver device, and then the predicted position of the integrated navigation receiver device is calculated. tp , prediction speed tv , get the predicted positioning position of the integrated navigation receiver at the current moment p r The advantage is that general receivers will have some random positioning errors. Kalman trajectory prediction can eliminate some errors and make the trajectory position and speed of the receiver smoother, making subsequent processing less affected by errors.
[0077] like Figure 6 As shown, in another preferred embodiment of the present application, the step S2 specifically further includes the steps of:
[0078] S22: predicting the current position of the integrated navigation receiver device p r To make corrections:
[0079] in, d is the control delay between the simulation time of the entire simulation system and the time of the hardware signal generation system, d The smaller it is, the higher the prediction accuracy is.
[0080] Since there is a fixed control delay between the simulation time of the entire simulation software system and the time of the hardware signal generation system, the present embodiment predicts the current position of the integrated navigation receiver device according to the delay. p r Corrections were made, which effectively improved the calculation accuracy of the predicted positioning position and provided reliable data support for the accurate calculation of the subsequent real dynamic trajectory.
[0081] In a preferred embodiment of the present application, step S3 specifically includes the following steps:
[0082] S31, in order to simulate the target flight equipment to adjust its own flight direction and speed in real time according to its own positioning state and the predetermined navigation point trajectory, the next follow position of the trajectory is set to: , the following position represents the virtual position followed by the flight equipment, which is affected by the deviation between the predicted positioning position and the predetermined trajectory position; the time to reach the next following position is estimated as: ,in Indicates speed Starting from the current position, at speed Estimation of the time interval required to reach the following position; Establishment of trajectory polynomial:
[0083]
[0084]
[0085] in: are 7 unknown three-dimensional vectors, Represent position, velocity, and acceleration respectively, which are three-dimensional vectors. At the initial simulation moment, the real trajectory point coincides with the corresponding predetermined navigation point trajectory. At the subsequent simulation moments, the state of the real trajectory point at the previous simulation moment is recursively deduced. Let t1 be the time of the previous simulation moment. dt is the simulation interval, and the position of the actual running trajectory of the target flight equipment at the previous moment t1 is calculated as , the speed is , the acceleration is , calculate the position of the predetermined navigation point trajectory at the current time t1+dt as , the speed is , the acceleration is ; The predicted positioning position reported by the corresponding integrated navigation receiver device is pr ;
[0086] S32, to ensure that the position, velocity and acceleration of the trajectory polynomial are Moment and Overlap, in Moment and coincide,
[0087] Set up the system of equations:
[0088] The matrix can be obtained:
[0089] Solve the equation: , we can get the solution ;
[0090] Solve the equation: , we can get the solution of the equation ;
[0091] Solve the equation: , we can get the solution of the equation ;
[0092] Among them, the subscript Represents a vector Component, W Combining the components, we can get the solution to the equation: ;
[0093] S33. Substitute the solution of the equation into the polynomial: , then the position of the real dynamic trajectory of the target flight equipment at the current moment is , the speed is , the acceleration is ;
[0094] S34, calculating the attitude of the real dynamic trajectory of the target flight equipment at the current moment, including: and upward Calculate the attitude angle of the target flight equipment in the northeast celestial coordinate system, and calculate the attitude angular velocity by the second-order central difference method of the attitude angle. In the body coordinate system of the target flight equipment, set the forward direction of the target flight equipment Always point in the direction of speed; the upward direction of the target flight equipment Calculate it in the following way: Calculate the celestial direction of the real dynamic trajectory position in ECEF coordinates at the current moment as , In The projection onto the plane with φ as the normal direction is the upward direction of the target flight equipment.
[0095] This embodiment realizes the calculation of the real trajectory points of the target flight equipment through steps S31 to S34, achieves the effect of real-time trajectory adjustment according to the equipment positioning status, and supports the human in the loop to change the preset trajectory in real time; the algorithm simulates the flight control principle of real flight equipment, and uses the current trajectory state to continuously iterate and calculate the subsequent trajectory state through the comprehensive equipment positioning status and preset trajectory through the sixth-order polynomial position equation.
[0096] At the same time, the real trajectory points calculated by the method of this embodiment are second-order smooth because the trajectory position equation is a polynomial about time and is second-order differentiable. Therefore, it meets the kinematic requirements of the inertial navigation simulation for the trajectory and ensures the high accuracy of the inertial navigation simulation.
[0097] like Figure 7 As shown, in another preferred embodiment of the present application, the trajectory generation method of the navigation simulation system further includes the steps of:
[0098] S5, during the simulation, the predetermined navigation point trajectory, the real dynamic trajectory, and the predicted positioning position of the target flight equipment are visualized and drawn respectively to facilitate the observation of the influence of various interference factors on the trajectory of the target flight equipment.
[0099] This embodiment visualizes the predetermined navigation point trajectory, real dynamic trajectory, and predicted positioning position of the target flight equipment during the simulation process, thereby facilitating intuitive observation and analysis of the impact of various interference factors on the trajectory of the target flight equipment, thereby accurately, quickly, and intuitively knowing the actual operating effects of the real simulated equipment under various interference conditions, and providing a reliable basis for actual navigation conditions.
[0100] like Figure 8 As shown, another preferred embodiment of the present application further provides a trajectory generating device of a navigation simulation system, comprising:
[0101] A predetermined navigation point trajectory calculation module is used to continuously calculate the predetermined navigation point trajectory of the target flight equipment according to the preset parameters of the navigation point trajectory of the scene;
[0102] The predicted positioning position calculation module is used to obtain the positioning solution results reported by the integrated navigation receiver device deployed on the target flight equipment in real time and predict the positioning position;
[0103] A real trajectory point generation module is used to adjust the flight direction and speed of the target flight equipment in real time according to the predicted positioning position and the predetermined navigation point trajectory, and to generate the real trajectory points of the target flight equipment in real time, including position, speed, acceleration, attitude angle, and attitude angular velocity;
[0104] The real dynamic trajectory generation module is used to repeat the above steps to recursively obtain all the real trajectory points of the target flight equipment at each simulation update moment during the simulation, and finally generate a 6-DOF second-order smooth real dynamic trajectory of the target flight equipment in real time.
[0105] In another preferred embodiment of the present application, the trajectory generating device of the navigation simulation system further comprises:
[0106] The visualization drawing module is used to visualize the predetermined navigation point trajectory, real dynamic trajectory, and predicted positioning position of the target flight equipment during the simulation process, so as to facilitate the observation of the impact of various interference factors on the trajectory of the target flight equipment.
[0107] like Fig. 9 As shown, a preferred embodiment of the present application also provides an electronic device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of the trajectory generation method of the navigation simulation system in the above-mentioned embodiment when executing the computer program.
[0108] like Fig.10 As shown, the preferred embodiment of the present application also provides a computer device, which can be a terminal or a liveness detection server, and its internal structure diagram can be as shown in Fig.10 As shown. The computer device includes a processor, a memory and a network interface connected through a system bus. Among them, the processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system and a computer program. The internal memory provides an environment for the operation of the operating system and the computer program in the non-volatile storage medium. The network interface of the computer device is used to communicate with other external computer devices through a network connection. When the computer program is executed by the processor, the steps of the trajectory generation method of the above-mentioned navigation simulation system are implemented.
[0109] Those skilled in the art will understand that Fig.10 The structure shown in the figure is only a block diagram of a part of the structure related to the solution of the present application, and does not constitute a limitation on the computer device to which the solution of the present application is applied. The specific computer device may include more or fewer components than those shown in the figure, or combine certain components, or have a different arrangement of components.
[0110] A preferred embodiment of the present application further provides a storage medium, which includes a stored program, and when the program is executed, controls the device where the storage medium is located to execute the steps of the trajectory generation method of the navigation simulation system in the above embodiment.
[0111] It should be noted that the steps shown in the flowcharts of the accompanying drawings can be executed in a computer system such as a set of computer executable instructions, and that, although a logical order is shown in the flowcharts, in some cases, the steps shown or described can be executed in an order different from that shown here.
[0112] If the functions described in the method of this embodiment are implemented in the form of software functional units and sold or used as independent products, they can be stored in one or more computing devices readable storage media. Based on this understanding, the part of the embodiment of the present application that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, which is stored in a storage medium and includes several instructions for a computing device (which can be a personal computer, server, mobile computing device or network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present application. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk and other media that can store program code.
[0113] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Moreover, the present application may adopt the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program codes. The schemes in the embodiments of the present application may be implemented in various computer languages, for example, object-oriented programming language Java and literal scripting language JavaScript, etc.
[0114] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0115] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.
[0116] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.
[0117] Although the preferred embodiments of the present application have been described, those skilled in the art may make other changes and modifications to these embodiments once they have learned the basic creative concept. Therefore, the appended claims are intended to be interpreted as including the preferred embodiments and all changes and modifications falling within the scope of the present application.
[0118] Obviously, those skilled in the art can make various changes and modifications to the present application without departing from the spirit and scope of the present application. Thus, if these modifications and variations of the present application fall within the scope of the claims of the present application and their equivalents, the present application is also intended to include these modifications and variations.
Claims
1. A trajectory generation method for a navigation simulation system, characterized in that: Includes steps: S1. Continuously calculate the predetermined navigation point trajectory of the target flight equipment according to the preset parameters of the navigation point trajectory of the scene; S2, real-time acquisition of positioning solution results reported by the integrated navigation receiver device deployed on the target flight equipment and prediction of the positioning position; S3, adjusting the flight direction and speed of the target flight equipment itself in real time according to the predicted positioning position and the predetermined navigation point trajectory, and generating real trajectory points of the target flight equipment in real time, including position, speed, acceleration, attitude angle, and attitude angular velocity, specifically comprising the steps of: S31, in order to simulate the target flight equipment to adjust its own flight direction and speed in real time according to its own positioning state and the predetermined navigation point trajectory, the next follow position of the trajectory is set to: m = p + (p o -p r ), the time to reach the next follow position is estimated as: Create the trajectory polynomial: in: are 7 unknown three-dimensional vectors, S(t), V(t), and A(t) represent position, velocity, and acceleration respectively, and are three-dimensional vectors. At the initial simulation moment, the real trajectory point coincides with the corresponding predetermined navigation point trajectory. At the subsequent simulation moments, the state of the real trajectory point at the previous simulation moment is recursively deduced. Let t1 be the time of the previous simulation moment, dt be the simulation interval, and the position of the real running trajectory of the target flight equipment at the previous moment t1 is calculated as p, the velocity is v, and the acceleration is a. The position of the predetermined navigation point trajectory at the current moment t1+dt is calculated as p o , the speed is v o , the acceleration is a o ; The predicted positioning position reported by the corresponding integrated navigation receiver device is p r ; S32, to ensure that the position, velocity, and acceleration of the trajectory polynomial coincide with p, v, and a at t = t1, and coincide with m, v at t = t2 o , a o Overlap and establish the system of equations: S(t1)=p,S(t2)=m,V(t1)=v,V(t2)=v o ,A(t1)=A,A(t2)=a o The matrix can be obtained: Solve the equation: The solution is available Solve the equation: The solution to the equation is Solve the equation: The solution to the equation is Where the subscripts x, y, and z represent the x, y, and z components of the vector. Combining the x, y, and z components of w gives the solution to the equation: S33. Substitute the solution of the equation into the polynomial: S(t), V(t), A(t), then the position of the real dynamic trajectory of the target flight equipment at the current moment is S(t1+dt), the speed is V(t1+dt), and the acceleration is A(t1+dt); S34, calculating the attitude of the real dynamic trajectory of the target flight equipment at the current moment, including: and upward Calculate the attitude angle of the target flight equipment in the northeast celestial coordinate system, and calculate the attitude angular velocity by the second-order central difference method of the attitude angle. In the body coordinate system of the target flight equipment, set the forward direction of the target flight equipment Always point in the direction of speed; the upward direction of the target flight equipment Calculate it in the following way: Calculate the celestial direction of the real dynamic trajectory position in ECEF coordinates at the current moment as In The projection on the plane with the normal direction is the upward direction of the target flight equipment; S4. At each simulation update time during the simulation, the above steps are repeated recursively to obtain all the real trajectory points of the target flight equipment, and finally a 6-DOF second-order smooth real dynamic trajectory of the target flight equipment is generated in real time.
2. The trajectory generation method of the navigation simulation system according to claim 1, characterized in that: The specific steps of step S1 are as follows: S11, setting navigation point trajectory parameters in the scene, wherein the navigation point trajectory is composed of multiple navigation points, and each navigation point includes the following information: position, speed, and turning radius; S12. When calculating the predetermined navigation point trajectory of the target flight equipment, the current trajectory position moves forward at a set speed along the geodetic line from the first navigation point position to the second navigation point position. When reaching the second navigation point, it turns according to the set turning radius, and after the forward direction points to the third navigation point, it stops turning and moves forward to the third navigation point position in the same way, and so on, thereby continuously generating a position, speed, and acceleration of a predetermined navigation point trajectory at each simulation update moment.
3. The trajectory generation method of the navigation simulation system according to claim 2, characterized in that: The step S1 specifically further comprises the steps of: S13. During the simulation process, the navigation point trajectory parameters allow for real-time control modification by humans in the loop, including a navigation point position, speed, turning radius, deletion of navigation points, and addition of new navigation points. The trajectory parameters of navigation points that have already passed through the navigation point position are prohibited from being modified.
4. The trajectory generation method of the navigation simulation system according to claim 1, characterized in that: The step S2 specifically includes: S21, at each simulation update time, after eliminating noise and smoothing the trajectory of the position and speed reported by the integrated navigation receiver device through the Kalman trajectory prediction algorithm, calculate the predicted position tp and predicted speed tv of the integrated navigation receiver device to obtain the predicted positioning position p of the integrated navigation receiver device at the current moment r .
5. The trajectory generation method of the navigation simulation system according to claim 4, characterized in that: The step S2 specifically further comprises the steps of: S22, predicting the current positioning position p of the integrated navigation receiver device r To make corrections: p r =tp+tv*d Where d is the control delay between the simulation time of the entire simulation system and the time of the hardware signal generation system. The smaller d is, the higher the prediction accuracy is.
6. The trajectory generation method of the navigation simulation system according to claim 1, characterized in that: Also includes the steps: S5, during the simulation, the predetermined navigation point trajectory, the real dynamic trajectory, and the predicted positioning position of the target flight equipment are visualized and drawn respectively to facilitate the observation of the influence of various interference factors on the trajectory of the target flight equipment.
7. A trajectory generating device for a navigation simulation system, characterized in that: include: A predetermined navigation point trajectory calculation module is used to continuously calculate the predetermined navigation point trajectory of the target flight equipment according to the preset parameters of the navigation point trajectory of the scene; The predicted positioning position calculation module is used to obtain the positioning solution results reported by the integrated navigation receiver device deployed on the target flight equipment in real time and predict the positioning position; The real trajectory point generation module is used to adjust the flight direction and speed of the target flight equipment in real time according to the predicted positioning position and the predetermined navigation point trajectory, and to generate the real trajectory points of the target flight equipment in real time, including position, speed, acceleration, attitude angle, and attitude angular velocity, and is specifically used for: In order to simulate the target flight equipment to adjust its own flight direction and speed in real time according to its own positioning state and the predetermined navigation point trajectory, the next follow position of the trajectory is set to: m = p + (p o -p r ), the time to reach the next follow position is estimated as: Create the trajectory polynomial: in: are 7 unknown three-dimensional vectors, S(t), V(t), and A(t) represent position, velocity, and acceleration respectively, and are three-dimensional vectors. At the initial simulation moment, the real trajectory point coincides with the corresponding predetermined navigation point trajectory. At the subsequent simulation moments, the state of the real trajectory point at the previous simulation moment is recursively deduced. Let t1 be the time of the previous simulation moment, dt be the simulation interval, and the position of the real running trajectory of the target flight equipment at the previous moment t1 is calculated as p, the velocity is v, and the acceleration is a. The position of the predetermined navigation point trajectory at the current moment t1+dt is calculated as p o , the speed is v o , the acceleration is a o ; The predicted positioning position reported by the corresponding integrated navigation receiver device is p r ; To ensure that the position, velocity, and acceleration of the trajectory polynomial coincide with p, v, and a at t = t1, and coincide with m, v at t = t2, o , a o Overlap and establish the system of equations: S(t1)=p,S(t2)=m,V(t1)=v,V(t2)=v o ,A(t1)=A,A(t2)=a o The matrix can be obtained: Solve the equation: The solution is available Solve the equation: The solution to the equation is Solve the equation: The solution to the equation is Where the subscripts x, y, and z represent the x, y, and z components of the vector. Combining the x, y, and z components of w gives the solution to the equation: Substitute the solution of the equation into the polynomial: S(t), V(t), A(t), then the position of the real dynamic trajectory of the target flight equipment at the current moment is S(t1+dt), the speed is V(t1+dt), and the acceleration is A(t1+dt); Calculate the attitude of the target flight equipment based on its real dynamic trajectory at the current moment, including: and upward Calculate the attitude angle of the target flight equipment in the northeast celestial coordinate system, and calculate the attitude angular velocity by the second-order central difference method of the attitude angle. In the body coordinate system of the target flight equipment, set the forward direction of the target flight equipment Always point in the direction of speed; the upward direction of the target flight equipment Calculate it in the following way: Calculate the celestial direction of the real dynamic trajectory position in ECEF coordinates at the current moment as In The projection on the plane with the normal direction is the upward direction of the target flight equipment; The real dynamic trajectory generation module is used to repeat the above steps to recursively obtain all the real trajectory points of the target flight equipment at each simulation update moment during the simulation, and finally generate a 6-DOF second-order smooth real dynamic trajectory of the target flight equipment in real time.
8. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the steps of the trajectory generation method of the navigation simulation system according to any one of claims 1 to 6 are implemented.
9. A storage medium comprising a stored program, characterized in that: When the program is running, the device where the storage medium is located is controlled to execute the steps of the trajectory generation method of the navigation simulation system as claimed in any one of claims 1 to 6.
