WO2021087737A1 - Radar mounting state detection method and device, movable platform, and storage medium - Google Patents

Radar mounting state detection method and device, movable platform, and storage medium Download PDF

Info

Publication number
WO2021087737A1
WO2021087737A1 PCT/CN2019/115678 CN2019115678W WO2021087737A1 WO 2021087737 A1 WO2021087737 A1 WO 2021087737A1 CN 2019115678 W CN2019115678 W CN 2019115678W WO 2021087737 A1 WO2021087737 A1 WO 2021087737A1
Authority
WO
WIPO (PCT)
Prior art keywords
information
terrain information
radar
terrain
movable platform
Prior art date
Application number
PCT/CN2019/115678
Other languages
French (fr)
Chinese (zh)
Inventor
王石荣
祝煌剑
王俊喜
Original Assignee
深圳市大疆创新科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to PCT/CN2019/115678 priority Critical patent/WO2021087737A1/en
Priority to CN201980039548.8A priority patent/CN112368592A/en
Publication of WO2021087737A1 publication Critical patent/WO2021087737A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C1/00Measuring angles

Definitions

  • the invention relates to the field of radars, in particular to a detection method, a movable platform, equipment and a storage medium for the installation state of a radar.
  • Movable platforms have been widely used in many fields. In different fields, mobile platforms have the need to avoid obstacles based on the environmental information of the operating environment.
  • the operating environment information may include terrain information, the distribution density of objects in the environment, and so on.
  • the mobile platform can first use its own radar to observe the surrounding environment, and then estimate the environmental information based on the point cloud data obtained from the observation, so as to realize obstacle avoidance based on the environmental information.
  • a movable platform can usually be used for spraying medicine, and the movable platform needs to be cleaned every time a period of time has passed. Before and after each cleaning, the radar configured on the movable platform needs to be disassembled and reinstalled. For users who are not familiar with the machine, it is easy to have radar installation errors. This installation error may also cause damage to the movable platform.
  • the invention provides a detection method, a movable platform, equipment and a storage medium for the radar installation state, which are used to accurately detect the installation state of the radar and avoid installation errors.
  • the first aspect of the present invention is to provide a method for detecting the installation state of a radar, the method including:
  • the radar on the movable platform is installed correctly.
  • the second aspect of the present invention is to provide a movable platform, which at least includes: a body, a power system, and a control device;
  • the power system is arranged on the body and used to provide power for the movable platform
  • the control device includes a memory and a processor
  • the memory is used to store a computer program
  • the processor is configured to run a computer program stored in the memory to realize:
  • the radar on the movable platform is installed correctly.
  • the third aspect of the present invention is to provide a radar installation state detection device, the detection device comprising:
  • Memory used to store computer programs
  • the processor is configured to run a computer program stored in the memory to realize:
  • the radar on the movable platform is installed correctly.
  • the fourth aspect of the present invention is to provide a computer-readable storage medium, the storage medium is a computer-readable storage medium, the computer-readable storage medium stores program instructions, and the program instructions are used in the first aspect.
  • the radar installation state detection method, movable platform, equipment and storage medium provided by the present invention can accurately detect the installation state of the radar and avoid installation errors.
  • FIG. 1 is a schematic flowchart of a method for detecting a radar installation state according to an embodiment of the present invention
  • Fig. 2 is a method for determining terrain information provided by an embodiment of the present invention
  • FIG. 3 is a schematic flowchart of another method for detecting the installation state of a radar according to an embodiment of the present invention
  • Fig. 4a is a predetermined correlation judgment method provided by an embodiment of the present invention.
  • FIG. 4b is another predetermined correlation judgment method provided by an embodiment of the present invention.
  • FIG. 4c is another predetermined correlation judgment method provided by an embodiment of the present invention.
  • FIG. 5 is a schematic structural diagram of a device for detecting the installation state of cloud radar provided by an embodiment of the present invention.
  • FIG. 6 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention.
  • Fig. 7 is a schematic structural diagram of a device for detecting the installation state of cloud radar provided by an embodiment of the present invention.
  • the detection method of the radar installation state, the movable platform, the equipment and the storage medium provided by the present invention can obtain the terrain information of the operating environment where the movable platform is located and the operating environment of the movable platform during the execution of tasks.
  • the posture information of the movable platform during the process Further, it is determined whether the radar configured on the movable platform is installed correctly according to the information of the terrain information and the attitude information. It can be seen that the present invention provides a solution for judging the installation state of the radar based on various information, which can accurately detect the installation state of the radar and avoid the situation that the movable platform is eventually damaged due to installation errors.
  • the detection of the installation status is often performed before normal tasks are performed, and the movable platform needs to run a predetermined trajectory, and it is usually necessary to place specific environmental markers in the running scene.
  • the detection method provided by the present invention is carried out in the process of the movable platform performing normal tasks, the movable platform does not need to run a predetermined trajectory, on the other hand, the movable platform is moving Throughout the process, the installation status of the radar can be continuously detected to improve the real-time detection.
  • an embodiment of the present invention provides a method for detecting the installation state of a radar, the method including:
  • the radar on the movable platform is installed correctly.
  • the embodiment of the present invention also provides a movable platform, which at least includes: a body, a power system, and a control device;
  • the power system is arranged on the body and used to provide power for the movable platform
  • the control device includes a memory and a processor
  • the memory is used to store a computer program
  • the processor is configured to run a computer program stored in the memory to realize:
  • the radar on the movable platform is installed correctly.
  • the embodiment of the present invention also provides a radar installation state detection device, which includes:
  • Memory used to store computer programs
  • the processor is configured to run a computer program stored in the memory to realize:
  • the radar on the movable platform is installed correctly.
  • the embodiment of the present invention also provides a computer-readable storage medium, the storage medium is a computer-readable storage medium, the computer-readable storage medium stores program instructions, and the program instructions are used for the detection of the above-mentioned radar installation status method.
  • FIG. 1 is a schematic flowchart of a method for detecting the installation state of a radar according to an embodiment of the present invention.
  • the execution subject of the detection method of the radar installation state is the detection equipment.
  • the detection device can be implemented as software or a combination of software and hardware.
  • the detection device executes the detection method of the installation state of the radar, and the detection of the installation state of the radar can be realized.
  • the detection equipment in this embodiment and the following embodiments may specifically be any movable platforms such as unmanned aerial vehicles, unmanned vehicles, and unmanned ships. Taking the case where the movable platform is an unmanned aerial vehicle as an example, the following embodiments are described.
  • the operating environment of the movable platform is the flying environment of the UAV
  • the operation of the movable platform is the flying of the UAV.
  • the method may include:
  • S101 Acquire terrain information of the operating environment where the movable platform is located.
  • an optional method is that the camera configured on the drone can take an image corresponding to the flight environment, and then the terrain information of the flight environment can be determined through image recognition.
  • This terrain information realizes obstacle avoidance.
  • the terrain information can indicate whether there is a slope on the ground in the flight environment, and it can also indicate the distribution of obstacles in the flight environment.
  • the radar configured on the UAV will continuously move and collect multiple point cloud data. Then, based on the coordinate values of the collected multiple point cloud data, the terrain information of the flight environment can be determined, and the location of the obstacles can be further determined based on the terrain information, so as to achieve obstacle avoidance.
  • the radar configured on the drone can be a rotating radar, and the multiple point cloud data mentioned above can be data collected by one rotation of the rotating radar, which can be used to describe the distribution of obstacles within the 360° viewing angle of the drone happensing.
  • multiple point cloud data collected by radar can also be filtered according to coordinate values, such as filtering out the 120° data used to describe the UAV Based on the point cloud data within the visual angle, the topographic information of the flight environment is determined based on the filtered point cloud data.
  • terrain information may be the slope information of the flight environment where the aircraft is located, or the distribution density of obstacles in the flight environment, and so on.
  • the terrain information is the distribution density of obstacles
  • the position of the obstacle and the position of the obstacle in the flight environment can be determined according to the coordinate values of the multiple point cloud data. Volume and other content. And further analyze the obstacle distribution density in the flying environment based on the position and volume of the obstacle.
  • the attitude information of the UAV can also be calculated based on the sensor data collected by its own sensors, such as the nine-axis sensor.
  • the attitude information of the UAV can indicate the flight attitude of the UAV, such as horizontal flight or tilt flight.
  • this attitude information may be the pitch angle, heading angle, or roll angle of the drone.
  • the terrain information when the terrain information is obtained through image recognition, it can be determined whether the radar is installed correctly according to whether the meanings of the terrain information and the posture information are consistent.
  • the terrain information indicates that the ground of the flight environment is flat, and the obtained attitude information indicates that the UAV is flying parallel to the horizontal ground, indicating that the meaning of the terrain information and attitude information is consistent
  • the radar installation error can be determined.
  • the terrain information is determined through the point cloud data collected by the radar, it can also be determined whether the radar is installed correctly by determining the predetermined correlation between the terrain information and the attitude information.
  • the predetermined correlation may be specifically expressed as the two types of information satisfying a preset value correspondence relationship.
  • the terrain information is the distribution density of obstacles and the attitude information is the elevation angle
  • the numerical interval and the angle interval exist
  • the preset correspondence relationship indicates that there is a preset correspondence relationship between the obstacle distribution density and the pitch angle, indicating that there is a predetermined correlation between the obstacle distribution density and the pitch angle, and it is determined that the radar is installed correctly.
  • the installation error can be the reverse installation or the upper and lower installation.
  • the user can control the drone to land and reinstall the radar to avoid damage to the drone caused by incorrect installation of the radar.
  • the method for detecting the installation status of the radar provided in this embodiment can obtain the terrain information of the flying environment of the drone and the attitude of the drone during the flight of the flying environment during the flight mission of the drone. information. Furthermore, it is determined whether the radar is installed correctly according to the terrain information and attitude information. It can be seen that this embodiment provides a solution for judging the radar installation status based on various information. On the one hand, this method is carried out during the normal flight mission of the drone, and the drone does not need to fly a predetermined trajectory. On the one hand, the installation status of the radar can be continuously detected during the entire flight of the UAV, which improves the real-time detection.
  • step S101 may be:
  • S1011 Obtain multiple point cloud data describing the operating environment of the mobile platform. For example, obtain multiple point transportation data describing the flight environment of the drone.
  • S1012 Select target point cloud data within a preset viewing angle range according to the coordinate values of the multiple point cloud data.
  • the radar on the drone can collect multiple point cloud data during the rotation process.
  • this multiple point cloud data can be used for It is described as the distribution of obstacles within the 360° viewing angle of the drone.
  • the data within the preset viewing angle range can be selected as the target point cloud data.
  • the size of the preset viewing angle can be preset according to actual conditions, for example, it can be set to 120° as mentioned in the above embodiment.
  • the least square method can be used to linearly fit it to obtain a straight line equation, and then the topographic information is determined according to the coefficient of the straight line equation.
  • the terrain information in the drone flight environment is: k/b
  • the terrain information may specifically be slope information of the flight environment.
  • Fig. 1 and Fig. 2 provides two methods for determining terrain information based on point cloud data collected by radar. In practical applications, you can choose to use different methods to obtain the terrain information of the corresponding content according to the specific meaning of the terrain information.
  • the detection method of the radar installation state may further include:
  • the UAV When it is determined that the installation status of the radar is an installation error based on the terrain information and the attitude information, the UAV will first record the detection result, which is to realize the update of the installation status as the number of installation errors. If the updated number is higher than the preset number, it indicates that the radar configured on the UAV is continuously in a wrong installation state. Only then can the radar be truly installed incorrectly, and the error in the detection result caused by the data collection error is ruled out. Then, the drone will generate a warning notification to notify users on the ground to make further adjustments to the drone's flight status to avoid damage to the drone.
  • the radar is in motion during the normal mission of the UAV, that is, the radar has a moving angular velocity. According to actual experience, there is the following relationship between the magnitude of the angular velocity of this motion and the predetermined correlation between terrain information and attitude information: when the angular velocity is not less than the preset speed, the predetermined correlation between terrain information and attitude information becomes more obvious. .
  • FIG. 3 is a schematic flowchart of another method for detecting the installation state of a radar according to an embodiment of the present invention. As shown in FIG. 3, based on the foregoing embodiments, before step S103, the detection method of the radar installation state may further include:
  • step S204 Determine whether the motion angular velocity is greater than a preset threshold, if the motion angular velocity is greater than the preset threshold, step S103 is executed, otherwise, step S205 is executed.
  • the angular velocity of movement of the drone can be measured by an inertial measurement unit (Inertial Measurement Unit, IMU for short) configured on an unmanned aerial vehicle. Then, for the acquired angular velocity of motion, it is determined whether it is greater than a preset threshold. If the angular velocity of motion is greater than or equal to the preset threshold, step S103 in the embodiment shown in FIG. 1 is executed.
  • IMU Inertial Measurement Unit
  • the detection method provided by the present invention is executed to obtain the detection result, and its accuracy cannot be guaranteed, then the detection of the radar installation state can be stopped at this time, and the motion collected at the next moment After the angular velocity is greater than the preset threshold, the detection of the installation state is turned on.
  • the number of times it is in an installation error state is updated.
  • the number of times is greater than the preset number, it indicates that the radar continues to be in a state of installation error, and then this installation error state will be notified to the user.
  • the statistics of the number of passes can increase the credibility of the detection results and avoid the contingency of the detection results. The user mis-operated the drone, and eventually caused the drone to fail to complete the flight mission or even be damaged.
  • this embodiment puts forward requirements for the angular velocity of the movement of the UAV.
  • the angular velocity of motion is directly related to the accuracy of the detection result. Therefore, by increasing the judging steps between the angular velocity of motion and the preset angular velocity, the accuracy of the installation state detection can be improved to avoid the occurrence of the detection result. An error occurred, which caused the drone to fail to complete the flight mission or even be damaged.
  • the most important step in the detection process of the radar installation state is the determination of the correlation between the terrain information and the attitude information.
  • the predetermined correlation between the terrain information and the posture information can be expressed as the two types of information satisfying the preset numerical correspondence.
  • the predetermined correlation between the terrain information and the posture information may also be expressed as that the two have the same changing trend.
  • step S103 in the foregoing embodiments that is, an implementation manner of optionally determining a predetermined correlation, is shown in FIG. 4a:
  • multiple terrain information and multiple posture information can be acquired within a preset time period. Since the point cloud data used in determining terrain information is collected during the rotation of the radar, and the attitude information is collected by the sensor on the UAV, when the rotation period of the radar is the same as the data collection period of the sensor, Then the quantity of terrain information and posture information acquired within the preset time period are equal.
  • the number of terrain information and attitude information acquired within the preset time period are both N, slope(i) represents the i-th one of the N acquired terrain information, and the terrain information corresponds to the body coordinate system,
  • This coordinate system conforms to the right-hand rule, its origin is the center of gravity of the drone, the X axis points to the forward direction of the drone, and the Y axis points to the right side of the aircraft from the origin.
  • the calculation result of the above formula is greater than the preset threshold, it indicates that the two kinds of information acquired during the preset time period have the same changing trend, and it can be determined that there is a predetermined correlation between the two, otherwise it can be determined that the two have no predetermined Correlation.
  • the preset threshold used in the above judgment process can be set to 0. If the sum of the products is greater than 0, it can be determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly. If the sum of the products is less than or equal to 0, it can be determined that there is no predetermined correlation between the terrain information and the attitude information, that is, a radar installation error. This error can be a reverse installation or a reverse installation.
  • the above formula (1) is actually an expression of the cross-correlation function between terrain information and posture information. If the product is greater than 0, that is, the cross-correlation function value is positive, it indicates that the radar is installed correctly. If the product is less than or equal to 0, that is, the cross-correlation function is non-positive, it indicates that the radar is installed incorrectly (reversed radar) or It may be installed incorrectly.
  • the preset threshold may be set to other values greater than 0. For example, set the preset threshold to 0.5. If the sum of the products is greater than 0.5, it is determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly. If the sum of the products is less than 0.5, it is determined that there is no predetermined correlation between the terrain information and the attitude information, that is, the radar installation error. If the sum of the products is between -0.5 and 0.5, you can re-test, or use other methods to combine judgment.
  • S1033 Calculate the first average value and the first standard deviation of the terrain information acquired in the preset time period.
  • the first average value of the terrain information can be calculated according to the following formula:
  • N is the number of acquired terrain information
  • slope(i) represents the i-th one of the N terrain information acquired under the body coordinate system.
  • S1034 Calculate a second average value and a second standard deviation of the posture information acquired within a preset time period.
  • the second average value of the posture information can be calculated according to the following formula:
  • N is the number of acquired posture information
  • pitch(i) represents the i-th one of the acquired N posture information
  • S1035 Determine whether there is a predetermined correlation between the terrain information and the posture information according to the first average value, the first standard deviation, the second average value, and the second standard deviation.
  • the calculation result of the above formula is greater than the preset threshold, it indicates that the two kinds of information acquired during the preset time period have the same changing trend, and it can be determined that there is a predetermined correlation between the two, otherwise it can be determined that the two have no predetermined Correlation.
  • the preset threshold used in the above judgment process can also be set to 0. If the sum of the products is greater than 0, it can be determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly. If the sum of the products is less than or equal to 0, it can be determined that there is no predetermined correlation between the terrain information and the attitude information, that is, a radar installation error. This error can also be installed backwards or upside down.
  • the above formula (6) is actually another way of expressing the cross-correlation function between terrain information and posture information. If the product is greater than 0, that is, the cross-correlation function value is positive, it indicates that the radar is installed correctly. If the product is less than or equal to 0, that is, the cross-correlation function is non-positive, it indicates that the radar is installed incorrectly.
  • the preset threshold may be set to other values greater than 0. For example, set the preset threshold to 0.5. If the sum of the products is greater than 0.5, it is determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly.
  • the sum of the products is less than 0.5, it is determined that there is no predetermined correlation between the terrain information and the attitude information, that is, the radar installation error. If the sum of the products is between -0.5 and 0.5, you need to re-test or use other methods to combine judgment.
  • the above formula (1) and formula (6) are two different representations of the cross-correlation function between terrain information and posture information, and both have their own advantages and disadvantages.
  • the expression of formula (1) is relatively simple and can realize fast calculation.
  • the expression of formula (6) is more complicated, the calculation of average and standard deviation can improve the accuracy of correlation calculation.
  • the amount of terrain information and posture information used should be equal.
  • the rotation period of the radar is usually greater than the data collection period of the sensor. This will result in more posture information and quantity than terrain information, that is, at a certain moment, there will be a situation where only the posture information is acquired but the terrain information is not acquired.
  • the installation state cannot be detected only based on the posture information, that is, the obtained posture information becomes invalid data.
  • the posture information acquired at the current time and the terrain information acquired at the previous time may be merged, so as to obtain the terrain information at the current time. After fusion processing, the number of terrain information and posture information can be equalized. At this time, you can continue to determine whether there is a predetermined correlation between the two according to the above formula.
  • S1036 Perform linear fitting on the terrain information acquired within a preset time period to determine a first slope corresponding to the terrain information.
  • S1037 Perform linear fitting on the posture information acquired within a preset time period to determine a second slope corresponding to the posture information.
  • linear fitting can be performed on the multiple pieces of acquired terrain information to obtain a straight line equation, that is, to determine the first slope of the equation.
  • linear fitting can be performed on multiple pieces of posture information to obtain the second slope of the straight line equation.
  • the two information is determined to have a predetermined correlation; otherwise, it is determined that they do not have a predetermined correlation.
  • this method does not require the same amount of terrain information and posture information.
  • the terrain information in the above-mentioned methods is specifically expressed as slope information
  • the attitude information is specifically expressed as a pitch angle.
  • Fig. 5 is a schematic structural diagram of a detection device for a radar installation state provided by an embodiment of the present invention. As shown in FIG. 5, this embodiment provides a detection device for the installation state of a radar, which can execute the above-mentioned detection method for the installation state of a radar; specifically, the detection device includes:
  • the first acquiring module 11 is used to acquire terrain information of the operating environment where the movable platform is located.
  • the second obtaining module 12 is used to obtain posture information of the movable platform during the operation of the operating environment.
  • the state determination module 13 is configured to determine whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
  • the device shown in FIG. 5 can also execute the method of the embodiment shown in FIG. 1 to FIG. 4c.
  • parts that are not described in detail in this embodiment please refer to the related description of the embodiment shown in FIG. 1 to FIG. 4c.
  • the implementation process and technical effects of this technical solution please refer to the description in the embodiment shown in FIG. 1 to FIG. 4c, which will not be repeated here.
  • FIG. 6 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention. referring to FIG. 6, an embodiment of the present invention provides a movable platform, and the movable platform is at least one of the following: Aircraft, unmanned ships, unmanned vehicles; specifically, the movable platform includes: a body 21, a power system 22, and a control device 23.
  • the power system 22 is arranged on the body and used to provide power for the movable platform.
  • the control device 23 includes a memory 231 and a processor 232.
  • the memory is used to store a computer program
  • the processor is configured to run a computer program stored in the memory to realize:
  • the radar on the movable platform is installed correctly.
  • the processor 232 is further configured to determine whether there is a predetermined correlation between the terrain information and the posture information;
  • the processor 232 is further configured to: for the terrain information and the attitude information acquired within a preset time period, respectively calculate the product of the terrain information and the attitude information corresponding to the same time;
  • the processor 232 is further configured to: calculate the first average value and the first standard deviation of the terrain information acquired within a preset time period;
  • the processor 232 is further configured to: perform linear fitting on the terrain information acquired within a preset time period to determine the first slope corresponding to the terrain information;
  • the processor 232 is further configured to: if there is no predetermined correlation between the terrain information and the attitude information, determine that the radar installed on the movable platform is installed incorrectly;
  • processor 232 is further configured to: obtain multiple point cloud data describing the operating environment of the movable platform;
  • the terrain information is determined according to the straight line equation.
  • processor 232 is further configured to: obtain the angular velocity of movement of the movable platform;
  • angular velocity of motion is greater than or equal to a preset threshold, it is determined whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
  • the movable platform shown in Fig. 6 can execute the method of the embodiment shown in Figs. 1 to 4c.
  • the parts not described in detail in this embodiment please refer to the relevant description of the embodiment shown in Figs. 1 to 4c.
  • the structure of the detection device of the radar installation state shown in FIG. 7 can be realized as an electronic device, and the electronic device can be an unmanned aerial vehicle.
  • the electronic device may include: one or more processors 31 and one or more memories 32.
  • the memory 32 is used to store a program that supports the electronic device to execute the radar installation state detection method provided in the embodiment shown in FIGS. 1 to 4c.
  • the processor 21 is configured to execute a program stored in the memory 32.
  • the program includes one or more computer instructions, where one or more computer instructions can implement the following steps when executed by the processor 31:
  • the radar on the movable platform is installed correctly.
  • the structure of the pan/tilt control device may further include a communication interface 33 for the electronic device to communicate with other devices or a communication network.
  • the processor 31 is further configured to determine whether there is a predetermined correlation between the terrain information and the posture information;
  • the processor 31 is further configured to: for the terrain information and the attitude information acquired within a preset time period, respectively calculate the product of the terrain information and the attitude information corresponding to the same time;
  • the processor 31 is further configured to: calculate the first average value and the first standard deviation of the terrain information acquired within a preset time period;
  • the processor 31 is further configured to: perform linear fitting on the terrain information acquired within a preset time period to determine the first slope corresponding to the terrain information;
  • the processor 31 is further configured to: if there is no predetermined correlation between the terrain information and the attitude information, determine that the radar installed on the movable platform is installed incorrectly;
  • the processor 31 is further configured to: obtain multiple point cloud data describing the operating environment of the movable platform;
  • the terrain information is determined according to the straight line equation.
  • the processor 31 is further configured to: obtain the angular velocity of movement of the movable platform;
  • angular velocity of motion is greater than or equal to a preset threshold, it is determined whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
  • the device shown in FIG. 7 can execute the method of the embodiment shown in FIG. 1 to FIG. 4c.
  • parts that are not described in detail in this embodiment refer to the related description of the embodiment shown in FIG. 1 to FIG. 4c.
  • the implementation process and technical effects of this technical solution please refer to the description in the embodiment shown in FIG. 1 to FIG. 4c, which will not be repeated here.
  • an embodiment of the present invention provides a computer-readable storage medium, the storage medium is a computer-readable storage medium, and the computer-readable storage medium stores program instructions, and the program instructions are used to implement the radar shown in FIGS. 1 to 4c. Detection method of installation status.
  • the related detection device for example: IMU
  • the embodiments of the remote control device described above are merely illustrative.
  • the division of the modules or units is only a logical function division. In actual implementation, there may be other division methods, such as multiple units or components. It can be combined or integrated into another system, or some features can be ignored or not implemented.
  • the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, remote control devices or units, and may be in electrical, mechanical or other forms.
  • the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the objectives of the solutions of the embodiments.
  • the functional units in the various embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units may be integrated into one unit.
  • the above-mentioned integrated unit can be implemented in the form of hardware or software functional unit.
  • the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer readable storage medium.
  • the technical solution of the present invention essentially or the part that contributes to the existing technology or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium.
  • the aforementioned storage media include: U disk, mobile hard disk, Read-Only Memory (ROM), Random Access Memory (RAM, Random Access Memory), magnetic disks or optical disks and other media that can store program codes.

Abstract

A radar mounting state detection method and device, a movable platform, and a storage medium. The radar mounting state detection method comprises: in the process of running a task on a movable platform, obtaining terrain information of the operating environment where the movable platform is located (S101); obtaining attitude information of the movable platform during the operation of the operating environment (S102); and determining, according to the terrain information and the attitude information, whether a radar configured on the movable platform is correctly mounted (S103). By comprehensively using multiple aspects of information, the radar mounting state can be accurately detected, and an error in mounting is avoided.

Description

雷达安装状态的检测方法、可移动平台、设备和存储介质Radar installation state detection method, movable platform, equipment and storage medium 技术领域Technical field
本发明涉及雷达领域,尤其涉及一种雷达安装状态的检测方法、可移动平台、设备和存储介质。The invention relates to the field of radars, in particular to a detection method, a movable platform, equipment and a storage medium for the installation state of a radar.
背景技术Background technique
可移动平台目前已经广泛使用到众多领域中。在不同领域中可移动平台都存在根据所在运行环境的环境信息进行避障的需求。其中,运行环境信息又可以包括地形信息、环境内物体分布密度等等。此时,可移动平台可以先利用自身配置的雷达对周围环境进行观测,再根据观测得到的点云数据估计环境信息,从而基于环境信息实现避障。Movable platforms have been widely used in many fields. In different fields, mobile platforms have the need to avoid obstacles based on the environmental information of the operating environment. Among them, the operating environment information may include terrain information, the distribution density of objects in the environment, and so on. At this point, the mobile platform can first use its own radar to observe the surrounding environment, and then estimate the environmental information based on the point cloud data obtained from the observation, so as to realize obstacle avoidance based on the environmental information.
而在一些特殊领域,比如农业领域中,通常可以利用可移动平台进行药物喷洒,且每经过一段时间就需要对此可移动平台进行清洗。而每次清洗前后,都需要对可移动平台上配置的雷达进行拆卸和重新安装。对于不熟悉机器的用户,很容易出现雷达安装错误的情况,此安装错误有可能还会导致可移动平台的损毁。In some special fields, such as agriculture, a movable platform can usually be used for spraying medicine, and the movable platform needs to be cleaned every time a period of time has passed. Before and after each cleaning, the radar configured on the movable platform needs to be disassembled and reinstalled. For users who are not familiar with the machine, it is easy to have radar installation errors. This installation error may also cause damage to the movable platform.
发明内容Summary of the invention
本发明提供了一种雷达安装状态的检测方法、可移动平台、设备和存储介质,用以准确检测出雷达的安装状态,避免出现安装错误。The invention provides a detection method, a movable platform, equipment and a storage medium for the radar installation state, which are used to accurately detect the installation state of the radar and avoid installation errors.
本发明的第一方面是为了提供一种雷达安装状态的检测方法,所述方法包括:The first aspect of the present invention is to provide a method for detecting the installation state of a radar, the method including:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
本发明的第二方面是为了提供一种可移动平台,所述移动平台至少包括:机体、动力系统以及控制装置;The second aspect of the present invention is to provide a movable platform, which at least includes: a body, a power system, and a control device;
所述动力系统,设置于所述机体上,用于为所述可移动平台提供动力;The power system is arranged on the body and used to provide power for the movable platform;
所述控制装置包含存储器和处理器;The control device includes a memory and a processor;
所述存储器,用于存储计算机程序;The memory is used to store a computer program;
所述处理器,用于运行所述存储器中存储的计算机程序以实现:The processor is configured to run a computer program stored in the memory to realize:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
本发明的第三方面是为了提供一种雷达安装状态的检测设备,所述检测设备包括:The third aspect of the present invention is to provide a radar installation state detection device, the detection device comprising:
存储器,用于存储计算机程序;Memory, used to store computer programs;
处理器,用于运行所述存储器中存储的计算机程序以实现:The processor is configured to run a computer program stored in the memory to realize:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
本发明的第四方面是为了提供一种计算机可读存储介质,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于第一方面所述的雷达安装状态的检测方法。The fourth aspect of the present invention is to provide a computer-readable storage medium, the storage medium is a computer-readable storage medium, the computer-readable storage medium stores program instructions, and the program instructions are used in the first aspect. The detection method of the radar installation state described.
本发明提供的雷达安装状态的检测方法、可移动平台、设备和存储介质,能够准确检测出雷达的安装状态,避免出现安装错误。The radar installation state detection method, movable platform, equipment and storage medium provided by the present invention can accurately detect the installation state of the radar and avoid installation errors.
附图说明Description of the drawings
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:The drawings described here are used to provide a further understanding of the application and constitute a part of the application. The exemplary embodiments and descriptions of the application are used to explain the application, and do not constitute an improper limitation of the application. In the attached picture:
图1为本发明实施例提供的一种雷达安装状态的检测方法的流程示意图;FIG. 1 is a schematic flowchart of a method for detecting a radar installation state according to an embodiment of the present invention;
图2为本发明实施例提供的一种地形信息的确定方式;Fig. 2 is a method for determining terrain information provided by an embodiment of the present invention;
图3为本发明实施例提供的另一种雷达安装状态的检测方法的流程示意图;FIG. 3 is a schematic flowchart of another method for detecting the installation state of a radar according to an embodiment of the present invention;
图4a为本发明实施例提供的一种预定的相关性的判断方式;Fig. 4a is a predetermined correlation judgment method provided by an embodiment of the present invention;
图4b为本发明实施例提供的另一种预定的相关性的判断方式;FIG. 4b is another predetermined correlation judgment method provided by an embodiment of the present invention;
图4c为本发明实施例提供的又一种预定的相关性的判断方式;FIG. 4c is another predetermined correlation judgment method provided by an embodiment of the present invention;
图5为本发明实施例提供的一种云雷达安装状态的检测装置的结构示意图;5 is a schematic structural diagram of a device for detecting the installation state of cloud radar provided by an embodiment of the present invention;
图6为本发明实施例提供的一种可移动平台的结构示意图;FIG. 6 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention;
图7为本发明实施例提供的一种云雷达安装状态的检测设备的结构示意图。Fig. 7 is a schematic structural diagram of a device for detecting the installation state of cloud radar provided by an embodiment of the present invention.
具体实施方式Detailed ways
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the objectives, technical solutions, and advantages of the embodiments of the present invention clearer, the following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments These are a part of the embodiments of the present invention, but not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of the present invention.
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by those skilled in the technical field of the present invention. The terms used in the description of the present invention herein are only for the purpose of describing specific embodiments, and are not intended to limit the present invention.
背景技术部分已经提及了农业场景中会存在对可移动平台进行清洗的需求,下面结合附图,可以基于此场景对本发明的一些实施方式作详细说明。但需要说明的有,上述的农业场景只是一种举例,本发明并不限定使用场景,只要有对可移动平台上配置的雷达进行拆卸需求的场景均可以。并且在各实施例之间不冲突的情况下,下述各实施例及各实施例中的特征可以相互组合。The background art section has already mentioned that there will be a need for cleaning the movable platform in the agricultural scene. In the following, with reference to the accompanying drawings, some embodiments of the present invention can be described in detail based on this scene. However, it should be noted that the above-mentioned agricultural scene is only an example, and the present invention does not limit the use scene, as long as there is a scene that requires disassembly of the radar configured on the movable platform. In addition, if there is no conflict between the embodiments, the following embodiments and the features in the embodiments can be combined with each other.
本发明提供的雷达安装状态的检测方法、可移动平台、设备和存储介质,在可移动平台执行任务的过程中,能够获取到可移动平台所处运行环境的地形信息以及在此运行环境运行的过程中可移动平台的姿态信息。进一步的,再根据地形信息与姿态信息这两方面的信息确定配置在可移动平台上的雷达是否安装正确。可见,本发明提供了一种根据多方面信息来判断雷达安装状态的方案,其能够准确检测出雷达的安装状态,避免出现因安装错误而最终导致可移动平台损毁的情况。The detection method of the radar installation state, the movable platform, the equipment and the storage medium provided by the present invention can obtain the terrain information of the operating environment where the movable platform is located and the operating environment of the movable platform during the execution of tasks. The posture information of the movable platform during the process. Further, it is determined whether the radar configured on the movable platform is installed correctly according to the information of the terrain information and the attitude information. It can be seen that the present invention provides a solution for judging the installation state of the radar based on various information, which can accurately detect the installation state of the radar and avoid the situation that the movable platform is eventually damaged due to installation errors.
同时,在现有技术中,安装状态的检测往往在执行正常任务之前进行, 并且可移动平台需要运行预定的轨迹,在运行场景中通常还需要摆放特定的环境标志物。而与现有技术相比,本发明提供的检测方法,一方面,是在可移动平台执行正常任务过程中进行的,可移动平台无需运行预定的轨迹,另一方面,在可移动平台运动的整个过程中能够对雷达的安装状态进行持续地检测,提高检测的实时性。At the same time, in the prior art, the detection of the installation status is often performed before normal tasks are performed, and the movable platform needs to run a predetermined trajectory, and it is usually necessary to place specific environmental markers in the running scene. Compared with the prior art, the detection method provided by the present invention, on the one hand, is carried out in the process of the movable platform performing normal tasks, the movable platform does not need to run a predetermined trajectory, on the other hand, the movable platform is moving Throughout the process, the installation status of the radar can be continuously detected to improve the real-time detection.
基于上述描述,本发明实施例提供一种雷达安装状态的检测方法,该方法包括:Based on the foregoing description, an embodiment of the present invention provides a method for detecting the installation state of a radar, the method including:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
本发明实施例还提供一种可移动平台,该平台至少包括:机体、动力系统以及控制装置;The embodiment of the present invention also provides a movable platform, which at least includes: a body, a power system, and a control device;
所述动力系统,设置于所述机体上,用于为所述可移动平台提供动力;The power system is arranged on the body and used to provide power for the movable platform;
所述控制装置包括存储器和处理器;The control device includes a memory and a processor;
所述存储器,用于存储计算机程序;The memory is used to store a computer program;
处理器,用于运行所述存储器中存储的计算机程序以实现:The processor is configured to run a computer program stored in the memory to realize:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
本发明实施例还提供一种雷达安装状态的检测设备,该设备包括:The embodiment of the present invention also provides a radar installation state detection device, which includes:
存储器,用于存储计算机程序;Memory, used to store computer programs;
处理器,用于运行所述存储器中存储的计算机程序以实现:The processor is configured to run a computer program stored in the memory to realize:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
本发明实施例还提供一种计算机可读存储介质,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于上述的雷达安装状态的检测方法。The embodiment of the present invention also provides a computer-readable storage medium, the storage medium is a computer-readable storage medium, the computer-readable storage medium stores program instructions, and the program instructions are used for the detection of the above-mentioned radar installation status method.
图1为本发明实施例提供的一种雷达安装状态的检测方法的流程示意图。该雷达安装状态的检测方法的执行主体是检测设备。可以理解的是,该检测设备可以实现为软件、或者软件和硬件的组合。检测设备执行该雷达安装状态的检测方法,则可以实现对雷达的安装状态的检测。本实施例以及下述各实施例中的检测设备具体来说可以是如无人机、无人车、无人船等的任意一种可移动平台。以可移动平台为无人机这种情况为例,对下述各实施例进行说明。在此种举例下,可移动平台的运行环境即为无人机的飞行环境,可移动平台的运行即为无人机的飞行。则具体的,该方法可以包括:FIG. 1 is a schematic flowchart of a method for detecting the installation state of a radar according to an embodiment of the present invention. The execution subject of the detection method of the radar installation state is the detection equipment. It can be understood that the detection device can be implemented as software or a combination of software and hardware. The detection device executes the detection method of the installation state of the radar, and the detection of the installation state of the radar can be realized. The detection equipment in this embodiment and the following embodiments may specifically be any movable platforms such as unmanned aerial vehicles, unmanned vehicles, and unmanned ships. Taking the case where the movable platform is an unmanned aerial vehicle as an example, the following embodiments are described. In this example, the operating environment of the movable platform is the flying environment of the UAV, and the operation of the movable platform is the flying of the UAV. Specifically, the method may include:
S101,获取可移动平台所处运行环境的地形信息。S101: Acquire terrain information of the operating environment where the movable platform is located.
无人机在执行正常的飞行任务时,一种可选地方式,无人机上配置的摄像头可以拍得飞行环境对应的图像,然后通过图像识别方式即可确定出飞行环境的地形信息,以根据此地形信息实现避障。其中,地形信息可以表示飞行环境中的地面是否存在坡度,也可以表示飞行环境中障碍物的分布情况。另一种可选地方式,无人机上配置的雷达会不断运动并采集到多个点云数据。然后,根据采集到的多个点云数据的坐标值可以确定飞行环境的地形信息,再进一步根据地形信息确定障碍物的位置,从而实现避障。可选地,无人机上配置的雷达可以是旋转雷达,则上述多个点云数据可以是旋转雷达旋转一周采集到的数据,其可以用于描述无人机360°视角范围内障碍物的分布情况。When the drone is performing a normal flight mission, an optional method is that the camera configured on the drone can take an image corresponding to the flight environment, and then the terrain information of the flight environment can be determined through image recognition. This terrain information realizes obstacle avoidance. Among them, the terrain information can indicate whether there is a slope on the ground in the flight environment, and it can also indicate the distribution of obstacles in the flight environment. In another alternative, the radar configured on the UAV will continuously move and collect multiple point cloud data. Then, based on the coordinate values of the collected multiple point cloud data, the terrain information of the flight environment can be determined, and the location of the obstacles can be further determined based on the terrain information, so as to achieve obstacle avoidance. Optionally, the radar configured on the drone can be a rotating radar, and the multiple point cloud data mentioned above can be data collected by one rotation of the rotating radar, which can be used to describe the distribution of obstacles within the 360° viewing angle of the drone Happening.
可选地,在实际应用中,出于计算量和避障效果的综合考虑,还可以根据坐标值对雷达采集到的多个点云数据进行筛选,比如筛选出用于描述无人机120°视角范围内的点云数据,再根据筛选后的点云数据确定飞行环境的地形信息。Optionally, in practical applications, for the comprehensive consideration of calculation amount and obstacle avoidance effect, multiple point cloud data collected by radar can also be filtered according to coordinate values, such as filtering out the 120° data used to describe the UAV Based on the point cloud data within the visual angle, the topographic information of the flight environment is determined based on the filtered point cloud data.
对于上述的地形信息,可选地,其可以是飞机所处飞行环境的坡度信息,也可以是此飞行环境中的障碍物分布密度等等。当地形信息为障碍物分布密度时,在获取到雷达采集的多个点云数据后,可以根据此多个点云数据的坐标值确定出在飞行环境中障碍物所处的位置、障碍物的体积等内容。并进一步根据此障碍物的位置和体积分析出飞行环境中的障碍物分布密度。For the above-mentioned terrain information, optionally, it may be the slope information of the flight environment where the aircraft is located, or the distribution density of obstacles in the flight environment, and so on. When the terrain information is the distribution density of obstacles, after obtaining multiple point cloud data collected by radar, the position of the obstacle and the position of the obstacle in the flight environment can be determined according to the coordinate values of the multiple point cloud data. Volume and other content. And further analyze the obstacle distribution density in the flying environment based on the position and volume of the obstacle.
S102,获取可移动平台在运行环境运行过程中的姿态信息。S102: Obtain posture information of the movable platform during the operation of the operating environment.
接着,在无人机飞行过程中,还可以根据其自身配置的传感器,比如九轴传感器采集到的传感数据计算无人机的姿态信息。顾名思义,无人机的姿 态信息可以表示无人机的飞行姿态,比如处于水平飞行或者倾斜飞行等等。可选地,此姿态信息可以是无人机的俯仰角、航向角或者滚转角等等。Then, during the flight of the UAV, the attitude information of the UAV can also be calculated based on the sensor data collected by its own sensors, such as the nine-axis sensor. As the name implies, the attitude information of the UAV can indicate the flight attitude of the UAV, such as horizontal flight or tilt flight. Optionally, this attitude information may be the pitch angle, heading angle, or roll angle of the drone.
S103,根据地形信息和姿态信息,确定在可移动平台上的雷达是否安装正确。S103: Determine whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
一种可选地方式,当地形信息通过图像识别方式得到时,可以根据地形信息和姿态信息所表示含义是否一致来确定雷达是否安装正确。In an optional manner, when the terrain information is obtained through image recognition, it can be determined whether the radar is installed correctly according to whether the meanings of the terrain information and the posture information are consistent.
具体来说,若地形信息表示飞行环境的地面为平地,得到的姿态信息表明无人机正在与水平地面平行飞行,说明地形信息和姿态信息所表示的含义具有一致性,则可以确定无人机上的雷达安装正确。若地形信息为飞行环境的地面为平地,而得到的姿态信息表明无人机正在与水平地面呈一定角度倾斜飞行,说明地形信息和姿态信息所表示的含义不一致,则可以确定雷达安装错误。另一种可选地方式,当地形信息是通过雷达采集的点云数据确定出时,还可以通过确定地形信息和姿态信息之间预定的相关性来确定雷达安装是否正确。Specifically, if the terrain information indicates that the ground of the flight environment is flat, and the obtained attitude information indicates that the UAV is flying parallel to the horizontal ground, indicating that the meaning of the terrain information and attitude information is consistent, it can be determined that the UAV is on board. The radar is installed correctly. If the terrain information is that the ground in the flight environment is flat, and the obtained attitude information indicates that the UAV is flying at a certain angle to the horizontal ground, indicating that the meaning of the terrain information and attitude information is inconsistent, the radar installation error can be determined. In another optional manner, when the terrain information is determined through the point cloud data collected by the radar, it can also be determined whether the radar is installed correctly by determining the predetermined correlation between the terrain information and the attitude information.
具体来说,在确定出飞行环境的地形信息以及无人机在此飞行环境中的姿态信息后,则可以进一步判断二种信息之间是否存在预定的相关性。可选地,此预定的相关性可以具体表现为二种信息满足预设的数值对应关系。Specifically, after determining the terrain information of the flight environment and the attitude information of the drone in the flight environment, it can be further determined whether there is a predetermined correlation between the two types of information. Optionally, the predetermined correlation may be specifically expressed as the two types of information satisfying a preset value correspondence relationship.
举例来说,当地形信息为障碍物分布密度,姿态信息为俯仰角时,先确定障碍物分布密度所属的数值区间与俯仰角所属的角度区间,第一种情况,若数值区间和角度区间存在预设的对应关系,表明障碍物分布密度与俯仰角之间存在预设的对应关系,表明障碍物分布密度与俯仰角之间具有预定的相关性,则确定雷达安装正确。For example, when the terrain information is the distribution density of obstacles and the attitude information is the elevation angle, first determine the numerical interval to which the obstacle distribution density belongs and the angle interval to which the elevation angle belongs. In the first case, if the numerical interval and the angle interval exist The preset correspondence relationship indicates that there is a preset correspondence relationship between the obstacle distribution density and the pitch angle, indicating that there is a predetermined correlation between the obstacle distribution density and the pitch angle, and it is determined that the radar is installed correctly.
第二种情况,当第一数值区间和第二数值区间不存在预设的对应关系,表明障碍物分布密度与俯仰角之间不存在预设的对应关系,说明障碍物分布密度与俯仰角之间不具有预定的相关性,则确定雷达安装错误。此安装错误具体来说可以是前后装反或者是上下装反。此时,用户可以控制无人机降落,并对重新安装雷达,以避免出现因雷达安装错误而导致的无人机损毁。In the second case, when there is no preset correspondence between the first numerical interval and the second numerical interval, it indicates that there is no preset correspondence between the obstacle distribution density and the pitch angle, indicating that the obstacle distribution density and the pitch angle are different. If there is no predetermined correlation between the two, it is determined that the radar is installed incorrectly. Specifically, the installation error can be the reverse installation or the upper and lower installation. At this point, the user can control the drone to land and reinstall the radar to avoid damage to the drone caused by incorrect installation of the radar.
本实施例提供的雷达安装状态的检测方法,在无人机执行飞行任务的过程中,能够获取到无人机所处飞行环境的地形信息以及在此飞行环境飞行的过程中无人机的姿态信息。进一步的,再根据地形信息与姿态信息确定雷达是否安装正确。可见,本实施例中提供了一种根据多方面信息判断雷达安装 状态的方案,此方法一方面,是在无人机执行正常飞行任务过程中进行的,无人机无需飞行预定的轨迹,另一方面,在无人机飞行的整个过程中能够对雷达的安装状态进行持续地检测,提高检测的实时性。The method for detecting the installation status of the radar provided in this embodiment can obtain the terrain information of the flying environment of the drone and the attitude of the drone during the flight of the flying environment during the flight mission of the drone. information. Furthermore, it is determined whether the radar is installed correctly according to the terrain information and attitude information. It can be seen that this embodiment provides a solution for judging the radar installation status based on various information. On the one hand, this method is carried out during the normal flight mission of the drone, and the drone does not need to fly a predetermined trajectory. On the one hand, the installation status of the radar can be continuously detected during the entire flight of the UAV, which improves the real-time detection.
上述实施例中已经提供了一种获取地形信息的方式,除了上述方式之外,如图2所示,步骤S101另一种可选地可实现方式可以为:In the foregoing embodiment, a method for obtaining terrain information has been provided. In addition to the foregoing manner, as shown in FIG. 2, another optional implementation manner of step S101 may be:
S1011,获取描述可移动平台运行环境的多个点云数据。例如,获取描述无人机飞行环境的多个点运数据。S1011: Obtain multiple point cloud data describing the operating environment of the mobile platform. For example, obtain multiple point transportation data describing the flight environment of the drone.
S1012,根据多个点云数据的坐标值选取预设视角范围内的目标点云数据。S1012: Select target point cloud data within a preset viewing angle range according to the coordinate values of the multiple point cloud data.
S1013,对目标点云数据进行线性拟合,以得到直线方程。S1013: Perform linear fitting on the target point cloud data to obtain a straight line equation.
S1014,根据直线方程确定地形信息。S1014: Determine terrain information according to the straight line equation.
在无人机运行(例如,正常飞行)过程中,首先,无人机上的雷达在旋转过程中可以采集到多个点云数据,正如上文所述的,此多个点云数据可以用于描述为无人机360°视角范围内障碍物的分布情况。然后,可以根据多个点云数据的坐标值选取预设视角范围内的数据作为目标点云数据。此预设视角的大小可以根据实际情况预先设定,比如可以设定为上述实施例中提及的120°。During the operation of the drone (for example, normal flight), first, the radar on the drone can collect multiple point cloud data during the rotation process. As mentioned above, this multiple point cloud data can be used for It is described as the distribution of obstacles within the 360° viewing angle of the drone. Then, according to the coordinate values of the multiple point cloud data, the data within the preset viewing angle range can be selected as the target point cloud data. The size of the preset viewing angle can be preset according to actual conditions, for example, it can be set to 120° as mentioned in the above embodiment.
接着,对于选取出的目标点云数据,可选地,可以利用最小二乘法对其进行线性拟合,以得到直线方程,再根据直线方程的系数确定地形信息。具体来说,假设直线方程表示为:y=kx+b,则可以确定无人机飞行环境中的地形信息为:k/b,此地形信息具体来说可以是飞行环境的坡度信息。Then, for the selected target point cloud data, optionally, the least square method can be used to linearly fit it to obtain a straight line equation, and then the topographic information is determined according to the coefficient of the straight line equation. Specifically, assuming that the linear equation is expressed as: y=kx+b, it can be determined that the terrain information in the drone flight environment is: k/b, and the terrain information may specifically be slope information of the flight environment.
综上所述,图1和图2所示实施例提供了两种以雷达采集到的点云数据为依据确定地形信息方式。在实际应用中,可以根据地形信息表示的具体含义不同,选择使用不同的方式以得到相应内容的地形信息。In summary, the embodiment shown in Fig. 1 and Fig. 2 provides two methods for determining terrain information based on point cloud data collected by radar. In practical applications, you can choose to use different methods to obtain the terrain information of the corresponding content according to the specific meaning of the terrain information.
根据上述各实施例中的描述可知,当确定出地形信息和姿态信息之间不具有预定的相关性时,就表明雷达当前处于安装错误状态。而在实际应用中,雷达和传感器采集到的、用于确定地形信息和姿态信息的数据又难免会存在错误。因此,基于上述各实施例,如图3所示,当确定出地形信息和姿态信息之间不具有预定的相关性时,该雷达安装状态的检测方法还可以包括:According to the description in the foregoing embodiments, when it is determined that there is no predetermined correlation between the terrain information and the attitude information, it indicates that the radar is currently in an installation error state. In practical applications, the data collected by radars and sensors for determining terrain information and attitude information will inevitably have errors. Therefore, based on the foregoing embodiments, as shown in FIG. 3, when it is determined that there is no predetermined correlation between the terrain information and the attitude information, the detection method of the radar installation state may further include:
S201,更新雷达安装状态为安装错误的次数。S201: Update the radar installation status to the number of installation errors.
S202,若更新后的次数高于预设次数,则发送警告通知。S202: If the updated number of times is higher than the preset number of times, a warning notification is sent.
当根据地形信息和姿态信息确定出雷达的安装状态为安装错误,则无人机会先对检测结果进行记录,也即是实现安装状态为安装错误的次数的更新。若更新后的次数高于预设次数,表明无人机上配置的雷达持续处于安装错误的状态,此时才可以真正认为雷达是安装错误的,排除了因数据采集错误而造成的检测结果错误。接着,无人机会生成警告通知,以通知地面上的用户对无人机的飞行状态作出进一步的调整,避免出现无人机损毁的情况。When it is determined that the installation status of the radar is an installation error based on the terrain information and the attitude information, the UAV will first record the detection result, which is to realize the update of the installation status as the number of installation errors. If the updated number is higher than the preset number, it indicates that the radar configured on the UAV is continuously in a wrong installation state. Only then can the radar be truly installed incorrectly, and the error in the detection result caused by the data collection error is ruled out. Then, the drone will generate a warning notification to notify users on the ground to make further adjustments to the drone's flight status to avoid damage to the drone.
另外,无人机在正常执行任务的过程中,雷达是处于运动状态的,也即是雷达具有一个运动角速度。而根据实际经验可知,此运动角速度的大小与地形信息与姿态信息之间预定的相关性存在以下关系:角速度不小于预设速度时,地形信息与姿态信息之间预定的相关性表现的越明显。In addition, the radar is in motion during the normal mission of the UAV, that is, the radar has a moving angular velocity. According to actual experience, there is the following relationship between the magnitude of the angular velocity of this motion and the predetermined correlation between terrain information and attitude information: when the angular velocity is not less than the preset speed, the predetermined correlation between terrain information and attitude information becomes more obvious. .
则基于上述描述,图3为本发明实施例提供的另一种雷达安装状态的检测方法的流程示意图。如图3所示,基于上述各实施例,在步骤S103之前,该雷达安装状态的检测方法还可以包括:Based on the foregoing description, FIG. 3 is a schematic flowchart of another method for detecting the installation state of a radar according to an embodiment of the present invention. As shown in FIG. 3, based on the foregoing embodiments, before step S103, the detection method of the radar installation state may further include:
S203,获取可移动平台的运动角速度。S203: Acquire the angular velocity of movement of the movable platform.
S204,确定运动角速度是否大于预设阈值,若运动角速度大于预设阈值,则执行步骤S103,否则执行步骤S205。S204: Determine whether the motion angular velocity is greater than a preset threshold, if the motion angular velocity is greater than the preset threshold, step S103 is executed, otherwise, step S205 is executed.
S205,停止检测雷达安装状态。S205: Stop detecting the installation state of the radar.
具体来说,无人机的运动角速度可以由无人上配置的惯性测量单元,(Inertial measurement unit,简称IMU)测量得到。然后,对于获取到的运动角速度,判断其是否大于预设阈值。若运动角速度大于或等于预设阈值,则执行图1所示实施例中的步骤S103,步骤S103的详细实施过程可以参见上述实施例中的相关描述,在此不再赘述。若运动角速度小于预设阈值,此时,执行本发明提供的检测方法得到检测结果,其的准确性并不能得到保证,则此时可以停止雷达安装状态的检测,待下一时刻采集到的运动角速度大于预设阈值后再开启安装状态的检测。Specifically, the angular velocity of movement of the drone can be measured by an inertial measurement unit (Inertial Measurement Unit, IMU for short) configured on an unmanned aerial vehicle. Then, for the acquired angular velocity of motion, it is determined whether it is greater than a preset threshold. If the angular velocity of motion is greater than or equal to the preset threshold, step S103 in the embodiment shown in FIG. 1 is executed. For the detailed implementation process of step S103, please refer to the relevant description in the foregoing embodiment, which will not be repeated here. If the motion angular velocity is less than the preset threshold, at this time, the detection method provided by the present invention is executed to obtain the detection result, and its accuracy cannot be guaranteed, then the detection of the radar installation state can be stopped at this time, and the motion collected at the next moment After the angular velocity is greater than the preset threshold, the detection of the installation state is turned on.
本实施例中,一方面,在确定出雷达处于安装错误状态时,会对处于安装错误状态的次数进行更新。当次数大于预设次数时,表明雷达持续处于一种安装错误状态,才会将这种安装错误状态告知用户,通过次数的统计可以增加检测结果的可信度,避免因检测结果的偶然性而使得用户对无人机作出误操作,并最终导致无人机无法正常完成飞行任务甚至损毁。In this embodiment, on the one hand, when it is determined that the radar is in an installation error state, the number of times it is in an installation error state is updated. When the number of times is greater than the preset number, it indicates that the radar continues to be in a state of installation error, and then this installation error state will be notified to the user. The statistics of the number of passes can increase the credibility of the detection results and avoid the contingency of the detection results. The user mis-operated the drone, and eventually caused the drone to fail to complete the flight mission or even be damaged.
另一方面,在上述各实施例的基础上,本实施例对无人机的运动角速度提出了要求。由于上文中已经提到运动角速度与检测结果的准确性有着直接的联系,因此,通过增加运动角速度与预设角速度之间的判断步骤便可以提高安装状态检测的准确性,以避免出现因检测结果出现错误,而导致无人机无法正常完成飞行任务甚至损毁的情况。On the other hand, on the basis of the foregoing embodiments, this embodiment puts forward requirements for the angular velocity of the movement of the UAV. As mentioned above, the angular velocity of motion is directly related to the accuracy of the detection result. Therefore, by increasing the judging steps between the angular velocity of motion and the preset angular velocity, the accuracy of the installation state detection can be improved to avoid the occurrence of the detection result. An error occurred, which caused the drone to fail to complete the flight mission or even be damaged.
根据上述各实施例中的描述可知,在雷达安装状态的检测过程中最重要的步骤就是地形信息和姿态信息间相关性的确定。并且上述实施例中已经提及,地形信息和姿态信息之间的预定的相关性可以表示为二种信息满足预设的数值对应关系。除此之外,无人机在飞行过程中,实际上是可以不断得到飞行环境中地形信息和姿态信息,则在预设时间段内比如T=2秒,也即是可以得到多个地形信息和多个姿态信息。此时,可选地,地形信息和姿态信息之间的预定的相关性也可以表现为二者具有相同的变化趋势。According to the description in the foregoing embodiments, the most important step in the detection process of the radar installation state is the determination of the correlation between the terrain information and the attitude information. In addition, it has been mentioned in the foregoing embodiment that the predetermined correlation between the terrain information and the posture information can be expressed as the two types of information satisfying the preset numerical correspondence. In addition, during the flight of the UAV, the terrain information and attitude information in the flight environment can actually be continuously obtained, so within the preset time period, for example, T=2 seconds, that is, multiple terrain information can be obtained. And multiple posture information. At this time, optionally, the predetermined correlation between the terrain information and the posture information may also be expressed as that the two have the same changing trend.
基于此,则可选地,上述各实施例中步骤S103的一种具体实现方式,也即是一种可选地确定预定的相关性的实现方式如图4a所示:Based on this, optionally, a specific implementation manner of step S103 in the foregoing embodiments, that is, an implementation manner of optionally determining a predetermined correlation, is shown in FIG. 4a:
S1031,对于预设时间段内获取到的地形信息和姿态信息,分别计算对应于相同时刻的地形信息和姿态信息之间的乘积。S1031: For the terrain information and the posture information acquired within the preset time period, respectively calculate the product of the terrain information and the posture information corresponding to the same time.
S1032,若乘积之和大于预设阈值,则确定地形信息和姿态信息之间具有预定的相关性。S1032: If the sum of the products is greater than a preset threshold, it is determined that there is a predetermined correlation between the terrain information and the posture information.
具体来说,根据上述各实施例提供的方式,可以在预设时长内获取到多个地形信息和多个姿态信息。由于确定地形信息中使用到的点云数据是在雷达旋转过程中采集到的,姿态信息是由无人机上的传感器采集到的,因此,当雷达的旋转周期与传感器的数据采集周期相同时,则在预设时长内获取到的地形信息和姿态信息的数量是相等的。Specifically, according to the methods provided in the foregoing embodiments, multiple terrain information and multiple posture information can be acquired within a preset time period. Since the point cloud data used in determining terrain information is collected during the rotation of the radar, and the attitude information is collected by the sensor on the UAV, when the rotation period of the radar is the same as the data collection period of the sensor, Then the quantity of terrain information and posture information acquired within the preset time period are equal.
此时,可以采用以下公式计算地形信息与姿态信息之间的相关性:At this time, the following formula can be used to calculate the correlation between terrain information and attitude information:
Figure PCTCN2019115678-appb-000001
Figure PCTCN2019115678-appb-000001
其中,在预设时间段内获取到的地形信息和姿态信息的个数均为N个,slope(i)表示获取到的N个地形信息中的第i个,地形信息对应于机体坐标系,此坐标系符合右手法则,其的原点为无人机重心,X轴指向无人机的前进方向,Y轴由原点指向飞行器右侧,pitch(i)表示获取到的N个姿态信息中的第i个。Among them, the number of terrain information and attitude information acquired within the preset time period are both N, slope(i) represents the i-th one of the N acquired terrain information, and the terrain information corresponds to the body coordinate system, This coordinate system conforms to the right-hand rule, its origin is the center of gravity of the drone, the X axis points to the forward direction of the drone, and the Y axis points to the right side of the aircraft from the origin. i.
若上式的计算结果大于预设阈值,表明在预设时间段获取到的两种信息 具有相同的变化趋势,则可以确定二者之间具有预定的相关性,否则可以确定二者没有预定的相关性。If the calculation result of the above formula is greater than the preset threshold, it indicates that the two kinds of information acquired during the preset time period have the same changing trend, and it can be determined that there is a predetermined correlation between the two, otherwise it can be determined that the two have no predetermined Correlation.
需要说明的有,一种可选地方式,上述判断过程中使用到的预设阈值可以设置为0。若乘积之和大于0,则可以确定地形信息和姿态信息之间具有预定的相关性,也即是雷达安装正确。若乘积之和小于或等于0,则可以确定地形信息和姿态信息之间不具有预定的相关性,也即是雷达安装错误,这种错误可以是前后装反或者上下装反。It should be noted that, in an optional manner, the preset threshold used in the above judgment process can be set to 0. If the sum of the products is greater than 0, it can be determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly. If the sum of the products is less than or equal to 0, it can be determined that there is no predetermined correlation between the terrain information and the attitude information, that is, a radar installation error. This error can be a reverse installation or a reverse installation.
另外,上述公式(1)实际上是地形信息和姿态信息之间的互相关函数的一种表达方式。乘积大于0,也即是互相关函数值为正值,则表明雷达安装正确,若乘积小于或等于0,也即是互相关函数为非正值,则表明雷达安装错误(雷达装反)或可能安装错误。In addition, the above formula (1) is actually an expression of the cross-correlation function between terrain information and posture information. If the product is greater than 0, that is, the cross-correlation function value is positive, it indicates that the radar is installed correctly. If the product is less than or equal to 0, that is, the cross-correlation function is non-positive, it indicates that the radar is installed incorrectly (reversed radar) or It may be installed incorrectly.
另一种可选地方式,为去除两个信息各自存在的偏差,或者为去除误差的影响,可以预设阈值可以设置为大于0的其他数值。例如,将预设阈值设置为0.5。若乘积之和大于0.5,则确定地形信息和姿态信息之间具有预定的相关性,也即是雷达安装正确。若乘积之和小于0.5,则确定地形信息和姿态信息之间不具有预定的相关性,也即是雷达安装错误。若乘积之和为-0.5至0.5之间,则可以重新进行检测,或利用其他方法结合判断。In another optional manner, in order to remove the respective deviations of the two pieces of information, or to remove the influence of errors, the preset threshold may be set to other values greater than 0. For example, set the preset threshold to 0.5. If the sum of the products is greater than 0.5, it is determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly. If the sum of the products is less than 0.5, it is determined that there is no predetermined correlation between the terrain information and the attitude information, that is, the radar installation error. If the sum of the products is between -0.5 and 0.5, you can re-test, or use other methods to combine judgment.
除了上述方式,可选地,又一种确定预定的相关性的方式如图4b所示:In addition to the above methods, optionally, another method for determining the predetermined correlation is shown in Figure 4b:
S1033,计算预设时间段内获取到的地形信息的第一平均值和第一标准差。S1033: Calculate the first average value and the first standard deviation of the terrain information acquired in the preset time period.
对于获取到的多个地形信息,可以根据如下公式计算地形信息的第一平均值:For the multiple obtained terrain information, the first average value of the terrain information can be calculated according to the following formula:
Figure PCTCN2019115678-appb-000002
Figure PCTCN2019115678-appb-000002
根据如下公式计算地形信息的第一标准差:Calculate the first standard deviation of terrain information according to the following formula:
Figure PCTCN2019115678-appb-000003
Figure PCTCN2019115678-appb-000003
其中,N为获取到的地形信息的数量,slope(i)表示机体坐标系下获取到的N个地形信息中的第i个。Among them, N is the number of acquired terrain information, and slope(i) represents the i-th one of the N terrain information acquired under the body coordinate system.
S1034,计算预设时间段内获取到的姿态信息的第二平均值和第二标准差。S1034: Calculate a second average value and a second standard deviation of the posture information acquired within a preset time period.
对于获取到的多个姿态信息,可以根据如下公式计算姿态信息的第二平均值:For the multiple pieces of acquired posture information, the second average value of the posture information can be calculated according to the following formula:
Figure PCTCN2019115678-appb-000004
Figure PCTCN2019115678-appb-000004
根据如下公式计算姿态信息的第二标准差:Calculate the second standard deviation of the attitude information according to the following formula:
Figure PCTCN2019115678-appb-000005
Figure PCTCN2019115678-appb-000005
其中,N为获取到的姿态信息的数量,pitch(i)表示获取到的N个姿态信息中的第i个。Among them, N is the number of acquired posture information, and pitch(i) represents the i-th one of the acquired N posture information.
S1035,根据第一平均值、第一标准差、第二平均值、第二标准差确定地形信息和姿态信息之间是否具有预定的相关性。S1035: Determine whether there is a predetermined correlation between the terrain information and the posture information according to the first average value, the first standard deviation, the second average value, and the second standard deviation.
基于上述计算结果,可以根据下述公式确定地形信息和姿态信息之间是否具有预定的相关性:Based on the above calculation results, whether there is a predetermined correlation between terrain information and attitude information can be determined according to the following formula:
Figure PCTCN2019115678-appb-000006
Figure PCTCN2019115678-appb-000006
若上式的计算结果大于预设阈值,表明在预设时间段获取到的两种信息具有相同的变化趋势,则可以确定二者之间具有预定的相关性,否则可以确定二者没有预定的相关性。If the calculation result of the above formula is greater than the preset threshold, it indicates that the two kinds of information acquired during the preset time period have the same changing trend, and it can be determined that there is a predetermined correlation between the two, otherwise it can be determined that the two have no predetermined Correlation.
需要说明的有,与图4a所示实施例类似的,一种可选地方式,上述判断过程中使用到的预设阈值同样可以设置为0。若乘积之和大于0,则可以确定地形信息和姿态信息之间具有预定的相关性,也即是雷达安装正确。若乘积之和小于或等于0,则可以确定地形信息和姿态信息之间不具有预定的相关性,也即是雷达安装错误,这种错误同样可以是前后装反或者上下装反。It should be noted that, similar to the embodiment shown in FIG. 4a, in an optional manner, the preset threshold used in the above judgment process can also be set to 0. If the sum of the products is greater than 0, it can be determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly. If the sum of the products is less than or equal to 0, it can be determined that there is no predetermined correlation between the terrain information and the attitude information, that is, a radar installation error. This error can also be installed backwards or upside down.
另外,上述公式(6)实际上是地形信息和姿态信息之间的互相关函数的另一种表达方式。若乘积大于0,也即是互相关函数值为正值,则表明雷达安装正确,若乘积小于或等于0,也即是互相关函数为非正值,则表明雷达安装错误。另一种可选地方式,为去除两个信号各自存在的偏差,或者为去除误差的影响,可以将预设阈值设置为大于0的其他数值。例如,设置预设阈值为0.5。若乘积之和大于0.5,则确定地形信息和姿态信息之间具有预定的相关性,也即是雷达安装正确。若乘积之和小于0.5,则确定地形信息和姿态信息之间不具有预定的相关性,也即是雷达安装错误。若乘积之和为-0.5至0.5之间,则需要重新进行检测,或利用其他方法结合判断。In addition, the above formula (6) is actually another way of expressing the cross-correlation function between terrain information and posture information. If the product is greater than 0, that is, the cross-correlation function value is positive, it indicates that the radar is installed correctly. If the product is less than or equal to 0, that is, the cross-correlation function is non-positive, it indicates that the radar is installed incorrectly. In another optional manner, in order to remove the respective deviations of the two signals, or to remove the influence of errors, the preset threshold may be set to other values greater than 0. For example, set the preset threshold to 0.5. If the sum of the products is greater than 0.5, it is determined that there is a predetermined correlation between the terrain information and the attitude information, that is, the radar is installed correctly. If the sum of the products is less than 0.5, it is determined that there is no predetermined correlation between the terrain information and the attitude information, that is, the radar installation error. If the sum of the products is between -0.5 and 0.5, you need to re-test or use other methods to combine judgment.
根据上述描述可知,上述的公式(1)和公式(6)是地形信息和姿态信息之间互相关函数的两种不同表示形式,二者都具有各自的优缺点。式(1) 的表达方式较为简单,能够实现快速计算。式(6)的表达方式虽然较为复杂,但通过平均值和标准差的计算能够提高相关性计算的准确性。According to the above description, the above formula (1) and formula (6) are two different representations of the cross-correlation function between terrain information and posture information, and both have their own advantages and disadvantages. The expression of formula (1) is relatively simple and can realize fast calculation. Although the expression of formula (6) is more complicated, the calculation of average and standard deviation can improve the accuracy of correlation calculation.
在此需要说明的还有,根据上述各公式可知,在使用互相关函数确定相关性的过程中,使用到的地形信息和姿态信息的数量是要相等的。然而在实际应用中,雷达具有的旋转周期又通常会大于传感器的数据采集周期。这样的就会导致姿态信息和数量多于地形信息,也即是在某一时刻会出现只获取到姿态信息而没有获取到地形信息的情况。It should be noted here that according to the above formulas, in the process of using the cross-correlation function to determine the correlation, the amount of terrain information and posture information used should be equal. However, in practical applications, the rotation period of the radar is usually greater than the data collection period of the sensor. This will result in more posture information and quantity than terrain information, that is, at a certain moment, there will be a situation where only the posture information is acquired but the terrain information is not acquired.
此时,只根据姿态信息是无法进行安装状态的检测的,也即是获取到的姿态信息成为了无效数据。为了避免这种情况的发生,可选地,可以将当前时刻获取到的姿态信息和上一时刻获取到的地形信息进行融合,从而得到当前时刻的地形信息。经过融合处理后,便可以使地形信息和姿态信息数量相等,此时,可以继续根据上述公式确定二者之间是否具有预定的相关性。At this time, the installation state cannot be detected only based on the posture information, that is, the obtained posture information becomes invalid data. In order to avoid this situation, optionally, the posture information acquired at the current time and the terrain information acquired at the previous time may be merged, so as to obtain the terrain information at the current time. After fusion processing, the number of terrain information and posture information can be equalized. At this time, you can continue to determine whether there is a predetermined correlation between the two according to the above formula.
当然也可以不进行上述的融合处理,而是从数量较多的姿态信息中筛选出部分姿态信息,以使得筛选出的姿态信息的数量与在预设时间段内获取到的地形信息的数量相等即可。Of course, it is not necessary to perform the above-mentioned fusion processing, but to filter out part of the posture information from a larger amount of posture information, so that the number of posture information filtered out is equal to the number of terrain information obtained in the preset time period. That's it.
除了上述两种根据互相关函数确定相关性的方式,可选地,另一种确定预定的相关性的方式如图4c所示:In addition to the above two ways of determining the correlation based on the cross-correlation function, optionally, another way of determining the predetermined correlation is shown in Figure 4c:
S1036,对预设时间段内获取到的地形信息进行线性拟合,以确定地形信息对应的第一斜率。S1036: Perform linear fitting on the terrain information acquired within a preset time period to determine a first slope corresponding to the terrain information.
S1037,对预设时间段内获取到的姿态信息进行线性拟合,以确定姿态信息对应的第二斜率。S1037: Perform linear fitting on the posture information acquired within a preset time period to determine a second slope corresponding to the posture information.
S1038,若第一斜率和第二斜率符号相同,则确定地形信息和姿态信息之间具有预定的相关性。S1038: If the signs of the first slope and the second slope are the same, it is determined that there is a predetermined correlation between the terrain information and the posture information.
具体来说,对获取到的多个地形信息可以对其进行线性拟合,以得到直线方程,也即是确定此方程具有的第一斜率。同样的,还可以对多个姿态信息进行线性拟合,以得到直线方程的第二斜率。Specifically, linear fitting can be performed on the multiple pieces of acquired terrain information to obtain a straight line equation, that is, to determine the first slope of the equation. Similarly, it is also possible to perform linear fitting on multiple pieces of posture information to obtain the second slope of the straight line equation.
若两斜率的符号相同,表明在预设时间段内两种信息的变化趋势相同,则确定二者具有预定的相关性;否则确定二者不具有预定的相关性。If the signs of the two slopes are the same, it indicates that the changing trends of the two types of information are the same within the preset time period, and the two information is determined to have a predetermined correlation; otherwise, it is determined that they do not have a predetermined correlation.
需要说明的有,与上述两种互相关函数的方式相比,此种方式中并不需要地形信息和姿态信息具有相同的数量。并且具体来说,上述几种方式中的 地形信息具体表现为坡度信息,姿态信息具体表现为俯仰角。It should be noted that, compared with the above two cross-correlation function methods, this method does not require the same amount of terrain information and posture information. And specifically, the terrain information in the above-mentioned methods is specifically expressed as slope information, and the attitude information is specifically expressed as a pitch angle.
综上所述,对于上述提供的多种方式,在实际应用中可以根据实际需求选择相应的确定方式。In summary, for the various methods provided above, in actual applications, the corresponding determination method can be selected according to actual needs.
图5为本发明实施例提供的一种雷达安装状态的检测装置的结构示意图。如图5所示,本实施例提供了一种雷达安装状态的检测装置,该检测装置可以执行上述的雷达安装状态的检测方法;具体的,检测装置包括:Fig. 5 is a schematic structural diagram of a detection device for a radar installation state provided by an embodiment of the present invention. As shown in FIG. 5, this embodiment provides a detection device for the installation state of a radar, which can execute the above-mentioned detection method for the installation state of a radar; specifically, the detection device includes:
第一获取模块11,用于获取可移动平台所处运行环境的地形信息。The first acquiring module 11 is used to acquire terrain information of the operating environment where the movable platform is located.
第二获取模块12,用于获取所述可移动平台在所述运行环境运行过程中的姿态信息。The second obtaining module 12 is used to obtain posture information of the movable platform during the operation of the operating environment.
状态确定模块13,用于根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。The state determination module 13 is configured to determine whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
图5所示装置还可以执行图1~图4c所示实施例的方法,本实施例未详细描述的部分,可参考对图1~图4c所示实施例的相关说明。该技术方案的执行过程和技术效果参见图1~图4c所示实施例中的描述,在此不再赘述。The device shown in FIG. 5 can also execute the method of the embodiment shown in FIG. 1 to FIG. 4c. For parts that are not described in detail in this embodiment, please refer to the related description of the embodiment shown in FIG. 1 to FIG. 4c. For the implementation process and technical effects of this technical solution, please refer to the description in the embodiment shown in FIG. 1 to FIG. 4c, which will not be repeated here.
图6为本发明实施例提供的一种可移动平台的结构示意图;参考附图6所示,本发明实施例的提供了一种可移动平台,该可移动平台为以下至少之一:无人飞行器、无人船、无人车;具体的,该可移动平台包括:机体21、动力系统22以及控制装置23。FIG. 6 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention; referring to FIG. 6, an embodiment of the present invention provides a movable platform, and the movable platform is at least one of the following: Aircraft, unmanned ships, unmanned vehicles; specifically, the movable platform includes: a body 21, a power system 22, and a control device 23.
所述动力系统22,设置于所述机体上,用于为所述可移动平台提供动力。The power system 22 is arranged on the body and used to provide power for the movable platform.
所述控制装置23包括存储器231和处理器232。The control device 23 includes a memory 231 and a processor 232.
所述存储器,用于存储计算机程序;The memory is used to store a computer program;
所述处理器,用于运行所述存储器中存储的计算机程序以实现:The processor is configured to run a computer program stored in the memory to realize:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
进一步的,处理器232还用于:确定所述地形信息和所述姿态信息之间是否具有预定的相关性;Further, the processor 232 is further configured to determine whether there is a predetermined correlation between the terrain information and the posture information;
若所述地形信息和所述姿态信息之间具有所述预定的相关性,则确定在 所述可移动平台上的所述雷达安装正确。If there is the predetermined correlation between the terrain information and the attitude information, it is determined that the radar on the movable platform is installed correctly.
进一步的,处理器232还用于:对于预设时间段内获取到的所述地形信息和所述姿态信息,分别计算对应于相同时刻的地形信息和姿态信息之间的乘积;Further, the processor 232 is further configured to: for the terrain information and the attitude information acquired within a preset time period, respectively calculate the product of the terrain information and the attitude information corresponding to the same time;
若所述乘积之和大于预设阈值,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性,。If the sum of the products is greater than a preset threshold, it is determined that there is the predetermined correlation between the terrain information and the posture information.
进一步的,处理器232还用于:计算预设时间段内获取到的所述地形信息的第一平均值和第一标准差;Further, the processor 232 is further configured to: calculate the first average value and the first standard deviation of the terrain information acquired within a preset time period;
计算所述预设时间段内获取到的所述姿态信息的第二平均值和第二标准差;Calculating a second average value and a second standard deviation of the posture information acquired within the preset time period;
根据所述第一平均值、所述第一标准差、所述第二平均值、所述第二标准差确定所述地形信息和所述姿态信息之间是否具有所述预定的相关性。It is determined whether there is the predetermined correlation between the terrain information and the posture information according to the first average value, the first standard deviation, the second average value, and the second standard deviation.
进一步的,处理器232还用于:对预设时间段内获取到的所述地形信息进行线性拟合,以确定所述地形信息对应的第一斜率;Further, the processor 232 is further configured to: perform linear fitting on the terrain information acquired within a preset time period to determine the first slope corresponding to the terrain information;
对所述预设时间段内获取到的所述姿态信息进行线性拟合,以确定所述姿态信息对应的第二斜率;Performing linear fitting on the posture information acquired within the preset time period to determine the second slope corresponding to the posture information;
若所述第一斜率和所述第二斜率符号相同,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性。If the signs of the first slope and the second slope are the same, it is determined that the terrain information and the posture information have the predetermined correlation.
进一步的,处理器232还用于:若所述地形信息和所述姿态信息之间不具有所述预定的相关性,则确定安装在所述可移动平台上的雷达安装错误;Further, the processor 232 is further configured to: if there is no predetermined correlation between the terrain information and the attitude information, determine that the radar installed on the movable platform is installed incorrectly;
更新雷达安装状态为安装错误的次数;Update the radar installation status to the number of installation errors;
若更新后的次数高于预设次数,则发送警告通知。If the updated number is higher than the preset number, a warning notification will be sent.
进一步的,处理器232还用于:获取描述所述可移动平台运行环境的多个点云数据;Further, the processor 232 is further configured to: obtain multiple point cloud data describing the operating environment of the movable platform;
根据所述多个点云数据的坐标值选取预设视角范围内的目标点云数据;Selecting target point cloud data within a preset viewing angle range according to the coordinate values of the multiple point cloud data;
对所述目标点云数据进行线性拟合,以得到直线方程;Performing linear fitting on the target point cloud data to obtain a straight line equation;
根据所述直线方程确定所述地形信息。The terrain information is determined according to the straight line equation.
进一步的,处理器232还用于:获取所述可移动平台的运动角速度;Further, the processor 232 is further configured to: obtain the angular velocity of movement of the movable platform;
若所述运动角速度大于或等于预设阈值,则根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。If the angular velocity of motion is greater than or equal to a preset threshold, it is determined whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
图6所示的可移动平台可以执行图1~图4c所示实施例的方法,本实施例未 详细描述的部分,可参考对图1~图4c所示实施例的相关说明。该技术方案的执行过程和技术效果参见图1~图4c所示实施例中的描述,在此不再赘述。The movable platform shown in Fig. 6 can execute the method of the embodiment shown in Figs. 1 to 4c. For the parts not described in detail in this embodiment, please refer to the relevant description of the embodiment shown in Figs. 1 to 4c. For the implementation process and technical effects of this technical solution, please refer to the description in the embodiment shown in FIG. 1 to FIG. 4c, which will not be repeated here.
在一个可能的设计中,图7所示雷达安装状态的检测设备的结构可实现为一电子设备,该电子设备可以是无人机。如图7所示,该电子设备可以包括:一个或多个处理器31和一个或多个存储器32。其中,存储器32用于存储支持电子设备执行上述图1~图4c所示实施例中提供的雷达安装状态的检测方法的程序。处理器21被配置为用于执行存储器32中存储的程序。In a possible design, the structure of the detection device of the radar installation state shown in FIG. 7 can be realized as an electronic device, and the electronic device can be an unmanned aerial vehicle. As shown in FIG. 7, the electronic device may include: one or more processors 31 and one or more memories 32. Wherein, the memory 32 is used to store a program that supports the electronic device to execute the radar installation state detection method provided in the embodiment shown in FIGS. 1 to 4c. The processor 21 is configured to execute a program stored in the memory 32.
具体的,程序包括一条或多条计算机指令,其中,一条或多条计算机指令被处理器31执行时能够实现如下步骤:Specifically, the program includes one or more computer instructions, where one or more computer instructions can implement the following steps when executed by the processor 31:
获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
其中,该云台控制设备的结构中还可以包括通信接口33,用于电子设备与其他设备或通信网络通信。Wherein, the structure of the pan/tilt control device may further include a communication interface 33 for the electronic device to communicate with other devices or a communication network.
进一步的,处理器31还用于:确定所述地形信息和所述姿态信息之间是否具有预定的相关性;Further, the processor 31 is further configured to determine whether there is a predetermined correlation between the terrain information and the posture information;
若所述地形信息和所述姿态信息之间具有所述预定的相关性,则确定在所述可移动平台上的所述雷达安装正确。If there is the predetermined correlation between the terrain information and the attitude information, it is determined that the radar on the movable platform is installed correctly.
进一步的,处理器31还用于:对于预设时间段内获取到的所述地形信息和所述姿态信息,分别计算对应于相同时刻的地形信息和姿态信息之间的乘积;Further, the processor 31 is further configured to: for the terrain information and the attitude information acquired within a preset time period, respectively calculate the product of the terrain information and the attitude information corresponding to the same time;
若所述乘积之和大于预设阈值,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性。If the sum of the products is greater than a preset threshold, it is determined that there is the predetermined correlation between the terrain information and the posture information.
进一步的,处理器31还用于:计算预设时间段内获取到的所述地形信息的第一平均值和第一标准差;Further, the processor 31 is further configured to: calculate the first average value and the first standard deviation of the terrain information acquired within a preset time period;
计算所述预设时间段内获取到的所述姿态信息的第二平均值和第二标准差;Calculating a second average value and a second standard deviation of the posture information acquired within the preset time period;
根据所述第一平均值、所述第一标准差、所述第二平均值、所述第二标准差确定所述地形信息和所述姿态信息之间是否具有所述预定的相关性。It is determined whether there is the predetermined correlation between the terrain information and the posture information according to the first average value, the first standard deviation, the second average value, and the second standard deviation.
进一步的,处理器31还用于:对预设时间段内获取到的所述地形信息进行线性拟合,以确定所述地形信息对应的第一斜率;Further, the processor 31 is further configured to: perform linear fitting on the terrain information acquired within a preset time period to determine the first slope corresponding to the terrain information;
对所述预设时间段内获取到的所述姿态信息进行线性拟合,以确定所述姿态信息对应的第二斜率;Performing linear fitting on the posture information acquired within the preset time period to determine the second slope corresponding to the posture information;
若所述第一斜率和所述第二斜率符号相同,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性。If the signs of the first slope and the second slope are the same, it is determined that the terrain information and the posture information have the predetermined correlation.
进一步的,处理器31还用于:若所述地形信息和所述姿态信息之间不具有所述预定的相关性,则确定安装在所述可移动平台上的雷达安装错误;Further, the processor 31 is further configured to: if there is no predetermined correlation between the terrain information and the attitude information, determine that the radar installed on the movable platform is installed incorrectly;
更新雷达安装状态为安装错误的次数;Update the radar installation status to the number of installation errors;
若更新后的次数高于预设次数,则发送警告通知。If the updated number is higher than the preset number, a warning notification will be sent.
进一步的,处理器31还用于:获取描述所述可移动平台运行环境的多个点云数据;Further, the processor 31 is further configured to: obtain multiple point cloud data describing the operating environment of the movable platform;
根据所述多个点云数据的坐标值选取预设视角范围内的目标点云数据;Selecting target point cloud data within a preset viewing angle range according to the coordinate values of the multiple point cloud data;
对所述目标点云数据进行线性拟合,以得到直线方程;Performing linear fitting on the target point cloud data to obtain a straight line equation;
根据所述直线方程确定所述地形信息。The terrain information is determined according to the straight line equation.
进一步的,处理器31还用于:获取所述可移动平台的运动角速度;Further, the processor 31 is further configured to: obtain the angular velocity of movement of the movable platform;
若所述运动角速度大于或等于预设阈值,则根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。If the angular velocity of motion is greater than or equal to a preset threshold, it is determined whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
图7所示设备可以执行图1~图4c所示实施例的方法,本实施例未详细描述的部分,可参考对图1~图4c所示实施例的相关说明。该技术方案的执行过程和技术效果参见图1~图4c所示实施例中的描述,在此不再赘述。The device shown in FIG. 7 can execute the method of the embodiment shown in FIG. 1 to FIG. 4c. For parts that are not described in detail in this embodiment, refer to the related description of the embodiment shown in FIG. 1 to FIG. 4c. For the implementation process and technical effects of this technical solution, please refer to the description in the embodiment shown in FIG. 1 to FIG. 4c, which will not be repeated here.
另外,本发明实施例提供了一种计算机可读存储介质,存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,程序指令用于实现上述图1~图4c的雷达安装状态的检测方法。In addition, an embodiment of the present invention provides a computer-readable storage medium, the storage medium is a computer-readable storage medium, and the computer-readable storage medium stores program instructions, and the program instructions are used to implement the radar shown in FIGS. 1 to 4c. Detection method of installation status.
以上各个实施例中的技术方案、技术特征在与本相冲突的情况下均可以单独,或者进行组合,只要未超出本领域技术人员的认知范围,均属于本申请保护范围内的等同实施例。The technical solutions and technical features in each of the above embodiments can be singly or combined in case of conflict with the present invention, as long as they do not exceed the cognitive scope of those skilled in the art, they all belong to the equivalent embodiments within the protection scope of this application. .
在本发明所提供的几个实施例中,应该理解到,所揭露的相关检测装置(例如:IMU)和方法,可以通过其它的方式实现。例如,以上所描述的遥控装置实施例仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻 辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,遥控装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。In the several embodiments provided by the present invention, it should be understood that the related detection device (for example: IMU) and method disclosed may be implemented in other ways. For example, the embodiments of the remote control device described above are merely illustrative. For example, the division of the modules or units is only a logical function division. In actual implementation, there may be other division methods, such as multiple units or components. It can be combined or integrated into another system, or some features can be ignored or not implemented. In addition, the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, remote control devices or units, and may be in electrical, mechanical or other forms.
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。The units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the objectives of the solutions of the embodiments.
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。In addition, the functional units in the various embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units may be integrated into one unit. The above-mentioned integrated unit can be implemented in the form of hardware or software functional unit.
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得计算机处理器(processor)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁盘或者光盘等各种可以存储程序代码的介质。If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer readable storage medium. Based on this understanding, the technical solution of the present invention essentially or the part that contributes to the existing technology or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium. , Including several instructions to make a computer processor (processor) execute all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage media include: U disk, mobile hard disk, Read-Only Memory (ROM), Random Access Memory (RAM, Random Access Memory), magnetic disks or optical disks and other media that can store program codes.
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。The above are only the embodiments of the present invention, which do not limit the scope of the present invention. Any equivalent structure or equivalent process transformation made by using the content of the description and drawings of the present invention, or directly or indirectly applied to other related technologies In the same way, all fields are included in the scope of patent protection of the present invention.
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: The technical solutions recorded in the foregoing embodiments can still be modified, or some or all of the technical features can be equivalently replaced; and these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the technical solutions of the embodiments of the present invention. range.

Claims (27)

  1. 一种雷达安装状态的检测方法,其特征在于,所述方法包括:A method for detecting the installation state of a radar, characterized in that the method includes:
    获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
    获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
    根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
  2. 根据权利要求1所述的方法,其特征在于,所述根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确,包括:The method according to claim 1, wherein the determining whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information comprises:
    确定所述地形信息和所述姿态信息之间是否具有预定的相关性;Determining whether there is a predetermined correlation between the terrain information and the posture information;
    若所述地形信息和所述姿态信息之间具有所述预定的相关性,则确定在所述可移动平台上的所述雷达安装正确。If there is the predetermined correlation between the terrain information and the attitude information, it is determined that the radar on the movable platform is installed correctly.
  3. 根据权利要求2所述的方法,其特征在于,所述确定所述地形信息和所述姿态信息之间是否具有预定的相关性,包括:The method according to claim 2, wherein the determining whether there is a predetermined correlation between the terrain information and the posture information comprises:
    对于预设时间段内获取到的所述地形信息和所述姿态信息,分别计算对应于相同时刻的地形信息和姿态信息之间的乘积;For the terrain information and the attitude information acquired within a preset time period, respectively calculating the product of the terrain information and the attitude information corresponding to the same time;
    若所述乘积之和大于预设阈值,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性。If the sum of the products is greater than a preset threshold, it is determined that there is the predetermined correlation between the terrain information and the posture information.
  4. 根据权利要求3所述的方法,其特征在于,所述预设阈值为0。The method according to claim 3, wherein the preset threshold value is zero.
  5. 根据权利要求2所述的方法,其特征在于,所述确定所述地形信息和所述姿态信息之间是否具预定的有相关性,包括:The method according to claim 2, wherein the determining whether there is a predetermined correlation between the terrain information and the posture information comprises:
    计算预设时间段内获取到的所述地形信息的第一平均值和第一标准差;Calculating the first average value and the first standard deviation of the terrain information acquired within a preset time period;
    计算所述预设时间段内获取到的所述姿态信息的第二平均值和第二标准差;Calculating a second average value and a second standard deviation of the posture information acquired within the preset time period;
    根据所述第一平均值、所述第一标准差、所述第二平均值、所述第二标准差确定所述地形信息和所述姿态信息之间是否具有所述预定的相关性。It is determined whether there is the predetermined correlation between the terrain information and the posture information according to the first average value, the first standard deviation, the second average value, and the second standard deviation.
  6. 根据权利要求2所述的方法,其特征在于,所述确定所述地形信息和所述姿态信息之间是否具有预定的相关性,包括:The method according to claim 2, wherein the determining whether there is a predetermined correlation between the terrain information and the posture information comprises:
    对预设时间段内获取到的所述地形信息进行线性拟合,以确定所述地形信息对应的第一斜率;Performing linear fitting on the terrain information acquired within a preset time period to determine the first slope corresponding to the terrain information;
    对所述预设时间段内获取到的所述姿态信息进行线性拟合,以确定所述姿态信息对应的第二斜率;Performing linear fitting on the posture information acquired within the preset time period to determine the second slope corresponding to the posture information;
    若所述第一斜率和所述第二斜率符号相同,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性。If the signs of the first slope and the second slope are the same, it is determined that the terrain information and the posture information have the predetermined correlation.
  7. 根据权利要求2所述的方法,其特征在于,所述方法还包括:The method according to claim 2, wherein the method further comprises:
    若所述地形信息和所述姿态信息之间不具有所述预定的相关性,则确定安装在所述可移动平台上的雷达安装错误;If there is no predetermined correlation between the terrain information and the attitude information, it is determined that the radar installed on the movable platform is installed incorrectly;
    更新雷达安装状态为安装错误的次数;Update the radar installation status to the number of installation errors;
    若更新后的次数高于预设次数,则发送警告通知。If the updated number is higher than the preset number, a warning notification will be sent.
  8. 根据权利要求1至7中任一项所述的方法,其特征在于,所述地形信息包括所述运行环境的坡度值;所述姿态信息包括所述可移动平台的俯仰角。The method according to any one of claims 1 to 7, wherein the terrain information includes a slope value of the operating environment; and the attitude information includes a pitch angle of the movable platform.
  9. 根据权利要求1所述的方法,其特征在于,所述获取可移动平台所处运行环境的地形信息,包括:The method according to claim 1, wherein the obtaining topographic information of the operating environment in which the movable platform is located comprises:
    获取描述所述可移动平台运行环境的多个点云数据;Acquiring multiple point cloud data describing the operating environment of the mobile platform;
    根据所述多个点云数据的坐标值选取预设视角范围内的目标点云数据;Selecting target point cloud data within a preset viewing angle range according to the coordinate values of the multiple point cloud data;
    对所述目标点云数据进行线性拟合,以得到直线方程;Performing linear fitting on the target point cloud data to obtain a straight line equation;
    根据所述直线方程确定所述地形信息。The terrain information is determined according to the straight line equation.
  10. 根据权利要求1所述的方法,其特征在于,The method of claim 1, wherein:
    获取所述可移动平台的运动角速度;Acquiring the angular velocity of movement of the movable platform;
    若所述运动角速度大于或等于预设阈值,则根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。If the angular velocity of motion is greater than or equal to a preset threshold, it is determined whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
  11. 一种可移动平台,其特征在于,至少包括:机体、动力系统以及控制装置;A movable platform, characterized in that it at least includes a body, a power system and a control device;
    所述动力系统,设置于所述机体上,用于为所述可移动平台提供动力;The power system is arranged on the body and used to provide power for the movable platform;
    所述控制装置包括存储器和处理器;The control device includes a memory and a processor;
    所述存储器,用于存储计算机程序;The memory is used to store a computer program;
    所述处理器,用于运行所述存储器中存储的计算机程序以实现:The processor is configured to run a computer program stored in the memory to realize:
    获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
    获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
    根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
  12. 根据权利要求11所述的平台,其特征在于,所述处理器还用于:The platform according to claim 11, wherein the processor is further configured to:
    确定所述地形信息和所述姿态信息之间是否具有预定的相关性;Determining whether there is a predetermined correlation between the terrain information and the posture information;
    若所述地形信息和所述姿态信息之间具有所述预定的相关性,则确定在所述可移动平台上的所述雷达安装正确。If there is the predetermined correlation between the terrain information and the attitude information, it is determined that the radar on the movable platform is installed correctly.
  13. 根据权利要求12所述的平台,其特征在于,所述处理器还用于:The platform according to claim 12, wherein the processor is further configured to:
    对于预设时间段内获取到的所述地形信息和所述姿态信息,分别计算对应于相同时刻的地形信息和姿态信息之间的乘积;For the terrain information and the attitude information acquired within a preset time period, respectively calculating the product of the terrain information and the attitude information corresponding to the same time;
    若所述乘积之和大于预设阈值,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性,。If the sum of the products is greater than a preset threshold, it is determined that there is the predetermined correlation between the terrain information and the posture information.
  14. 根据权利要求12所述的平台,其特征在于,所述处理器还用于:The platform according to claim 12, wherein the processor is further configured to:
    计算预设时间段内获取到的所述地形信息的第一平均值和第一标准差;Calculating the first average value and the first standard deviation of the terrain information acquired within a preset time period;
    计算所述预设时间段内获取到的所述姿态信息的第二平均值和第二标准差;Calculating a second average value and a second standard deviation of the posture information acquired within the preset time period;
    根据所述第一平均值、所述第一标准差、所述第二平均值、所述第二标准差确定所述地形信息和所述姿态信息之间是否具有所述预定的相关性。It is determined whether there is the predetermined correlation between the terrain information and the posture information according to the first average value, the first standard deviation, the second average value, and the second standard deviation.
  15. 根据权利要求12所述的平台,其特征在于,所述处理器还用于:The platform according to claim 12, wherein the processor is further configured to:
    对预设时间段内获取到的所述地形信息进行线性拟合,以确定所述地形信息对应的第一斜率;Performing linear fitting on the terrain information acquired within a preset time period to determine the first slope corresponding to the terrain information;
    对所述预设时间段内获取到的所述姿态信息进行线性拟合,以确定所述姿态信息对应的第二斜率;Performing linear fitting on the posture information acquired within the preset time period to determine the second slope corresponding to the posture information;
    若所述第一斜率和所述第二斜率符号相同,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性。If the signs of the first slope and the second slope are the same, it is determined that the terrain information and the posture information have the predetermined correlation.
  16. 根据权利要求12所述的平台,其特征在于,所述处理器还用于:The platform according to claim 12, wherein the processor is further configured to:
    若所述地形信息和所述姿态信息之间不具有所述预定的相关性,则确定安装在所述可移动平台上的雷达安装错误;If there is no predetermined correlation between the terrain information and the attitude information, it is determined that the radar installed on the movable platform is installed incorrectly;
    更新雷达安装状态为安装错误的次数;Update the radar installation status to the number of installation errors;
    若更新后的次数高于预设次数,则发送警告通知。If the updated number is higher than the preset number, a warning notification will be sent.
  17. 根据权利要求10所述的平台,其特征在于,所述处理器还用于:The platform according to claim 10, wherein the processor is further configured to:
    获取描述所述可移动平台运行环境的多个点云数据;Acquiring multiple point cloud data describing the operating environment of the mobile platform;
    根据所述多个点云数据的坐标值选取预设视角范围内的目标点云数据;Selecting target point cloud data within a preset viewing angle range according to the coordinate values of the multiple point cloud data;
    对所述目标点云数据进行线性拟合,以得到直线方程;Performing linear fitting on the target point cloud data to obtain a straight line equation;
    根据所述直线方程确定所述地形信息。The terrain information is determined according to the straight line equation.
  18. 根据权利要求10所述的平台,其特征在于,所述处理器还用于:The platform according to claim 10, wherein the processor is further configured to:
    获取所述可移动平台的运动角速度;Acquiring the angular velocity of movement of the movable platform;
    若所述运动角速度大于或等于预设阈值,则根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。If the angular velocity of motion is greater than or equal to a preset threshold, it is determined whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
  19. 一种雷达安装状态的检测设备,其特征在于,所述检测设备包括:A detection device for a radar installation state, characterized in that the detection device includes:
    存储器,用于存储计算机程序;Memory, used to store computer programs;
    处理器,用于运行所述存储器中存储的计算机程序以实现:The processor is configured to run a computer program stored in the memory to realize:
    获取可移动平台所处运行环境的地形信息;Obtain the terrain information of the operating environment of the mobile platform;
    获取所述可移动平台在所述运行环境运行过程中的姿态信息;Acquiring posture information of the movable platform during the operation of the operating environment;
    根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。According to the terrain information and the attitude information, it is determined whether the radar on the movable platform is installed correctly.
  20. 根据权利要求19所述的设备,其特征在于,所述处理器还用于:The device according to claim 19, wherein the processor is further configured to:
    确定所述地形信息和所述姿态信息之间是否具有预定的相关性;Determining whether there is a predetermined correlation between the terrain information and the posture information;
    若所述地形信息和所述姿态信息之间具有所述预定的相关性,则确定在所述可移动平台上的所述雷达安装正确。If there is the predetermined correlation between the terrain information and the attitude information, it is determined that the radar on the movable platform is installed correctly.
  21. 根据权利要求20所述的设备,其特征在于,所述处理器还用于:The device according to claim 20, wherein the processor is further configured to:
    对于预设时间段内获取到的所述地形信息和所述姿态信息,分别计算对应于相同时刻的地形信息和姿态信息之间的乘积;For the terrain information and the attitude information acquired within a preset time period, respectively calculating the product of the terrain information and the attitude information corresponding to the same time;
    若所述乘积之和大于预设阈值,则确定所述地形信息和所述姿态信息之间具有所述预定的相关性。If the sum of the products is greater than a preset threshold, it is determined that there is the predetermined correlation between the terrain information and the posture information.
  22. 根据权利要求20所述的设备,其特征在于,所述处理器还用于:The device according to claim 20, wherein the processor is further configured to:
    计算预设时间段内获取到的所述地形信息的第一平均值和第一标准差;Calculating the first average value and the first standard deviation of the terrain information acquired within a preset time period;
    计算所述预设时间段内获取到的所述姿态信息的第二平均值和第二标准差;Calculating a second average value and a second standard deviation of the posture information acquired within the preset time period;
    根据所述第一平均值、所述第一标准差、所述第二平均值、所述第二标准差确定所述地形信息和所述姿态信息之间是否具有所述预定的相关性。It is determined whether there is the predetermined correlation between the terrain information and the posture information according to the first average value, the first standard deviation, the second average value, and the second standard deviation.
  23. 根据权利要求20所述的设备,其特征在于,所述处理器还用于:The device according to claim 20, wherein the processor is further configured to:
    对预设时间段内获取到的所述地形信息进行线性拟合,以确定所述地形信息对应的第一斜率;Performing linear fitting on the terrain information acquired within a preset time period to determine the first slope corresponding to the terrain information;
    对所述预设时间段内获取到的所述姿态信息进行线性拟合,以确定所述姿态信息对应的第二斜率;Performing linear fitting on the posture information acquired within the preset time period to determine the second slope corresponding to the posture information;
    若所述第一斜率和所述第二斜率符号相同,则确定所述地形信息和所述 姿态信息之间具有所述预定的相关性。If the signs of the first slope and the second slope are the same, it is determined that the terrain information and the posture information have the predetermined correlation.
  24. 根据权利要求20所述的设备,其特征在于,所述处理器还用于:The device according to claim 20, wherein the processor is further configured to:
    若所述地形信息和所述姿态信息之间不具有所述预定的相关性,则确定安装在所述可移动平台上的雷达安装错误;If there is no predetermined correlation between the terrain information and the attitude information, it is determined that the radar installed on the movable platform is installed incorrectly;
    更新雷达安装状态为安装错误的次数;Update the radar installation status to the number of installation errors;
    若更新后的次数高于预设次数,则发送警告通知。If the updated number is higher than the preset number, a warning notification will be sent.
  25. 根据权利要求19所述的设备,其特征在于,所述处理器还用于:The device according to claim 19, wherein the processor is further configured to:
    获取描述所述可移动平台运行环境的多个点云数据;Acquiring multiple point cloud data describing the operating environment of the mobile platform;
    根据所述多个点云数据的坐标值选取预设视角范围内的目标点云数据;Selecting target point cloud data within a preset viewing angle range according to the coordinate values of the multiple point cloud data;
    对所述目标点云数据进行线性拟合,以得到直线方程;Performing linear fitting on the target point cloud data to obtain a straight line equation;
    根据所述直线方程确定所述地形信息。The terrain information is determined according to the straight line equation.
  26. 根据权利要求19所述的设备,其特征在于,所述处理器还用于:The device according to claim 19, wherein the processor is further configured to:
    获取所述可移动平台的运动角速度;Acquiring the angular velocity of movement of the movable platform;
    若所述运动角速度大于或等于预设阈值,则根据所述地形信息和所述姿态信息,确定在所述可移动平台上的所述雷达是否安装正确。If the angular velocity of motion is greater than or equal to a preset threshold, it is determined whether the radar on the movable platform is installed correctly according to the terrain information and the attitude information.
  27. 一种计算机可读存储介质,其特征在于,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于实现权利要求1至10中任一项所述的雷达安装状态的检测方法。A computer-readable storage medium, wherein the storage medium is a computer-readable storage medium, the computer-readable storage medium stores program instructions, and the program instructions are used to implement any one of claims 1 to 10 The detection method of the radar installation state described in the item.
PCT/CN2019/115678 2019-11-05 2019-11-05 Radar mounting state detection method and device, movable platform, and storage medium WO2021087737A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2019/115678 WO2021087737A1 (en) 2019-11-05 2019-11-05 Radar mounting state detection method and device, movable platform, and storage medium
CN201980039548.8A CN112368592A (en) 2019-11-05 2019-11-05 Method for detecting radar installation state, movable platform, equipment and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/115678 WO2021087737A1 (en) 2019-11-05 2019-11-05 Radar mounting state detection method and device, movable platform, and storage medium

Publications (1)

Publication Number Publication Date
WO2021087737A1 true WO2021087737A1 (en) 2021-05-14

Family

ID=74516631

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/115678 WO2021087737A1 (en) 2019-11-05 2019-11-05 Radar mounting state detection method and device, movable platform, and storage medium

Country Status (2)

Country Link
CN (1) CN112368592A (en)
WO (1) WO2021087737A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113447899B (en) * 2021-06-29 2024-02-02 上海为彪汽配制造有限公司 Method and system for mounting and testing vehicle-mounted millimeter wave radar
CN114755642B (en) * 2022-03-23 2023-03-10 广州文远知行科技有限公司 Radar line detection method and device, vehicle and storage medium

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110050525A1 (en) * 2009-08-26 2011-03-03 Fujitsu Ten Limited Radar device and antenna angle adjusting method
CN108306217A (en) * 2018-02-11 2018-07-20 广州市极臻智能科技有限公司 A kind of overhead high-voltage wire intelligent independent is along conducting wire flight cruising inspection system and method
CN109032182A (en) * 2018-08-20 2018-12-18 辽宁壮龙无人机科技有限公司 A kind of unmanned plane obstacle avoidance system and control method based on millimetre-wave radar
CN109074098A (en) * 2017-12-18 2018-12-21 深圳市大疆创新科技有限公司 Control method, control device, unmanned plane and the agriculture unmanned plane of unmanned plane
CN208314185U (en) * 2018-05-17 2019-01-01 驭势科技(北京)有限公司 The test device of radar position
CN109782258A (en) * 2018-12-26 2019-05-21 北京百度网讯科技有限公司 Method for detecting position, device and the storage medium of vehicle laser radar
CN109855568A (en) * 2019-01-16 2019-06-07 北京百度网讯科技有限公司 Detection method, device, electronic equipment and the storage medium of automatic Pilot sensor
CN109884650A (en) * 2019-01-16 2019-06-14 北京百度网讯科技有限公司 Detection method, device, electronic equipment and the storage medium of ultrasonic radar
CN110146055A (en) * 2019-05-21 2019-08-20 深圳市道通智能航空技术有限公司 A kind of the super voice abnormality detection method, device and electronic equipment
CN110221610A (en) * 2019-06-10 2019-09-10 吉林大学 The intelligent operation system and operational method of unmanned engineering machinery

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100516773C (en) * 2004-12-31 2009-07-22 比亚迪股份有限公司 Vehicle carried road slope angle measuring system and vehicle carried road slope angle measuring method
KR20120106143A (en) * 2011-03-17 2012-09-26 현대모비스 주식회사 Method of alignment of radar of vihecle in the horizontal or vertical direction
JP6221607B2 (en) * 2013-10-08 2017-11-01 株式会社デンソー Object detection device
CN110082734A (en) * 2019-04-28 2019-08-02 安徽瑞泰智能装备有限公司 Caliberating device, calibration system and the scaling method of automobile mounted millimetre-wave radar extrinsic calibration

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110050525A1 (en) * 2009-08-26 2011-03-03 Fujitsu Ten Limited Radar device and antenna angle adjusting method
CN109074098A (en) * 2017-12-18 2018-12-21 深圳市大疆创新科技有限公司 Control method, control device, unmanned plane and the agriculture unmanned plane of unmanned plane
CN108306217A (en) * 2018-02-11 2018-07-20 广州市极臻智能科技有限公司 A kind of overhead high-voltage wire intelligent independent is along conducting wire flight cruising inspection system and method
CN208314185U (en) * 2018-05-17 2019-01-01 驭势科技(北京)有限公司 The test device of radar position
CN109032182A (en) * 2018-08-20 2018-12-18 辽宁壮龙无人机科技有限公司 A kind of unmanned plane obstacle avoidance system and control method based on millimetre-wave radar
CN109782258A (en) * 2018-12-26 2019-05-21 北京百度网讯科技有限公司 Method for detecting position, device and the storage medium of vehicle laser radar
CN109855568A (en) * 2019-01-16 2019-06-07 北京百度网讯科技有限公司 Detection method, device, electronic equipment and the storage medium of automatic Pilot sensor
CN109884650A (en) * 2019-01-16 2019-06-14 北京百度网讯科技有限公司 Detection method, device, electronic equipment and the storage medium of ultrasonic radar
CN110146055A (en) * 2019-05-21 2019-08-20 深圳市道通智能航空技术有限公司 A kind of the super voice abnormality detection method, device and electronic equipment
CN110221610A (en) * 2019-06-10 2019-09-10 吉林大学 The intelligent operation system and operational method of unmanned engineering machinery

Also Published As

Publication number Publication date
CN112368592A (en) 2021-02-12

Similar Documents

Publication Publication Date Title
Yang et al. Monocular vision SLAM-based UAV autonomous landing in emergencies and unknown environments
CN112567201B (en) Distance measuring method and device
Hu et al. Joint monocular 3D vehicle detection and tracking
Chen et al. A review of visual-inertial simultaneous localization and mapping from filtering-based and optimization-based perspectives
JP6831414B2 (en) Methods for positioning, devices, devices and computers for positioning Readable storage media
Yang et al. Hybrid camera array-based uav auto-landing on moving ugv in gps-denied environment
Symington et al. Probabilistic target detection by camera-equipped UAVs
US10139493B1 (en) Rotor safety system
CN109211277B (en) State determination method and device of visual inertial odometer and electronic equipment
CN108897836B (en) Method and device for robot to map based on semantics
WO2021087737A1 (en) Radar mounting state detection method and device, movable platform, and storage medium
US11565712B2 (en) Systems and methods for managing speed thresholds for vehicles
US20220027038A1 (en) Interactive virtual interface
CN112051591A (en) Detection method and related device for laser radar and inertial measurement unit
Zhao et al. An orientation sensor-based head tracking system for driver behaviour monitoring
WO2022021027A1 (en) Target tracking method and apparatus, unmanned aerial vehicle, system, and readable storage medium
Bai et al. Robust visual-inertial integrated navigation system aided by online sensor model adaption for autonomous ground vehicles in urban areas
AU2020375559B2 (en) Systems and methods for generating annotations of structured, static objects in aerial imagery using geometric transfer learning and probabilistic localization
CN108801250B (en) Real-time attitude acquisition method and device based on underwater robot
Yuan et al. A hierarchical vision-based UAV localization for an open landing
Wu et al. Artificial marker and MEMS IMU-based pose estimation method to meet multirotor UAV landing requirements
CN112513766A (en) Method, tracking device, storage medium and computer program product for path planning
Wang et al. Design of airport obstacle-free zone monitoring UAV system based on computer vision
CN111736190B (en) Unmanned aerial vehicle airborne target detection system and method
CN105807083A (en) Real-time speed measuring method and system for unmanned aerial vehicle

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19951994

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19951994

Country of ref document: EP

Kind code of ref document: A1