WO2021134376A1 - Control method, movable platform, and storage medium - Google Patents

Control method, movable platform, and storage medium Download PDF

Info

Publication number
WO2021134376A1
WO2021134376A1 PCT/CN2019/130217 CN2019130217W WO2021134376A1 WO 2021134376 A1 WO2021134376 A1 WO 2021134376A1 CN 2019130217 W CN2019130217 W CN 2019130217W WO 2021134376 A1 WO2021134376 A1 WO 2021134376A1
Authority
WO
WIPO (PCT)
Prior art keywords
movable platform
straight line
radar
observation points
line model
Prior art date
Application number
PCT/CN2019/130217
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/130217 priority Critical patent/WO2021134376A1/en
Priority to CN201980059919.9A priority patent/CN112740070A/en
Publication of WO2021134376A1 publication Critical patent/WO2021134376A1/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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/933Radar or analogous systems specially adapted for specific applications for anti-collision purposes of aircraft or spacecraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/106Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00Three dimensional [3D] modelling, e.g. data description of 3D objects
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02GINSTALLATION OF ELECTRIC CABLES OR LINES, OR OF COMBINED OPTICAL AND ELECTRIC CABLES OR LINES
    • H02G1/00Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines
    • H02G1/02Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines for overhead lines or cables

Definitions

  • This application relates to the field of control technology, in particular to a control method, a removable platform and a storage medium.
  • the current power inspection operations mainly include manual inspection and mobile platform inspection, and mobile platforms include drones.
  • the manual detection method is inefficient and causes high labor costs.
  • the movable platform performs detection, it needs to move along the wire, so it is very important to keep a certain safe distance from the wire.
  • the detection of movable platforms currently includes two methods: manual movement and automatic movement.
  • the manual movement method is to be detected by human remote control, which is difficult and inefficient.
  • Automatic movement methods include the need to rely on Global Positioning System (GPS) data to perform real-time dynamic (RTK, Real time kinematic) spotting on the movement trajectory of the movable platform in advance, and the method of determining the position of the wire through image acquisition and analysis. The way of visually ensuring safe distance movement.
  • GPS Global Positioning System
  • RTK Real-time dynamic
  • the real-time dynamic dotting method will cause the problem of decreased accuracy when the GPS signal is weak.
  • the wires are relatively thin, it is difficult to accurately locate the wires in the image collection method.
  • it will also affect the image collection, which greatly reduces the reliability of the vision solution.
  • the present application provides a control method, a movable platform, and a storage medium to improve the measurement accuracy and reliability of the movable platform in power inspection.
  • the present application provides a control method, which is applied to a movable platform including a radar, and the control method includes:
  • the observation data including multiple position information of multiple observation points
  • the movement track of the movable platform is controlled to complete the inspection of the target object.
  • the application also provides a movable platform, the movable platform includes a radar, a memory, and a processor: the radar is used to send radar signals for measurement or detection; the memory is used to store computer programs The processor is used to execute the computer program and when executing the computer program, implement the following steps:
  • the observation data including multiple position information of multiple observation points
  • the movement track of the movable platform is controlled to complete the inspection of the target object.
  • the present application also provides a computer-readable storage medium that stores a computer program, and when the computer program is executed by a processor, the processor implements the above-mentioned control method.
  • the control method, the movable platform and the storage medium provided by the present invention can improve the measurement accuracy and reliability of the movable platform in the electric power inspection.
  • FIG. 1 is a schematic diagram of a scene of a control method provided by an embodiment of the present application
  • FIG. 2 is a schematic structural diagram of a radar provided by an embodiment of the present application.
  • FIG. 3 is a schematic flowchart of a control method provided by an embodiment of the present application.
  • FIG. 4 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application.
  • FIG. 5 is a schematic diagram of a scene of a radar coordinate system and a target coordinate system provided by an embodiment of the present application;
  • FIG. 6 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 7 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 8 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 9 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 10 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 11 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application.
  • FIG. 12 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 13 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 14 is a schematic diagram of a radar coordinate system and a target coordinate system provided by an embodiment of the present application.
  • 15 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application.
  • FIG. 16 is a schematic flowchart of another control method provided by an embodiment of the present application.
  • FIG. 17 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application.
  • FIG. 18 is a schematic block diagram of a movable platform provided by an embodiment of the present application.
  • the embodiments of the present application provide a control method, a movable platform, and a storage medium, which are applied to a movable platform including a radar during power inspection, which can improve the measurement accuracy and reliability of the movable platform in the power inspection .
  • Power patrol inspection refers to the patrol inspection of power facilities of the power system, for example, it can be the patrol inspection of power lines or high-voltage towers, and the faults of the power facilities can be predicted in advance through the power patrol inspection of the power facilities.
  • the control method may be applied to a movable platform including a radar.
  • the movable platform includes an aircraft, a robot, or an autonomous vehicle.
  • Aircraft include drones, which include rotary-wing drones, such as quadrotor drones, hexarotor drones, and octo-rotor drones. It can also be a fixed-wing drone or a rotary-wing drone. The combination with fixed-wing UAV is not limited here.
  • the movable platform is equipped with a radar, which can realize the detection of the surrounding environment of the movable platform during the movement.
  • the radar can realize functions such as speed measurement, ranging, detection, tracking, positioning, and identification.
  • the radar can detect power facilities.
  • the radar can detect the target objects that the mobile platform is inspected in the power inspection.
  • the movable platform 10 is patrolling the target object 20
  • the movable platform 10 may be a drone
  • the target object 20 may be a wire
  • the movable platform 10 is equipped with a radar 11,
  • the radar 11 can detect electric wires during the inspection process.
  • the radar can be a mechanical rotating radar.
  • the radar includes a radio frequency module and a signal processing module.
  • the radio frequency module can be a radio frequency board composed of an array antenna.
  • the array antenna includes a transmitting antenna and a receiving antenna.
  • the transmitting antenna of the array antenna can transmit radar signals, such as millimeter wave signals.
  • the millimeter wave signals propagate in the air until they are reflected after encountering obstacles, and the receiving antenna of the array antenna can receive the returned millimeter waves.
  • the signal processing module can convert the returned millimeter wave signal into an electric signal, and process the electric signal to detect the distance and angle information of the obstacle and the speed of the movable platform.
  • the radar can scan in the horizontal direction and measure the angle in the vertical direction.
  • the outer normal direction of the radio frequency board is the direction perpendicular to the radio frequency board.
  • the signal transmission direction of the antenna set on the radar is mainly to transmit the signal along the outer normal, and the signal from the antenna will also be scattered around.
  • the radar includes a radio frequency board 12 and a rotation axis 120.
  • the radio frequency board 12 may be arranged on the rotation axis 120.
  • the radio frequency board 12 may rotate around the rotation axis 120 to change the radio frequency board 12 The signal transmission direction of the antenna.
  • the movable platform is also provided with a posture detection module, and the posture detection module is used to obtain the running posture information of the movable platform when it is moving.
  • the movable platform can be a drone
  • the attitude detection module can be a flight control module
  • the flight control module can also obtain the flight direction, flight attitude, flight height, flight speed and/or position information of the drone during flight. Wait.
  • the radar can obtain the operating attitude information of the movable platform from the attitude detection module, and adjust the signal emission direction of the radar according to the operating attitude information of the movable platform.
  • the radar includes a radio frequency board
  • the radar can obtain the movement direction of the movable platform through the attitude detection module, and adjust the angle of the radio frequency board according to the movement direction to adjust the signal transmission direction of the radar, and maintain the signal transmission direction of the radar and the movable screen.
  • the moving direction is the same, and the radar can realize the detection of the environment in the forward direction of the movable platform.
  • FIG. 3 is a schematic flowchart of steps of a control method provided by an embodiment of the present application.
  • the method can be applied to a movable platform that includes a radar, and is used for power inspection of a target object, so as to improve the measurement accuracy and reliability of the movable platform in the power inspection.
  • control method includes step S101 to step S103.
  • the target object is a linear object that is inspected in the power inspection.
  • the target object may be any one of wires, cables, optical cables, or optical fibers.
  • the radar signal emitted by the radar on the movable platform 10 will meet multiple position points on the target object 20, and the radar signal of the radar
  • the multiple locations encountered are regarded as observation points. For example, if the target object is an electric wire, and the scanning range of the radar includes a part of the electric wire, several radar signals emitted by the radar will encounter a part of the electric wire, and the several radar signals will be returned to the radar. In this way, the radar can determine the position information of the observation point based on the transmitted radar signal and the received radar signal.
  • the position information of the observation point may be a parameter used to reflect the position relationship between the observation point and the radar, or it may be a parameter used to reflect the position relationship between the observation point and the movable platform.
  • the acquisition of radar observation data of the target object may be implemented in the following manner:
  • the relative distance and relative included angle between multiple observation points of the target object and the movable platform are collected by radar, and the position information of the observation point is determined according to the relative distance and relative included angle between the observation point and the movable platform.
  • the relative distance and the relative included angle are parameters used to reflect the positional relationship between the observation point and the movable platform.
  • the radar sends a radar signal, and the radar signal returns after encountering the target object. According to the sending time of the radar signal and the receiving time of the returned radar signal, the relative distance between the target object and the radar can be determined.
  • the radar signal encounters multiple observation points on the target object, and the relative distance between each observation point and the radar can be determined according to the radar signal corresponding to each observation point.
  • the radar is provided with multiple antennas, and the radar can determine the phase angle between the target object and the radar according to the phase difference between the returned radar signals received by the multiple antennas. For example, in a radar observation, n observation points on the target object are acquired, the corresponding relative distance is r n , and the corresponding relative included angle is ⁇ n .
  • the radar is mounted on a movable platform, so according to the relative distance and the relative angle between the observation point and the radar collected by the radar, the relative distance and the relative angle between the observation point and the movable platform can be determined.
  • the location of the observation point can be determined, and then the location information of the observation point can be determined.
  • the relative distance is the distance of the line between the observation point and the movable platform
  • the relative included angle is the clamp between the line and the outer normal direction of the radio frequency board of the radar. angle.
  • the relative distance can be the length of the line 22 between the observation point 21 and the radar center point on the movable platform 10, and the line 22 and the outer normal direction 100 of the radar radio frequency board
  • the included angle 23 is used as the relative included angle. According to the relative distance and the relative included angle, the positional relationship between the observation point and the movable platform can be determined.
  • the definition of the relative distance and the relative included angle can be set according to actual needs, and is not limited to this.
  • other angles representing the angular relationship between the observation point and the radar, or the observation point and the movable platform can be used in the present invention.
  • the determination of the position information of the observation point according to the relative distance and the relative included angle between the observation point and the movable platform may be implemented in the following manner:
  • the coordinates of the observation point in the radar coordinate system are determined according to the relative distance of each observation point and the relative included angle, and the position information of the observation point is obtained.
  • the radar itself defines a radar coordinate system, and what the radar determines by observing the target object can be the position information of the target object in the radar coordinate system.
  • the radar coordinate system may be based on the center point of the radar as the origin O, and the signal emission direction of the radar as the coordinate axis X b of the radar coordinate system, and the coordinate axis Y b is parallel to the radar radio frequency ,
  • the coordinate axis Y b , the coordinate axis X b and the coordinate axis Z b conform to the right-hand rule of the coordinate system; for example, the coordinate axis Z b may point to the sky.
  • the radar coordinate system can be set according to actual conditions, and is not limited to this.
  • the relative distance and relative included angle of each observation point detected by the radar can be the relative distance and relative included angle between the center point of the radar and the relative distance and relative included angle of each observation point.
  • the coordinates of each observation point in the radar coordinate system, and the coordinates of the observation point in the radar coordinate system are used as the position information of the observation point.
  • the relative distance of each observation point and the relative included angle can be converted into coordinates in the radar coordinate system according to the following formula:
  • the position information of the observation point can be a parameter used to reflect the position relationship between the observation point and the movable platform, so the straight line model determined according to the position information of the observation point can be used To embody the position function equation of the target object relative to the movable platform.
  • a straight line can be determined, which passes through the two points.
  • a straight line model of the straight line where the multiple observation points are located can be determined.
  • the radar continuously observes the target object when the movable platform is patrolling the target object, so the part of the target object observed by the radar every time can be regarded as a straight line.
  • the target object is an electric wire
  • the multiple observation points detected by the radar may be a short section of the electric wire, and the linear model of the short electric wire can be determined based on the multiple observation points on this small electric wire.
  • a wire is generally a long section of a smooth line. After determining the straight line model of this small section of wire, it can be considered that the part of the wire in front is also on the straight line model. Therefore, after determining the linear model, the position of the wire in front of the moving process can be predicted, and then the movement of the movable platform can be controlled accordingly.
  • the determined straight line model about the multiple observation points may be the following formula:
  • k is the slope of the linear model
  • b is the intercept of the linear model
  • the determination of a straight line model about the plurality of observation points according to the plurality of position information may be implemented in the following manner:
  • Fitting is performed according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
  • fitting is to determine a smooth line based on multiple points, which can connect multiple points.
  • a straight line model about multiple observation points can be determined, and a straight line can be determined according to multiple position information, and the straight line can connect multiple observation points.
  • multiple observation points are located in the On a straight line, in another case, some of the multiple observation points are located on the straight line, and other observation points are kept relatively close to the straight line.
  • the fitting according to the plurality of position information to determine the straight line model about the plurality of observation points may be implemented in the following manner:
  • the position information of multiple observation points belongs to the target object, and the target object is a linear object, so the position information of multiple observation points will show a linear relationship, and then the multiple position information can be calculated according to linear fitting. Fitting is performed to obtain a straight line model of multiple observation points.
  • the step of performing linear fitting according to the plurality of position information may be implemented in the following manner: based on the least square method, performing linear fitting according to the plurality of position information.
  • the least square method is a mathematical optimization algorithm.
  • the unknown data can be easily obtained by the least square method, and the sum of squares of the error between the obtained data and the actual data is minimized.
  • the multiple position information can be fitted based on the least squares method, and a straight line model with the smallest sum of squares of the error from the multiple position information can be obtained.
  • the performing linear fitting according to the plurality of position information to determine the straight line model about the plurality of observation points may be implemented in the following manner:
  • S21 Determine two first observation points from the multiple observation points, and determine a first sample straight line model about the two first observation points according to the position information of the two first observation points;
  • the multiple observation points include at least two observation points, and after determining the position information of the two observation points, a straight line can be determined based on the two points, and the straight line can connect the two observation points. Therefore, two first observation points can be determined from a plurality of observation points, and a first sample straight line model passing through the two first observation points can be determined according to the position information of the two first observation points.
  • the position relationship between the other observation points and the first sample line model can be determined, if the position relationship between the other observation points and the first sample line model conforms to The set conditions can determine the first sample linear model as the linear model.
  • the Euclidean distance between each observation point and the first sample straight line model can be used to determine the positional relationship between the observation point and the first sample straight line model, based on multiple other observation points and the first sample straight line model.
  • the Euclidean distance determines the distance data of the first sample linear model.
  • the distance data is used to reflect the positional relationship between the multiple other observation points and the first sample straight line model, and the straight line model about the multiple observation points can be determined according to the distance data and the first sample straight line model. Exemplarily, if the distance data meets the set distance condition, it is determined that the first sample straight line model is a straight line model with respect to the plurality of observation points.
  • the determining the distance data of the first sample linear model according to the multiple Euclidean distances may be implemented in the following manner:
  • the Euclidean distances between multiple other observation points and the first sample straight line model can be added to the first value, and the first value is used as the distance data of the first sample straight line model.
  • the overall positional relationship between the multiple other observation points and the first sample linear model can be determined, and then the overall positional relationship and the first sample linear model can be determined. Determine the straight line model of multiple observation points.
  • performing linear fitting according to the plurality of position information to determine a straight line model about the plurality of observation points may be implemented in the following manner:
  • S212 Determine multiple sample straight line models for the multiple sample point sets according to the position information of the two first observation points in each sample point set respectively;
  • S213 Determine the minimum value of the multiple distance data respectively according to multiple distance data about the multiple sample straight line models
  • two arbitrary observation points can be selected from multiple observation points as a sample point set.
  • the observation points contained in each two sample point sets are not completely the same.
  • multiple samples can be determined from multiple observation points. Point collection.
  • Each sample point set can determine a sample line model, and multiple sample point sets can determine multiple sample line models; because the observation points contained in every two sample point sets are not completely the same, the determined multiple sample line models There will be no duplication.
  • the Euclidean distances between multiple other observation points and each sample straight line model are calculated, and the distance data of the multiple sample straight line models can be determined.
  • the fitting according to the plurality of position information to determine the straight line model about the plurality of observation points may be implemented in the following manner:
  • S25 Perform fitting according to multiple pieces of position information received at the first moment, and determine a first straight line model of the multiple observation points at the first moment;
  • S26 Perform fitting according to the multiple pieces of position information received at the second time, and determine a second straight line model of the multiple observation points at the second time;
  • the radar can continuously detect the target object, and the radar obtains the position information of the observation point on the target object at two times before and after.
  • the radar can acquire the position information of the multiple observation points at the first moment, and then determine the first straight line model about the multiple observation points at the first moment according to the position information of the multiple observation points.
  • the radar obtains the position information of multiple observation points at the second time, and can determine the second linear model of the multiple observation points at the second time according to the position information of the multiple observation points.
  • the final straight line model can be determined according to the straight line models at the two moments.
  • the determination of a straight line model based on the first straight line model and the second straight line model may be implemented in the following manner:
  • the final straight line model is determined according to the average intercept and average slope, which can avoid the problem of inaccurate detection accuracy caused by the delay or advancement of the radar detection work , Select the average intercept and slope to determine the final straight line model, which can improve the accuracy of the straight line model, and further improve the measurement accuracy and reliability of the inspection of the movable platform during the inspection process.
  • the movable platform can move according to the set movement track. After the linear model of the target object is obtained, the positions of other segments of the wires in front can be calculated according to the linear model, and the movement trajectory of the movable platform can be adjusted in real time according to this, so that the movable platform can perform inspections along the target object to avoid An error occurred during the inspection process.
  • the movement track includes the running direction of the movable platform and the target distance from the movable platform to the target object, and the movement of the movable platform is controlled according to the linear model
  • the trajectory can be implemented in the following ways:
  • the target distance from the movable platform to the target object and the running direction of the movable platform are determined according to the model parameters of the linear model.
  • the moving direction is the forward direction when the movable platform is moving
  • the target distance is the distance between the target object and the movable platform.
  • the movable platform needs to keep a proper distance from the target object to realize the detection of the target object, and at the same time, it can avoid the collision of the movable platform and the target object when the distance is too close.
  • the position of the target object in front can be predicted, and then the moving trajectory of the movable platform can be adjusted in real time, so that the movable platform moves along the running direction determined according to the model parameters , And keep the target distance with the target object.
  • the target distance includes a vertical distance from the movable platform to the target object.
  • the target object is linear, and the moving direction of the movable platform is generally along a straight line.
  • the vertical distance from the movable platform to the target object can be determined as the target distance.
  • the movable platform The vertical distance between 10 and the target object 20 is 102.
  • the movable platform 10 can effectively measure the target object 20 and maintain an appropriate distance from the target object 20. If the movable platform 10 continuously maintains a vertical distance 102 from the target object 20 during the inspection process, the measurement accuracy and safety reliability of the movable platform during the inspection process of the target object can be ensured.
  • the determination of the target distance from the movable platform to the target object and the running direction of the movable platform according to the model parameters of the linear model may be implemented in the following manner:
  • the vertical distance from the movable platform to the target object and the running direction of the movable platform are determined according to the slope and intercept of the straight line model.
  • the straight line model is a function equation that reflects the position of the target object relative to the movable platform, and the coordinate system where the straight line model is located may be based on the movable platform as the origin. Therefore, the vertical distance from the movable platform to the target object and the running direction of the movable platform can be determined according to the slope and intercept of the linear model.
  • the vertical distance can be determined according to the following formula:
  • the running direction can be determined according to the following formula:
  • L is the vertical distance
  • ⁇ L is the direction of the linear model and also the running direction
  • k is the slope of the linear model
  • b is the intercept of the linear model.
  • the direction determined according to the slope and intercept of the linear model is the direction of the linear model, and the direction of the linear model is taken as the running direction of the movable platform, which can make the mobile platform move in parallel with the linear model during operation, which can ensure The movable platform is safe during the inspection process to avoid collision with the target object.
  • the running direction of the movable platform is parallel to the linear model.
  • setting the running direction of the movable platform to be parallel to the linear model can make the movable platform move along the target object and keep parallel during the inspection process, so as to ensure that the movable platform is in the inspection process. It is safe to avoid collision between the movable platform and the target object.
  • the movable platform 10 can move along the running direction 101, so that the movable platform 10 can continue to maintain a stable target distance from the target object 20 during the movement.
  • the signal transmission direction of the radar can be set before receiving the observation data of the radar on the target object; specifically including: obtaining the information of the movable platform
  • the operating attitude parameter is used to adjust the angle of the radio frequency board of the radar according to the operating attitude parameter.
  • the radar can be a mechanical rotating radar.
  • the radio frequency board of the radar can be rotated according to the needs. Multiple antennas are set on the radio frequency board.
  • the radio frequency board can be rotated along the rotation axis to adjust the angle of the radio frequency board. After the angle, the signal transmission direction of the antenna on the radio frequency board will also change.
  • the radio frequency board of the radar on the movable platform may be at the angle maintained at the end of the previous scan, or at the initial angle, but the angle of the radio frequency board at the initial time may not be adapted to Inspection task, so the angle of the radio frequency board of the radar can be adjusted according to the inspection task.
  • the running posture parameters include parameters for reflecting the movement state of the movable platform.
  • the running posture parameters include the running direction of the movable platform.
  • the movable platform is also provided with a posture detection module, and the posture detection module can obtain the operating posture parameters of the movable platform in real time.
  • the radar can obtain the operating attitude parameters of the movable platform through the attitude detection module.
  • the attitude detection module may be a flight control module.
  • the movement status of the movable platform can be obtained.
  • the movable platform When the operating attitude parameters of the movable platform are obtained, the movement status of the movable platform can be obtained.
  • the movable platform When the movable platform conducts inspections, it will adjust its own movement status according to the target object, and adjust the radar according to the movement status of the movable platform.
  • the angle of the radio frequency board so that the radar signal of the radar can radiate to the target object.
  • the outer normal direction of the radio frequency board of the radar is the same as the running direction of the movable platform.
  • the signal emission direction of the radar is set to be the same as the running direction of the movable platform, that is, the radar can detect the position information of the target object in the forward direction of the movable platform, and determine the straight line model of the target object accordingly.
  • the running direction of the movable platform 10 is consistent with the outer normal direction of the radar radio frequency board, that is, the running direction of the mobile platform 10 is perpendicular to the radar radio frequency board, so that the radar can detect that the movable platform 10 is moving forward.
  • Direction of the target object 20 is consistent with the outer normal direction of the radar radio frequency board, that is, the running direction of the mobile platform 10 is perpendicular to the radar radio frequency board, so that the radar can detect that the movable platform 10 is moving forward.
  • the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform, that is, the radio frequency board of the radar is parallel to the running direction of the movable platform and faces the target object.
  • the direction of the radio frequency board of the radar is set such that the outer normal direction is perpendicular to the running direction of the movable platform and faces the target object. That is, the radio frequency board of the radar is parallel to the running direction of the movable platform.
  • the radar can directly face the target object.
  • the radar can observe the position of a part of the target object closest to the movable platform in real time. Information, and determine the straight line model of the target object based on this.
  • the movable platform 10 moves along the running direction 100, and the outer normal direction 111 of the radio frequency board of the radar is perpendicular to the running direction of the movable platform 10 and faces the target object 20. That is, the radio frequency board of the radar is parallel to the running direction of the movable platform 10. In this way, during the movement of the movable platform 10, the radar can observe some of the target objects 20 that are closest to the movable platform 10.
  • the determination of a straight line model about the plurality of observation points according to the plurality of position information may be implemented in the following manner:
  • S1020 Perform coordinate conversion on the multiple position information to obtain the coordinates of the multiple observation points in the target coordinate system;
  • the multiple position information of the observation point obtained by the radar is based on the position information in the radar coordinate system defined by the radar, and the movable platform is not necessarily based on the radar coordinate system defined by the radar.
  • the target coordinate system is a coordinate system on which the movement trajectory of the movable platform is defined, and the target coordinate system may be a coordinate system defined by an actual geographic environment.
  • the target coordinate system is the northeast coordinate system.
  • the northeast coordinate system may be based on the movable platform as the origin, the direction pointing to the north as the north axis, the direction pointing to the east as the east axis, and the vertical pointing
  • the direction of the ground serves as the axis of the earth.
  • the north axis of the north-east coordinate system can be X g
  • the east axis can be Y g
  • the earth axis can be Z g .
  • the radar coordinate system and the target coordinate system are differently defined coordinate axes, and the coordinates of the objects in the actual physical space in the radar coordinate system and the target coordinate system are differently defined.
  • the coordinates of the observation point in the target coordinate system can be obtained through the coordinate conversion of the position information of the observation point acquired by the radar under the definition of the radar coordinate system.
  • the position information can be coordinate transformed to obtain the coordinates of the multiple observation points in the target coordinate system, and the target object can be obtained through the coordinates of the multiple observation points in the target coordinate system
  • the linear model in the target coordinate system, and then the linear model of the target coordinate system and the moving trajectory of the movable platform are in the same coordinate system.
  • the movable platform can directly adjust its own moving trajectory according to the linear model, which can improve the movable platform.
  • the processing efficiency can improve the efficiency of the inspection process in the movable platform.
  • the method before the receiving radar observation data of the target object, the method further includes:
  • the radar includes a radio frequency board composed of an array antenna
  • the signal transmission direction of the radar is the outer normal direction of the radio frequency board
  • the signal transmission direction of the radar can be adjusted by adjusting the angle of the radio frequency board of the radar.
  • the antenna of the radar adopts other structure types, the transmitting direction of the radar signal can be adjusted correspondingly according to the other structure types.
  • the running posture parameters include parameters for reflecting the movement state of the movable platform.
  • the running posture parameters include the running direction of the movable platform.
  • the movable platform is also provided with a posture detection module, and the posture detection module can obtain the operating posture parameters of the movable platform in real time.
  • the radar can obtain the operating attitude parameters of the movable platform through the attitude detection module.
  • the attitude detection module may be a flight control module.
  • the signal emission direction of the radar is adjusted according to the operating attitude parameters, so that the radar signal of the radar can radiate to the target object when the movable platform is patrolled, which can further improve the mobility The inspection efficiency of the platform.
  • the signal transmission direction of the radar is the same as the running direction of the movable platform.
  • the signal transmission direction of the radar is the same as the running direction of the movable platform, and both are direction 100. Setting the signal emission direction of the radar to be the same as the running direction of the movable platform can make the radar scan the position information of the target object in the forward direction of the movable platform, and determine the linear model of the target object based on this.
  • the position information includes the coordinates of the observation point in the radar coordinate system, and the signal emission direction of the radar is the same as the running direction of the movable platform, as shown in FIG.
  • Coordinate conversion is performed on multiple position information to obtain the coordinates of the multiple observation points in the target coordinate system, which can be implemented in the following manner:
  • S201 Determine a first included angle between a coordinate axis of the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform;
  • S203 Perform coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system according to the conversion matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
  • the radar coordinate system is a coordinate system defined by the radar, and the position information of the observation point detected by the radar includes the coordinates of the observation point in the radar coordinate system.
  • the radar coordinate system and the target coordinate system are different coordinate systems, and there is a corresponding spatial geometric relationship between the two coordinate systems in the actual physical space. Since the defined coordinates of an observation point in the actual physical space are different in the two coordinate systems, it is necessary to transform the coordinates in the two coordinate systems according to the transformation matrix. For example, the transformation matrix can be determined according to the spatial geometric relationship between the two coordinate systems.
  • the coordinate axis X g and the coordinate axis Y g of the target coordinate system constitute a plane of the target coordinate system
  • the coordinate axis X b and the coordinate axis Y b of the radar coordinate system constitute the correspondence of the radar coordinate system.
  • Plane The spatial geometric relationship between the plane of the target coordinate system and the corresponding plane of the radar coordinate system includes: the angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system is the first angle ⁇ v .
  • the conversion matrix can be determined according to the included angle, and then the coordinates of the radar coordinate system can be converted into the coordinates of the target coordinate system.
  • the signal transmission direction of the radar is the same as the running direction of the movable platform. Therefore, the angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system is the first angle.
  • the angle ⁇ v is the angle between the coordinate axis X g of the target coordinate system and the running direction of the movable platform. That is to say, when the signal emission direction of the radar is the same as the running direction of the movable platform, the conversion matrix can be determined according to the angle between the coordinate axis X g of the target coordinate system and the running direction of the movable platform .
  • the spatial geometric relationship between the two coordinate systems can be determined according to the running direction of the movable platform, and the radar coordinate system can be determined
  • a first included angle between a coordinate axis and a coordinate axis of the target coordinate system, and the conversion matrix can be determined according to the first included angle.
  • a coordinate axis in the radar coordinate system corresponds to a coordinate axis of the target coordinate system.
  • the two coordinate axes are the same x-axis, or the same y-axis, or both are the z-axis.
  • mapping relationship between the coordinates of the radar coordinate system and the coordinates of the target coordinate system conforms to the following formula:
  • the target coordinate system is a geodetic coordinate system.
  • the coordinates of the target coordinate system can be obtained, that is, the coordinates of the observation point in the target coordinate system can be obtained, and then the linear model of the target object in the target coordinate system can be obtained ,
  • the linear model of the target coordinate system and the movement trajectory of the movable platform are in the same coordinate system.
  • the movable platform can directly adjust its movement trajectory according to the linear model, which can improve the processing efficiency of the movable platform and improve the movable platform. The efficiency of the inspection process.
  • the position information includes the coordinates of the observation point in the radar coordinate system.
  • the coordinate conversion is performed on the plurality of position information to obtain the coordinates of the plurality of observation points in the target coordinate system.
  • the coordinates of the system can be implemented as follows:
  • S204 Determine a first included angle between a coordinate axis in the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform and the signal emission direction of the radar;
  • S206 Perform coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system according to the conversion matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
  • the signal emission direction of the radar is not necessarily the same as the running direction of the movable platform.
  • the signal emission direction of the radar and the running direction of the movable platform may be at a preset angle. It can be 30°, 40°, 75° or 90°, etc.
  • the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform and facing the target object, that is, the signal emission direction of the radar is perpendicular to the running direction of the movable platform.
  • the coordinate axis X b of the radar coordinate system is the signal transmission direction 111 of the radar.
  • the angle defined by the running direction 100 of the mobile platform 10 in the target coordinate system is ⁇ 0 , and ⁇ 0 may be the angle between the running direction 100 of the movable platform 10 and the coordinate axis X g of the target coordinate system.
  • the angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system is ⁇ v is not equivalent to the angle ⁇ 0 between the running direction 100 of the movable platform 10 and the coordinate axis X g of the target coordinate system.
  • the angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system needs to be determined according to the running direction 100 of the movable platform 10 and the signal emission direction 111 of the radar.
  • the preset included angle ⁇ ' may be determined according to the running direction of the movable platform and the signal emission direction of the radar, and the first included angle may be determined according to the running direction of the movable platform and the preset included angle. Exemplarily, it may be the angle ⁇ 0 defined in the target coordinate system of the running direction of the movable platform minus the preset angle ⁇ ′ to obtain the first angle ⁇ v .
  • the signal transmission direction of the radar may not necessarily be set to be consistent with the running direction of the movable platform.
  • the signal transmission direction of the radar can be adjusted according to the actual inspection situation. As long as it is facing the target object, various presets can be set. Setting the angle to meet different inspection requirements can further improve the inspection efficiency of the movable platform.
  • FIG. 18 is a schematic block diagram of a movable platform provided by an embodiment of the present application.
  • the mobile platform 10 includes a radar 11, a processor 13, and a memory 14.
  • the processor 13, the memory 14 and the radar 11 are connected by a bus.
  • the bus is, for example, an I2C (Inter-integrated Circuit) bus or the radar 11 and the processor 13 pass through CAN bus connection.
  • I2C Inter-integrated Circuit
  • the movable platform includes aircraft, robots or autonomous unmanned vehicles.
  • the processor 13 may be a micro-controller unit (MCU), a central processing unit (CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
  • MCU micro-controller unit
  • CPU central processing unit
  • DSP Digital Signal Processor
  • the memory 14 may be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk, or a mobile hard disk.
  • the radar 11 is used to send radar signals for measurement or detection.
  • the processor is used to run a computer program stored in a memory, and implement the following steps when executing the computer program:
  • Obtain radar observation data of the target object including multiple position information of multiple observation points; determine a straight line model about the multiple observation points according to the multiple position information; according to the straight line model, Control the movement track of the movable platform to complete the inspection of the target object.
  • the step of obtaining radar observation data of the target object includes:
  • the relative distance and relative included angle between multiple observation points of the target object and the movable platform are collected by radar; the position information of the observation point is determined according to the relative distance and relative included angle between the observation point and the movable platform.
  • the step of determining the position information of the observation point according to the relative distance and the relative included angle between the observation point and the movable platform includes:
  • the coordinates of the observation point in the radar coordinate system are determined according to the relative distance of each observation point and the relative included angle, and the position information of the observation point is obtained.
  • the relative distance is the distance of the line between the observation point and the movable platform
  • the relative included angle is the clamp between the line and the outer normal direction of the radio frequency board of the radar. angle.
  • the step of determining a straight line model for the plurality of observation points according to the plurality of position information includes:
  • Fitting is performed according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
  • the step of performing fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
  • the step of performing linear fitting according to the plurality of position information includes:
  • linear fitting is performed according to the multiple position information.
  • the step of performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
  • Determine two first observation points from the multiple observation points determine a first sample straight line model about the two first observation points according to the position information of the two first observation points; determine the multiple The multiple Euclidean distances between multiple observation points other than the two first observation points in the two observation points and the first sample straight line model; determine the first same according to the multiple Euclidean distances
  • the distance data of the present straight line model; the straight line model about the multiple observation points is determined according to the distance data and the first sample straight line model.
  • the step of performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
  • each sample point set includes two first observation points; respectively according to the position information of the two first observation points in each sample point set
  • the sample straight line model serves as a straight line model with respect to the plurality of observation points.
  • the step of determining the distance data of the first sample linear model according to the multiple Euclidean distances includes:
  • the multiple Euclidean distances are added together to obtain a first value; and the first value is used as the distance data of the first sample straight line model.
  • the step of performing fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
  • Fitting is performed according to the multiple position information received at the first time to determine the first linear model of the multiple observation points at the first time; and the first straight line model is determined based on the multiple location information received at the second time.
  • the step of determining a straight line model according to the first straight line model and the second straight line model includes:
  • the movement track includes the running direction of the movable platform and the target distance from the movable platform to the target object; the movement of the movable platform is controlled according to the linear model
  • the steps of the trajectory include:
  • the target distance from the movable platform to the target object and the running direction of the movable platform are determined according to the model parameters of the linear model.
  • the target distance includes a vertical distance from the movable platform to the target object.
  • the step of determining the target distance from the movable platform to the target object and the running direction of the movable platform according to the model parameters of the linear model includes:
  • the vertical distance from the movable platform to the target object and the running direction of the movable platform are determined according to the slope and intercept of the straight line model.
  • the running direction of the movable platform is parallel to the linear model.
  • the target object includes wires, cables, optical cables, or optical fibers.
  • the method before the step of receiving radar observation data of the target object, the method further includes:
  • the outer normal direction of the radio frequency board of the radar is the same as the running direction of the movable platform.
  • the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform and faces the target object.
  • the step of determining a straight line model for the plurality of observation points according to the plurality of position information includes:
  • the method before the step of receiving radar observation data of the target object, the method further includes:
  • the operating posture parameter includes the operating direction of the movable platform.
  • the signal transmission direction of the radar is the same as the running direction of the movable platform
  • the position information includes the coordinates of the observation point in the radar coordinate system
  • the step of performing coordinate conversion on the plurality of position information to obtain the coordinates of the plurality of observation points in the target coordinate system include:
  • the position information includes the coordinates of the observation point in the radar coordinate system
  • the step of performing coordinate conversion on the plurality of position information to obtain the coordinates of the plurality of observation points in the target coordinate system include:
  • the target coordinate system is a northeast coordinate system.
  • the embodiments of the present application also provide a computer-readable storage medium, the computer-readable storage medium stores a computer program, the computer program includes program instructions, and the processor executes the program instructions to implement the foregoing implementation The steps of the control method provided by the example.
  • the computer-readable storage medium may be the internal storage unit of the removable platform described in any of the foregoing embodiments, such as the hard disk or memory of the server.
  • the computer-readable storage medium may also be an external storage device of the server, such as a plug-in hard disk equipped on the server, a Smart Media Card (SMC), or a Secure Digital (SD) card , Flash Card, etc.
  • SMC Smart Media Card
  • SD Secure Digital

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Computer Graphics (AREA)
  • Geometry (AREA)
  • Software Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

A control method, a movable platform (10), and a storage medium. The method comprises: obtaining observation data of a radar (11) for a target object (20), the observation data comprising multiple pieces of location information of multiple observation points (21) (S101); determining a linear model for the multiple observation points (21) according to the multiple pieces of location information (S102); and controlling the moving trajectory of the movable platform (10) according to the linear model to complete the inspection of the target object (20) (S103). The measurement accuracy and reliability of the movable platform (10) in power inspection can be improved.

Description

控制方法、可移动平台及存储介质Control method, movable platform and storage medium 技术领域Technical field
本申请涉及控制技术领域,尤其涉及一种控制方法、可移动平台及存储介质。This application relates to the field of control technology, in particular to a control method, a removable platform and a storage medium.
背景技术Background technique
在电力巡检行业,常常需要对高压塔和电线等进行电力巡检,以提前预知电力故障,目前电力巡检的作业方式主要包括人工检测和可移动平台检测,可移动平台包括无人机。其中,人工检测的方式效率低下而且造成较高的人工成本。而可移动平台进行检测时,需要沿电线进行移动作业,所以和电线保持一定的安全距离是十分重要的。In the power inspection industry, it is often necessary to conduct power inspections on high-voltage towers and wires to predict power failures in advance. The current power inspection operations mainly include manual inspection and mobile platform inspection, and mobile platforms include drones. Among them, the manual detection method is inefficient and causes high labor costs. When the movable platform performs detection, it needs to move along the wire, so it is very important to keep a certain safe distance from the wire.
可移动平台检测目前包括手动移动和自动移动两种方式,手动移动方式即由通过人为遥控进行检测,难度较高而且效率低下。自动移动方式包括需要依靠全球定位系统(GPS,Global Positioning System)数据来提前对可移动平台的移动轨迹进行实时动态(RTK,Real time kinematic)打点的方式,以及通过图像采集分析来确定电线位置的视觉保障安全距离移动的方式。The detection of movable platforms currently includes two methods: manual movement and automatic movement. The manual movement method is to be detected by human remote control, which is difficult and inefficient. Automatic movement methods include the need to rely on Global Positioning System (GPS) data to perform real-time dynamic (RTK, Real time kinematic) spotting on the movement trajectory of the movable platform in advance, and the method of determining the position of the wire through image acquisition and analysis. The way of visually ensuring safe distance movement.
其中,实时动态打点的方式在全球定位系统信号较弱时,会出现精度下降的问题。而由于电线比较细,图像采集的方式很难精确定位到电线,另外在光线不足的情况下,也会对图像采集造成影响,大大降低视觉方案的可靠性。Among them, the real-time dynamic dotting method will cause the problem of decreased accuracy when the GPS signal is weak. However, because the wires are relatively thin, it is difficult to accurately locate the wires in the image collection method. In addition, in the case of insufficient light, it will also affect the image collection, which greatly reduces the reliability of the vision solution.
发明内容Summary of the invention
基于此,本申请提供了一种控制方法、可移动平台及存储介质,以提高可移动平台在电力巡检中的测量精度与可靠性。Based on this, the present application provides a control method, a movable platform, and a storage medium to improve the measurement accuracy and reliability of the movable platform in power inspection.
第一方面,本申请提供了一种控制方法,应用于包括雷达的可移动平台,所述控制方法包括:In the first aspect, the present application provides a control method, which is applied to a movable platform including a radar, and the control method includes:
获取雷达对目标对象的观测数据,所述观测数据包括多个观测点的多个位 置信息;Acquiring radar observation data of the target object, the observation data including multiple position information of multiple observation points;
根据所述多个位置信息,确定关于所述多个观测点的直线模型;Determining a straight line model about the plurality of observation points according to the plurality of position information;
根据所述直线模型,控制所述可移动平台的移动轨迹,以完成对所述目标对象的巡检。According to the linear model, the movement track of the movable platform is controlled to complete the inspection of the target object.
第二方面,本申请还提供了一种可移动平台,所述可移动平台包括雷达、存储器和处理器:所述雷达用于发送雷达信号以进行测量或探测;所述存储器用于存储计算机程序;所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:In the second aspect, the application also provides a movable platform, the movable platform includes a radar, a memory, and a processor: the radar is used to send radar signals for measurement or detection; the memory is used to store computer programs The processor is used to execute the computer program and when executing the computer program, implement the following steps:
获取雷达对目标对象的观测数据,所述观测数据包括多个观测点的多个位置信息;Acquiring observation data of the target object by the radar, the observation data including multiple position information of multiple observation points;
根据所述多个位置信息,确定关于所述多个观测点的直线模型;Determining a straight line model about the plurality of observation points according to the plurality of position information;
根据所述直线模型,控制所述可移动平台的移动轨迹,以完成对所述目标对象的巡检。According to the linear model, the movement track of the movable platform is controlled to complete the inspection of the target object.
第三方面,本申请还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现上述的控制方法。In a third aspect, the present application also provides a computer-readable storage medium that stores a computer program, and when the computer program is executed by a processor, the processor implements the above-mentioned control method.
本发明提出的控制方法、可移动平台及存储介质,可以提高可移动平台在电力巡检中的测量精度与可靠性。The control method, the movable platform and the storage medium provided by the present invention can improve the measurement accuracy and reliability of the movable platform in the electric power inspection.
应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本申请。It should be understood that the above general description and the following detailed description are only exemplary and explanatory, and cannot limit the application.
附图说明Description of the drawings
为了更清楚地说明本申请实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to explain the technical solutions of the embodiments of the present application more clearly, the following will briefly introduce the drawings used in the description of the embodiments. Obviously, the drawings in the following description are some embodiments of the present application. Ordinary technicians can obtain other drawings based on these drawings without creative work.
图1是本申请一实施例提供的一种控制方法的一个场景的示意图;FIG. 1 is a schematic diagram of a scene of a control method provided by an embodiment of the present application;
图2是本申请一实施例提供的雷达的示意结构图;FIG. 2 is a schematic structural diagram of a radar provided by an embodiment of the present application;
图3是本申请一实施例提供的一种控制方法的示意流程图;FIG. 3 is a schematic flowchart of a control method provided by an embodiment of the present application;
图4是本申请一实施例提供的一种控制方法的另一个场景的示意图;FIG. 4 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application;
图5是本申请一实施例提供的雷达坐标系和目标坐标系的场景示意图;FIG. 5 is a schematic diagram of a scene of a radar coordinate system and a target coordinate system provided by an embodiment of the present application;
图6是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 6 is a schematic flowchart of another control method provided by an embodiment of the present application;
图7是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 7 is a schematic flowchart of another control method provided by an embodiment of the present application;
图8是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 8 is a schematic flowchart of another control method provided by an embodiment of the present application;
图9是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 9 is a schematic flowchart of another control method provided by an embodiment of the present application;
图10是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 10 is a schematic flowchart of another control method provided by an embodiment of the present application;
图11是本申请一实施例提供的一种控制方法的另一个场景的示意图;FIG. 11 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application;
图12是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 12 is a schematic flowchart of another control method provided by an embodiment of the present application;
图13是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 13 is a schematic flowchart of another control method provided by an embodiment of the present application;
图14是本申请一实施例提供的雷达坐标系和目标坐标系的示意图;FIG. 14 is a schematic diagram of a radar coordinate system and a target coordinate system provided by an embodiment of the present application;
图15是本申请一实施例提供的一种控制方法的另一个场景的示意图;15 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application;
图16是本申请一实施例提供的另一种控制方法的示意流程图;FIG. 16 is a schematic flowchart of another control method provided by an embodiment of the present application;
图17是本申请一实施例提供的一种控制方法的另一个场景的示意图;FIG. 17 is a schematic diagram of another scenario of a control method provided by an embodiment of the present application;
图18是本申请一实施例提供的可移动平台的示意性框图。FIG. 18 is a schematic block diagram of a movable platform provided by an embodiment of the present application.
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The technical solutions in the embodiments of the present application will be described clearly and completely in conjunction with the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of them. Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of this application.
附图中所示的流程图仅是示例说明,不是必须包括所有的内容和操作/步骤,也不是必须按所描述的顺序执行。例如,有的操作/步骤还可以分解、组合或部分合并,因此实际执行的顺序有可能根据实际情况改变。The flowchart shown in the drawings is only an example, and does not necessarily include all contents and operations/steps, nor does it have to be executed in the described order. For example, some operations/steps can also be decomposed, combined or partially combined, so the actual execution order may be changed according to actual conditions.
下面结合附图,对本申请的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。Hereinafter, some embodiments of the present application will be described in detail with reference to the accompanying drawings. In the case of no conflict, the following embodiments and features in the embodiments can be combined with each other.
本申请的实施例提供了一种控制方法、可移动平台及存储介质,应用于包括雷达的可移动平台在进行电力巡检时,可以提高可移动平台在电力巡检中的测量精度与可靠性。The embodiments of the present application provide a control method, a movable platform, and a storage medium, which are applied to a movable platform including a radar during power inspection, which can improve the measurement accuracy and reliability of the movable platform in the power inspection .
电力巡检为对电力系统的电力设施进行巡检,例如,可以是对电线或高压塔的巡检,通过对电力设施进行电力巡检可以提前预知电力设施的故障。该控制方法可以是应用于包括雷达的可移动平台,示例性的,可移动平台包括飞行器、机器人或自动驾驶车辆等。Power patrol inspection refers to the patrol inspection of power facilities of the power system, for example, it can be the patrol inspection of power lines or high-voltage towers, and the faults of the power facilities can be predicted in advance through the power patrol inspection of the power facilities. The control method may be applied to a movable platform including a radar. Illustratively, the movable platform includes an aircraft, a robot, or an autonomous vehicle.
飞行器包括无人机,该无人机包括旋翼型无人机,例如四旋翼无人机、六旋翼无人机、八旋翼无人机,也可以是固定翼无人机,还可以是旋翼型与固定翼无人机的组合,在此不作限定。Aircraft include drones, which include rotary-wing drones, such as quadrotor drones, hexarotor drones, and octo-rotor drones. It can also be a fixed-wing drone or a rotary-wing drone. The combination with fixed-wing UAV is not limited here.
可移动平台上搭载有雷达,通过雷达实现对可移动平台在移动过程中周围环境的检测,例如可以通过雷达实现测速、测距、探测、跟踪、定位以及识别等功能。可移动平台进行电力巡检时,雷达可以对电力设施进行检测。The movable platform is equipped with a radar, which can realize the detection of the surrounding environment of the movable platform during the movement. For example, the radar can realize functions such as speed measurement, ranging, detection, tracking, positioning, and identification. When the movable platform conducts power inspections, the radar can detect power facilities.
在通过可移动平台进行电力巡检时,雷达可以检测可移动平台在电力巡检中被巡检的目标对象。示例性的,如图1所示,可移动平台10在对目标对象20进行巡检,可移动平台10可以为无人机,目标对象20可以是电线,可移动平台10上搭载有雷达11,雷达11可以在巡检过程中检测电线。When conducting power inspections through the mobile platform, the radar can detect the target objects that the mobile platform is inspected in the power inspection. Exemplarily, as shown in FIG. 1, the movable platform 10 is patrolling the target object 20, the movable platform 10 may be a drone, the target object 20 may be a wire, and the movable platform 10 is equipped with a radar 11, The radar 11 can detect electric wires during the inspection process.
雷达可以是机械旋转式雷达,雷达包括射频模块和信号处理模块,射频模块可以是由阵列天线组成的射频板,阵列天线包括发射天线和接收天线。在雷达进行检测时,阵列天线的发射天线可以发射雷达信号,例如可以是毫米波信号,毫米波信号在空气中传播直到遇到障碍物后被反射,阵列天线的接收天线可以接收返回的毫米波信号,信号处理模块可以将返回的毫米波信号转换为电信号,并对电信号进行处理,以此检测障碍物的距离、角度信息以及可移动平台的速度。雷达可以在水平方向上进行扫描,并在竖直方向上测角。The radar can be a mechanical rotating radar. The radar includes a radio frequency module and a signal processing module. The radio frequency module can be a radio frequency board composed of an array antenna. The array antenna includes a transmitting antenna and a receiving antenna. During radar detection, the transmitting antenna of the array antenna can transmit radar signals, such as millimeter wave signals. The millimeter wave signals propagate in the air until they are reflected after encountering obstacles, and the receiving antenna of the array antenna can receive the returned millimeter waves. Signal, the signal processing module can convert the returned millimeter wave signal into an electric signal, and process the electric signal to detect the distance and angle information of the obstacle and the speed of the movable platform. The radar can scan in the horizontal direction and measure the angle in the vertical direction.
射频板的外法线方向是与射频板垂直的方向。雷达上设置的天线的信号发射方向主要是沿着外法线发射信号,同时天线的信号也会向四周散射。The outer normal direction of the radio frequency board is the direction perpendicular to the radio frequency board. The signal transmission direction of the antenna set on the radar is mainly to transmit the signal along the outer normal, and the signal from the antenna will also be scattered around.
示例性地,如图2所示,雷达包括射频板12以及旋转轴120,射频板12可以是设置在旋转轴120上,射频板12可以绕着旋转轴120进行旋转,以改变射频板12上天线的信号发射方向。Exemplarily, as shown in FIG. 2, the radar includes a radio frequency board 12 and a rotation axis 120. The radio frequency board 12 may be arranged on the rotation axis 120. The radio frequency board 12 may rotate around the rotation axis 120 to change the radio frequency board 12 The signal transmission direction of the antenna.
可移动平台上还设置有姿态检测模块,姿态检测模块用于获取可移动平台在移动时的运行姿态信息。例如,可移动平台可以是无人机,姿态检测模块可以是飞控模块,飞控模块也可以获取无人机在飞行时的飞行方向、飞行姿态、飞行高度、飞行速度和/或位置信息等等。The movable platform is also provided with a posture detection module, and the posture detection module is used to obtain the running posture information of the movable platform when it is moving. For example, the movable platform can be a drone, the attitude detection module can be a flight control module, and the flight control module can also obtain the flight direction, flight attitude, flight height, flight speed and/or position information of the drone during flight. Wait.
雷达可以从姿态检测模块获取可移动平台的运行姿态信息,并根据可移动平台的运行姿态信息调整雷达的信号发射方向。例如,若雷达包括射频板,雷达可以通过姿态检测模块获取可移动平台的移动方向,根据移动方向调整射频板的角度以实现调整雷达的信号发射方向,保持雷达的信号发射方向和可移动屏的移动方向一致,雷达可以实现对可移动平台前进方向环境的检测。The radar can obtain the operating attitude information of the movable platform from the attitude detection module, and adjust the signal emission direction of the radar according to the operating attitude information of the movable platform. For example, if the radar includes a radio frequency board, the radar can obtain the movement direction of the movable platform through the attitude detection module, and adjust the angle of the radio frequency board according to the movement direction to adjust the signal transmission direction of the radar, and maintain the signal transmission direction of the radar and the movable screen. The moving direction is the same, and the radar can realize the detection of the environment in the forward direction of the movable platform.
请参阅图3,图3是本申请一实施例提供的一种控制方法的步骤示意流程图。该方法可以应用于包括雷达的可移动平台中,用于对目标对象进行电力巡检,以提高可移动平台在电力巡检中的测量精度与可靠性。Please refer to FIG. 3, which is a schematic flowchart of steps of a control method provided by an embodiment of the present application. The method can be applied to a movable platform that includes a radar, and is used for power inspection of a target object, so as to improve the measurement accuracy and reliability of the movable platform in the power inspection.
如图3所示,该控制方法包括步骤S101至步骤S103。As shown in Fig. 3, the control method includes step S101 to step S103.
S101、获取雷达对目标对象的观测数据,所述观测数据包括多个观测点的多个位置信息。S101. Obtain observation data of a target object by a radar, where the observation data includes multiple position information of multiple observation points.
其中,所述目标对象为电力巡检中被巡检的呈线状的物体,例如,目标对象可以是电线、电缆、光缆或光纤中的任意一种。Wherein, the target object is a linear object that is inspected in the power inspection. For example, the target object may be any one of wires, cables, optical cables, or optical fibers.
如图4所示,可移动平台10在对目标对象20进行巡检时,可移动平台10上的雷达所发射的雷达信号会遇上目标对象20上的多个位置点,将雷达的雷达信号所遇到的多个位置点作为观测点。例如,如果目标对象是电线,雷达的扫描范围里包括电线的一部分,雷达所发射的若干个雷达信号会遇到电线的一部分,而该若干个雷达信号会被返回至雷达。由此,雷达根据发射的雷达信号以及接收到返回的雷达信号可以确定观测点的位置信息。As shown in FIG. 4, when the movable platform 10 is patrolling the target object 20, the radar signal emitted by the radar on the movable platform 10 will meet multiple position points on the target object 20, and the radar signal of the radar The multiple locations encountered are regarded as observation points. For example, if the target object is an electric wire, and the scanning range of the radar includes a part of the electric wire, several radar signals emitted by the radar will encounter a part of the electric wire, and the several radar signals will be returned to the radar. In this way, the radar can determine the position information of the observation point based on the transmitted radar signal and the received radar signal.
观测点的位置信息可以是用于体现观测点与雷达之间的位置关系的参数,也可以是用于体现观测点与可移动平台之间的位置关系的参数。The position information of the observation point may be a parameter used to reflect the position relationship between the observation point and the radar, or it may be a parameter used to reflect the position relationship between the observation point and the movable platform.
在一些实施例中,所述获取雷达对目标对象的观测数据,可以通过如下方式实施:In some embodiments, the acquisition of radar observation data of the target object may be implemented in the following manner:
通过雷达采集目标对象的多个观测点与可移动平台之间的相对距离以及相对夹角,根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息。The relative distance and relative included angle between multiple observation points of the target object and the movable platform are collected by radar, and the position information of the observation point is determined according to the relative distance and relative included angle between the observation point and the movable platform.
其中,相对距离以及相对夹角为用于体现观测点与可移动平台之间位置关系的参数。雷达通过发送雷达信号,雷达信号遇到目标对象后返回,根据雷达信号的发送时间以及返回的雷达信号的接收时间,可以确定目标对象与雷达之间的相对距离。Among them, the relative distance and the relative included angle are parameters used to reflect the positional relationship between the observation point and the movable platform. The radar sends a radar signal, and the radar signal returns after encountering the target object. According to the sending time of the radar signal and the receiving time of the returned radar signal, the relative distance between the target object and the radar can be determined.
在通过雷达对目标对象进行检测时,雷达信号遇到目标对象上的多个观测点,根据每个观测点对应的雷达信号可以确定每个观测点与雷达的相对距离。When the target object is detected by radar, the radar signal encounters multiple observation points on the target object, and the relative distance between each observation point and the radar can be determined according to the radar signal corresponding to each observation point.
雷达上设置有多个天线,雷达可以根据多个天线接收到的返回的雷达信号之间的相位差来确定目标对象与雷达之间的相位角。例如,雷达的一次观测中获取了目标对象上的n个观测点,对应的相对距离为r n,对应的相对夹角为θ nThe radar is provided with multiple antennas, and the radar can determine the phase angle between the target object and the radar according to the phase difference between the returned radar signals received by the multiple antennas. For example, in a radar observation, n observation points on the target object are acquired, the corresponding relative distance is r n , and the corresponding relative included angle is θ n .
雷达搭载在可移动平台上,所以根据雷达采集的观测点与雷达之间的相对距离以及相对夹角,可以确定观测点与可移动平台之间的相对距离以及相对夹角。The radar is mounted on a movable platform, so according to the relative distance and the relative angle between the observation point and the radar collected by the radar, the relative distance and the relative angle between the observation point and the movable platform can be determined.
在确定了观测点与可移动平台之间的相对距离以及相对夹角,即可以确定观测点所在的位置,进而可以确定观测点的位置信息。After determining the relative distance and relative included angle between the observation point and the movable platform, the location of the observation point can be determined, and then the location information of the observation point can be determined.
在一些实施例中,所述相对距离为观测点和可移动平台之间连线的距离,所述相对夹角为所述连线与所述雷达的射频板的外法线方向之间的夹角。In some embodiments, the relative distance is the distance of the line between the observation point and the movable platform, and the relative included angle is the clamp between the line and the outer normal direction of the radio frequency board of the radar. angle.
如图4所示,相对距离可以是观测点21与可移动平台10上的雷达中心点之间的连线22的长度,而该连线22与雷达的射频板的外法线方向100之间的夹角23作为相对夹角。根据该相对距离以及相对夹角即可以确定观测点和可移动平台之间的位置关系。As shown in FIG. 4, the relative distance can be the length of the line 22 between the observation point 21 and the radar center point on the movable platform 10, and the line 22 and the outer normal direction 100 of the radar radio frequency board The included angle 23 is used as the relative included angle. According to the relative distance and the relative included angle, the positional relationship between the observation point and the movable platform can be determined.
在实际应用中,相对距离和相对夹角的定义可以根据实际需求进行设置,并不限于此。例如,其他表示观测点和雷达,或者观测点和可移动平台之间的角度关系的夹角均可用于本发明。In practical applications, the definition of the relative distance and the relative included angle can be set according to actual needs, and is not limited to this. For example, other angles representing the angular relationship between the observation point and the radar, or the observation point and the movable platform can be used in the present invention.
在一些实施例中,所述根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息,可以通过如下方式实施:In some embodiments, the determination of the position information of the observation point according to the relative distance and the relative included angle between the observation point and the movable platform may be implemented in the following manner:
根据每个观测点的相对距离和所述相对夹角确定所述观测点在雷达坐标系中的坐标,得到观测点的位置信息。The coordinates of the observation point in the radar coordinate system are determined according to the relative distance of each observation point and the relative included angle, and the position information of the observation point is obtained.
其中,雷达本身定义了一个雷达坐标系,雷达通过观测目标对象所确定的可以是目标对象在雷达坐标系中的位置信息。示例性地,如图5所示,雷达坐标系可以是以雷达的中心点为原点O,以雷达的信号发射方向作为雷达坐标系的坐标轴X b,坐标轴Y b与雷达的射频板平行,坐标轴Y b、坐标轴X b与坐标轴Z b符合坐标系右手法则;示例性地,坐标轴Z b可以是指向天。在实际应用中,雷达坐标系可以根据实际情况进行设置,并不限定于此。 Among them, the radar itself defines a radar coordinate system, and what the radar determines by observing the target object can be the position information of the target object in the radar coordinate system. Exemplarily, as shown in FIG. 5, the radar coordinate system may be based on the center point of the radar as the origin O, and the signal emission direction of the radar as the coordinate axis X b of the radar coordinate system, and the coordinate axis Y b is parallel to the radar radio frequency , The coordinate axis Y b , the coordinate axis X b and the coordinate axis Z b conform to the right-hand rule of the coordinate system; for example, the coordinate axis Z b may point to the sky. In practical applications, the radar coordinate system can be set according to actual conditions, and is not limited to this.
雷达所检测的每个观测点的相对距离和相对夹角可以是与雷达的中心点之 间的相对距离和相对夹角,在得到每个观测点的相对距离和相对夹角后即可以确定每个观测点在雷达坐标系中的坐标,并将观测点在雷达坐标系中的坐标作为观测点的位置信息。The relative distance and relative included angle of each observation point detected by the radar can be the relative distance and relative included angle between the center point of the radar and the relative distance and relative included angle of each observation point. The coordinates of each observation point in the radar coordinate system, and the coordinates of the observation point in the radar coordinate system are used as the position information of the observation point.
可以根据如下公式将每个观测点的相对距离和所述相对夹角转换为在雷达坐标系中的坐标:The relative distance of each observation point and the relative included angle can be converted into coordinates in the radar coordinate system according to the following formula:
Figure PCTCN2019130217-appb-000001
Figure PCTCN2019130217-appb-000001
其中,
Figure PCTCN2019130217-appb-000002
为雷达坐标系的坐标,r n为相对距离,θ n为相对夹角。
among them,
Figure PCTCN2019130217-appb-000002
Is the coordinates of the radar coordinate system, r n is the relative distance, and θ n is the relative included angle.
S102、根据所述多个位置信息,确定关于所述多个观测点的直线模型。S102. Determine a straight line model about the multiple observation points according to the multiple location information.
其中,多个观测点是属于目标对象,观测点的位置信息可以是用于体现观测点与可移动平台之间的位置关系的参数,所以根据观测点的位置信息所确定的直线模型可以是用于体现目标对象相对于可移动平台的位置函数方程。Among them, multiple observation points belong to the target object, and the position information of the observation point can be a parameter used to reflect the position relationship between the observation point and the movable platform, so the straight line model determined according to the position information of the observation point can be used To embody the position function equation of the target object relative to the movable platform.
获取两个点的位置信息后即可以确定一个直线,该直线穿过两个点。在获取到多个观测点的位置信息后,可以确定多个观测点所在直线的直线模型。After obtaining the position information of the two points, a straight line can be determined, which passes through the two points. After obtaining the position information of multiple observation points, a straight line model of the straight line where the multiple observation points are located can be determined.
由于目标对象是呈线状的物体,可移动平台在对目标对象进行巡检时,雷达是持续观测目标对象,所以雷达每一次观测的目标对象的部分区域可以视为直线。示例性地,若目标对象为电线,雷达所检测的多个观测点可以是电线上的一小段,根据这一小段电线上的多个观测点可以确定这一小段电线的直线模型。Since the target object is a linear object, the radar continuously observes the target object when the movable platform is patrolling the target object, so the part of the target object observed by the radar every time can be regarded as a straight line. Exemplarily, if the target object is an electric wire, the multiple observation points detected by the radar may be a short section of the electric wire, and the linear model of the short electric wire can be determined based on the multiple observation points on this small electric wire.
电线一般是一长段呈平滑的线条状态,在确定这一小段电线的直线模型后,即可以视为前方的部分电线也是处于该直线模型上。所以在确定直线模型后,可以预知移动过程的前方的电线的位置,进而可以据此控制可移动平台的移动。A wire is generally a long section of a smooth line. After determining the straight line model of this small section of wire, it can be considered that the part of the wire in front is also on the straight line model. Therefore, after determining the linear model, the position of the wire in front of the moving process can be predicted, and then the movement of the movable platform can be controlled accordingly.
其中,确定的关于所述多个观测点的直线模型可以是如下公式:Wherein, the determined straight line model about the multiple observation points may be the following formula:
Y=kX+b;Y=kX+b;
其中,k为直线模型的斜率,b为直线模型的截距。Among them, k is the slope of the linear model, and b is the intercept of the linear model.
在一些实施例中,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型,可以通过如下方式实施:In some embodiments, the determination of a straight line model about the plurality of observation points according to the plurality of position information may be implemented in the following manner:
根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型。Fitting is performed according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
其中,拟合为根据多个点确定一个光滑的线条,该线条可以将多个点连接 起来。根据拟合的方式可以确定关于多个观测点的直线模型,根据多个位置信息确定一条直线,而该直线可以将多个观测点连接起来,在一种情况下,多个观测点均位于该直线上,另一种情况,多个观测点中有部分观测点位于该直线上,其他观测点和该直线保持相对近的距离。Among them, fitting is to determine a smooth line based on multiple points, which can connect multiple points. According to the fitting method, a straight line model about multiple observation points can be determined, and a straight line can be determined according to multiple position information, and the straight line can connect multiple observation points. In one case, multiple observation points are located in the On a straight line, in another case, some of the multiple observation points are located on the straight line, and other observation points are kept relatively close to the straight line.
在一些实施例中,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型,可以通过如下方式实施:In some embodiments, the fitting according to the plurality of position information to determine the straight line model about the plurality of observation points may be implemented in the following manner:
根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型。Performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
其中,多个观测点的位置信息属于目标对象,而目标对象是呈线状的物体,所以多个观测点的位置信息之间会呈现线性关系,进而可以根据线性拟合来对多个位置信息进行拟合,以得到多个观测点的直线模型。Among them, the position information of multiple observation points belongs to the target object, and the target object is a linear object, so the position information of multiple observation points will show a linear relationship, and then the multiple position information can be calculated according to linear fitting. Fitting is performed to obtain a straight line model of multiple observation points.
在一些实施例中,所述根据所述多个位置信息进行线性拟合的步骤,可以通过如下方式实施:基于最小二乘法,根据所述多个位置信息进行线性拟合。In some embodiments, the step of performing linear fitting according to the plurality of position information may be implemented in the following manner: based on the least square method, performing linear fitting according to the plurality of position information.
其中,最小二乘法是一种数学优化算法,通过最小二乘法可以简便地求得未知的数据,并使得这些求得的数据与实际数据之间误差的平方和为最小。可以基于最小二乘法来对多个位置信息进行拟合,可以得到与多个位置信息误差的平方和最小的直线模型。Among them, the least square method is a mathematical optimization algorithm. The unknown data can be easily obtained by the least square method, and the sum of squares of the error between the obtained data and the actual data is minimized. The multiple position information can be fitted based on the least squares method, and a straight line model with the smallest sum of squares of the error from the multiple position information can be obtained.
在一些实施例中,如图6所示,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型,可以通过如下方式实施:In some embodiments, as shown in FIG. 6, the performing linear fitting according to the plurality of position information to determine the straight line model about the plurality of observation points may be implemented in the following manner:
S21、从所述多个观测点中确定两个第一观测点,根据所述两个第一观测点的位置信息确定关于所述两个第一观测点的第一样本直线模型;S21: Determine two first observation points from the multiple observation points, and determine a first sample straight line model about the two first observation points according to the position information of the two first observation points;
S22、确定所述多个观测点中除所述两个第一观测点之外的多个其他观测点与所述第一样本直线模型的多个欧式距离;S22. Determine multiple Euclidean distances between multiple observation points other than the two first observation points among the multiple observation points and the first sample straight line model;
S23、根据所述多个欧式距离,确定所述第一样本直线模型的距离数据;S23. Determine distance data of the first sample straight line model according to the multiple Euclidean distances;
S24、根据所述距离数据和所述第一样本直线模型确定关于所述多个观测点的直线模型。S24. Determine a straight line model with respect to the multiple observation points according to the distance data and the first sample straight line model.
其中,多个观测点中包括至少两个观测点,而在确定两个观测点的位置信息后,根据两个点就可以确定一条直线,而该直线可以连接该两个观测点。所以可以从多个观测点中确定两个第一观测点,根据两个第一观测点的位置信息可以确定穿过两个第一观测点的第一样本直线模型。Wherein, the multiple observation points include at least two observation points, and after determining the position information of the two observation points, a straight line can be determined based on the two points, and the straight line can connect the two observation points. Therefore, two first observation points can be determined from a plurality of observation points, and a first sample straight line model passing through the two first observation points can be determined according to the position information of the two first observation points.
在确定两个第一观测点的第一样本直线模型后,可以确定其他观测点和第一样本直线模型之间的位置关系,若其他观测点和第一样本直线模型的位置关系符合设定的条件,则可以将第一样本直线模型确定为直线模型。After determining the first sample line model of the two first observation points, the position relationship between the other observation points and the first sample line model can be determined, if the position relationship between the other observation points and the first sample line model conforms to The set conditions can determine the first sample linear model as the linear model.
每个观测点和第一样本直线模型的欧式距离,可以判断观测点和第一样本直线模型之间的位置关系,根据多个其他观测点和第一样本直线模型之间的多个欧式距离,确定所述第一样本直线模型的距离数据。The Euclidean distance between each observation point and the first sample straight line model can be used to determine the positional relationship between the observation point and the first sample straight line model, based on multiple other observation points and the first sample straight line model. The Euclidean distance determines the distance data of the first sample linear model.
距离数据用于体现多个其他观测点和第一样本直线模型之间的位置关系,根据所述距离数据和第一样本直线模型可以确定关于所述多个观测点的直线模型。示例性地,若距离数据符合设定的距离条件,则确定第一样本直线模型为关于所述多个观测点的直线模型。The distance data is used to reflect the positional relationship between the multiple other observation points and the first sample straight line model, and the straight line model about the multiple observation points can be determined according to the distance data and the first sample straight line model. Exemplarily, if the distance data meets the set distance condition, it is determined that the first sample straight line model is a straight line model with respect to the plurality of observation points.
在一些实施例中,如图7所示,所述根据所述多个欧式距离,确定所述第一样本直线模型的距离数据,可以通过如下方式实施:In some embodiments, as shown in FIG. 7, the determining the distance data of the first sample linear model according to the multiple Euclidean distances may be implemented in the following manner:
S231、将所述多个欧式距离相加,得到第一值;S231. Add the multiple Euclidean distances to obtain a first value;
S232、将所述第一值作为所述第一样本直线模型的距离数据。S232. Use the first value as distance data of the first sample straight line model.
其中,可以将多个其他观测点与第一样本直线模型之间的欧式距离相加的到第一值,将第一值作为第一样本直线模型的距离数据。根据多个其他观测点对应的欧式距离之和,可以确定多个其他观测点与第一样本直线模型之间的整体的位置关系,进而可以根据该整体的位置关系以及第一样本直线模型确定多个观测点的直线模型。Wherein, the Euclidean distances between multiple other observation points and the first sample straight line model can be added to the first value, and the first value is used as the distance data of the first sample straight line model. According to the sum of the Euclidean distances corresponding to multiple other observation points, the overall positional relationship between the multiple other observation points and the first sample linear model can be determined, and then the overall positional relationship and the first sample linear model can be determined. Determine the straight line model of multiple observation points.
在一些实施例中,如图8所示,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型,可以通过如下方式实施:In some embodiments, as shown in FIG. 8, performing linear fitting according to the plurality of position information to determine a straight line model about the plurality of observation points may be implemented in the following manner:
S211、从所述多个观测点中选择多个样本点集合,其中,每一个样本点集合包括两个第一观测点;S211. Select multiple sample point sets from the multiple observation points, where each sample point set includes two first observation points;
S212、分别根据每一个样本点集合中的所述两个第一观测点的位置信息确定关于所述多个样本点集合的多个样本直线模型;S212: Determine multiple sample straight line models for the multiple sample point sets according to the position information of the two first observation points in each sample point set respectively;
S213、分别依据关于所述多个样本直线模型的多个距离数据,确定所述多个距离数据的最小值;S213: Determine the minimum value of the multiple distance data respectively according to multiple distance data about the multiple sample straight line models;
S214、将所述最小值对应的样本直线模型作为关于所述多个观测点的直线模型。S214. Use the sample straight line model corresponding to the minimum value as a straight line model with respect to the multiple observation points.
其中,可以从多个观测点中选择两个任意观测点作为一个样本点集合,每 两个样本点集合所包含的观测点不完全相同,根据排列组合从多个观测点中可以确定多个样本点集合。Among them, two arbitrary observation points can be selected from multiple observation points as a sample point set. The observation points contained in each two sample point sets are not completely the same. According to the permutation and combination, multiple samples can be determined from multiple observation points. Point collection.
每个样本点集合可以确定一条样本直线模型,多个样本点集合可以确定多个样本直线模型;由于每两个样本点集合所包含的观测点不完全相同,所以所确定的多个样本直线模型也不会出现重复。Each sample point set can determine a sample line model, and multiple sample point sets can determine multiple sample line models; because the observation points contained in every two sample point sets are not completely the same, the determined multiple sample line models There will be no duplication.
在得到多个样本直线模型后,针对每个样本直线模型,分别计算多个其他观测点与每个样本直线模型的欧式距离,进而可以确定多个样本直线模型的距离数据。After obtaining multiple sample straight line models, for each sample straight line model, the Euclidean distances between multiple other observation points and each sample straight line model are calculated, and the distance data of the multiple sample straight line models can be determined.
从多个距离数据中选择最小值,并将最小值对应的样本直线模型作为关于所述多个观测点的直线模型,可以得到最接近所述多个观测点的直线模型,即该直线模型最接近目标对象实际的形状。Select the minimum value from multiple distance data, and use the sample straight line model corresponding to the minimum value as the straight line model for the multiple observation points, so that the straight line model closest to the multiple observation points can be obtained, that is, the straight line model is the most Close to the actual shape of the target object.
在一些实施例中,如图9所示,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型,可以通过如下方式实施:In some embodiments, as shown in FIG. 9, the fitting according to the plurality of position information to determine the straight line model about the plurality of observation points may be implemented in the following manner:
S25、根据第一时刻接收的多个位置信息进行拟合,确定所述第一时刻的多个观测点的第一直线模型;S25: Perform fitting according to multiple pieces of position information received at the first moment, and determine a first straight line model of the multiple observation points at the first moment;
S26、根据第二时刻接收的多个位置信息进行拟合,确定所述第二时刻的多个观测点的第二直线模型;S26: Perform fitting according to the multiple pieces of position information received at the second time, and determine a second straight line model of the multiple observation points at the second time;
S27、根据所述第一直线模型和所述第二直线模型确定直线模型,其中,所述第一时刻先于所述第二时刻。S27. Determine a straight line model according to the first straight line model and the second straight line model, wherein the first time is before the second time.
其中,雷达可以持续检测目标对象,雷达在前后两个时刻都获取了目标对象上观测点的位置信息。雷达可以在第一时刻获取到多个观测点的位置信息,进而根据多个观测点的位置信息确定关于第一时刻的多个观测点的第一直线模型。雷达在第二时刻又获取到多个观测点的位置信息,进而可以根据多个观测点的位置信息确定关于第二时刻的多个观测点的第二直线模型。根据多个观测点的位置信息确定直线模型的具体实施方式可以参考上文的相关描述,在此不再赘述。Among them, the radar can continuously detect the target object, and the radar obtains the position information of the observation point on the target object at two times before and after. The radar can acquire the position information of the multiple observation points at the first moment, and then determine the first straight line model about the multiple observation points at the first moment according to the position information of the multiple observation points. The radar obtains the position information of multiple observation points at the second time, and can determine the second linear model of the multiple observation points at the second time according to the position information of the multiple observation points. For the specific implementation of determining the linear model according to the position information of multiple observation points, reference may be made to the relevant description above, which will not be repeated here.
在前后得到两个时刻的直线模型后,可以根据两个时刻的直线模型来确定最终的直线模型。在一些实施例中,如图10所示,所述根据所述第一直线模型和所述第二直线模型确定直线模型,可以通过如下方式实施:After obtaining the straight line models at two moments before and after, the final straight line model can be determined according to the straight line models at the two moments. In some embodiments, as shown in FIG. 10, the determination of a straight line model based on the first straight line model and the second straight line model may be implemented in the following manner:
S271、确定所述第一直线模型和所述第二直线模型的截距的平均值,作为 平均截距;S271. Determine an average value of the intercepts of the first straight line model and the second straight line model as the average intercept.
S272、确定所述第一直线模型和所述第二直线模型的斜率的平均值,作为平均斜率;S272. Determine an average value of the slopes of the first straight line model and the second straight line model as the average slope;
S273、根据所述平均截距和所述平均斜率确定直线模型。S273. Determine a straight line model according to the average intercept and the average slope.
其中,通过计算两个直线模型的截距与斜率的平均值,根据平均截距和平均斜率来确定最终的直线模型,可以避免由于雷达的检测工作出现迟延或提前而导致检测精度不准确的问题,选择平均后的截距和斜率来确定最终的直线模型,可以提高直线模型的准确性,进一步可以提高可移动平台在巡检过程中的巡检的测量精度和可靠性。Among them, by calculating the average of the intercept and slope of the two straight line models, the final straight line model is determined according to the average intercept and average slope, which can avoid the problem of inaccurate detection accuracy caused by the delay or advancement of the radar detection work , Select the average intercept and slope to determine the final straight line model, which can improve the accuracy of the straight line model, and further improve the measurement accuracy and reliability of the inspection of the movable platform during the inspection process.
S103、根据所述直线模型,控制所述可移动平台的移动轨迹,以完成对所述目标对象的巡检。S103. According to the straight line model, control the movement track of the movable platform to complete the inspection of the target object.
其中,可移动平台可以根据设定好的移动轨迹进行移动。在得到目标对象的直线模型后,即可以根据该直线模型计算得到前方其他段电线的位置,据此可以实时调整可移动平台的移动轨迹,使得可移动平台可以沿着目标对象进行巡检,避免在巡检过程中发生失误。Among them, the movable platform can move according to the set movement track. After the linear model of the target object is obtained, the positions of other segments of the wires in front can be calculated according to the linear model, and the movement trajectory of the movable platform can be adjusted in real time according to this, so that the movable platform can perform inspections along the target object to avoid An error occurred during the inspection process.
在一些实施例中,所述移动轨迹包括所述可移动平台的运行方向以及所述可移动平台到所述目标对象的目标距离,所述根据所述直线模型,控制所述可移动平台的移动轨迹,可以通过如下方式实施:In some embodiments, the movement track includes the running direction of the movable platform and the target distance from the movable platform to the target object, and the movement of the movable platform is controlled according to the linear model The trajectory can be implemented in the following ways:
根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向。The target distance from the movable platform to the target object and the running direction of the movable platform are determined according to the model parameters of the linear model.
其中,移动方向为可移动平台移动时的前进方向,目标距离为目标对象和可移动平台之间的距离。可移动平台在对目标对象进行巡检的过程中,需要跟目标对象保持一个合适的距离以实现对目标对象的检测,同时又可以避免可移动平台与目标对象距离过近而发生冲撞。Wherein, the moving direction is the forward direction when the movable platform is moving, and the target distance is the distance between the target object and the movable platform. In the process of patrolling the target object, the movable platform needs to keep a proper distance from the target object to realize the detection of the target object, and at the same time, it can avoid the collision of the movable platform and the target object when the distance is too close.
通过对目标对象进行观测,并确定目标对象的直线模型,可以预测到目标对象在前方的位置,进而实时调整可移动平台的移动轨迹,使得可移动平台沿着根据模型参数确定的运行方向进行移动,并与目标对象之间保持目标距离。By observing the target object and determining the straight-line model of the target object, the position of the target object in front can be predicted, and then the moving trajectory of the movable platform can be adjusted in real time, so that the movable platform moves along the running direction determined according to the model parameters , And keep the target distance with the target object.
在一些实施例中,所述目标距离包括所述可移动平台到所述目标对象的垂直距离。In some embodiments, the target distance includes a vertical distance from the movable platform to the target object.
其中,目标对象呈线状,可移动平台的移动方向也一般是沿着一个直线方 向进行移动,可以将可移动平台到目标对象的垂直距离确定为目标距离,如图4所示,可移动平台10与目标对象20之间的垂直距离为102,保持垂直距离102的情况下,可移动平台10可以对目标对象20进行有效的测量又可以与目标对象20保持一个合适的距离。若可移动平台10在巡检过程中时持续保持与目标对象20保持垂直距离102,可以保证可移动平台在对目标对象的巡检过程中的测量精度以及安全可靠性。Among them, the target object is linear, and the moving direction of the movable platform is generally along a straight line. The vertical distance from the movable platform to the target object can be determined as the target distance. As shown in Figure 4, the movable platform The vertical distance between 10 and the target object 20 is 102. When the vertical distance 102 is maintained, the movable platform 10 can effectively measure the target object 20 and maintain an appropriate distance from the target object 20. If the movable platform 10 continuously maintains a vertical distance 102 from the target object 20 during the inspection process, the measurement accuracy and safety reliability of the movable platform during the inspection process of the target object can be ensured.
在一些实施例中,所述根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向,可以通过如下方式实施:In some embodiments, the determination of the target distance from the movable platform to the target object and the running direction of the movable platform according to the model parameters of the linear model may be implemented in the following manner:
根据所述直线模型的斜率和截距确定所述可移动平台到所述目标对象的垂直距离以及所述可移动平台的运行方向。The vertical distance from the movable platform to the target object and the running direction of the movable platform are determined according to the slope and intercept of the straight line model.
其中,直线模型是体现目标对象相对于可移动平台的位置函数方程,直线模型所在的坐标系可以是以可移动平台为原点。所以可以根据直线模型的斜率和截距确定所述可移动平台到所述目标对象的垂直距离,以及所述可移动平台的运行方向。Among them, the straight line model is a function equation that reflects the position of the target object relative to the movable platform, and the coordinate system where the straight line model is located may be based on the movable platform as the origin. Therefore, the vertical distance from the movable platform to the target object and the running direction of the movable platform can be determined according to the slope and intercept of the linear model.
可以根据如下公式确定垂直距离:The vertical distance can be determined according to the following formula:
Figure PCTCN2019130217-appb-000003
Figure PCTCN2019130217-appb-000003
可以根据如下公式确定运行方向:The running direction can be determined according to the following formula:
θ L=tan -1k; θ L =tan -1 k;
其中,L为垂直距离,θ L为直线模型的方向同时也是运行方向,k为直线模型的斜率,b为直线模型的截距。 Among them, L is the vertical distance, θ L is the direction of the linear model and also the running direction, k is the slope of the linear model, and b is the intercept of the linear model.
其中,根据直线模型的斜率与截距确定的方向为直线模型的方向,将直线模型的方向作为可移动平台的运行方向,可以使移动平台在运行时与直线模型保持平行地进行移动,可以保证可移动平台在巡检过程中的安全,避免与目标对象发生冲撞。Among them, the direction determined according to the slope and intercept of the linear model is the direction of the linear model, and the direction of the linear model is taken as the running direction of the movable platform, which can make the mobile platform move in parallel with the linear model during operation, which can ensure The movable platform is safe during the inspection process to avoid collision with the target object.
在一些实施例中,所述可移动平台的运行方向与所述直线模型平行。In some embodiments, the running direction of the movable platform is parallel to the linear model.
其中,将可移动平台的运行方向设置为与所述直线模型平行,可以使可移动平台在巡检过程中沿着目标对象并保持平行地进行移动,如此可以保证可移 动平台在巡检过程中的安全,避免可移动平台与目标对象发生冲撞。Wherein, setting the running direction of the movable platform to be parallel to the linear model can make the movable platform move along the target object and keep parallel during the inspection process, so as to ensure that the movable platform is in the inspection process. It is safe to avoid collision between the movable platform and the target object.
如图4所示,可移动平台10若沿着原本的运行方向100继续移动,可移动平台10和目标对象20之间的目标距离会发生变化,而若将可移动平台10的运行方向设置为与直线模型平行,可移动平台10可以沿着运行方向101进行移动,如此可移动平台10在移动过程中可以持续与目标对象20保持一个稳定的目标距离。As shown in FIG. 4, if the movable platform 10 continues to move along the original running direction 100, the target distance between the movable platform 10 and the target object 20 will change, and if the running direction of the movable platform 10 is set to Parallel to the linear model, the movable platform 10 can move along the running direction 101, so that the movable platform 10 can continue to maintain a stable target distance from the target object 20 during the movement.
在一些实施例中,为了提高可移动平台上雷达对目标对象的观测效率,可以在接收雷达对目标对象的观测数据之前,对雷达的信号发射方向进行设定;具体包括:获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的射频板的角度。In some embodiments, in order to improve the observation efficiency of the radar on the target object on the movable platform, the signal transmission direction of the radar can be set before receiving the observation data of the radar on the target object; specifically including: obtaining the information of the movable platform The operating attitude parameter is used to adjust the angle of the radio frequency board of the radar according to the operating attitude parameter.
其中,雷达可以是机械式旋转雷达,可以根据需求旋转雷达的射频板,射频板上设置了多个天线,射频板可以沿着旋转轴进行旋转以调整射频板的角度,在调整了射频板的角度后,射频板上的天线的信号发射方向也会发生变化。Among them, the radar can be a mechanical rotating radar. The radio frequency board of the radar can be rotated according to the needs. Multiple antennas are set on the radio frequency board. The radio frequency board can be rotated along the rotation axis to adjust the angle of the radio frequency board. After the angle, the signal transmission direction of the antenna on the radio frequency board will also change.
可移动平台在进行巡检的初始时刻,可移动平台上的雷达的射频板可能是处于上一次扫描结束时所保持的角度,或者是处于初始角度,但是初始时刻的射频板角度不一定适应于巡检任务,所以可以根据巡检任务调整雷达的射频板的角度。At the initial moment of the inspection of the movable platform, the radio frequency board of the radar on the movable platform may be at the angle maintained at the end of the previous scan, or at the initial angle, but the angle of the radio frequency board at the initial time may not be adapted to Inspection task, so the angle of the radio frequency board of the radar can be adjusted according to the inspection task.
运行姿态参数包括用于体现可移动平台的移动状态的参数,在一些实施例中,所述运行姿态参数包括可移动平台的运行方向。可移动平台上还设置有姿态检测模块,姿态检测模块可以实时获取可移动平台的运行姿态参数。雷达可以通过姿态检测模块获取可移动平台的运行姿态参数。示例性地,如果可移动平台为无人机,姿态检测模块可以是飞控模块。The running posture parameters include parameters for reflecting the movement state of the movable platform. In some embodiments, the running posture parameters include the running direction of the movable platform. The movable platform is also provided with a posture detection module, and the posture detection module can obtain the operating posture parameters of the movable platform in real time. The radar can obtain the operating attitude parameters of the movable platform through the attitude detection module. Exemplarily, if the movable platform is a drone, the attitude detection module may be a flight control module.
在获取可移动平台的运行姿态参数,即可以获取可移动平台的移动状态,而可移动平台进行巡检时,会依据目标对象调整自身的移动状态,可以根据可移动平台的移动状态调整雷达的射频板的角度,以使雷达的雷达信号可以辐射到目标对象。When the operating attitude parameters of the movable platform are obtained, the movement status of the movable platform can be obtained. When the movable platform conducts inspections, it will adjust its own movement status according to the target object, and adjust the radar according to the movement status of the movable platform. The angle of the radio frequency board so that the radar signal of the radar can radiate to the target object.
在一些实施例中,所述雷达的射频板的外法线方向与所述可移动平台的运行方向相同。In some embodiments, the outer normal direction of the radio frequency board of the radar is the same as the running direction of the movable platform.
其中,将所述雷达的信号发射方向设置为与所述可移动平台的运行方向相同,即雷达可以检测到可移动平台前进方向的目标对象的位置信息,并据此确 定目标对象的直线模型。Wherein, the signal emission direction of the radar is set to be the same as the running direction of the movable platform, that is, the radar can detect the position information of the target object in the forward direction of the movable platform, and determine the straight line model of the target object accordingly.
如图4所示,可移动平台10的运行方向和雷达的射频板的外法线方向一致,即可移动平台10的运行方向和雷达的射频板垂直,如此雷达可以检测到可移动平台10前进方向的目标对象20。As shown in Figure 4, the running direction of the movable platform 10 is consistent with the outer normal direction of the radar radio frequency board, that is, the running direction of the mobile platform 10 is perpendicular to the radar radio frequency board, so that the radar can detect that the movable platform 10 is moving forward. Direction of the target object 20.
在一些实施例中,所述雷达的射频板的外法线方向与所述可移动平台的运行方向垂直,即所述雷达的射频板与所述可移动平台的运行方向平行,并朝向目标对象。In some embodiments, the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform, that is, the radio frequency board of the radar is parallel to the running direction of the movable platform and faces the target object. .
其中,将雷达的射频板的方向设置为外法线方向与可移动平台的运行方向保持垂直,且朝向目标对象。也就是说,雷达的射频板与所述可移动平台的运行方向平行。在此实施例中,可以使在可移动平台的运行过程中,雷达可以直面目标对象,在可移动平台进行巡检的过程中,雷达可以实时观测到离可移动平台最近的一部分目标对象的位置信息,并据此确定目标对象的直线模型。Wherein, the direction of the radio frequency board of the radar is set such that the outer normal direction is perpendicular to the running direction of the movable platform and faces the target object. That is, the radio frequency board of the radar is parallel to the running direction of the movable platform. In this embodiment, during the operation of the movable platform, the radar can directly face the target object. During the inspection process of the movable platform, the radar can observe the position of a part of the target object closest to the movable platform in real time. Information, and determine the straight line model of the target object based on this.
如图11所示,可移动平台10沿着运行方向100进行移动,而雷达的射频板的外法线方向111与可移动平台10的运行方向垂直,并朝向目标对象20。即,雷达的射频板与可移动平台10的运行方向平行。如此一来,在可移动平台10的移动过程中,雷达可以观测到离可移动平台10最近的部分目标对象20。As shown in FIG. 11, the movable platform 10 moves along the running direction 100, and the outer normal direction 111 of the radio frequency board of the radar is perpendicular to the running direction of the movable platform 10 and faces the target object 20. That is, the radio frequency board of the radar is parallel to the running direction of the movable platform 10. In this way, during the movement of the movable platform 10, the radar can observe some of the target objects 20 that are closest to the movable platform 10.
在一些实施例中,如图12所示,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型,可以通过如下方式实施:In some embodiments, as shown in FIG. 12, the determination of a straight line model about the plurality of observation points according to the plurality of position information may be implemented in the following manner:
S1020、对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标;S1020: Perform coordinate conversion on the multiple position information to obtain the coordinates of the multiple observation points in the target coordinate system;
S1021、根据所述多个观测点在目标坐标系的坐标,确定关于所述多个观测点的直线模型。S1021, according to the coordinates of the multiple observation points in the target coordinate system, determine a straight line model with respect to the multiple observation points.
其中,通过雷达获取的观测点的多个位置信息,是基于雷达所定义的雷达坐标系中的位置信息,可移动平台移动时所依据的不一定是雷达所定义的雷达坐标系。Among them, the multiple position information of the observation point obtained by the radar is based on the position information in the radar coordinate system defined by the radar, and the movable platform is not necessarily based on the radar coordinate system defined by the radar.
目标坐标系为可移动平台的移动轨迹的定义所依据的坐标系,目标坐标系可以是以实际地理环境所定义的坐标系。在一些实施例中,所述目标坐标系为北东地坐标系,北东地坐标系可以是以可移动平台为原点,指向北方的方向作为北轴,指向东方的方向作为东轴,垂直指向地面的方向作为地轴。如图5所示,北东地坐标系的北轴可以为X g,东轴可以为Y g,地轴可以为Z gThe target coordinate system is a coordinate system on which the movement trajectory of the movable platform is defined, and the target coordinate system may be a coordinate system defined by an actual geographic environment. In some embodiments, the target coordinate system is the northeast coordinate system. The northeast coordinate system may be based on the movable platform as the origin, the direction pointing to the north as the north axis, the direction pointing to the east as the east axis, and the vertical pointing The direction of the ground serves as the axis of the earth. As shown in Figure 5, the north axis of the north-east coordinate system can be X g , the east axis can be Y g , and the earth axis can be Z g .
雷达坐标系和目标坐标系是不同定义的坐标轴,实际物理空间中的物体在雷达坐标系和目标坐标系中的坐标是不同的定义。通过雷达获取的观测点在雷达坐标系定义下的位置信息进行坐标转换,可以得到观测点在目标坐标系的坐标。The radar coordinate system and the target coordinate system are differently defined coordinate axes, and the coordinates of the objects in the actual physical space in the radar coordinate system and the target coordinate system are differently defined. The coordinates of the observation point in the target coordinate system can be obtained through the coordinate conversion of the position information of the observation point acquired by the radar under the definition of the radar coordinate system.
在获取多个观测点的位置信息后,可以对该位置信息进行坐标转换,以得到多个观测点在目标坐标系中的坐标,通过多个观测点在目标坐标系中的坐标可以得到目标对象在目标坐标系中的直线模型,进而目标坐标系的直线模型与可移动平台的移动轨迹是同在一个坐标系中,可移动平台可以直接根据直线模型调整自身的移动轨迹,可以提高可移动平台的处理效率,可以提高可移动平台在的巡检过程的效率。After obtaining the position information of multiple observation points, the position information can be coordinate transformed to obtain the coordinates of the multiple observation points in the target coordinate system, and the target object can be obtained through the coordinates of the multiple observation points in the target coordinate system The linear model in the target coordinate system, and then the linear model of the target coordinate system and the moving trajectory of the movable platform are in the same coordinate system. The movable platform can directly adjust its own moving trajectory according to the linear model, which can improve the movable platform. The processing efficiency can improve the efficiency of the inspection process in the movable platform.
在一些实施例中,所述接收雷达对目标对象的观测数据之前,还包括:In some embodiments, before the receiving radar observation data of the target object, the method further includes:
获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的信号发射方向。Obtain the operating attitude parameters of the movable platform, and adjust the signal emission direction of the radar according to the operating attitude parameters.
其中,如果雷达包括由阵列天线组成的射频板,雷达的信号发射方向即射频板的外法线方向,通过调整雷达的射频板的角度即可以实现调整雷达的信号发射方向。如果雷达的天线是采用其他结构类型,则可以根据其他结构类型来对应调整雷达信号的发射方向。Among them, if the radar includes a radio frequency board composed of an array antenna, the signal transmission direction of the radar is the outer normal direction of the radio frequency board, and the signal transmission direction of the radar can be adjusted by adjusting the angle of the radio frequency board of the radar. If the antenna of the radar adopts other structure types, the transmitting direction of the radar signal can be adjusted correspondingly according to the other structure types.
运行姿态参数包括用于体现可移动平台的移动状态的参数,在一些实施例中,所述运行姿态参数包括可移动平台的运行方向。可移动平台上还设置有姿态检测模块,姿态检测模块可以实时获取可移动平台的运行姿态参数。雷达可以通过姿态检测模块获取可移动平台的运行姿态参数。示例性地,如果可移动平台为无人机,姿态检测模块可以是飞控模块。The running posture parameters include parameters for reflecting the movement state of the movable platform. In some embodiments, the running posture parameters include the running direction of the movable platform. The movable platform is also provided with a posture detection module, and the posture detection module can obtain the operating posture parameters of the movable platform in real time. The radar can obtain the operating attitude parameters of the movable platform through the attitude detection module. Exemplarily, if the movable platform is a drone, the attitude detection module may be a flight control module.
通过获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的信号发射方向,以使得在可移动平台进行巡检时雷达的雷达信号可以辐射到目标对象,进一步可以提高可移动平台的巡检效率。By acquiring the operating attitude parameters of the movable platform, the signal emission direction of the radar is adjusted according to the operating attitude parameters, so that the radar signal of the radar can radiate to the target object when the movable platform is patrolled, which can further improve the mobility The inspection efficiency of the platform.
在一些实施例中,所述雷达的信号发射方向与所述可移动平台的运行方向相同。In some embodiments, the signal transmission direction of the radar is the same as the running direction of the movable platform.
如图4所示,雷达的信号发射方向与可移动平台的运行方向相同,均为方向100。将雷达的信号发射方向设置为与可移动平台的运行方向相同,可以使雷达扫描到可移动平台前进方向的目标对象的位置信息,并据此确定目标对象 的直线模型。As shown in Fig. 4, the signal transmission direction of the radar is the same as the running direction of the movable platform, and both are direction 100. Setting the signal emission direction of the radar to be the same as the running direction of the movable platform can make the radar scan the position information of the target object in the forward direction of the movable platform, and determine the linear model of the target object based on this.
在一些实施例中,所述位置信息包括观测点在雷达坐标系中的坐标,所述雷达的信号发射方向与所述可移动平台的运行方向相同,如图13所示,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标,可以通过如下方式实施:In some embodiments, the position information includes the coordinates of the observation point in the radar coordinate system, and the signal emission direction of the radar is the same as the running direction of the movable platform, as shown in FIG. Coordinate conversion is performed on multiple position information to obtain the coordinates of the multiple observation points in the target coordinate system, which can be implemented in the following manner:
S201、根据所述可移动平台的运行方向确定雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;S201: Determine a first included angle between a coordinate axis of the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform;
S202、根据所述第一夹角确定转换矩阵;S202. Determine a conversion matrix according to the first included angle.
S203、根据所述转换矩阵对多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。S203: Perform coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system according to the conversion matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
其中,雷达坐标系是雷达定义的坐标系,通过雷达检测的观测点的位置信息包括观测点在雷达坐标系的坐标。雷达坐标系和目标坐标系是不同的坐标系,在实际物理空间两个坐标系之间存在相应的空间几何关系。由于位于实际物理空间中的一个观测点在两个坐标系中被定义的坐标是不同的,因此需要依据转换矩阵来对两个坐标系中的坐标进行转换。例如,可以根据两个坐标系之间的空间几何关系确定转换矩阵。Among them, the radar coordinate system is a coordinate system defined by the radar, and the position information of the observation point detected by the radar includes the coordinates of the observation point in the radar coordinate system. The radar coordinate system and the target coordinate system are different coordinate systems, and there is a corresponding spatial geometric relationship between the two coordinate systems in the actual physical space. Since the defined coordinates of an observation point in the actual physical space are different in the two coordinate systems, it is necessary to transform the coordinates in the two coordinate systems according to the transformation matrix. For example, the transformation matrix can be determined according to the spatial geometric relationship between the two coordinate systems.
示例性地,如图14所示,目标坐标系的坐标轴X g与坐标轴Y g构成目标坐标系的一个平面,雷达坐标系的坐标轴X b与坐标轴Y b构成雷达坐标系的对应的平面。目标坐标系的平面和雷达坐标系的对应平面之间的空间几何关系包括:目标坐标系的坐标轴X g与雷达坐标系的坐标轴X b之间的夹角为第一夹角θ v。根据该夹角可以确定转换矩阵,进而可以将雷达坐标系的坐标转换为目标坐标系的坐标。 Exemplarily, as shown in FIG. 14, the coordinate axis X g and the coordinate axis Y g of the target coordinate system constitute a plane of the target coordinate system, and the coordinate axis X b and the coordinate axis Y b of the radar coordinate system constitute the correspondence of the radar coordinate system. Plane. The spatial geometric relationship between the plane of the target coordinate system and the corresponding plane of the radar coordinate system includes: the angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system is the first angle θ v . The conversion matrix can be determined according to the included angle, and then the coordinates of the radar coordinate system can be converted into the coordinates of the target coordinate system.
在本实施例中,雷达的信号发射方向与所述可移动平台的运行方向相同,因此,目标坐标系的坐标轴X g与雷达坐标系的坐标轴X b之间的夹角为第一夹角θ v即为目标坐标系的坐标轴X g与所述可移动平台的运行方向之间的夹角。也就是说,当雷达的信号发射方向与所述可移动平台的运行方向相同时,可以依据目标坐标系的坐标轴X g与所述可移动平台的运行方向之间的夹角来确定转换矩阵。 In this embodiment, the signal transmission direction of the radar is the same as the running direction of the movable platform. Therefore, the angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system is the first angle. The angle θ v is the angle between the coordinate axis X g of the target coordinate system and the running direction of the movable platform. That is to say, when the signal emission direction of the radar is the same as the running direction of the movable platform, the conversion matrix can be determined according to the angle between the coordinate axis X g of the target coordinate system and the running direction of the movable platform .
在一个实施例中,当雷达的信号发射方向与所述可移动平台的运行方向相同时,根据可移动平台的运行方向可以确定两个坐标系之间的空间几何关系, 以及确定雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角,并根据第一夹角可以确定转换矩阵。其中,雷达坐标系中一坐标轴与目标坐标系的一坐标轴相对应,例如,这两个坐标轴同为x轴,或同为y轴,或同为z轴。In one embodiment, when the signal emission direction of the radar is the same as the running direction of the movable platform, the spatial geometric relationship between the two coordinate systems can be determined according to the running direction of the movable platform, and the radar coordinate system can be determined A first included angle between a coordinate axis and a coordinate axis of the target coordinate system, and the conversion matrix can be determined according to the first included angle. Among them, a coordinate axis in the radar coordinate system corresponds to a coordinate axis of the target coordinate system. For example, the two coordinate axes are the same x-axis, or the same y-axis, or both are the z-axis.
雷达坐标系的坐标和目标坐标系的坐标之间符合如下公式的映射关系:The mapping relationship between the coordinates of the radar coordinate system and the coordinates of the target coordinate system conforms to the following formula:
Figure PCTCN2019130217-appb-000004
Figure PCTCN2019130217-appb-000004
其中,
Figure PCTCN2019130217-appb-000005
为目标坐标系的坐标,
Figure PCTCN2019130217-appb-000006
为雷达坐标系的坐标,θ v为当雷达的信号发射方向与所述可移动平台的运行方向相同时,目标坐标系的坐标轴X g与所述可移动平台的运行方向之间的夹角,
Figure PCTCN2019130217-appb-000007
为转换矩阵。在一个实施方式中,目标坐标系为大地坐标系。
among them,
Figure PCTCN2019130217-appb-000005
Is the coordinates of the target coordinate system,
Figure PCTCN2019130217-appb-000006
Is the coordinates of the radar coordinate system, θ v is the angle between the coordinate axis X g of the target coordinate system and the running direction of the movable platform when the signal emission direction of the radar is the same as the running direction of the movable platform ,
Figure PCTCN2019130217-appb-000007
Is the conversion matrix. In one embodiment, the target coordinate system is a geodetic coordinate system.
其中,通过将雷达坐标系的坐标乘以转换矩阵后,即可以得到目标坐标系的坐标,即可以得到观测点在目标坐标系中的坐标,进而可以得到目标对象在目标坐标系中的直线模型,目标坐标系的直线模型与可移动平台的移动轨迹是同在一个坐标系中,可移动平台可以直接根据直线模型调整自身的移动轨迹,可以提高可移动平台的处理效率,可以提高可移动平台在的巡检过程的效率。Among them, by multiplying the coordinates of the radar coordinate system by the conversion matrix, the coordinates of the target coordinate system can be obtained, that is, the coordinates of the observation point in the target coordinate system can be obtained, and then the linear model of the target object in the target coordinate system can be obtained , The linear model of the target coordinate system and the movement trajectory of the movable platform are in the same coordinate system. The movable platform can directly adjust its movement trajectory according to the linear model, which can improve the processing efficiency of the movable platform and improve the movable platform. The efficiency of the inspection process.
需要说明的是,在雷达的信号发射方向与可移动平台的运行方向不一致时,需要根据雷达的信号发射方向结合可移动平台的运行方向来确定两个坐标系的空间几何关系,具体实施如下:It should be noted that when the signal emission direction of the radar is inconsistent with the movement direction of the movable platform, the spatial geometric relationship of the two coordinate systems needs to be determined according to the signal emission direction of the radar and the movement direction of the movable platform. The specific implementation is as follows:
在一些实施例中,所述位置信息包括观测点在雷达坐标系中的坐标,如图16所示,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标,可以通过如下方式实施:In some embodiments, the position information includes the coordinates of the observation point in the radar coordinate system. As shown in FIG. 16, the coordinate conversion is performed on the plurality of position information to obtain the coordinates of the plurality of observation points in the target coordinate system. The coordinates of the system can be implemented as follows:
S204、根据所述可移动平台的运行方向与雷达的信号发射方向确定雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;S204: Determine a first included angle between a coordinate axis in the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform and the signal emission direction of the radar;
S205、根据所述第一夹角确定转换矩阵;S205. Determine a conversion matrix according to the first included angle.
S206、根据所述转换矩阵对多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。S206: Perform coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system according to the conversion matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
在本实施例中,所述雷达的信号发射方向不一定与所述可移动平台的运行 方向相同,雷达的信号发射方向与可移动平台的运行方向可以是呈预设夹角,预设夹角可以是30°、40°、75°或90°等。例如,雷达的射频板的外法线方向与可移动平台的运行方向垂直并朝向目标对象的情况,即雷达的信号发射方向与所述可移动平台的运行方向垂直。In this embodiment, the signal emission direction of the radar is not necessarily the same as the running direction of the movable platform. The signal emission direction of the radar and the running direction of the movable platform may be at a preset angle. It can be 30°, 40°, 75° or 90°, etc. For example, when the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform and facing the target object, that is, the signal emission direction of the radar is perpendicular to the running direction of the movable platform.
如图17所示,在雷达的信号发射方向111与可移动平台10的运行方向100呈预设夹角θ‘的情况中,雷达坐标系的坐标轴X b为雷达的信号发射方向111,可移动平台10的运行方向100在目标坐标系中定义的角度为θ 0,θ 0可以是可移动平台10的运行方向100与目标坐标系的坐标轴X g之间的夹角。 As shown in Fig. 17, in the case where the signal transmission direction 111 of the radar and the running direction 100 of the movable platform 10 are at a preset angle θ', the coordinate axis X b of the radar coordinate system is the signal transmission direction 111 of the radar. The angle defined by the running direction 100 of the mobile platform 10 in the target coordinate system is θ 0 , and θ 0 may be the angle between the running direction 100 of the movable platform 10 and the coordinate axis X g of the target coordinate system.
由于在本实施例中,雷达的信号发射方向与可移动平台10的运行方向100呈预设夹角,所以目标坐标系的坐标轴X g与雷达坐标系的坐标轴X b之间的夹角θ v并不等同于可移动平台10的运行方向100与目标坐标系的坐标轴X g之间的夹角θ 0。目标坐标系的坐标轴X g与雷达坐标系的坐标轴X b之间的夹角需要根据可移动平台10的运行方向100以及雷达的信号发射方向111进行确定。 Since in this embodiment, the signal emission direction of the radar and the running direction 100 of the movable platform 10 are at a preset angle, the angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system is θ v is not equivalent to the angle θ 0 between the running direction 100 of the movable platform 10 and the coordinate axis X g of the target coordinate system. The angle between the coordinate axis X g of the target coordinate system and the coordinate axis X b of the radar coordinate system needs to be determined according to the running direction 100 of the movable platform 10 and the signal emission direction 111 of the radar.
可以根据所述可移动平台的运行方向与雷达的信号发射方向确定预设夹角θ‘,根据可移动平台的运行方向与所述预设夹角确定第一夹角。示例性地,可以是将可移动平台的运行方向在目标坐标系中定义的角度θ 0减去预设夹角θ‘以得到第一夹角θ vThe preset included angle θ'may be determined according to the running direction of the movable platform and the signal emission direction of the radar, and the first included angle may be determined according to the running direction of the movable platform and the preset included angle. Exemplarily, it may be the angle θ 0 defined in the target coordinate system of the running direction of the movable platform minus the preset angle θ′ to obtain the first angle θ v .
在本实施例中,雷达的信号发射方向可以不一定与可移动平台的运行方向设置为一致,雷达的信号发射方向可以根据实际巡检情况进行调整,只要是朝向目标对象,可以设置各种预设夹角以满足不同的巡检需求,可以进一步提高可移动平台的巡检效率。In this embodiment, the signal transmission direction of the radar may not necessarily be set to be consistent with the running direction of the movable platform. The signal transmission direction of the radar can be adjusted according to the actual inspection situation. As long as it is facing the target object, various presets can be set. Setting the angle to meet different inspection requirements can further improve the inspection efficiency of the movable platform.
请参阅图18,图18是本申请一实施例提供的可移动平台的示意性框图。该可移动平台10包括雷达11、处理器13和存储器14,处理器13、存储器14和雷达11通过总线连接,该总线比如为I2C(Inter-integrated Circuit)总线或者,雷达11与处理器13通过CAN总线连接。Please refer to FIG. 18, which is a schematic block diagram of a movable platform provided by an embodiment of the present application. The mobile platform 10 includes a radar 11, a processor 13, and a memory 14. The processor 13, the memory 14 and the radar 11 are connected by a bus. The bus is, for example, an I2C (Inter-integrated Circuit) bus or the radar 11 and the processor 13 pass through CAN bus connection.
其中,该可移动平台包括飞行器、机器人或自动无人驾驶车辆等。Among them, the movable platform includes aircraft, robots or autonomous unmanned vehicles.
具体地,处理器13可以是微控制单元(Micro-controller Unit,MCU)、中央处理单元(Central Processing Unit,CPU)或数字信号处理器(Digital Signal Processor,DSP)等。Specifically, the processor 13 may be a micro-controller unit (MCU), a central processing unit (CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
具体地,存储器14可以是Flash芯片、只读存储器(ROM,Read-Only  Memory)磁盘、光盘、U盘或移动硬盘等。Specifically, the memory 14 may be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk, or a mobile hard disk.
具体地,雷达11用于发送雷达信号以进行测量或探测。Specifically, the radar 11 is used to send radar signals for measurement or detection.
其中,所述处理器用于运行存储在存储器中的计算机程序,并在执行所述计算机程序时实现如下步骤:Wherein, the processor is used to run a computer program stored in a memory, and implement the following steps when executing the computer program:
获取雷达对目标对象的观测数据,所述观测数据包括多个观测点的多个位置信息;根据所述多个位置信息,确定关于所述多个观测点的直线模型;根据所述直线模型,控制所述可移动平台的移动轨迹,以完成对所述目标对象的巡检。Obtain radar observation data of the target object, the observation data including multiple position information of multiple observation points; determine a straight line model about the multiple observation points according to the multiple position information; according to the straight line model, Control the movement track of the movable platform to complete the inspection of the target object.
在一些实施例中,所述获取雷达对目标对象的观测数据的步骤,包括:In some embodiments, the step of obtaining radar observation data of the target object includes:
通过雷达采集目标对象的多个观测点与可移动平台之间的相对距离以及相对夹角;根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息。The relative distance and relative included angle between multiple observation points of the target object and the movable platform are collected by radar; the position information of the observation point is determined according to the relative distance and relative included angle between the observation point and the movable platform.
在一些实施例中,所述根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息的步骤,包括:In some embodiments, the step of determining the position information of the observation point according to the relative distance and the relative included angle between the observation point and the movable platform includes:
根据每个观测点的相对距离和所述相对夹角确定所述观测点在雷达坐标系中的坐标,得到观测点的位置信息。The coordinates of the observation point in the radar coordinate system are determined according to the relative distance of each observation point and the relative included angle, and the position information of the observation point is obtained.
在一些实施例中,所述相对距离为观测点和可移动平台之间连线的距离,所述相对夹角为所述连线与所述雷达的射频板的外法线方向之间的夹角。In some embodiments, the relative distance is the distance of the line between the observation point and the movable platform, and the relative included angle is the clamp between the line and the outer normal direction of the radio frequency board of the radar. angle.
在一些实施例中,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型的步骤,包括:In some embodiments, the step of determining a straight line model for the plurality of observation points according to the plurality of position information includes:
根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型。Fitting is performed according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
在一些实施例中,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型的步骤,包括:In some embodiments, the step of performing fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型。Performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
在一些实施例中,所述根据所述多个位置信息进行线性拟合的步骤,包括:In some embodiments, the step of performing linear fitting according to the plurality of position information includes:
基于最小二乘法,根据所述多个位置信息进行线性拟合。Based on the least square method, linear fitting is performed according to the multiple position information.
在一些实施例中,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型的步骤,包括:In some embodiments, the step of performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
从所述多个观测点中确定两个第一观测点,根据所述两个第一观测点的位 置信息确定关于所述两个第一观测点的第一样本直线模型;确定所述多个观测点中除所述两个第一观测点之外的多个其他观测点与所述第一样本直线模型的多个欧式距离;根据所述多个欧式距离,确定所述第一样本直线模型的距离数据;根据所述距离数据和所述第一样本直线模型确定关于所述多个观测点的直线模型。Determine two first observation points from the multiple observation points, determine a first sample straight line model about the two first observation points according to the position information of the two first observation points; determine the multiple The multiple Euclidean distances between multiple observation points other than the two first observation points in the two observation points and the first sample straight line model; determine the first same according to the multiple Euclidean distances The distance data of the present straight line model; the straight line model about the multiple observation points is determined according to the distance data and the first sample straight line model.
在一些实施例中,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型的步骤,包括:In some embodiments, the step of performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
从所述多个观测点中选择多个样本点集合,其中,每一个样本点集合包括两个第一观测点;分别根据每一个样本点集合中的所述两个第一观测点的位置信息确定关于所述多个样本点集合的多个样本直线模型;分别依据关于所述多个样本直线模型的多个距离数据,确定所述多个距离数据的最小值;将所述最小值对应的样本直线模型作为关于所述多个观测点的直线模型。Select a plurality of sample point sets from the plurality of observation points, wherein each sample point set includes two first observation points; respectively according to the position information of the two first observation points in each sample point set Determine a plurality of sample line models about the plurality of sample point sets; determine the minimum value of the plurality of distance data according to the plurality of distance data about the plurality of sample line models; and correspond the minimum value to The sample straight line model serves as a straight line model with respect to the plurality of observation points.
在一些实施例中,所述根据所述多个欧式距离,确定所述第一样本直线模型的距离数据的步骤,包括:In some embodiments, the step of determining the distance data of the first sample linear model according to the multiple Euclidean distances includes:
将所述多个欧式距离相加,得到第一值;将所述第一值作为所述第一样本直线模型的距离数据。The multiple Euclidean distances are added together to obtain a first value; and the first value is used as the distance data of the first sample straight line model.
在一些实施例中,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型的步骤,包括:In some embodiments, the step of performing fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points includes:
根据第一时刻接收的多个位置信息进行拟合,确定所述第一时刻的多个观测点的第一直线模型;根据第二时刻接收的多个位置信息进行拟合,确定所述第二时刻的多个观测点的第二直线模型;根据所述第一直线模型和所述第二直线模型确定直线模型;其中,所述第一时刻先于所述第二时刻。Fitting is performed according to the multiple position information received at the first time to determine the first linear model of the multiple observation points at the first time; and the first straight line model is determined based on the multiple location information received at the second time. A second straight-line model of multiple observation points at two moments; a straight-line model is determined according to the first straight-line model and the second straight-line model; wherein the first moment precedes the second moment.
在一些实施例中,所述根据所述第一直线模型和所述第二直线模型确定直线模型的步骤,包括:In some embodiments, the step of determining a straight line model according to the first straight line model and the second straight line model includes:
确定所述第一直线模型和所述第二直线模型的截距的平均值,作为平均截距;确定所述第一直线模型和所述第二直线模型的斜率的平均值,作为平均斜率;根据所述平均截距和所述平均斜率确定直线模型。Determine the average value of the intercepts of the first straight line model and the second straight line model as the average intercept; determine the average value of the slopes of the first straight line model and the second straight line model as the average Slope; a straight line model is determined according to the average intercept and the average slope.
在一些实施例中,所述移动轨迹包括所述可移动平台的运行方向以及所述可移动平台到所述目标对象的目标距离;所述根据所述直线模型,控制所述可移动平台的移动轨迹的步骤,包括:In some embodiments, the movement track includes the running direction of the movable platform and the target distance from the movable platform to the target object; the movement of the movable platform is controlled according to the linear model The steps of the trajectory include:
根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向。The target distance from the movable platform to the target object and the running direction of the movable platform are determined according to the model parameters of the linear model.
在一些实施例中,所述目标距离包括所述可移动平台到所述目标对象的垂直距离。In some embodiments, the target distance includes a vertical distance from the movable platform to the target object.
在一些实施例中,所述根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向的步骤,包括:In some embodiments, the step of determining the target distance from the movable platform to the target object and the running direction of the movable platform according to the model parameters of the linear model includes:
根据所述直线模型的斜率和截距确定所述可移动平台到所述目标对象的垂直距离以及所述可移动平台的运行方向。The vertical distance from the movable platform to the target object and the running direction of the movable platform are determined according to the slope and intercept of the straight line model.
在一些实施例中,所述可移动平台的运行方向与所述直线模型平行。In some embodiments, the running direction of the movable platform is parallel to the linear model.
在一些实施例中,所述目标对象包括电线、电缆、光缆或光纤。In some embodiments, the target object includes wires, cables, optical cables, or optical fibers.
在一些实施例中,所述接收雷达对目标对象的观测数据的步骤之前,还包括:In some embodiments, before the step of receiving radar observation data of the target object, the method further includes:
获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的射频板的角度。Obtain the operating attitude parameters of the movable platform, and adjust the angle of the radio frequency board of the radar according to the operating attitude parameters.
在一些实施例中,所述雷达的射频板的外法线方向与所述可移动平台的运行方向相同。In some embodiments, the outer normal direction of the radio frequency board of the radar is the same as the running direction of the movable platform.
在一些实施例中,所述雷达的射频板的外法线方向与所述可移动平台的运行方向垂直,并朝向目标对象。In some embodiments, the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform and faces the target object.
在一些实施例中,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型的步骤,包括:In some embodiments, the step of determining a straight line model for the plurality of observation points according to the plurality of position information includes:
对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标;根据所述多个观测点在目标坐标系的坐标,确定关于所述多个观测点的直线模型。Perform coordinate conversion on the plurality of position information to obtain the coordinates of the plurality of observation points in the target coordinate system; determine the linear model of the plurality of observation points according to the coordinates of the plurality of observation points in the target coordinate system .
在一些实施例中,所述接收雷达对目标对象的观测数据的步骤之前,还包括:In some embodiments, before the step of receiving radar observation data of the target object, the method further includes:
获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的信号发射方向。Obtain the operating attitude parameters of the movable platform, and adjust the signal emission direction of the radar according to the operating attitude parameters.
在一些实施例中,所述运行姿态参数包括可移动平台的运行方向。In some embodiments, the operating posture parameter includes the operating direction of the movable platform.
在一些实施例中,所述雷达的信号发射方向与所述可移动平台的运行方向相同In some embodiments, the signal transmission direction of the radar is the same as the running direction of the movable platform
在一些实施例中,所述位置信息包括观测点在雷达坐标系中的坐标,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标的步骤,包括:In some embodiments, the position information includes the coordinates of the observation point in the radar coordinate system, and the step of performing coordinate conversion on the plurality of position information to obtain the coordinates of the plurality of observation points in the target coordinate system, include:
根据所述可移动平台的运行方向确定雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;根据所述第一夹角确定转换矩阵;根据所述转换矩阵对多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。Determine the first included angle between a coordinate axis in the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform; determine a conversion matrix according to the first included angle; determine the conversion matrix according to the conversion The matrix performs coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system to obtain the coordinates of the multiple observation points in the target coordinate system.
在一些实施例中,所述位置信息包括观测点在雷达坐标系中的坐标,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标的步骤,包括:In some embodiments, the position information includes the coordinates of the observation point in the radar coordinate system, and the step of performing coordinate conversion on the plurality of position information to obtain the coordinates of the plurality of observation points in the target coordinate system, include:
根据所述可移动平台的运行方向与雷达的信号发射方向确定所述雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;根据所述第一夹角确定转换矩阵;根据所述转换矩阵对所述多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。Determine the first included angle between a coordinate axis in the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform and the signal emission direction of the radar; according to the first included angle Determine a conversion matrix; perform coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system according to the conversion matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
在一些实施例中,所述目标坐标系为北东地坐标系。In some embodiments, the target coordinate system is a northeast coordinate system.
本申请的实施例中还提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序中包括程序指令,所述处理器执行所述程序指令,实现上述实施例提供的控制方法的步骤。The embodiments of the present application also provide a computer-readable storage medium, the computer-readable storage medium stores a computer program, the computer program includes program instructions, and the processor executes the program instructions to implement the foregoing implementation The steps of the control method provided by the example.
其中,所述计算机可读存储介质可以是前述任一实施例所述的可移动平台的内部存储单元,例如所述服务器的硬盘或内存。所述计算机可读存储介质也可以是所述服务器的外部存储设备,例如所述服务器上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。The computer-readable storage medium may be the internal storage unit of the removable platform described in any of the foregoing embodiments, such as the hard disk or memory of the server. The computer-readable storage medium may also be an external storage device of the server, such as a plug-in hard disk equipped on the server, a Smart Media Card (SMC), or a Secure Digital (SD) card , Flash Card, etc.
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以权利要求的保护范围为准。The above are only specific implementations of this application, but the protection scope of this application is not limited to this. Anyone familiar with the technical field can easily think of various equivalents within the technical scope disclosed in this application. Modifications or replacements, these modifications or replacements shall be covered within the protection scope of this application. Therefore, the protection scope of this application should be subject to the protection scope of the claims.

Claims (56)

  1. 一种控制方法,应用于包括雷达的可移动平台,其特征在于,所述控制方法包括:A control method applied to a movable platform including a radar, characterized in that the control method includes:
    获取雷达对目标对象的观测数据,所述观测数据包括多个观测点的多个位置信息;Acquiring observation data of the target object by the radar, the observation data including multiple position information of multiple observation points;
    根据所述多个位置信息,确定关于所述多个观测点的直线模型;Determining a straight line model about the plurality of observation points according to the plurality of position information;
    根据所述直线模型,控制所述可移动平台的移动轨迹,以完成对所述目标对象的巡检。According to the linear model, the movement track of the movable platform is controlled to complete the inspection of the target object.
  2. 根据权利要求1所述的方法,其特征在于,所述获取雷达对目标对象的观测数据,包括:The method according to claim 1, wherein said obtaining radar observation data of the target object comprises:
    通过雷达采集目标对象的多个观测点与可移动平台之间的相对距离以及相对夹角;The relative distance and relative included angle between multiple observation points of the target object and the movable platform are collected by radar;
    根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息。The position information of the observation point is determined according to the relative distance and the relative included angle between the observation point and the movable platform.
  3. 根据权利要求2所述的方法,其特征在于,所述根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息,包括:The method according to claim 2, wherein the determining the position information of the observation point according to the relative distance and the relative included angle between the observation point and the movable platform comprises:
    根据每个观测点的相对距离和所述相对夹角确定所述观测点在雷达坐标系中的坐标,得到观测点的位置信息。The coordinates of the observation point in the radar coordinate system are determined according to the relative distance of each observation point and the relative included angle, and the position information of the observation point is obtained.
  4. 根据权利要求2或3所述的方法,其特征在于,所述相对距离为观测点和可移动平台之间连线的距离,所述相对夹角为所述连线与所述雷达的射频板的外法线方向之间的夹角。The method according to claim 2 or 3, wherein the relative distance is the distance between the observation point and the movable platform, and the relative included angle is the connection and the radio frequency board of the radar. The angle between the directions of the outer normals.
  5. 根据权利要求1所述的方法,其特征在于,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型,包括:The method according to claim 1, wherein the determining a straight line model about the plurality of observation points according to the plurality of position information comprises:
    根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型。Fitting is performed according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
  6. 根据权利要求5所述的方法,其特征在于,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型,包括:The method according to claim 5, wherein the fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型。Performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
  7. 根据权利要求6所述的方法,其特征在于,所述根据所述多个位置信息进行线性拟合,包括:The method according to claim 6, wherein the performing linear fitting according to the plurality of position information comprises:
    基于最小二乘法,根据所述多个位置信息进行线性拟合。Based on the least square method, linear fitting is performed according to the multiple position information.
  8. 根据权利要求6所述的方法,其特征在于,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型,包括:The method according to claim 6, wherein the performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    从所述多个观测点中确定两个第一观测点,根据所述两个第一观测点的位置信息确定关于所述两个第一观测点的第一样本直线模型;Determining two first observation points from the plurality of observation points, and determining a first sample straight line model about the two first observation points according to location information of the two first observation points;
    确定所述多个观测点中除所述两个第一观测点之外的多个其他观测点与所述第一样本直线模型的多个欧式距离;Determining a plurality of Euclidean distances between a plurality of observation points other than the two first observation points among the plurality of observation points and the first sample straight line model;
    根据所述多个欧式距离,确定所述第一样本直线模型的距离数据;Determine the distance data of the first sample linear model according to the multiple Euclidean distances;
    根据所述距离数据和所述第一样本直线模型确定关于所述多个观测点的直线模型。A straight line model with respect to the plurality of observation points is determined according to the distance data and the first sample straight line model.
  9. 根据权利要求6所述的方法,其特征在于,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型,包括:The method according to claim 6, wherein the performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    从所述多个观测点中选择多个样本点集合,其中,每一个样本点集合包括两个第一观测点;Selecting multiple sample point sets from the multiple observation points, wherein each sample point set includes two first observation points;
    分别根据每一个样本点集合中的所述两个第一观测点的位置信息确定关于所述多个样本点集合的多个样本直线模型;Determining, respectively, a plurality of sample line models about the plurality of sample point sets according to the position information of the two first observation points in each sample point set;
    分别依据关于所述多个样本直线模型的多个距离数据,确定所述多个距离数据的最小值;Determine the minimum value of the multiple distance data respectively according to multiple distance data about the multiple sample straight line models;
    将所述最小值对应的样本直线模型作为关于所述多个观测点的直线模型。The sample straight line model corresponding to the minimum value is used as the straight line model with respect to the multiple observation points.
  10. 根据权利要求8所述的方法,其特征在于,所述根据所述多个欧式距离,确定所述第一样本直线模型的距离数据,包括:The method according to claim 8, wherein the determining the distance data of the first sample linear model according to the multiple Euclidean distances comprises:
    将所述多个欧式距离相加,得到第一值;Adding up the multiple Euclidean distances to obtain a first value;
    将所述第一值作为所述第一样本直线模型的距离数据。The first value is used as the distance data of the first sample straight line model.
  11. 根据权利要求5所述的方法,其特征在于,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型,包括:The method according to claim 5, wherein the fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    根据第一时刻接收的多个位置信息进行拟合,确定所述第一时刻的多个观测点的第一直线模型;Fitting according to a plurality of position information received at the first moment, and determining a first straight line model of the plurality of observation points at the first moment;
    根据第二时刻接收的多个位置信息进行拟合,确定所述第二时刻的多个观 测点的第二直线模型;Fitting according to multiple pieces of position information received at the second time, and determining a second straight line model of multiple observation points at the second time;
    根据所述第一直线模型和所述第二直线模型确定直线模型;Determining a straight line model according to the first straight line model and the second straight line model;
    其中,所述第一时刻先于所述第二时刻。Wherein, the first moment is prior to the second moment.
  12. 根据权利要求11所述的方法,其特征在于,所述根据所述第一直线模型和所述第二直线模型确定直线模型,包括:The method according to claim 11, wherein the determining a straight line model according to the first straight line model and the second straight line model comprises:
    确定所述第一直线模型和所述第二直线模型的截距的平均值,作为平均截距;Determining the average value of the intercepts of the first straight line model and the second straight line model as the average intercept;
    确定所述第一直线模型和所述第二直线模型的斜率的平均值,作为平均斜率;Determining the average value of the slopes of the first straight line model and the second straight line model as the average slope;
    根据所述平均截距和所述平均斜率确定直线模型。A straight line model is determined according to the average intercept and the average slope.
  13. 根据权利要求1所述的方法,其特征在于,所述移动轨迹包括所述可移动平台的运行方向以及所述可移动平台到所述目标对象的目标距离;The method according to claim 1, wherein the movement track includes the running direction of the movable platform and the target distance from the movable platform to the target object;
    所述根据所述直线模型,控制所述可移动平台的移动轨迹,包括:The controlling the movement trajectory of the movable platform according to the straight line model includes:
    根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向。The target distance from the movable platform to the target object and the running direction of the movable platform are determined according to the model parameters of the linear model.
  14. 根据权利要求13所述的方法,其特征在于,所述目标距离包括所述可移动平台到所述目标对象的垂直距离。The method according to claim 13, wherein the target distance includes a vertical distance from the movable platform to the target object.
  15. 根据权利要求14所述的方法,其特征在于,所述根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向,包括:The method according to claim 14, wherein the determining the target distance from the movable platform to the target object and the running direction of the movable platform according to the model parameters of the linear model comprises:
    根据所述直线模型的斜率和截距确定所述可移动平台到所述目标对象的垂直距离以及所述可移动平台的运行方向。The vertical distance from the movable platform to the target object and the running direction of the movable platform are determined according to the slope and intercept of the straight line model.
  16. 根据权利要求15所述的方法,其特征在于,所述可移动平台的运行方向与所述直线模型平行。The method according to claim 15, wherein the running direction of the movable platform is parallel to the linear model.
  17. 根据权利要求1所述的方法,其特征在于,所述目标对象包括电线、电缆、光缆或光纤。The method according to claim 1, wherein the target object includes a wire, a cable, an optical cable, or an optical fiber.
  18. 根据权利要求1所述的方法,其特征在于,所述接收雷达对目标对象的观测数据之前,还包括:The method according to claim 1, characterized in that, before the receiving radar observation data of the target object, the method further comprises:
    获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的射频板的角度。Obtain the operating attitude parameters of the movable platform, and adjust the angle of the radio frequency board of the radar according to the operating attitude parameters.
  19. 根据权利要求18所述的方法,其特征在于,所述雷达的射频板的外法线方向与所述可移动平台的运行方向相同。The method according to claim 18, wherein the outer normal direction of the radio frequency board of the radar is the same as the running direction of the movable platform.
  20. 根据权利要求18所述的方法,其特征在于,所述雷达的射频板的外法线方向与所述可移动平台的运行方向垂直,并朝向目标对象。The method according to claim 18, wherein the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform and faces the target object.
  21. 根据权利要求1所述的方法,其特征在于,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型,包括:The method according to claim 1, wherein the determining a straight line model about the plurality of observation points according to the plurality of position information comprises:
    对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标;Performing coordinate conversion on the multiple position information to obtain the coordinates of the multiple observation points in the target coordinate system;
    根据所述多个观测点在目标坐标系的坐标,确定关于所述多个观测点的直线模型。According to the coordinates of the multiple observation points in the target coordinate system, a straight line model with respect to the multiple observation points is determined.
  22. 根据权利要求21所述的方法,其特征在于,所述接收雷达对目标对象的观测数据之前,还包括:The method according to claim 21, characterized in that before the receiving radar observation data of the target object, the method further comprises:
    获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的信号发射方向。Obtain the operating attitude parameters of the movable platform, and adjust the signal emission direction of the radar according to the operating attitude parameters.
  23. 根据权利要求18或22所述的方法,其特征在于,所述运行姿态参数包括可移动平台的运行方向。The method according to claim 18 or 22, wherein the operating posture parameter includes the operating direction of the movable platform.
  24. 根据权利要求23所述的方法,其特征在于,所述雷达的信号发射方向与所述可移动平台的运行方向相同。The method according to claim 23, wherein the signal transmission direction of the radar is the same as the running direction of the movable platform.
  25. 根据权利要求24所述的方法,其特征在于,所述位置信息包括观测点在雷达坐标系中的坐标,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标,包括:The method according to claim 24, wherein the position information includes the coordinates of the observation point in a radar coordinate system, and the coordinate conversion is performed on the plurality of position information to obtain that the plurality of observation points are in the target The coordinates of the coordinate system, including:
    根据所述可移动平台的运行方向确定雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;Determining a first included angle between a coordinate axis of the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform;
    根据所述第一夹角确定转换矩阵;Determining a conversion matrix according to the first included angle;
    根据所述转换矩阵对多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。The coordinates of the multiple observation points in the radar coordinate system are converted according to the transformation matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
  26. 根据权利要求23所述的方法,其特征在于,所述位置信息包括观测点在雷达坐标系中的坐标,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标,包括:23. The method according to claim 23, wherein the position information includes the coordinates of the observation point in a radar coordinate system, and the coordinate conversion is performed on the plurality of position information to obtain the coordinates of the plurality of observation points in the target The coordinates of the coordinate system, including:
    根据所述可移动平台的运行方向与雷达的信号发射方向确定所述雷达坐标 系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;Determining a first included angle between a coordinate axis in the radar coordinate system and a coordinate axis in the target coordinate system according to the running direction of the movable platform and the signal emission direction of the radar;
    根据所述第一夹角确定转换矩阵;Determining a conversion matrix according to the first included angle;
    根据所述转换矩阵对所述多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。Perform coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system according to the transformation matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
  27. 根据权利要求21所述的方法,其特征在于,所述目标坐标系为北东地坐标系。The method according to claim 21, wherein the target coordinate system is a north-east coordinate system.
  28. 一种可移动平台,其特征在于,所述可移动平台包括雷达、存储器和处理器:A movable platform, characterized in that the movable platform includes a radar, a memory and a processor:
    所述雷达用于发送雷达信号以进行测量或探测;The radar is used to send radar signals for measurement or detection;
    所述存储器用于存储计算机程序;The memory is used to store a computer program;
    所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
    获取雷达对目标对象的观测数据,所述观测数据包括多个观测点的多个位置信息;Acquiring observation data of the target object by the radar, the observation data including multiple position information of multiple observation points;
    根据所述多个位置信息,确定关于所述多个观测点的直线模型;Determining a straight line model about the plurality of observation points according to the plurality of position information;
    根据所述直线模型,控制所述可移动平台的移动轨迹,以完成对所述目标对象的巡检。According to the linear model, the movement track of the movable platform is controlled to complete the inspection of the target object.
  29. 根据权利要求28所述的可移动平台,其特征在于,所述获取雷达对目标对象的观测数据的步骤,包括:The movable platform according to claim 28, wherein the step of obtaining observation data of the target object by the radar comprises:
    通过雷达采集目标对象的多个观测点与可移动平台之间的相对距离以及相对夹角;The relative distance and relative included angle between multiple observation points of the target object and the movable platform are collected by radar;
    根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息。The position information of the observation point is determined according to the relative distance and the relative included angle between the observation point and the movable platform.
  30. 根据权利要求29所述的可移动平台,其特征在于,所述根据观测点与可移动平台之间的相对距离以及相对夹角确定观测点的位置信息的步骤,包括:The movable platform according to claim 29, wherein the step of determining the position information of the observation point according to the relative distance and the relative included angle between the observation point and the movable platform comprises:
    根据每个观测点的相对距离和所述相对夹角确定所述观测点在雷达坐标系中的坐标,得到观测点的位置信息。The coordinates of the observation point in the radar coordinate system are determined according to the relative distance of each observation point and the relative included angle, and the position information of the observation point is obtained.
  31. 根据权利要求29或30所述的可移动平台,其特征在于,所述相对距离为观测点和可移动平台之间连线的距离,所述相对夹角为所述连线与所述雷达的射频板的外法线方向之间的夹角。The movable platform according to claim 29 or 30, wherein the relative distance is the distance between the observation point and the movable platform, and the relative included angle is the distance between the connection and the radar. The angle between the outer normal directions of the radio frequency board.
  32. 根据权利要求28所述的可移动平台,其特征在于,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型的步骤,包括:The movable platform according to claim 28, wherein the step of determining a linear model of the plurality of observation points according to the plurality of position information comprises:
    根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型。Fitting is performed according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
  33. 根据权利要求32所述的可移动平台,其特征在于,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型的步骤,包括:The movable platform according to claim 32, wherein the step of fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型。Performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points.
  34. 根据权利要求33所述的可移动平台,其特征在于,所述根据所述多个位置信息进行线性拟合的步骤,包括:The movable platform according to claim 33, wherein the step of performing linear fitting according to the plurality of position information comprises:
    基于最小二乘法,根据所述多个位置信息进行线性拟合。Based on the least square method, linear fitting is performed according to the multiple position information.
  35. 根据权利要求33所述的可移动平台,其特征在于,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型的步骤,包括:The movable platform according to claim 33, wherein the step of performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    从所述多个观测点中确定两个第一观测点,根据所述两个第一观测点的位置信息确定关于所述两个第一观测点的第一样本直线模型;Determining two first observation points from the plurality of observation points, and determining a first sample straight line model about the two first observation points according to location information of the two first observation points;
    确定所述多个观测点中除所述两个第一观测点之外的多个其他观测点与所述第一样本直线模型的多个欧式距离;Determining a plurality of Euclidean distances between a plurality of observation points other than the two first observation points among the plurality of observation points and the first sample straight line model;
    根据所述多个欧式距离,确定所述第一样本直线模型的距离数据;Determine the distance data of the first sample linear model according to the multiple Euclidean distances;
    根据所述距离数据和所述第一样本直线模型确定关于所述多个观测点的直线模型。A straight line model with respect to the plurality of observation points is determined according to the distance data and the first sample straight line model.
  36. 根据权利要求33所述的可移动平台,其特征在于,所述根据所述多个位置信息进行线性拟合,以确定关于所述多个观测点的直线模型,包括:The movable platform according to claim 33, wherein the performing linear fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    从所述多个观测点中选择多个样本点集合,其中,每一个样本点集合包括两个第一观测点;Selecting multiple sample point sets from the multiple observation points, wherein each sample point set includes two first observation points;
    分别根据每一个样本点集合中的所述两个第一观测点的位置信息确定关于所述多个样本点集合的多个样本直线模型;Determining, respectively, a plurality of sample line models about the plurality of sample point sets according to the position information of the two first observation points in each sample point set;
    分别依据关于所述多个样本直线模型的多个距离数据,确定所述多个距离数据的最小值;Determine the minimum value of the multiple distance data respectively according to multiple distance data about the multiple sample straight line models;
    将所述最小值对应的样本直线模型作为关于所述多个观测点的直线模型。The sample straight line model corresponding to the minimum value is used as the straight line model with respect to the multiple observation points.
  37. 根据权利要求35所述的可移动平台,其特征在于,所述根据所述多个欧式距离,确定所述第一样本直线模型的距离数据的步骤,包括:The movable platform according to claim 35, wherein the step of determining the distance data of the first sample linear model according to the multiple Euclidean distances comprises:
    将所述多个欧式距离相加,得到第一值;Adding up the multiple Euclidean distances to obtain a first value;
    将所述第一值作为所述第一样本直线模型的距离数据。The first value is used as the distance data of the first sample straight line model.
  38. 根据权利要求32所述的可移动平台,其特征在于,所述根据所述多个位置信息进行拟合,以确定关于所述多个观测点的直线模型的步骤,包括:The movable platform according to claim 32, wherein the step of fitting according to the plurality of position information to determine a straight line model with respect to the plurality of observation points comprises:
    根据第一时刻接收的多个位置信息进行拟合,确定所述第一时刻的多个观测点的第一直线模型;Fitting according to a plurality of position information received at the first moment, and determining a first straight line model of the plurality of observation points at the first moment;
    根据第二时刻接收的多个位置信息进行拟合,确定所述第二时刻的多个观测点的第二直线模型;Fitting according to multiple pieces of position information received at the second time, and determining a second straight line model of multiple observation points at the second time;
    根据所述第一直线模型和所述第二直线模型确定直线模型;Determining a straight line model according to the first straight line model and the second straight line model;
    其中,所述第一时刻先于所述第二时刻。Wherein, the first moment is prior to the second moment.
  39. 根据权利要求38所述的可移动平台,其特征在于,所述根据所述第一直线模型和所述第二直线模型确定直线模型的步骤,包括:The movable platform according to claim 38, wherein the step of determining a straight line model according to the first straight line model and the second straight line model comprises:
    确定所述第一直线模型和所述第二直线模型的截距的平均值,作为平均截距;Determining the average value of the intercepts of the first straight line model and the second straight line model as the average intercept;
    确定所述第一直线模型和所述第二直线模型的斜率的平均值,作为平均斜率;Determining the average value of the slopes of the first straight line model and the second straight line model as the average slope;
    根据所述平均截距和所述平均斜率确定直线模型。A straight line model is determined according to the average intercept and the average slope.
  40. 根据权利要求28所述的可移动平台,其特征在于,所述移动轨迹包括所述可移动平台的运行方向以及所述可移动平台到所述目标对象的目标距离;The movable platform according to claim 28, wherein the movement track includes the running direction of the movable platform and the target distance from the movable platform to the target object;
    所述根据所述直线模型,控制所述可移动平台的移动轨迹的步骤,包括:The step of controlling the movement trajectory of the movable platform according to the linear model includes:
    根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向。The target distance from the movable platform to the target object and the running direction of the movable platform are determined according to the model parameters of the linear model.
  41. 根据权利要求40所述的可移动平台,其特征在于,所述目标距离包括所述可移动平台到所述目标对象的垂直距离。The movable platform of claim 40, wherein the target distance includes a vertical distance from the movable platform to the target object.
  42. 根据权利要求41所述的可移动平台,其特征在于,所述根据所述直线模型的模型参数确定所述可移动平台到所述目标对象的目标距离以及所述可移动平台的运行方向的步骤,包括:The movable platform according to claim 41, wherein the step of determining the target distance from the movable platform to the target object and the running direction of the movable platform according to the model parameters of the linear model ,include:
    根据所述直线模型的斜率和截距确定所述可移动平台到所述目标对象的垂直距离以及所述可移动平台的运行方向。The vertical distance from the movable platform to the target object and the running direction of the movable platform are determined according to the slope and intercept of the straight line model.
  43. 根据权利要求42所述的可移动平台,其特征在于,所述可移动平台的 运行方向与所述直线模型平行。The movable platform according to claim 42, wherein the running direction of the movable platform is parallel to the linear model.
  44. 根据权利要求28所述的可移动平台,其特征在于,所述目标对象包括电线、电缆、光缆或光纤。The movable platform according to claim 28, wherein the target object includes wires, cables, optical cables or optical fibers.
  45. 根据权利要求28所述的可移动平台,其特征在于,所述接收雷达对目标对象的观测数据的步骤之前,还包括:The movable platform according to claim 28, characterized in that, before the step of receiving the observation data of the target object by the radar, it further comprises:
    获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的射频板的角度。Obtain the operating attitude parameters of the movable platform, and adjust the angle of the radio frequency board of the radar according to the operating attitude parameters.
  46. 根据权利要求45所述的可移动平台,其特征在于,所述雷达的射频板的外法线方向与所述可移动平台的运行方向相同。The movable platform according to claim 45, wherein the outer normal direction of the radio frequency board of the radar is the same as the running direction of the movable platform.
  47. 根据权利要求45所述的可移动平台,其特征在于,所述雷达的射频板的外法线方向与所述可移动平台的运行方向垂直,并朝向目标对象。The movable platform according to claim 45, wherein the outer normal direction of the radio frequency board of the radar is perpendicular to the running direction of the movable platform and faces the target object.
  48. 根据权利要求28所述的可移动平台,其特征在于,所述根据所述多个位置信息,确定关于所述多个观测点的直线模型的步骤,包括:The movable platform according to claim 28, wherein the step of determining a linear model of the plurality of observation points according to the plurality of position information comprises:
    对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标;Performing coordinate conversion on the multiple position information to obtain the coordinates of the multiple observation points in the target coordinate system;
    根据所述多个观测点在目标坐标系的坐标,确定关于所述多个观测点的直线模型。According to the coordinates of the multiple observation points in the target coordinate system, a straight line model with respect to the multiple observation points is determined.
  49. 根据权利要求48所述的可移动平台,其特征在于,所述接收雷达对目标对象的观测数据的步骤之前,还包括:The movable platform according to claim 48, characterized in that, before the step of receiving the observation data of the target object by the radar, it further comprises:
    获取可移动平台的运行姿态参数,根据所述运行姿态参数调整所述雷达的信号发射方向。Obtain the operating attitude parameters of the movable platform, and adjust the signal emission direction of the radar according to the operating attitude parameters.
  50. 根据权利要求45或49所述的可移动平台,其特征在于,所述运行姿态参数包括可移动平台的运行方向。The movable platform according to claim 45 or 49, wherein the operating posture parameter includes the operating direction of the movable platform.
  51. 根据权利要求50所述的可移动平台,其特征在于,所述雷达的信号发射方向与所述可移动平台的运行方向相同。The movable platform according to claim 50, wherein the signal transmission direction of the radar is the same as the running direction of the movable platform.
  52. 根据权利要求51所述的可移动平台,其特征在于,所述位置信息包括观测点在雷达坐标系中的坐标,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标的步骤,包括:The mobile platform according to claim 51, wherein the position information includes the coordinates of the observation point in a radar coordinate system, and the coordinate conversion is performed on the plurality of position information to obtain the plurality of observation points The steps for the coordinates in the target coordinate system include:
    根据所述可移动平台的运行方向确定雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;Determining a first included angle between a coordinate axis of the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform;
    根据所述第一夹角确定转换矩阵;Determining a conversion matrix according to the first included angle;
    根据所述转换矩阵对多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。The coordinates of the multiple observation points in the radar coordinate system are converted according to the transformation matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
  53. 根据权利要求50所述的可移动平台,其特征在于,所述位置信息包括观测点在雷达坐标系中的坐标,所述对所述多个位置信息进行坐标转换,得到所述多个观测点在目标坐标系的坐标的步骤,包括:The movable platform according to claim 50, wherein the position information includes the coordinates of the observation point in a radar coordinate system, and the coordinate conversion is performed on the plurality of position information to obtain the plurality of observation points The steps for the coordinates in the target coordinate system include:
    根据所述可移动平台的运行方向与雷达的信号发射方向确定所述雷达坐标系中一坐标轴与所述目标坐标系的一坐标轴之间的第一夹角;Determining a first included angle between a coordinate axis in the radar coordinate system and a coordinate axis of the target coordinate system according to the running direction of the movable platform and the signal emission direction of the radar;
    根据所述第一夹角确定转换矩阵;Determining a conversion matrix according to the first included angle;
    根据所述转换矩阵对所述多个观测点在雷达坐标系的坐标进行坐标转换,得到所述多个观测点在目标坐标系的坐标。Perform coordinate conversion on the coordinates of the multiple observation points in the radar coordinate system according to the transformation matrix to obtain the coordinates of the multiple observation points in the target coordinate system.
  54. 根据权利要求48所述的可移动平台,其特征在于,所述目标坐标系为北东地坐标系。The movable platform according to claim 48, wherein the target coordinate system is a north-east coordinate system.
  55. 根据权利要求28至54中任一项所述的可移动平台,其特征在于,所述可移动平台包括飞行器、机器人或无人驾驶车辆。The movable platform according to any one of claims 28 to 54, wherein the movable platform comprises an aircraft, a robot or an unmanned vehicle.
  56. 一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如权利要求1至27中任一项所述的控制方法。A computer-readable storage medium, characterized in that, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor realizes the method described in any one of claims 1 to 27. The control method described.
PCT/CN2019/130217 2019-12-30 2019-12-30 Control method, movable platform, and storage medium WO2021134376A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2019/130217 WO2021134376A1 (en) 2019-12-30 2019-12-30 Control method, movable platform, and storage medium
CN201980059919.9A CN112740070A (en) 2019-12-30 2019-12-30 Control method, movable platform and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/130217 WO2021134376A1 (en) 2019-12-30 2019-12-30 Control method, movable platform, and storage medium

Publications (1)

Publication Number Publication Date
WO2021134376A1 true WO2021134376A1 (en) 2021-07-08

Family

ID=75589258

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/130217 WO2021134376A1 (en) 2019-12-30 2019-12-30 Control method, movable platform, and storage medium

Country Status (2)

Country Link
CN (1) CN112740070A (en)
WO (1) WO2021134376A1 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106157507A (en) * 2016-07-08 2016-11-23 武汉三江中电科技有限责任公司 A kind of transmission line of electricity solid preventer based on radar and video fusion
US20180107226A1 (en) * 2016-10-17 2018-04-19 Mediatek Inc. Path planning method and related navigation device
CN109062233A (en) * 2018-08-15 2018-12-21 广东电网有限责任公司 A kind of power transmission line unmanned machine automatic drive method for inspecting
CN110031818A (en) * 2019-04-29 2019-07-19 中国南方电网有限责任公司超高压输电公司昆明局 Based on the transmission line of electricity of point cloud data to earth's surface clearance contour line extraction method
CN110530366A (en) * 2019-08-08 2019-12-03 广东电网有限责任公司 A kind of flight course planning system and method for transmission line of electricity modeling

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10338209B2 (en) * 2015-04-28 2019-07-02 Edh Us Llc Systems to track a moving sports object
CN109521403B (en) * 2017-09-19 2020-11-20 百度在线网络技术(北京)有限公司 Parameter calibration method, device and equipment of multi-line laser radar and readable medium
CN108335353B (en) * 2018-02-23 2020-12-22 清华-伯克利深圳学院筹备办公室 Three-dimensional reconstruction method, device and system of dynamic scene, server and medium
CN108549087B (en) * 2018-04-16 2021-10-08 北京瑞途科技有限公司 Online detection method based on laser radar
CN110596664B (en) * 2019-10-28 2022-07-12 北京润科通用技术有限公司 Vehicle-mounted radar deflection angle estimation method and device

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106157507A (en) * 2016-07-08 2016-11-23 武汉三江中电科技有限责任公司 A kind of transmission line of electricity solid preventer based on radar and video fusion
US20180107226A1 (en) * 2016-10-17 2018-04-19 Mediatek Inc. Path planning method and related navigation device
CN109062233A (en) * 2018-08-15 2018-12-21 广东电网有限责任公司 A kind of power transmission line unmanned machine automatic drive method for inspecting
CN110031818A (en) * 2019-04-29 2019-07-19 中国南方电网有限责任公司超高压输电公司昆明局 Based on the transmission line of electricity of point cloud data to earth's surface clearance contour line extraction method
CN110530366A (en) * 2019-08-08 2019-12-03 广东电网有限责任公司 A kind of flight course planning system and method for transmission line of electricity modeling

Also Published As

Publication number Publication date
CN112740070A (en) 2021-04-30

Similar Documents

Publication Publication Date Title
CN111435163B (en) Ground point cloud data filtering method, device, detection system and storage medium
US10801843B2 (en) Indoor mobile robot position and posture measurement system based on photoelectric scanning and measurement method
CN110889808B (en) Positioning method, device, equipment and storage medium
CN110609570A (en) Autonomous obstacle avoidance inspection method based on unmanned aerial vehicle
CN112051590A (en) Detection method and related device for laser radar and inertial measurement unit
US20130038717A1 (en) Image Based Position Determination
CN109946729B (en) Aerial target tracking method and device
WO2021016854A1 (en) Calibration method and device, movable platform, and storage medium
JP6996729B2 (en) Electromagnetic field data acquisition system, flying object, terminal device, and program
CN111244822B (en) Fixed-wing unmanned aerial vehicle line patrol method, system and device in complex geographic environment
CN112013877B (en) Detection method and related device for millimeter wave radar and inertial measurement unit
US20200380667A1 (en) Method and system for servicing an object
CN110849363B (en) Pose calibration method, system and medium for laser radar and combined inertial navigation
CN112306078B (en) Method and system for automatically avoiding obstacle wires of unmanned aerial vehicle
Zalud et al. Calibration and evaluation of parameters in a 3D proximity rotating scanner
WO2021166845A1 (en) Information processing device, information processing method, and program
WO2021134376A1 (en) Control method, movable platform, and storage medium
CN112180942A (en) Power transmission line autonomous line-tracing inspection system and method and terminal equipment
US20220018950A1 (en) Indoor device localization
CN112311478B (en) Array antenna calibration method, device, equipment and storage medium
CN112462784B (en) Robot pose determining method, device, equipment and medium
CN113763457B (en) Method and device for calibrating drop terrain, electronic equipment and storage medium
CN115575892A (en) Target position determining method and device, electronic equipment and storage medium
WO2022183450A1 (en) Electric power inspection method, unmanned aerial vehicle and storage medium
CN110869777A (en) Antenna testing method and device based on mobile platform and information processing equipment

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: 19958703

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: 19958703

Country of ref document: EP

Kind code of ref document: A1