A target motion state estimation method for unmanned aerial vehicles
Through the method based on the target positioning algorithm, GPS, GLONASS and Beidou satellite navigation systems are used to estimate the drone's target motion state, which solves the problems of high hardware costs and poor stability in the existing technology, and achieves low resource consumption and fast response The target motion state estimate is suitable for small drone reconnaissance platforms.
Patent Information
- Application Number
- CN202410407477.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-04-07
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-04-07
AI Technical Summary
Existing drones rely on high computing chips and complex peripheral circuits in estimating target motion states, resulting in high hardware costs, poor stability and difficult maintenance, making it difficult to apply to small drone reconnaissance platforms with limited resources.
Using a method based on target positioning algorithm, the target position information is filtered, the latitude and longitude difference is calculated, the Cartesian coordinate system is established, the heading angle and driving trajectory are predicted, and the dependence on high computing power and complex hardware is reduced. GPS, GLONASS and Beidou satellite are used. Navigation system for positioning.
It realizes target motion state estimation with low resource consumption, fast response and high stability, reduces hardware costs and application thresholds, is suitable for resource-constrained drone systems, and improves tracking accuracy and reliability.
Smart Images

Figure CN118276143B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of unmanned aerial vehicle (UAV) reconnaissance, and in particular, relates to a target motion state estimation method applied to an unmanned aerial vehicle (UAV). Background Art
[0002] In recent years, with the tactical application of drones, small drones can already realize the settlement function of accurate target position information for the measured targets. In order to analyze the observed targets more intuitively and comprehensively, more accurate target information is needed, which includes the dynamic information of the target, such as heading angle, driving speed, and even estimation and prediction of the target's driving trajectory. To solve such problems, most manufacturers will use chips with powerful computing power to perform AI recognition on the target and image matrix settlement to estimate the target's heading and speed. This not only increases the hardware cost and application threshold, but also greatly reduces the stability of the product and increases the difficulty of maintenance. Moreover, the size of domestic high-computing power chips is too complicated, and the peripheral circuits are also subject to high-cost environmental screening, making it difficult to apply them to small drone reconnaissance platforms with limited space. Summary of the invention
[0003] In view of the above problems, the present invention proposes a target motion state estimation method applied to unmanned aerial vehicles. Based on the target positioning algorithm, the target position information is scientifically filtered and selected, and then the target's driving speed is calculated by settling the deviation values of longitude and latitude. In order to more intuitively reflect the dynamic information of the target, the heading angle prediction on the image is performed, thereby achieving comprehensive settlement of the target's dynamic information.
[0004] The present invention is achieved through the following technical solutions:
[0005] A method for estimating the motion state of a target applied to a drone: The method specifically comprises the following steps:
[0006] Step 1, continuously obtain target location information through the positioning system;
[0007] Step 2, removing the height information in the position information of step 1 and performing filtering processing;
[0008] Step 3, calculate the difference between longitude and latitude, establish a rectangular coordinate system to calculate the heading angle; mark the predicted heading angle on the image, and predict the target's trajectory based on its heading and speed.
[0009] Furthermore, in step 1,
[0010] The positioning system includes GPS, GLONASS and BeiDou satellite navigation systems;
[0011] The target location information includes the speed, longitude and latitude information of the target, and the positioning system collects the longitude and latitude information of the target at fixed intervals.
[0012] Furthermore, in step 2,
[0013] After removing the altitude information, the Kalman filter algorithm is used to process the longitude and latitude data to reduce the noise and outliers caused by equipment errors and environmental factors.
[0014] Furthermore, in step 3,
[0015] Combined with the difference of 1 degree of longitude and latitude being 111 km, when the interval collected in step 1 is short enough, we have:
[0016] Calculate the target longitude difference information:
[0017]
[0018] Calculate the target latitude difference information:
[0019] M E =(M N -M O )×60×1852
[0020] Among them, M O is the latitude information of the original target before sampling, U O is the longitude information of the original target before sampling, M N is the latitude information of the new target after sampling, U N It is the longitude information of the new target after sampling;
[0021] A rectangular coordinate system is established with the original position of the target as the center, due north as the positive and negative direction of the Y axis, and due east as the positive direction of the X axis. That is, the current target coordinates are (U E , M E ).
[0022] Furthermore, when the interval collected in step 1 is short enough and the influence of altitude is removed, the heading angle problem can be regarded as a trigonometric function problem;
[0023] The heading angle is calculated as follows:
[0024]
[0025] Then the target's travel distance L and speed V within the sampling period S are calculated:
[0026]
[0027]
[0028] Finally, the heading of the target is predicted and represented on the image, and the heading angle β of the target relative to the earth coordinate system is calculated. O and the actual heading angle β of the target; through these two angles, their difference β is obtained E , that is, the expected heading angle of the target on the image plane; with the center of the image as the base point, draw an arrow representing this heading with an angle of β E , thereby obtaining the predicted heading of the target;
[0029] β E =β-β O .
[0030] An estimation system for a target motion state estimation method applied to an unmanned aerial vehicle:
[0031] The estimation system includes an acquisition module, a filtering module and an estimation module:
[0032] The acquisition module continuously acquires target location information through a positioning system;
[0033] The filtering module removes the height information collected by the collection module and performs filtering processing;
[0034] The estimation module calculates the difference between longitude and latitude, establishes a rectangular coordinate system to calculate the heading angle, and marks the predicted heading angle on the image, and predicts the target's driving trajectory according to its heading and speed.
[0035] An electronic device comprises a memory and a processor, wherein the memory stores a computer program, and the processor implements the steps of the above method when executing the computer program.
[0036] A computer-readable storage medium is used to store computer instructions, and when the computer instructions are executed by a processor, the steps of the above method are implemented.
[0037] Beneficial effects of the present invention
[0038] The present invention includes at least the following advantages:
[0039] Low resource consumption: It does not rely on complex image recognition AI processing, which can reduce computing resource consumption and is suitable for resource-constrained UAV systems.
[0040] Fast response: The processing process is simplified, and the target's motion state can be estimated and tracked more quickly, which is helpful for applications with high real-time requirements.
[0041] Easy to implement: Easy to implement on a variety of UAV systems, without the need for complex algorithm support or advanced hardware.
[0042] Stability: In an environment where the terrain height does not change much, the method of calculating the difference between longitude and latitude is more stable than relying on visual information, because visual tracking is easily affected by environmental factors such as lighting and weather.
[0043] Flexibility: This method can be combined with other systems (such as visual tracking, radar system) as an auxiliary means to improve the overall tracking accuracy and reliability.
[0044] That is, the present invention performs target position data analysis through a target positioning algorithm, discards target altitude information on the basis of sampling millisecond-level sampling calculation time, performs filtering analysis on the target longitude and latitude, and combines the navigation and map drawing conventional data that 1 degree of longitude and latitude is approximately 111 km. It can estimate and predict the information of designated specific targets through the photoelectric stabilized reconnaissance equipment carried by the unmanned aerial vehicle, thereby achieving a more accurate understanding of the target's motion trajectory and trend. In the case of short-term target tracking or tracking targets where the terrain height fluctuations are not large, it is possible to locate and track targets without the aid of image recognition AI functions, which can lower the application threshold and reduce hardware costs for unmanned aerial vehicles. BRIEF DESCRIPTION OF THE DRAWINGS
[0045] Figure 1 The present invention is a flow chart of the method.
[0046] Figure 2 It is a schematic diagram of the coordinate system of the present invention. DETAILED DESCRIPTION
[0047] The technical solutions in the embodiments of the present invention will be described clearly and completely below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0048] Combination Figure 1 to Figure 2 .
[0049] A target motion state estimation method applied to UAV:
[0050] The method specifically comprises the following steps:
[0051] Step 1, continuously obtain target location information through the positioning system;
[0052] The positioning system includes GPS, GLONASS and BeiDou satellite navigation systems;
[0053] The target location information includes the speed, longitude and latitude information of the target, and the positioning system collects the longitude and latitude information of the target at fixed intervals.
[0054] Step 2, removing the height information in the position information of step 1 and performing filtering processing;
[0055] After removing the altitude information, the Kalman filter algorithm is used to process the longitude and latitude data to reduce the noise and outliers caused by equipment errors and environmental factors. (Or use a particle filter or other filtering algorithm to process the longitude and latitude information to reduce the impact of noise and improve the accuracy of the data.)
[0056] In the embodiment, the target speed is 300km / h (about 0.08km / s, estimated at 0.1km / s), and combined with the difference of 1 degree of longitude and latitude of 111km, the maximum latitude difference per second is calculated to be ≤0.001 degree, and the obviously wrong data is removed according to the sampling time. (If the sampling time is 100ms, you can compare whether the data before and after exceed 0.0001 degree)
[0057] Step 3, calculate the difference between longitude and latitude, establish a rectangular coordinate system to calculate the heading angle; mark the predicted heading angle on the image, and predict the target's trajectory based on its heading and speed.
[0058] Combined with the difference of 1 degree of longitude and latitude being 111 km, when the interval collected in step 1 is short enough, we have:
[0059] Calculate the target longitude difference information:
[0060]
[0061] The change in longitude is converted to meters by multiplying the change in longitude by 60*1852. Here, 1 degree of longitude at the equator is approximately equal to 60 nautical miles, and 1 nautical mile is equal to 1852 meters.
[0062] Calculate the target latitude difference information:
[0063] M E =(M N -M O )×60×1852
[0064] Among them, M O is the latitude information of the original target before sampling, U O is the longitude information of the original target before sampling, M N is the latitude information of the new target after sampling, U N is the longitude information of the new target after sampling; the resolution is °;
[0065] A rectangular coordinate system is established with the original position of the target as the center, due north as the positive and negative direction of the Y axis, and due east as the positive direction of the X axis. That is, the current target coordinates are (U E , M E ).
[0066] When the interval collected in step 1 is short enough and the influence of altitude is removed, the heading angle problem can be regarded as a trigonometric function problem;
[0067] The heading angle is calculated as follows:
[0068]
[0069] Then the target's travel distance L and speed V within the sampling period S are calculated:
[0070]
[0071]
[0072] Finally, the heading of the target is predicted and represented on the image, and the heading angle β of the target relative to the earth coordinate system is calculated. O and the actual heading angle β of the target; through these two angles, their difference β is obtained E , that is, the expected heading angle of the target on the image plane; with the center of the image as the base point, draw an arrow representing this heading with an angle of β E , thereby obtaining the predicted heading of the target;
[0073] β E =β-β O .
[0074] A target motion state estimation system applied to UAV:
[0075] The estimation system includes an acquisition module, a filtering module and an estimation module:
[0076] The acquisition module continuously acquires target location information through a positioning system;
[0077] The filtering module removes the height information collected by the collection module and performs filtering processing;
[0078] The estimation module calculates the difference between longitude and latitude, establishes a rectangular coordinate system to calculate the heading angle, and marks the predicted heading angle on the image, and predicts the target's driving trajectory according to its heading and speed.
[0079] An electronic device comprises a memory and a processor, wherein the memory stores a computer program, and the processor implements the steps of the above method when executing the computer program.
[0080] A computer-readable storage medium is used to store computer instructions, and when the computer instructions are executed by a processor, the steps of the above method are implemented.
[0081] The memory in the embodiments of the present application may be a volatile memory or a non-volatile memory, or may include both volatile and non-volatile memories. Among them, the non-volatile memory may be a read-only memory, ROM, a programmable read-only memory, PROM, an erasable programmable read-only memory, EPROM, an electrically erasable programmable read-only memory, EEPROM, or a flash memory. The volatile memory may be a random access memory, RAM, which is used as an external cache. By way of example but not limitation, many forms of RAM are available, such as static random access memory static RAM, SRAM, dynamic random access memory dynamic RAM, DRAM, synchronous dynamic random access memory synchronous DRAM, SDRAM, double data rate synchronous dynamic random access memory double data rate SDRAM, DDR SDRAM, enhanced synchronous dynamic random access memory enhanced SDRAM, ESDRAM, synchronous link dynamic random access memory synchlink DRAM, SLDRAM, and direct memory bus random access memory direct rambus RAM, DR RAM. It should be noted that memory of the methods described herein is intended to include, but is not limited to, these and any other suitable types of memory.
[0082] In the above embodiments, it can be implemented in whole or in part by software, hardware, firmware or any combination thereof. When implemented by software, it can be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions. When the computer instructions are loaded and executed on a computer, the process or function described in the embodiment of the present application is generated in whole or in part. The computer can be a general-purpose computer, a special-purpose computer, a computer network, or other programmable device. The computer instructions can be stored in a computer-readable storage medium, or transmitted from one computer-readable storage medium to another computer-readable storage medium. For example, the computer instructions can be transmitted from a website site, computer, server or data center through a wired method such as coaxial cable, optical fiber, digital subscriber line digital subscriber line, DSL or wireless such as infrared, wireless, microwave, etc. to another website site, computer, server or data center. The computer-readable storage medium can be any available medium that can be accessed by a computer or a data storage device such as a server or data center that includes one or more available media integrated. The available medium can be a magnetic medium such as a floppy disk, a hard disk, a tape, an optical medium such as a high-density digital video disc digital video disc, DVD, or a semiconductor medium such as a solid state hard disk solid state disc, SSD, etc.
[0083] In the implementation process, each step of the above method can be completed by an integrated logic circuit of hardware in a processor or an instruction in the form of software. The steps of the method disclosed in conjunction with the embodiment of the present application can be directly embodied as a hardware processor for execution, or a combination of hardware and software modules in a processor for execution. The software module can be located in a storage medium mature in the art such as a random access memory, a flash memory, a read-only memory, a programmable read-only memory or an electrically erasable programmable memory, a register, etc. The storage medium is located in a memory, and the processor reads the information in the memory and completes the steps of the above method in conjunction with its hardware. To avoid repetition, it is not described in detail here.
[0084] It should be noted that the processor in the embodiment of the present application can be an integrated circuit chip with signal processing capabilities. In the implementation process, each step of the above method embodiment can be completed by an integrated logic circuit of hardware in the processor or an instruction in the form of software. The above processor can be a general-purpose processor, a digital signal processor DSP, an application-specific integrated circuit ASIC, a field programmable gate array FPGA or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components. The methods, steps and logic block diagrams disclosed in the embodiments of the present application can be implemented or executed. The general-purpose processor can be a microprocessor or the processor can also be any conventional processor, etc. The steps of the method disclosed in the embodiment of the present application can be directly embodied as a hardware decoding processor to perform, or the hardware and software modules in the decoding processor can be combined to perform. The software module can be located in a mature storage medium in the field such as a random access memory, a flash memory, a read-only memory, a programmable read-only memory or an electrically erasable programmable memory, a register, etc. The storage medium is located in a memory, and the processor reads the information in the memory and completes the steps of the above method in combination with its hardware.
[0085] The above is a detailed introduction to a target motion state estimation method for a drone proposed in the present invention, and the principles and implementation methods of the present invention are explained. The description of the above embodiments is only used to help understand the method of the present invention and its core idea; at the same time, for those skilled in the art, according to the idea of the present invention, there will be changes in the specific implementation method and application scope. In summary, the content of this specification should not be understood as limiting the present invention.
Claims
1. A method for estimating target motion state applied to an unmanned aerial vehicle, characterized in that: The method specifically comprises the following steps: Step 1, continuously obtain target location information through the positioning system; Step 2, removing the height information in the position information of step 1 and performing filtering processing; After removing the altitude information, the Kalman filter algorithm is used to process the latitude and longitude data to reduce the noise and outliers caused by equipment errors and environmental factors; Step 3, calculate the difference between longitude and latitude, establish a rectangular coordinate system to calculate the heading angle; mark the predicted heading angle on the image, and predict the target's trajectory based on its heading and speed; Combined with the difference of 1 degree of longitude and latitude being 111 km, when the interval collected in step 1 reaches the millisecond level, we have: Calculate the target longitude difference information: Calculate the target latitude difference information: M E =(M N -M O )×60×1852 Among them, M O is the latitude information of the original target before sampling, U O is the longitude information of the original target before sampling, M N is the latitude information of the new target after sampling, U N It is the longitude information of the new target after sampling; A rectangular coordinate system is established with the original position of the target as the center, due north as the positive direction of the Y axis, and due east as the positive direction of the X axis. That is, the current target coordinates are (U E , M E ).
2. The estimation method according to claim 1, characterized in that: In step 1, The positioning system includes GPS, GLONASS and BeiDou satellite navigation systems; The target location information includes the altitude, longitude and latitude information of the target, and the positioning system collects the longitude and latitude information of the target at fixed intervals.
3. The estimation method according to claim 2, characterized in that: When the interval collected in step 1 reaches the millisecond level and the influence of altitude is removed, the heading angle problem can be regarded as a trigonometric function problem; The heading angle is calculated as follows: Then the target's travel distance L and speed V within the sampling period S are calculated: Finally, the heading of the target is predicted and represented on the image, and the heading angle β of the target relative to the earth coordinate system is calculated. O and the actual heading angle β of the target; through these two angles, their difference β is obtained E , that is, the expected heading angle of the target on the image plane; with the center of the image as the base point, draw an arrow representing this heading with an angle of β E , thereby obtaining the predicted heading of the target; β E =β-β O 。 4. An estimation system for executing the target motion state estimation method applied to a drone as claimed in any one of claims 1 to 3, characterized in that: The estimation system includes an acquisition module, a filtering module and an estimation module: The acquisition module continuously acquires target location information through a positioning system; The filtering module removes the height information collected by the collection module and performs filtering processing; The estimation module calculates the difference between longitude and latitude, establishes a rectangular coordinate system to calculate the heading angle, and marks the predicted heading angle on the image, and predicts the target's driving trajectory according to its heading and speed.
5. An electronic device comprising a memory and a processor, wherein the memory stores a computer program, wherein: When the processor executes the computer program, the steps of the method according to any one of claims 1 to 3 are implemented.
6. A computer-readable storage medium for storing computer instructions, characterized in that: When the computer instructions are executed by a processor, the steps of the method according to any one of claims 1 to 3 are implemented.
Citation Information
Patent Citations
Target tracking method, device and system
CN105676865A
Target positioning method based on hydrophone streamer shape equation analysis
CN108761470A
Target tracking method and device based on unmanned aerial vehicle pod
CN115328212A
KR20190116042A
