Plant protection unmanned aerial vehicle operation trajectory tracking precision test method and system
By using the fusion method of satellite positioning and ultrasonic plane positioning data in the plant protection drone operation trajectory test, the problem of reduced positioning accuracy caused by weak GNSS signal in cloudy weather or wood occlusion environment is solved, and the centimeter-level under these conditions is achieved Positioning accuracy and stability of high control.
Patent Information
- Application Number
- CN202411117657.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-15
- Publication Date
- 2024-11-26
AI Technical Summary
In cloudy weather or wood occlusion environments, the GNSS signal strength decreases, resulting in a deviation in the results of the plant protection drone operation tracking accuracy, and it is difficult for the prior art to maintain centimeter-level positioning accuracy under these conditions.
Using the fusion method of satellite positioning and ultrasonic plane positioning data, the base station and ultrasonic receiver are set up at the starting point of the flight trajectory of the plant protection drone to form a long-distance coverage of RTCM differential data, and the satellite positioning data and ultrasonic positioning are performed on the mobile station. The fusion calculation of data ensures positioning accuracy.
Even in cloudy weather or wood occlusion environments, centimeter-level positioning accuracy can always be obtained, with high and stable testing accuracy. At the same time, the fusion of attitude data through laser altimeter and IMU solution ensures the accuracy of height control.
Smart Images

Figure CN119024368A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of unmanned aerial vehicle trajectory testing, and in particular to a method and system for testing the operation trajectory tracking accuracy of a plant protection unmanned aerial vehicle. Background Art
[0002] When spraying fertilizers, the plant protection UAV needs to pre-set the operation trajectory and altitude, and then turn on the autonomous control mode to operate along the pre-set trajectory and altitude.
[0003] According to the requirements of 7.3.2 Autonomous control mode flight accuracy test in NY / T 3213-2018 "Technical Specifications for Quality Evaluation of Plant Protection UAVs" formulated by my country, plant protection UAVs need to preset flight routes in the test field under rated quality conditions. The spatial position of the plant protection UAVs in autonomous control flight mode must be continuously measured and recorded to evaluate their horizontal and altitude deviations.
[0004] At present, most of the testing methods are Figure 1 As shown, a mobile station 02 is installed on the tested plant protection UAV 01, and a base station 04 is set on the ground. The base station 04 obtains satellite positioning data through the GNSS antenna, calculates the differential data and sends it to the mobile station 02 via wireless. The base station 04 provides a relative positioning reference for the mobile station 02. The mobile station 02 obtains satellite positioning data through the GNSS antenna 03, calculates with the differential data provided by the mobile station 02, and obtains the longitude and latitude coordinates, altitude and speed data of the UAV with a positioning accuracy of centimeters after analysis. When the tested plant protection UAV 01 flies in the autonomous control mode, the mobile station 02 continuously measures and records its spatial position, and the host computer 05 receives all data to evaluate its horizontal deviation and altitude deviation.
[0005] However, in actual testing processes, it is often necessary to measure the tracking accuracy of the plant protection UAV's operation trajectory in different environments. For example, in cloudy weather or in an environment where there are trees blocking the GNSS signal, the GNSS signal received by the mobile station 02 is weakened, resulting in a decrease in the spatial position measurement accuracy, resulting in a large deviation in the test results. Summary of the invention
[0006] The purpose of the present invention is to provide a method and system for testing the operation trajectory tracking accuracy of a plant protection UAV, which adopts a data fusion method of satellite positioning and ultrasonic plane positioning. Even if the GNSS signal strength is reduced in cloudy weather or in an environment blocked by trees, centimeter-level positioning accuracy can always be obtained, and the test accuracy is high and stable.
[0007] In order to achieve the above object, the technical solution adopted by the present invention is: a method for testing the tracking accuracy of the operation trajectory of a plant protection UAV, comprising the following steps: Step 1: Pre-plan the test trajectory of the plant protection UAV in the environment to be tested. The test trajectory can be divided into N segments, and the N test trajectories contain a total of N+1 plant protection UAV flight control points; Step 2: Set up a base station and an ultrasonic receiver on the left and right sides of the starting point of the flight trajectory of the tested plant protection UAV, and set up a pair of ultrasonic receivers on the left and right sides of the flight control point of other plant protection UAVs; Step 3: The base station obtains satellite positioning data, calculates and generates RTCM differential data and sends it to other ultrasonic receivers and mobile stations; the ultrasonic receiver forwards the RTCM differential data to the next pair of ultrasonic receivers, forming long-distance coverage of RTCM differential data; Step 4: Install the mobile station on the plant protection UAV to be tested. The mobile station obtains satellite positioning data and receives RTCM differential data sent by the base station or ultrasonic receiver. The satellite positioning data and differential data are fused and calculated to obtain the initialization of the starting position coordinates of the plant protection UAV to be tested with a positioning accuracy of centimeters. Step 5: Place the plant protection UAV under test on each plant protection UAV flight control point in turn. The mobile station sends a synchronous start test signal and ultrasonic waves to all ultrasonic receivers. The ultrasonic receivers receive the synchronous start test signal and ultrasonic waves and record the start time. The distance to the plant protection UAV under test is calculated by the time difference, and the test distance and ID are sent to the base station. The host computer connects to the base station to read the data and calculate the spatial position of the plant protection UAV operating track under test and the spatial position of each ultrasonic receiver, completing the initialization of the test track. Step 6. Start the autonomous control mode of the plant protection UAV under test, and the plant protection UAV under test will perform flight operations along the flight trajectory and at a certain altitude. During the operation, the mobile station periodically sends a synchronous start test signal and ultrasonic waves to all ultrasonic receivers. The ultrasonic receivers receive the synchronous start test signal and ultrasonic waves and record the start time. The distance to the plant protection UAV under test is calculated through the time difference, and the test distance and ID are sent back to the mobile station. The mobile station selects the test distances and IDs sent by the four ultrasonic receivers closest to itself for continuous positioning in the spatial plane, and calculates the spatial plane coordinates of the plant protection UAV under test in real time. During the positioning process, the mobile station performs data fusion calculation on the acquired satellite positioning data and ultrasonic plane positioning data. Step 7: The test ends when the tested plant protection UAV reaches the end point; the host computer receives the continuous spatial position data collected by the mobile station and evaluates the results.
[0008] Preferably, when the plant protection UAV under test is flying autonomously, a laser altimeter is installed on the plant protection UAV under test to test the relative height between the plant protection UAV under test and the ground. The mobile station collects the motion acceleration and angular velocity of the plant protection UAV under test during flight, calculates the flight attitude of the plant protection UAV under test and the height collected by the laser altimeter, and measures the vertical height data of the plant protection UAV under test over the ground during flight.
[0009] Preferably, the environment to be tested in step 1 is under cloudy weather conditions or under conditions where there are trees around to block the environment.
[0010] Preferably, in step 3, before the base station acquires the satellite positioning data, the base station and the nine ultrasonic receivers are all powered on to complete initialization.
[0011] Preferably, in step 3, after the base station is powered on, the built-in GNSS module acquires satellite positioning data through the GNSS antenna and sends it to the base station WIFI module, the base station WIFI module calculates and generates RTCM differential data and sends it to other ultrasonic receivers and mobile stations through the WIFI antenna; the ultrasonic receiver WIFI module built into the ultrasonic receiver receives the RTCM differential data and then forwards it to the next pair of ultrasonic receivers through the WIFI antenna, forming long-distance coverage of RTCM differential data.
[0012] Preferably, in step 4, the plant protection UAV under test is placed at the starting point of the test trajectory and set as the flight starting point. The built-in GNSS+IMU inertial navigation module of the mobile station obtains satellite positioning data through the GNSS antenna and sends it to the mobile station WIFI module. The mobile station WIFI module simultaneously receives RTCM differential data sent by the base station or ultrasonic receiver.
[0013] Preferably, in step 5, the mobile station sends a synchronous start test signal to all ultrasonic receivers through the built-in mobile station WIFI module, and sends ultrasonic waves through the ultrasonic transmitter at the same time; the ultrasonic receiver receives the synchronous start test signal through the built-in ultrasonic receiver WIFI module and records the start time, and receives the ultrasonic wave sent by the ultrasonic transmitter through the built-in ultrasonic receiving module and records the receiving time. The ultrasonic receiver WIFI module calculates the distance to the tested plant protection drone through the time difference, and sends the test distance and ID to the base station through the WIFI antenna. The host computer connects to the base station to read the data to calculate the spatial position of the operation track and the spatial positions of all ultrasonic receivers, thereby completing the initialization of the test track.
[0014] Preferably, in step 6, the autonomous control mode of the tested plant protection UAV is turned on, and the tested plant protection UAV performs flight operations along the flight trajectory and at a certain altitude; during the operation, the mobile station periodically sends a synchronous start test signal to all ultrasonic receivers through the built-in mobile station WIFI module and sends ultrasonic waves through the ultrasonic transmitter; the ultrasonic receiver receives the synchronous start test signal through the built-in ultrasonic receiver WIFI module and records the start time, and at the same time receives the ultrasonic wave sent by the ultrasonic transmitter through the built-in ultrasonic receiving module and records the receiving time, the ultrasonic receiver WIFI module calculates the distance to the tested plant protection UAV through the time difference, and sends the test distance and ID back to the mobile station through the WIFI antenna; the mobile station selects the test distances and IDs sent by the four ultrasonic receivers closest to itself for continuous positioning in the spatial plane, and calculates the spatial plane coordinates of the tested plant protection UAV in real time; during the positioning process, the mobile station performs data fusion calculation on the satellite positioning data and ultrasonic plane positioning data obtained by the GNSS+IMU inertial navigation module.
[0015] A plant protection UAV operation trajectory tracking accuracy test system, including a plant protection UAV to be tested, a mobile station, a laser altimeter, an ultrasonic transmitter, a base station, a host computer and multiple ultrasonic receivers; The test trajectory of the tested plant protection UAV can be divided into N segments, and the N test trajectories contain a total of N+1 plant protection UAV flight control points; The mobile station and the laser altimeter are installed on the plant protection UAV under test; the base station and one of the ultrasonic receivers are respectively arranged on the left and right sides of the starting point of the flight trajectory of the plant protection UAV under test, and the other ultrasonic receivers are respectively arranged on the left and right sides of the flight control points of other UAVs; The mobile station is equipped with a GNSS+IMU inertial navigation module, a GNSS antenna, a mobile station WIFI module, a power module, a CAN communication module and an ultrasonic transmitter; The base station is equipped with a GNSS module, a GNSS antenna, a base station WIFI module, an ultrasonic receiving module, and a power supply module; The ultrasonic receiver is built with an ultrasonic receiver WIFI module, a power module, and an ultrasonic receiving module; The host computer is connected to the base station to read data and calculate the spatial position of the operating track of the tested plant protection UAV and the spatial positions of the nine ultrasonic receivers.
[0016] Preferably, the flight control points of the plant protection UAV include a starting point of the flight trajectory of the plant protection UAV being tested, an end point of the flight trajectory of the plant protection UAV being tested, and a plurality of waypoints.
[0017] The beneficial effects of the present invention are: This solution is not only applicable to the test of the straight-line trajectory tracking accuracy of plant protection UAVs, but also to the test and evaluation of the multi-segment trajectory tracking accuracy. Due to the use of the data fusion method of satellite positioning and ultrasonic plane positioning, even in cloudy weather or when the GNSS signal strength is reduced due to the surrounding woods blocking the environment, centimeter-level positioning accuracy can always be obtained, and the test accuracy is high and stable. At the same time, since the laser altimeter is rigidly fixed to the plant protection UAV, the swing of the plant protection UAV in the air will cause the probe of the laser altimeter to not be perpendicular to the ground, and the height value will swing over a large range. The present invention uses the laser altimeter and the posture solved by the IMU for data fusion during the height control accuracy test, so that even if the plant protection UAV swings, the vertical height of the UAV to the ground can be accurately and stably measured. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] 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, the drawings described below are only some embodiments of the invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0019] Figure 1 It is a schematic diagram of a trajectory tracking accuracy test system in the prior art; Figure 2 It is a schematic diagram of the installation of some equipment of the trajectory tracking accuracy test system of the present invention; Figure 3 It is a schematic diagram of equipment installation of the trajectory tracking accuracy test system of the present invention; Figure 4 A schematic diagram showing the relationship between modules in the mobile station of the present invention; Figure 5 A schematic diagram showing the relationship between modules in a base station of the present invention; Figure 6 Schematic diagram of the relationship between modules in the ultrasonic receiver of the present invention.
[0020] Figure 1 Markings in the figure: 01, tested plant protection UAV, 02, mobile station, 03, GNSS antenna, 04, base station, 05, host computer.
[0021] Figure 2-6Markings: 1. Tested plant protection UAV, 2. Mobile station, 3. GNSS antenna, 4. Base station, 5. Host computer, 6. Laser altimeter, 7. Ultrasonic receiver, 8. Ultrasonic transmitter, 9. Mobile station WIFI module, 10. GNSS+IMU inertial navigation module, 11. Base station WIFI module, 12. CAN communication module, 13. Power module, 14. GNSS module, 15. Ultrasonic receiving module, 16. Ultrasonic receiver WIFI module. DETAILED DESCRIPTION
[0022] The present invention will be further described in detail below in conjunction with the accompanying drawings and specific embodiments.
[0023] The structures, proportions, sizes, etc. illustrated in the drawings of this specification are only used to match the contents disclosed in the specification so as to facilitate understanding and reading by persons familiar with the technology. They are not used to limit the conditions under which the present invention can be implemented, and therefore have no substantive technical significance. Any structural modification, change in proportion or adjustment of size shall still fall within the scope of the technical contents disclosed in the present invention without affecting the effects and purposes that can be achieved by the present invention.
[0024] At the same time, it should be noted that: unless otherwise defined, the technical terms or scientific terms used in this article should be the ordinary meaning understood by people with ordinary skills in the technical field to which the present invention belongs. The meaning of "multiple" used in the patent application specification and claims of the present invention is two or more; the orientation or position relationship indicated by the terms "upper", "lower", "left", "right", "front end", "rear end", etc. is based on the orientation or position relationship shown in the drawings, which is only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present invention. Changes or adjustments in their relative relationships should also be regarded as the scope of the implementation of the present invention without substantially changing the technical content.
[0025] The present invention is further described in detail below in conjunction with embodiments and with reference to the accompanying drawings.
[0026] The present invention discloses a plant protection UAV operation trajectory tracking accuracy test system. Figure 2 , 3 As shown, the embodiment includes a tested plant protection UAV 1, a mobile station 2, a laser altimeter 6, an ultrasonic transmitter 8, a base station 4, a host computer 5 and nine ultrasonic receivers 7.
[0027] like Figure 3As shown, the test track of the tested plant protection UAV 1 can be divided into four sections, each section is 30m apart, and the total length of the test section track is 120m. The four test tracks contain a total of five plant protection UAV flight control points, namely the starting point, waypoint 1, waypoint 2, waypoint 3 and the end point.
[0028] The mobile station 2 and the laser altimeter 6 are installed on the tested plant protection UAV 1; the base station 4 and one of the ultrasonic receivers 7 are respectively arranged at a distance of 10 meters on the left and right sides of the starting point of the flight trajectory of the tested plant protection UAV 1, and the other eight ultrasonic receivers 7 are respectively arranged at a distance of 10 meters on the left and right sides of the waypoint 1, waypoint 2, waypoint 3, and the end point.
[0029] like Figure 4 As shown, the mobile station 2 is equipped with a GNSS+IMU inertial navigation module 10, a GNSS antenna 3, a mobile station WIFI module 9, a power module 13, a CAN communication module 12 and an ultrasonic transmitter 8. The power module 13 is responsible for the charge and discharge management of the battery and the power supply of the whole machine; the GNSS+IMU inertial navigation module 10 collects satellite positioning data and the motion acceleration and angular velocity of the tested plant protection UAV 1; the CAN communication module 12 is used to receive the altitude data of the laser altimeter 6; the ultrasonic transmitter 8 is used to send ultrasonic waves; the mobile station WIFI module 9 sends a synchronous start test signal and controls the ultrasonic transmitter 8 to send ultrasonic waves, and receives ultrasonic positioning data and satellite data for fusion positioning, and on the other hand receives the altitude data of the laser altimeter 6 and the acceleration and angular velocity data collected by the GNSS+IMU inertial navigation module 10, and continuously calculates the altitude data after fusion.
[0030] like Figure 5 As shown, the base station 4 is built with a GNSS module 14, a GNSS antenna 3, a base station WIFI module 11, an ultrasonic receiving module 15, and a power module 13, wherein the power module 13 is responsible for the charge and discharge management of the battery and the power supply of the whole machine; the GNSS module 14 is used to obtain satellite positioning data; the ultrasonic receiving module 15 is used to receive ultrasonic signals; the base station WIFI module 11 is used to send RTCM differential data to the mobile station 2 on the one hand, and is used to receive the start synchronization test signal and the ultrasonic signal of the ultrasonic receiving module 15 on the other hand, calculate the test distance and send the test result to the mobile station 2.
[0031] like Figure 6As shown, the ultrasonic receiver 7 is built with an ultrasonic receiver WIFI module 16, a power module 13, and an ultrasonic receiving module 15. The power module 13 is responsible for the charge and discharge management of the battery and the power supply of the whole machine; the ultrasonic receiving module 15 is used to receive ultrasonic signals; the ultrasonic receiver WIFI module 16 is used to receive the start synchronization test signal and the ultrasonic signal of the ultrasonic receiving module 15, calculate the test distance and send the test result to the mobile station 2.
[0032] The host computer 5 is connected to the base station 4 to read data and calculate the spatial position of the operating track of the tested plant protection UAV 1 and the spatial positions of the nine ultrasonic receivers 7 .
[0033] The present invention discloses a method for testing the operation trajectory tracking accuracy of a plant protection UAV, and an embodiment thereof comprises the following steps: The first step, such as Figure 3 As shown, in the environment to be tested, such as cloudy weather or the surrounding forest blocking environment, the test trajectory of the tested plant protection UAV 1 is pre-planned. The test trajectory can be divided into four sections, each with an interval of 30m, and the total length of the test section trajectory is 120m. The four test trajectories contain a total of five plant protection UAV flight control points, namely the starting point, waypoint 1, waypoint 2, waypoint 3 and the end point.
[0034] The second step is, Figure 3 As shown, a base station 4 and an ultrasonic receiver 7 are respectively set at a distance of 10 meters on the left and right sides of the starting point of the flight track of the plant protection UAV. A pair of ultrasonic receivers 7 are respectively set at a distance of 10 meters on the left and right sides of the waypoint 1, waypoint 2, waypoint 3, and the end point.
[0035] The third step is to power on the base station 4 and the nine ultrasonic receivers 7 to complete initialization. Figure 5 As shown, after the base station 4 is powered on, the built-in GNSS module 14 will obtain satellite positioning data through the GNSS antenna 3 and send it to the base station WIFI module 11. The base station WIFI module 11 calculates and generates RTCM differential data and sends it to other ultrasonic receivers 7 and mobile stations 2 through the WIFI antenna. Figure 6 As shown, the ultrasonic receiver WIFI module 16 built into the ultrasonic receiver 7 receives the RTCM differential data and then forwards it to the next pair of ultrasonic receivers 7 through the WIFI antenna, forming long-distance coverage of the RTCM differential data.
[0036] In the fourth step, the plant protection UAV 1 to be tested is placed at the starting point of the test track and set as the flight starting point. The mobile station 2 is installed on the plant protection UAV 1 to be tested. The built-in GNSS+IMU inertial navigation module 10 of the mobile station 2 obtains satellite positioning data through the GNSS antenna 3 and sends it to the mobile station WIFI module 9. The mobile station WIFI module 9 simultaneously receives the RTCM differential data sent by the base station 4 or the ultrasonic receiver 7, and fuses the satellite positioning data and the differential data to calculate the initialization of the starting position coordinates of the plant protection UAV 1 to be tested with a positioning accuracy of centimeters.
[0037] In the fifth step, the tested plant protection drone 1 is placed at the starting point, waypoint 1, waypoint 2, waypoint 3, and the end point in sequence, and is set as the corresponding function point on the software of the tested plant protection drone 1. Figure 4 As shown, the mobile station 2 sends a synchronous start test signal to all ultrasonic receivers 7 through the built-in mobile station WIFI module 9, and sends ultrasonic waves through the ultrasonic transmitter 8. Figure 6 As shown, the ultrasonic receiver 7 receives the synchronous start test signal through the built-in ultrasonic receiver WIFI module 16 and records the start time. At the same time, it receives the ultrasonic wave sent by the ultrasonic transmitter 8 through the built-in ultrasonic receiving module 15 and records the receiving time. The ultrasonic receiver WIFI module 16 calculates the distance to the tested plant protection drone 1 through the time difference, and sends the test distance and ID to the base station 4 through the WIFI antenna. The host computer 5 connects to the base station 4 to read the data and calculate the spatial position of the operation track and the spatial position of the nine ultrasonic receivers 7, completing the initialization of the test track.
[0038] Step 6: Start the autonomous control mode of the tested plant protection UAV 1, and the tested plant protection UAV 1 performs flight operations along the flight trajectory and at a certain altitude. Figure 4 As shown, during the operation, the mobile station 2 sends a synchronous start test signal to all ultrasonic receivers 7 through the built-in mobile station WIFI module 9 and sends ultrasonic waves through the ultrasonic transmitter 8 every 100ms. Figure 6As shown, the ultrasonic receiver 7 receives the synchronous start test signal through the built-in ultrasonic receiver WIFI module 16 and records the start time, and receives the ultrasonic wave sent by the ultrasonic transmitter 8 through the built-in ultrasonic receiving module 15 and records the receiving time. The ultrasonic receiver WIFI module 16 calculates the distance from the tested plant protection UAV 1 through the time difference, and sends the test distance and ID back to the mobile station 2 through the WIFI antenna. The mobile station 2 selects the test distances and IDs sent by the four ultrasonic receivers 7 closest to itself for continuous positioning in the spatial plane, and calculates the spatial plane coordinates of the tested plant protection UAV 1 in real time. During the positioning process, the mobile station 2 will perform data fusion calculations on the satellite positioning data and ultrasonic plane positioning data obtained by the GNSS+IMU inertial navigation module 10. Even if the GNSS signal strength is reduced in cloudy weather or when there are trees blocking the surrounding environment, centimeter-level positioning accuracy can always be obtained due to ultrasonic plane-assisted positioning.
[0039] When the plant protection UAV 1 under test is autonomously controlled to fly, the relative height yaw of the plant protection UAV 1 under test and the ground is required at the same time. The laser altimeter 6 is installed on the plant protection UAV 1 under test. The relative height of the plant protection UAV 1 under test and the ground is not the vertical height because the fuselage of the plant protection UAV 1 under test will swing during the flight. At the same time, the built-in GNSS+IMU inertial navigation module 10 of the mobile station 2 will collect the motion acceleration and angular velocity of the plant protection UAV 1 under test during the flight and send it to the mobile station WIFI module 9. The mobile station WIFI module 9 calculates the flight attitude of the plant protection UAV 1 under test and the height collected by the laser altimeter 6, and finally measures the vertical height data of the plant protection UAV 1 under test and the ground during flight.
[0040] Step 7: The test ends when the tested plant protection drone 1 reaches the end point. Figure 3 As shown, the host computer 5 receives the continuous spatial position data collected by the mobile station 2 and evaluates the results.
[0041] It should be noted that the parts not described in detail in the above embodiments are all prior art.
[0042] The above description is only a preferred embodiment of the present invention and does not constitute any form of limitation to the present invention. Although the present invention has been disclosed as a preferred embodiment as above, it is not intended to limit the present invention. Any technician familiar with the profession can make some changes or modifications to equivalent embodiments of equivalent changes using the technical contents disclosed above without departing from the scope of the technical solution of the present invention. However, any simple modifications, equivalent changes and modifications made to the above embodiments based on the technical essence of the present invention without departing from the content of the technical solution of the present invention should be covered within the protection scope of the present invention.
Claims
1. A method for testing the trajectory tracking accuracy of a plant protection UAV, characterized by: The following steps are involved: Step 1: pre-plan a test trajectory of the plant protection UAV (1) to be tested in the environment to be tested. The test trajectory can be divided into N segments, and the N test trajectories contain a total of N+1 flight control points of the plant protection UAV; Step 2: a base station (4) and an ultrasonic receiver (7) are respectively arranged on the left and right sides of the starting point of the flight trajectory of the tested plant protection UAV (1), and a pair of ultrasonic receivers (7) are respectively arranged on the left and right sides of the flight control point of other plant protection UAVs; Step 3, the base station (4) obtains satellite positioning data, calculates and generates RTCM differential data and sends it to other ultrasonic receivers (7) and the mobile station (2); the ultrasonic receiver (7) forwards the RTCM differential data to the next pair of ultrasonic receivers (7), thereby forming long-distance coverage of RTCM differential data; Step 4: Install the mobile station (2) on the plant protection UAV (1) to be tested. The mobile station (2) obtains satellite positioning data and receives RTCM differential data sent by the base station (4) or the ultrasonic receiver (7). The satellite positioning data and the differential data are fused and calculated to obtain the initialization of the starting position coordinates of the plant protection UAV (1) to be tested with a positioning accuracy of centimeters. Step 5: The plant protection UAV (1) to be tested is placed on each plant protection UAV flight control point in turn. The mobile station (2) sends a synchronous start test signal and an ultrasonic wave to all ultrasonic receivers (7). The ultrasonic receiver (7) receives the synchronous start test signal and the ultrasonic wave and records the start time. The distance to the plant protection UAV (1) to be tested is calculated by the time difference, and the test distance and ID are sent to the base station (4). The host computer (5) is connected to the base station (4) to read the data and calculate the spatial position of the operation track of the plant protection UAV (1) to be tested and the spatial position of each ultrasonic receiver (7), thereby completing the initialization of the test track. Step 6, start the autonomous control mode of the tested plant protection UAV (1), and the tested plant protection UAV (1) performs flight operations along the flight trajectory and at a certain altitude; during the operation, the mobile station (2) regularly sends a synchronous start test signal and an ultrasonic wave to all ultrasonic receivers (7), and the ultrasonic receiver (7) receives the synchronous start test signal and the ultrasonic wave and records the start time, calculates the distance to the tested plant protection UAV (1) through the time difference, and sends the test distance and ID back to the mobile station (2); the mobile station (2) selects the test distance and ID sent by the four ultrasonic receivers (7) closest to itself for continuous spatial plane positioning, and calculates the spatial plane coordinates of the tested plant protection UAV (1) in real time; during the positioning process, the mobile station (2) performs data fusion calculation on the acquired satellite positioning data and ultrasonic plane positioning data; Step 7: The test ends when the tested plant protection UAV (1) reaches the end point; the host computer (5) receives the continuous spatial position data collected by the mobile station (2) and evaluates the results.
2. The method for testing the tracking accuracy of a plant protection UAV operation trajectory according to claim 1, characterized in that: When the tested plant protection UAV (1) is autonomously controlled to fly, a laser altimeter (6) is installed on the tested plant protection UAV (1) to test the relative height between the tested plant protection UAV (1) and the ground. The mobile station (2) collects the motion acceleration and angular velocity of the tested plant protection UAV (1) during flight, calculates the flight attitude of the tested plant protection UAV (1) and the height collected by the laser altimeter (6), and measures the vertical height data between the tested plant protection UAV (1) and the ground during flight.
3. The method for testing the tracking accuracy of a plant protection UAV operation trajectory according to claim 1, characterized in that: The environment to be tested in step 1 is under cloudy weather conditions or under conditions where there are trees around to block the environment.
4. The method for testing the tracking accuracy of a plant protection UAV operation trajectory according to claim 1, characterized in that: In step 3, before the base station (4) acquires the satellite positioning data, the base station (4) and the nine ultrasonic receivers (7) are all powered on to complete initialization.
5. The method for testing the tracking accuracy of a plant protection UAV operation trajectory according to claim 4, characterized in that: In step 3, after the base station (4) is powered on, the built-in GNSS module (14) obtains satellite positioning data through the GNSS antenna (3) and sends it to the base station WIFI module (11); the base station WIFI module (11) calculates and generates RTCM differential data and sends it to other ultrasonic receivers (7) and the mobile station (2) through the WIFI antenna; the ultrasonic receiver WIFI module (16) built into the ultrasonic receiver (7) receives the RTCM differential data and then forwards it to the next pair of ultrasonic receivers (7) through the WIFI antenna, thereby forming long-distance coverage of RTCM differential data.
6. The method for testing the tracking accuracy of a plant protection UAV operation trajectory according to claim 5, characterized in that: In step 4, the plant protection drone (1) to be tested is placed at the starting point of the test track and set as the flight starting point. The GNSS+IMU inertial navigation module (10) built into the mobile station (2) obtains satellite positioning data through the GNSS antenna (3) and sends it to the mobile station WIFI module (9). The mobile station WIFI module (9) simultaneously receives RTCM differential data sent by the base station (4) or the ultrasonic receiver (7).
7. The method for testing the tracking accuracy of a plant protection UAV operation trajectory according to claim 6, characterized in that: In step 5, the mobile station (2) sends a synchronous start test signal to all ultrasonic receivers (7) through a built-in mobile station WIFI module (9), and simultaneously sends ultrasonic waves through an ultrasonic transmitter (8); the ultrasonic receiver (7) receives the synchronous start test signal through a built-in ultrasonic receiver WIFI module (16) and records the start time, and simultaneously receives the ultrasonic waves sent by the ultrasonic transmitter (8) through a built-in ultrasonic receiving module (15) and records the reception time; the ultrasonic receiver WIFI module (16) calculates the distance to the tested plant protection drone (1) through the time difference, and sends the test distance and ID to the base station (4) through a WIFI antenna; the host computer (5) connects to the base station (4) to read the data to calculate the spatial position of the operation track and the spatial positions of all ultrasonic receivers (7), and completes the initialization of the test track.
8. The method for testing the tracking accuracy of a plant protection UAV operation trajectory according to claim 7, characterized in that: In step 6, the autonomous control mode of the plant protection drone (1) under test is turned on, and the plant protection drone (1) under test performs a flight operation along a flight trajectory and at a certain altitude; during the operation, the mobile station (2) periodically sends a synchronous start test signal to all ultrasonic receivers (7) through a built-in mobile station WIFI module (9) and sends ultrasonic waves through an ultrasonic transmitter (8); the ultrasonic receiver (7) receives the synchronous start test signal through a built-in ultrasonic receiver WIFI module (16) and records the start time, and at the same time receives the ultrasonic waves sent by the ultrasonic transmitter (8) through a built-in ultrasonic receiving module (15). The ultrasonic receiver WIFI module (16) calculates the distance to the tested plant protection UAV (1) through the time difference, and sends the test distance and ID back to the mobile station (2) through the WIFI antenna; the mobile station (2) selects the test distances and IDs sent by the four ultrasonic receivers (7) closest to itself for continuous spatial plane positioning, and calculates the spatial plane coordinates of the tested plant protection UAV (1) in real time; during the positioning process, the mobile station (2) performs data fusion calculation on the satellite positioning data obtained by the GNSS+IMU inertial navigation module (10) and the ultrasonic plane positioning data.
9. A plant protection UAV operation trajectory tracking accuracy test system, applied to the plant protection UAV operation trajectory tracking accuracy test method according to any one of claims 1 to 8, characterized in that: It includes a tested plant protection UAV (1), a mobile station (2), a laser altimeter (6), an ultrasonic transmitter (8), a base station (4), a host computer (5) and a plurality of ultrasonic receivers (7); The test trajectory of the tested plant protection UAV (1) can be divided into N segments, and the N test trajectories contain a total of N+1 plant protection UAV flight control points; The mobile station (2) and the laser altimeter (6) are installed on the plant protection UAV (1) to be tested; the base station (4) and one of the ultrasonic receivers (7) are respectively arranged on the left and right sides of the starting point of the flight trajectory of the plant protection UAV (1) to be tested, and the other ultrasonic receivers (7) are respectively arranged on the left and right sides of the flight control point of other UAVs; The mobile station (2) is equipped with a GNSS+IMU inertial navigation module (10), a GNSS antenna (3), a mobile station WIFI module (9), a power module (13), a CAN communication module (12) and an ultrasonic transmitter (8); The base station (4) has a built-in GNSS module (14), a GNSS antenna (3), a base station WIFI module (11), an ultrasonic receiving module (15), and a power supply module (13); The ultrasonic receiver (7) is equipped with an ultrasonic receiver WIFI module (16), a power module (13), and an ultrasonic receiving module (15); The host computer (5) is connected to the base station (4) to read data and calculate the spatial position of the operating track of the tested plant protection drone (1) and the spatial positions of the nine ultrasonic receivers (7).
10. The plant protection UAV operation trajectory tracking accuracy test system according to claim 9, characterized in that: The flight control points of the plant protection UAV include a starting point of a flight track of the plant protection UAV (1) being tested, an end point of a flight track of the plant protection UAV (1) being tested, and a plurality of waypoints.
