WO2022133676A1 - Method for detecting arm state of unmanned aerial vehicle, control device of unmanned aerial vehicle, and unmanned aerial vehicle - Google Patents

Method for detecting arm state of unmanned aerial vehicle, control device of unmanned aerial vehicle, and unmanned aerial vehicle Download PDF

Info

Publication number
WO2022133676A1
WO2022133676A1 PCT/CN2020/138087 CN2020138087W WO2022133676A1 WO 2022133676 A1 WO2022133676 A1 WO 2022133676A1 CN 2020138087 W CN2020138087 W CN 2020138087W WO 2022133676 A1 WO2022133676 A1 WO 2022133676A1
Authority
WO
WIPO (PCT)
Prior art keywords
positioning sensor
arms
distance information
drone
position information
Prior art date
Application number
PCT/CN2020/138087
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/CN2020/138087 priority Critical patent/WO2022133676A1/en
Priority to CN202080079887.1A priority patent/CN114787036A/en
Publication of WO2022133676A1 publication Critical patent/WO2022133676A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64DEQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
    • B64D43/00Arrangements or adaptations of instruments

Definitions

  • the present application relates to the technical field of unmanned aerial vehicles, and in particular, to a method for detecting the state of an arm of an unmanned aerial vehicle, a control device of an unmanned aerial vehicle, and an unmanned aerial vehicle.
  • the arms of the drone are often designed in a foldable form in the prior art.
  • the arms are in a folded state when the drone is stowed and unfolded when the drone is working.
  • the user unfolds the arm it may not be properly deployed or not locked, causing the drone to fold back during flight. If the control system of the UAV still maintains a continuous control output, safety accidents may occur, and in severe cases, the UAV may even crash.
  • Some foldable drones are equipped with locking recognition sensors at the joints of the arms to sense the state of the arms, but this method will lead to increased structural complexity and cost.
  • the present application provides a method for detecting an arm state of an unmanned aerial vehicle, a control device for an unmanned aerial vehicle, an unmanned aerial vehicle, and a storage medium.
  • the present application provides a method for detecting the state of an arm of an unmanned aerial vehicle, wherein two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be Switching between a collapsed state and an expanded state, the method includes:
  • Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
  • the present application provides a control device for an unmanned aerial vehicle, wherein two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be folded and Switching between deployment states,
  • the control device of the drone includes: a memory and a processor;
  • the memory is used to store computer programs
  • the processor is configured to execute the computer program and implement the following steps when executing the computer program:
  • Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
  • the present application provides an unmanned aerial vehicle, wherein two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be in a folded state or an unfolded state.
  • switching between, the drone includes: a memory and a processor;
  • the memory is used to store computer programs
  • the processor is configured to execute the computer program and implement the following steps when executing the computer program:
  • Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
  • the present application provides a computer-readable storage medium, where the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor implements the above-mentioned unmanned aerial vehicle Arm state detection method.
  • the embodiments of the present application provide a method for detecting the state of an unmanned aerial vehicle, a control device of the unmanned aerial vehicle, an unmanned aerial vehicle, and a storage medium.
  • the two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor.
  • a positioning sensor the two arms can be switched between the folded state and the unfolded state, and the position information detected by the first positioning sensor and the second positioning sensor is obtained; according to the position information, the difference between the two arms can be obtained.
  • distance information between the two arms according to the distance information between the two arms and the calibration distance information, determine whether the two arms are normally deployed, and the calibration distance information is used to indicate when the two arms are normally deployed the distance.
  • the two arms can be determined. Whether the arms are normally deployed provides technical support for the subsequent avoidance of safety accidents in the drone; on the other hand, compared with the prior art, additional sensors are installed on the arms to detect whether the two arms are normally deployed.
  • This application implements the For example, the position information detected by the positioning sensor configured on the UAV is directly used to obtain the distance information between the two arms, and then it is determined whether the two arms are normally deployed, which can reduce the cost and the structural complexity of the UAV.
  • FIG. 1 is a schematic flowchart of an embodiment of a method for detecting the state of an unmanned aerial vehicle of the present application
  • Fig. 2 is the structural representation of the arm of the unmanned aerial vehicle in the unfolded state in an embodiment of the method for detecting the arm state of the unmanned aerial vehicle of the present application;
  • 3 and 4 are schematic structural diagrams of the UAV in FIG. 2 in a folded state with two arms at different angles;
  • FIG. 5 is a schematic flowchart of another embodiment of the method for detecting the state of the drone arm of the present application.
  • FIG. 6 is a schematic flowchart of another embodiment of the method for detecting the state of the UAV arm of the present application.
  • FIG. 7 is a schematic flowchart of another embodiment of the method for detecting the state of the drone arm of the present application.
  • FIG. 8 is a schematic flowchart of another embodiment of the method for detecting the state of the drone arm of the present application.
  • FIG. 9 is a schematic structural diagram of an embodiment of a control device for an unmanned aerial vehicle of the present application.
  • FIG. 10 is a schematic structural diagram of an embodiment of the UAV of the present application.
  • the foldable arms of the drone are in a folded state when stowed and unfolded when working. If the arm is not unfolded properly or is not locked, the arm will fold back during the flight of the drone. If the control system of the UAV still maintains a continuous control output, safety accidents or even crashes may occur. In some cases, a locking recognition sensor is installed at the connection of the machine arm to sense the state of the machine arm, but this tends to increase the structural complexity and cost.
  • the embodiments of the present application provide a method for detecting the state of an unmanned aerial vehicle, a control device of the unmanned aerial vehicle, an unmanned aerial vehicle, and a storage medium.
  • the two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor.
  • a positioning sensor the two arms can be switched between the folded state and the unfolded state, and the position information detected by the first positioning sensor and the second positioning sensor is obtained; according to the position information, the difference between the two arms can be obtained.
  • distance information between the two arms according to the distance information between the two arms and the calibration distance information, determine whether the two arms are normally deployed, and the calibration distance information is used to indicate when the two arms are normally deployed the distance.
  • the two arms can be determined. Whether each of the arms is normally deployed provides technical support for the subsequent avoidance of safety accidents in the drone. When it is determined that at least one of the two arms is not normally deployed, the drone can be controlled to perform the corresponding safety operation, thereby avoiding the occurrence of safety accidents.
  • additional sensors are installed on the arms to detect whether the two arms are normally deployed, which easily increases the structural complexity and cost.
  • the positioning sensor is the standard of the drone Configuration, directly use the position information detected by the standard positioning sensor on the UAV to obtain the distance information between the two arms, and then determine whether the two arms are normally deployed, so it can reduce the cost and reduce the structural complexity of the UAV .
  • FIG. 1 is a schematic flowchart of an embodiment of the method for detecting the arm state of the unmanned aerial vehicle of the present application. It should be noted that the detection method of this embodiment can be deployed on the unmanned aerial vehicle, executed by the unmanned aerial vehicle, and also It can be deployed on the control device of the UAV and executed by the control device of the UAV; it is not limited here.
  • FIG. 2 is a schematic structural diagram of the arm of the unmanned aerial vehicle in the unfolded state in an embodiment of the method for detecting the arm state of the unmanned aerial vehicle of the present application
  • FIG. 3 and FIG. A schematic diagram of the structure of the man-machine in the folded state of the man-machine at two different angles.
  • the two arms 10 of the UAV 200 are respectively provided with a first positioning sensor 20 and a second positioning sensor 30, and the two arms 10 can be in a folded state (as shown in FIG. 3 and FIG. 4 ). shown) and the expanded state (shown in Figure 2).
  • Positioning technology can be divided into absolute positioning technology and relative positioning technology, and the corresponding sensors are also divided into absolute positioning sensors (ranging method and inertial navigation method) and relative positioning sensors (magnetic compass method, activity marking method, global positioning system, road sign navigation) method, model matching method).
  • Positioning sensors are mainly used in autonomous mobile devices such as space lunar rovers, autonomous vehicles, AGVs (Autonomous Guided Vehicles), mobile robots and mobile cleaning equipment.
  • Commonly used positioning sensors include but are not limited to: ultrasonic sensors, infrared sensors, laser sensors, RTK sensors, vision sensors, and the like.
  • the position information detected by at least one of the first positioning sensor and the second positioning sensor can provide accurate positioning for the drone, and the position information detected by the first positioning sensor and the second positioning sensor can be Drones provide precise orientation.
  • the first positioning sensor and the second positioning sensor are both RTK (Real Time Kinematic) sensors, and specifically include RTK antennas.
  • RTK technology adopts real-time dynamic carrier phase difference method, which can realize centimeter-level high-precision positioning, and brings new measurement principles and methods to various industrial applications such as engineering stakeout and terrain mapping.
  • UAVs for industrial applications are mostly equipped with RTK sensors.
  • This embodiment reuses the first positioning sensor and the second positioning sensor configured on the drone for precise positioning or orientation of the drone itself to detect whether the two arms are normally deployed, without installing additional sensors, which can reduce costs and reduce The structural complexity of UAVs.
  • the RTK board can be integrated with the RTK antenna, or the RTK board can be set separately from the RTK antenna.
  • the RTK board is set on the drone body, and the RTK antenna is set on the drone arm.
  • the first positioning sensor and the second positioning sensor are respectively provided on the two arms of the drone.
  • a positioning sensor can also be set on each arm.
  • the two arms are equipped with power components, according to experience and theory, if the direction of the force output by the power components on the arms is consistent with the folding direction of the arms, then the arms are more likely to fold back.
  • the power assembly includes blades. If the rotation direction of the blades is counterclockwise, the direction of the force on the arm when the power assembly outputs power is clockwise, that is, the counter torque received by the arm is clockwise. If the folding direction of the machine arm is also clockwise, the machine arm is prone to fold back.
  • the first positioning sensor 20 and the first power assembly are installed on the first arm
  • the second positioning sensor 30 and the second power assembly are installed on the second arm
  • the blades of the first power assembly rotate The direction is clockwise, the counter-torque corresponding to the first arm is counterclockwise, the folding direction of the first arm is counterclockwise; the rotation direction of the blades of the second power assembly is counterclockwise, the second arm
  • the corresponding reaction torque is clockwise, and the folding direction of the second arm is clockwise. That is, the first arm and the second arm are likely to be folded back.
  • the first positioning sensor and the second positioning sensor can be set on the two arms that are prone to turning back in a targeted manner, which not only saves costs, but also can detect the two arms that are prone to turning back in a targeted manner. Check whether the arms are normally deployed to avoid safety incidents.
  • the first positioning sensor and the second positioning sensor can be respectively arranged at the ends of the two arms of the drone.
  • the method includes: step S101, step S102 and step S103.
  • Step S101 Acquire position information detected by the first positioning sensor and the second positioning sensor.
  • Step S102 Obtain distance information between the two arms according to the position information.
  • Step S103 Determine whether the two arms are normally deployed according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed .
  • the first positioning sensor and the second positioning sensor can detect their respective position information. Specifically, the first positioning sensor and the second positioning sensor can detect their respective position information on the machine arm. The distance information between the first positioning sensor and the second positioning sensor can be obtained according to the position information detected by the first positioning sensor and the second positioning sensor. The distance information is taken as the distance information between the two arms.
  • the calibration distance information is used to indicate the distance when the two arms are normally deployed, and the distance when the two arms are normally deployed is usually fixed or changes little.
  • the calibration distance information can be calibrated when the drone leaves the factory and stored in the storage device of the drone; with the extension of the use time of the drone, the arm of the drone will be worn out, so it can also be used when the drone is unmanned. After the aircraft leaves the factory, re-calibrate the distance between the two arms when the two arms are normally deployed before and during take-off regularly or irregularly during use, and obtain the calibrated distance information.
  • Whether the two arms are normally deployed can be determined by comparing the current distance information between the two arms with the calibrated distance information indicating the distance when the two arms are normally deployed.
  • the distance between the current two arms is basically the same as the distance when the two arms are normally unfolded; if the current two arms are folded back, the current two arms are The distance between the two arms is different from the distance when the two arms are normally deployed: Specifically, if one arm is folded back away from the other arm, the current distance between the two arms can be greater than the distance between the two arms. The distance when the arms are normally deployed. If one arm is folded back toward the other arm, the current distance between the two arms can be smaller than the distance when the two arms are normally deployed.
  • the embodiment of the present application provides a method for detecting the state of an arm of a drone.
  • the two arms of the drone are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be in a folded state and an unfolded state.
  • Switch between the two arms to obtain the position information detected by the first positioning sensor and the second positioning sensor; obtain the distance information between the two arms according to the position information; according to the distance between the two arms.
  • the distance information and the calibration distance information are determined to determine whether the two arms are normally deployed, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
  • the two arms can be determined. Whether each of the arms is normally deployed provides technical support for the subsequent avoidance of safety accidents in the drone. When it is determined that at least one of the two arms is not normally deployed, the drone can be controlled to perform the corresponding safety operation, thereby avoiding the occurrence of safety accidents.
  • additional sensors are installed on the arms to detect whether the two arms are normally deployed, which easily increases the structural complexity and cost.
  • the positioning sensor is the standard of the drone Configuration, directly use the position information detected by the standard positioning sensor on the UAV to obtain the distance information between the two arms, and then determine whether the two arms are normally deployed, so it can reduce the cost and reduce the structural complexity of the UAV .
  • the most important significance of determining whether the two arms are normally deployed is: if it is determined that the two arms are not normally deployed, it is necessary to control the drone to perform corresponding safety operations to avoid safety accidents and avoid possible crashes that cause users loss.
  • the method further includes: step S104A, as shown in FIG. 5 .
  • Step S104A If it is determined that at least one of the two arms is not normally deployed, control the UAV to perform corresponding safety operations according to the state of the UAV, where the state of the UAV includes unmanned aerial vehicles. Takeoff status and flight status.
  • the drone when it is determined that at least one of the two arms is not unfolded normally (that is, the arm is abnormal), the drone is controlled to perform the corresponding safety operation according to the unmanned state or the flying state of the drone. , in order to avoid the occurrence of safety accidents and the loss of users caused by possible crashes.
  • the safety operation includes at least one of the following: not responding to the take-off command; and outputting prompt information through the application program, the prompt information is used to prompt the user to check the aircraft arm .
  • the control drone will not respond to the take-off command.
  • the user checks the arm; it can also not respond to the take-off command, and at the same time output a prompt message through the application program to prompt the user to check the arm.
  • it is possible to perform safe operations on the UAV when it is detected that at least one of the two arms is not properly deployed before takeoff, so as to prevent the UAV with abnormal arms from taking off without prior intervention, To avoid possible subsequent safety accidents in advance, play a preventive role.
  • the safe operation includes at least one of the following: adjusting the power output of the power component of the drone to automatically control the landing of the drone; limiting the unmanned aerial vehicle speed and acceleration of the man-machine; and outputting prompt information through the application program, the prompt information is used to prompt the user to control the drone to land.
  • the power output of the UAV power assembly can be adjusted to automatically control the landing of the UAV, for example, if it is a quadrotor unmanned aerial vehicle
  • the UAV can be prohibited from performing large maneuvering flight by limiting the speed and acceleration of the UAV.
  • the speed and acceleration of the UAV can be limited by The method does not respond to the user's large maneuvering flight instructions to avoid crashes (for example, when the arm is not folded back, the drone can also fly at a small speed and acceleration); it can also output prompt information through the app , prompting the user to control the drone to land; it can also be a combination of the above-mentioned safety operations.
  • the above methods can also perform corresponding safety operations while the UAV is in flight to protect the UAV and avoid safety accidents.
  • the arm return level is further refined and determined, and refined safety operations are performed accordingly, so as to meet the refined requirements of the user. That is, the method further includes: step S104B1 and step S104B2, as shown in FIG. 6 .
  • Step S104B1 If it is determined that at least one of the two arms is not unfolded normally, determine the level of the arm folding back.
  • Step S104B2 Control the UAV to perform a corresponding safety operation according to the arm return level.
  • the control of the drone to perform the corresponding safety operation according to the arm turn-back level may further include:
  • the reversing level is the second reversing level, control the drone to perform a second safety operation, the second reversing level is higher than the first reversing level, and the second safe operation is different from the The first safe operation.
  • the reversion level includes a first reversion level and a second reversion level, and the second reversion level is higher than the first reversion level; that is, compared with the first reversion level, the second reversion level is more severe, Drones are also in a relatively more dangerous environment.
  • this refined return level it is possible to more accurately identify the danger level of the environment in which the UAV is currently located, so that more targeted safety operations can be taken.
  • the first safety operation includes: limiting the speed and acceleration of the drone.
  • the second safety operation includes: adjusting the power output of the unmanned aerial vehicle power assembly to automatically control the landing of the unmanned aerial vehicle.
  • multiple pieces of position information may be obtained by multiple measurements, and the final distance information is an average distance information. That is, in step S101, the obtaining the position information detected by the first positioning sensor and the second positioning sensor may include: obtaining multiple data detected by the first positioning sensor and the second positioning sensor within a predetermined period of time. location information. At this time, in step S102, the obtaining the distance information between the two arms according to the position information may include sub-step S1021 and sub-step S1022, as shown in FIG. 7 .
  • Sub-step S1021 Obtain a plurality of distance information between the two arms according to the plurality of position information.
  • Sub-step S1022 Determine the average distance information between the two arms according to the plurality of distance information, and use the average distance information between the two arms as the distance information between the two arms .
  • Any detection sensor has its own error when measuring or detecting (the data of each measurement is biased), and there will also be errors caused by some accidental factors (for example, due to external influences, the measurement data suddenly becomes larger or smaller, return to normal after external influences disappear).
  • multiple pieces of detected position information are acquired within a predetermined period of time, and multiple pieces of corresponding piece of position information are obtained, and the average distance information of the pieces of position information is used as the distance information between the two arms. In this way, It can reduce the influence of measurement errors and accidental factors.
  • step S103 determining whether the two arms are normally deployed according to the distance information and the calibration distance information between the two arms may further include: sub-step S1031 and sub-step S1032, as shown in FIG. 8 .
  • Sub-step S1031 Obtain standard deviation information corresponding to the plurality of distance information according to the plurality of distance information.
  • Sub-step S1032 Determine whether the two arms are normally deployed according to the average distance information between the two arms, the calibrated distance information and the corresponding standard deviation information.
  • Standard Deviation most commonly used in probability statistics as a measure of statistical dispersion.
  • the standard deviation is defined as the square root of the arithmetic mean of the squared deviation of each unit measurement of the population from its mean. It reflects the degree of dispersion among individuals in a group, and is a measure of the degree of dispersion of the average value of a group of data. A larger standard deviation means that most values are more different from their mean; a smaller standard deviation means that these values are closer to the mean.
  • the standard deviation if the standard deviation is large, it means that the difference between most of the distance information and the average distance information in the plurality of distance information is large, and the influence of external accidental factors is large; if the standard deviation is small, it means that multiple distances The difference between most of the distance information and the average distance information in the information is small, and the influence of external accidental factors is small.
  • the average distance information combined with the standard deviation information, it can stably and objectively reflect whether the current two arms are normally deployed. In this way, therefore, false detection can be prevented.
  • the average distance between the two arms is greater than the standard distance and the standard deviation is relatively small, it can be determined that at least one arm is not unfolded normally, and at least one arm is folded back away from the other arm;
  • the average distance between the arms is smaller than the standard distance and the standard deviation is relatively small, it can be determined that at least one of the arms is not unfolded normally, and at least one of the arms is folded back toward the direction close to the other.
  • the distance between the two arms when they are normally deployed can also be calibrated. That is, the method further includes: if an arm calibration instruction is received, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
  • the UAV's use time is prolonged, the UAV's arms will be worn out, so the distance between the two arms when the two arms are normally unfolded can be re-calibrated before and during take-off regularly or irregularly, and the calibration can be obtained. distance information.
  • the arm calibration command can be input by the user.
  • the usage scenarios include: a virtual button for arm calibration is displayed on the interactive interface of the ground control terminal. After the user clicks the button, the ground control terminal generates the arm calibration command and sends it to the UAV.
  • the arm calibration command can also be automatically generated.
  • the usage scenarios include: after the UAV is powered on and taken off, if it is detected that the star search state meets the conditions, the UAV will be automatically triggered to start the arm calibration.
  • the method further includes: if an arm calibration instruction is received, controlling the UAV to fly to a preset height; acquiring the position information detected by the first positioning sensor and the second positioning sensor to Obtaining the calibration distance information may further include: when the UAV is at the preset altitude, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information .
  • the application scenarios are basically the same, which can make the calibration distance information more consistent with the distance between the two arms when the drone is flying normally, and provide more realistic calibration distance information for subsequent determination of whether the two arms are normally deployed.
  • the method further includes: if an arm calibration instruction is received, acquiring the star search status of the first positioning sensor and the second positioning sensor; acquiring the first positioning sensor and the second positioning sensor Positioning the position information detected by the sensor to obtain the calibration distance information, may further include: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, obtaining the first positioning sensor and the second positioning sensor.
  • the second positioning sensor detects the position information to obtain the calibration distance information.
  • the satellite search status of the positioning sensor may refer to how many satellite signals are received and the status of the strength of each received satellite signal. When the number of received satellite signals is more, the positioning is more accurate. For positioning sensors (such as GPS sensors, RTK sensors, etc.) that need to use satellite communication for positioning, the positioning must be relatively accurate only when several satellites communicate at the same time. When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is obtained to obtain the calibration distance information, and the In this way, the obtained calibration distance information can be made more accurate.
  • positioning sensors such as GPS sensors, RTK sensors, etc.
  • the acquiring the position information detected by the first positioning sensor and the second positioning sensor includes: in the first positioning sensor When the star search status of the second positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired. In this way, the detected position information can be made more accurate, the distance information obtained according to the detected position information can be made more accurate, and the judgment of whether the two arms are normally deployed can be made more accurate.
  • FIG. 9 is a schematic structural diagram of an embodiment of the control device of the unmanned aerial vehicle of the present application.
  • the two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor.
  • the arm can be switched between a folded state and an unfolded state.
  • the control device of this embodiment can execute the steps in the above-mentioned method for detecting the arm state of the UAV.
  • the relevant content please refer to the relevant content of the above-mentioned method for detecting the arm state of the UAV, in This will not be repeated here.
  • the control device 100 of the drone includes: a memory 1 and a processor 2; the processor 2 and the memory 1 are connected through a bus.
  • the processor 2 may be a microcontroller unit, a central processing unit or a digital signal processor, and so on.
  • the memory 1 may be a Flash chip, a read-only memory, a magnetic disk, an optical disk, a U disk, a mobile hard disk, and the like.
  • the memory 1 is used to store a computer program; the processor 2 is used to execute the computer program and implement the following steps when executing the computer program:
  • the processor when executing the computer program, implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, controlling the UAV according to the state of the UAV A corresponding safety operation is performed, and the state of the UAV includes a non-take-off state and a flight state.
  • the processor implements at least one of the following steps when executing the computer program: not responding to the take-off command; and outputting prompt information through the application program, so that The above prompt information is used to prompt the user to check the machine arm.
  • the processor implements at least one of the following steps when executing the computer program: adjusting the power output of the UAV power assembly to automatically control the the drone to land; limit the speed and acceleration of the drone; and output prompt information through the application program, the prompt information is used to prompt the user to control the drone to land.
  • the processor when executing the computer program, implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, determining the level of the arm folding back; The drones perform corresponding safety operations.
  • the processor when executing the computer program, implements the following steps: if the turn-back level is a first turn-back level, controlling the drone to perform a first safety operation; if the turn-back level is a second turn-back level If the back-turning level is set, the drone is controlled to perform a second safe operation, the second back-turning level is higher than the first back-turning level, and the second safe operation is different from the first safe operation.
  • the first safety operation includes: limiting the speed and acceleration of the drone.
  • the second safety operation includes: adjusting the power output of the unmanned aerial vehicle power assembly to automatically control the landing of the unmanned aerial vehicle.
  • the processor when executing the computer program, implements the following steps: acquiring multiple pieces of position information detected by the first positioning sensor and the second positioning sensor within a predetermined time length; Obtaining the distance information between the two arms from the information includes: obtaining a plurality of distance information between the two arms according to the plurality of position information; determining the two arms according to the plurality of distance information The average distance information between the arms, and the average distance information between the two arms is used as the distance information between the two arms.
  • the processor when executing the computer program, implements the following steps: obtaining standard deviation information corresponding to the plurality of distance information according to the plurality of distance information; according to the average distance between the two arms information, the calibration distance information and the corresponding standard deviation information to determine whether the two arms are normally deployed.
  • the processor when executing the computer program, implements the following steps: if an arm calibration instruction is received, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
  • the processor when executing the computer program, implements the following steps: if receiving an arm calibration instruction, controlling the UAV to fly to a preset height; acquiring the first positioning sensor and the Obtaining the calibration distance information from the position information detected by the second positioning sensor includes: when the UAV is at the preset altitude, obtaining the positions detected by the first positioning sensor and the second positioning sensor information to obtain the calibration distance information.
  • the processor when executing the computer program, implements the following steps: obtaining the star search status of the first positioning sensor and the second positioning sensor if the arm calibration instruction is received; Obtaining the calibration distance information from the position information detected by the first positioning sensor and the second positioning sensor includes: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, obtaining all the information about the calibration distance. position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
  • the first positioning sensor and the second positioning sensor include RTK sensors.
  • the processor when executing the computer program, implements the following steps: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, acquire the first positioning sensor and the second positioning sensor. The position information detected by the second positioning sensor.
  • the first positioning sensor and the second positioning sensor are respectively arranged at the ends of the two arms of the drone.
  • power assemblies are installed on the two arms, and the folding directions of the two arms are consistent with the direction of the force acting on the arms when the power assemblies output power.
  • FIG. 10 is a schematic structural diagram of an embodiment of the unmanned aerial vehicle of the present application. 2 to 4 , the two arms 10 of the UAV 200 are respectively provided with a first positioning sensor 20 and a second positioning sensor 30 , and the two arms 10 can be in either a folded state or an unfolded state. switch between.
  • the UAV of this embodiment can execute the steps in the above-mentioned method for detecting the state of the UAV's arm.
  • the relevant content of the above-mentioned method for detecting the state of the UAV's arm please refer to the relevant content of the above-mentioned method for detecting the state of the UAV's arm. I won't go into details here.
  • the drone 200 further includes: a memory 11 and a processor 22; the processor 22 is connected to the memory 11 through a bus.
  • the processor 22 may be a microcontroller unit, a central processing unit or a digital signal processor, and so on.
  • the memory 11 may be a Flash chip, a read-only memory, a magnetic disk, an optical disk, a U disk, a mobile hard disk, or the like.
  • the memory 11 is used to store a computer program; the processor 22 is used to execute the computer program and implement the following steps when executing the computer program:
  • the processor when executing the computer program, implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, controlling the UAV according to the state of the UAV A corresponding safety operation is performed, and the state of the UAV includes a non-take-off state and a flying state.
  • the processor implements at least one of the following steps when executing the computer program: not responding to the take-off command; and outputting prompt information through the application program, so that The above prompt information is used to prompt the user to check the machine arm.
  • the processor implements at least one of the following steps when executing the computer program: adjusting the power output of the UAV power assembly to automatically control the the drone to land; limit the speed and acceleration of the drone; and output prompt information through the application program, the prompt information is used to prompt the user to control the drone to land.
  • the processor when executing the computer program, implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, determining the level of the arm folding back; The drones perform corresponding safety operations.
  • the processor when executing the computer program, implements the following steps: if the turn-back level is a first turn-back level, controlling the drone to perform a first safety operation; if the turn-back level is a second turn-back level If the back-turning level is set, the drone is controlled to perform a second safe operation, the second back-turning level is higher than the first back-turning level, and the second safe operation is different from the first safe operation.
  • the first safety operation includes: limiting the speed and acceleration of the drone.
  • the second safety operation includes: adjusting the power output of the unmanned aerial vehicle power assembly to automatically control the landing of the unmanned aerial vehicle.
  • the processor when executing the computer program, implements the following steps: acquiring multiple pieces of position information detected by the first positioning sensor and the second positioning sensor within a predetermined time length; Obtaining the distance information between the two arms from the information includes: obtaining a plurality of distance information between the two arms according to the plurality of position information; determining the two arms according to the plurality of distance information The average distance information between the arms, and the average distance information between the two arms is used as the distance information between the two arms.
  • the processor when executing the computer program, implements the following steps: obtaining standard deviation information corresponding to the plurality of distance information according to the plurality of distance information; according to the average distance between the two arms information, the calibration distance information and the corresponding standard deviation information to determine whether the two arms are normally deployed.
  • the processor when executing the computer program, implements the following steps: if an arm calibration instruction is received, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
  • the processor when executing the computer program, implements the following steps: if receiving an arm calibration instruction, controlling the UAV to fly to a preset height; obtaining the first positioning sensor and the Obtaining the calibration distance information from the position information detected by the second positioning sensor includes: when the UAV is at the preset altitude, obtaining the positions detected by the first positioning sensor and the second positioning sensor information to obtain the calibration distance information.
  • the processor when executing the computer program, implements the following steps: obtaining the star search status of the first positioning sensor and the second positioning sensor if an arm calibration instruction is received; Obtaining the calibration distance information by obtaining the position information detected by the first positioning sensor and the second positioning sensor includes: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, obtaining all the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
  • the first positioning sensor and the second positioning sensor include RTK sensors.
  • the processor when executing the computer program, implements the following steps: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, acquire the first positioning sensor and the second positioning sensor. The position information detected by the second positioning sensor.
  • the first positioning sensor and the second positioning sensor are respectively arranged at the ends of the two arms of the drone.
  • power assemblies are installed on the two arms, and the folding directions of the two arms are consistent with the direction of the force acting on the arms when the power assemblies output power.
  • the present application also provides a computer-readable storage medium, where the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor enables the processor to implement the UAV as described in any of the above Arm state detection method.
  • the relevant content please refer to the above-mentioned relevant content section, which will not be repeated here.
  • the computer-readable storage medium may be the above-mentioned control device or an internal storage unit of the drone, such as a hard disk or a memory.
  • the computer-readable storage medium may also be an external storage device, such as an equipped plug-in hard disk, smart memory card, secure digital card, flash memory card, and the like.

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Forklifts And Lifting Vehicles (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A method for detecting the arm state of an unmanned aerial vehicle, a control device, an unmanned aerial vehicle, and a storage medium. Two arms (10) of an unmanned aerial vehicle (200) are provided with a first positioning sensor (20) and a second positioning sensor (30) respectively, and the two arms (10) may switch between a folded state and an unfolded state. The method comprises: acquiring position information detected by a first positioning sensor (20) and a second positioning sensor (30) (S101); obtaining information regarding the distance between the two arms (10) according to the position information (S102); and according to the information regarding the distance between the two arms (10) and calibration distance information, determining whether the two arms (10) are normally unfolded, the calibration distance information being used to indicate the distance between the two arms (10) when same are normally unfolded (S103).

Description

无人机机臂状态的检测方法、无人机的控制装置及无人机UAV arm state detection method, UAV control device and UAV 技术领域technical field
本申请涉及无人机技术领域,尤其涉及一种无人机机臂状态的检测方法、无人机的控制装置及无人机。The present application relates to the technical field of unmanned aerial vehicles, and in particular, to a method for detecting the state of an arm of an unmanned aerial vehicle, a control device of an unmanned aerial vehicle, and an unmanned aerial vehicle.
背景技术Background technique
为了无人机携带的便携性,现有技术中经常将无人机的机臂设计为可折叠的形式。机臂在无人机收纳时处于折叠状态,在无人机工作时处于展开状态。然而,用户在展开机臂时可能展开不到位或者没有锁紧,导致无人机在飞行过程中出现机臂回折。如果无人机的控制系统仍然保持持续的控制量输出,可能会出现安全事故,严重时甚至导致无人机坠毁。For the portability of the drone, the arms of the drone are often designed in a foldable form in the prior art. The arms are in a folded state when the drone is stowed and unfolded when the drone is working. However, when the user unfolds the arm, it may not be properly deployed or not locked, causing the drone to fold back during flight. If the control system of the UAV still maintains a continuous control output, safety accidents may occur, and in severe cases, the UAV may even crash.
有的可折叠无人机在机臂连接处安装有锁紧识别传感器来感知机臂状态,然而这种方式会导致结构复杂度和成本的提高。Some foldable drones are equipped with locking recognition sensors at the joints of the arms to sense the state of the arms, but this method will lead to increased structural complexity and cost.
发明内容SUMMARY OF THE INVENTION
基于此,本申请提供一种无人机机臂状态的检测方法、无人机的控制装置、无人机及存储介质。Based on this, the present application provides a method for detecting an arm state of an unmanned aerial vehicle, a control device for an unmanned aerial vehicle, an unmanned aerial vehicle, and a storage medium.
第一方面,本申请提供一种无人机机臂状态的检测方法,所述无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,所述两个机臂能够在折叠状态和展开状态之间切换,所述方法包括:In a first aspect, the present application provides a method for detecting the state of an arm of an unmanned aerial vehicle, wherein two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be Switching between a collapsed state and an expanded state, the method includes:
获取所述第一定位传感器和所述第二定位传感器探测的位置信息;acquiring position information detected by the first positioning sensor and the second positioning sensor;
根据所述位置信息得到所述两个机臂之间的距离信息;obtain the distance information between the two arms according to the position information;
根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
第二方面,本申请提供一种无人机的控制装置,所述无人机的两个机臂分 别设置有第一定位传感器和第二定位传感器,所述两个机臂能够在折叠状态和展开状态之间切换,所述无人机的控制装置包括:存储器和处理器;In a second aspect, the present application provides a control device for an unmanned aerial vehicle, wherein two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be folded and Switching between deployment states, the control device of the drone includes: a memory and a processor;
所述存储器用于存储计算机程序;the memory is used to store computer programs;
所述处理器用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and implement the following steps when executing the computer program:
获取所述第一定位传感器和所述第二定位传感器探测的位置信息;acquiring position information detected by the first positioning sensor and the second positioning sensor;
根据所述位置信息得到所述两个机臂之间的距离信息;obtain the distance information between the two arms according to the position information;
根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
第三方面,本申请提供一种无人机,所述无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,所述两个机臂能够在折叠状态和展开状态之间切换,所述无人机包括:存储器和处理器;In a third aspect, the present application provides an unmanned aerial vehicle, wherein two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be in a folded state or an unfolded state. switching between, the drone includes: a memory and a processor;
所述存储器用于存储计算机程序;the memory is used to store computer programs;
所述处理器用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and implement the following steps when executing the computer program:
获取所述第一定位传感器和所述第二定位传感器探测的位置信息;acquiring position information detected by the first positioning sensor and the second positioning sensor;
根据所述位置信息得到所述两个机臂之间的距离信息;obtain the distance information between the two arms according to the position information;
根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
第四方面,本申请提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如上所述的无人机机臂状态的检测方法。In a fourth aspect, the present application provides a computer-readable storage medium, where the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor implements the above-mentioned unmanned aerial vehicle Arm state detection method.
本申请实施例提供了一种无人机机臂状态的检测方法、无人机的控制装置、无人机及存储介质,无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,两个机臂能够在折叠状态和展开状态之间切换,获取所述第一定位传感器和所述第二定位传感器探测的位置信息;根据所述位置信息得到所述两个机臂之间的距离信息;根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机 臂正常展开时的距离。一方面,由于能够通过两个机臂上分别设置的两个定位传感器探测的位置信息得到两个机臂之间的距离信息,结合两个机臂正常展开时的标定距离信息,即可确定两个机臂是否正常展开,为后续避免无人机出现安全事故提供技术支持;另一方面,相对于现有技术在机臂上安装额外的传感器来检测两个机臂是否正常展开,本申请实施例直接利用无人机上配置的定位传感器探测的位置信息得到两个机臂之间的距离信息,进而确定两个机臂是否正常展开,能够降低成本,降低无人机的结构复杂度。The embodiments of the present application provide a method for detecting the state of an unmanned aerial vehicle, a control device of the unmanned aerial vehicle, an unmanned aerial vehicle, and a storage medium. The two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor. A positioning sensor, the two arms can be switched between the folded state and the unfolded state, and the position information detected by the first positioning sensor and the second positioning sensor is obtained; according to the position information, the difference between the two arms can be obtained. distance information between the two arms; according to the distance information between the two arms and the calibration distance information, determine whether the two arms are normally deployed, and the calibration distance information is used to indicate when the two arms are normally deployed the distance. On the one hand, since the distance information between the two arms can be obtained through the position information detected by the two positioning sensors respectively provided on the two arms, and combined with the calibration distance information when the two arms are normally deployed, the two arms can be determined. Whether the arms are normally deployed provides technical support for the subsequent avoidance of safety accidents in the drone; on the other hand, compared with the prior art, additional sensors are installed on the arms to detect whether the two arms are normally deployed. This application implements the For example, the position information detected by the positioning sensor configured on the UAV is directly used to obtain the distance information between the two arms, and then it is determined whether the two arms are normally deployed, which can reduce the cost and the structural complexity of the UAV.
应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本申请。It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory only and are not limiting of the present application.
附图说明Description of drawings
为了更清楚地说明本申请实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to explain the technical solutions of the embodiments of the present application more clearly, the following briefly introduces the accompanying drawings used in the description of the embodiments. For those of ordinary skill, other drawings can also be obtained from these drawings without any creative effort.
图1是本申请无人机机臂状态的检测方法一实施例的流程示意图;1 is a schematic flowchart of an embodiment of a method for detecting the state of an unmanned aerial vehicle of the present application;
图2是本申请无人机机臂状态的检测方法一实施例中无人机的机臂在展开状态的结构示意图;Fig. 2 is the structural representation of the arm of the unmanned aerial vehicle in the unfolded state in an embodiment of the method for detecting the arm state of the unmanned aerial vehicle of the present application;
图3和图4是图2中的无人机在两个不同角度机臂在折叠状态的结构示意图;3 and 4 are schematic structural diagrams of the UAV in FIG. 2 in a folded state with two arms at different angles;
图5是本申请无人机机臂状态的检测方法另一实施例的流程示意图;5 is a schematic flowchart of another embodiment of the method for detecting the state of the drone arm of the present application;
图6是本申请无人机机臂状态的检测方法又一实施例的流程示意图;6 is a schematic flowchart of another embodiment of the method for detecting the state of the UAV arm of the present application;
图7是本申请无人机机臂状态的检测方法又一实施例的流程示意图;FIG. 7 is a schematic flowchart of another embodiment of the method for detecting the state of the drone arm of the present application;
图8是本申请无人机机臂状态的检测方法又一实施例的流程示意图;8 is a schematic flowchart of another embodiment of the method for detecting the state of the drone arm of the present application;
图9是本申请无人机的控制装置一实施例的结构示意图;9 is a schematic structural diagram of an embodiment of a control device for an unmanned aerial vehicle of the present application;
图10是本申请无人机一实施例的结构示意图。FIG. 10 is a schematic structural diagram of an embodiment of the UAV of the present application.
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清 楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The technical solutions in the embodiments of the present application will be clearly and completely described below with reference to 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 the embodiments. Based on the embodiments in the present application, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present application.
附图中所示的流程图仅是示例说明,不是必须包括所有的内容和操作/步骤,也不是必须按所描述的顺序执行。例如,有的操作/步骤还可以分解、组合或部分合并,因此实际执行的顺序有可能根据实际情况改变。The flowcharts shown in the figures are for illustration only, and do not necessarily include all contents and operations/steps, nor do they have to be performed in the order described. For example, some operations/steps can also be decomposed, combined or partially combined, so the actual execution order may be changed according to the actual situation.
无人机可折叠的机臂在收纳时处于折叠状态,在工作时处于展开状态。如果机臂展开不到位或者没有锁紧,无人机在飞行过程中会出现机臂回折。如果无人机的控制系统仍然保持持续的控制量输出,可能出现安全事故,甚至坠机。有的在机臂连接处安装锁紧识别传感器来感知机臂状态,但这容易增加结构复杂度和成本。The foldable arms of the drone are in a folded state when stowed and unfolded when working. If the arm is not unfolded properly or is not locked, the arm will fold back during the flight of the drone. If the control system of the UAV still maintains a continuous control output, safety accidents or even crashes may occur. In some cases, a locking recognition sensor is installed at the connection of the machine arm to sense the state of the machine arm, but this tends to increase the structural complexity and cost.
本申请实施例提供了一种无人机机臂状态的检测方法、无人机的控制装置、无人机及存储介质,无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,两个机臂能够在折叠状态和展开状态之间切换,获取所述第一定位传感器和所述第二定位传感器探测的位置信息;根据所述位置信息得到所述两个机臂之间的距离信息;根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。一方面,由于能够通过两个机臂上分别设置的两个定位传感器探测的位置信息得到两个机臂之间的距离信息,结合两个机臂正常展开时的标定距离信息,即可确定两个机臂是否正常展开,为后续避免无人机出现安全事故提供技术支持,当确定两个机臂至少一个没有正常展开时,可以控制无人机执行对应的安全操作,从而能够避免安全事故发生;另一方面,相对于现有技术在机臂上安装额外的传感器来检测两个机臂是否正常展开,这容易增加结构复杂度和成本,本申请实施例中定位传感器是无人机的标准配置,直接利用无人机上标准配置的定位传感器探测的位置信息得到两个机臂之间的距离信息,进而确定两个机臂是否正常展开,因此能够降低成本,降低无人机的结构复杂度。The embodiments of the present application provide a method for detecting the state of an unmanned aerial vehicle, a control device of the unmanned aerial vehicle, an unmanned aerial vehicle, and a storage medium. The two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor. A positioning sensor, the two arms can be switched between the folded state and the unfolded state, and the position information detected by the first positioning sensor and the second positioning sensor is obtained; according to the position information, the difference between the two arms can be obtained. distance information between the two arms; according to the distance information between the two arms and the calibration distance information, determine whether the two arms are normally deployed, and the calibration distance information is used to indicate when the two arms are normally deployed the distance. On the one hand, since the distance information between the two arms can be obtained through the position information detected by the two positioning sensors respectively provided on the two arms, and combined with the calibration distance information when the two arms are normally deployed, the two arms can be determined. Whether each of the arms is normally deployed provides technical support for the subsequent avoidance of safety accidents in the drone. When it is determined that at least one of the two arms is not normally deployed, the drone can be controlled to perform the corresponding safety operation, thereby avoiding the occurrence of safety accidents. On the other hand, compared to the prior art, additional sensors are installed on the arms to detect whether the two arms are normally deployed, which easily increases the structural complexity and cost. In the embodiment of the present application, the positioning sensor is the standard of the drone Configuration, directly use the position information detected by the standard positioning sensor on the UAV to obtain the distance information between the two arms, and then determine whether the two arms are normally deployed, so it can reduce the cost and reduce the structural complexity of the UAV .
下面结合附图,对本申请的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。Some embodiments of the present application will be described in detail below with reference to the accompanying drawings. The embodiments described below and features in the embodiments may be combined with each other without conflict.
参见图1,图1是本申请无人机机臂状态的检测方法一实施例的流程示意图,需要说明的是,本实施例的检测方法可以部署在无人机,由无人机执行,也可以部署在无人机的控制装置上,由无人机的控制装置执行;在此不做限定。Referring to FIG. 1, FIG. 1 is a schematic flowchart of an embodiment of the method for detecting the arm state of the unmanned aerial vehicle of the present application. It should be noted that the detection method of this embodiment can be deployed on the unmanned aerial vehicle, executed by the unmanned aerial vehicle, and also It can be deployed on the control device of the UAV and executed by the control device of the UAV; it is not limited here.
结合参见图2至图4,图2是本申请无人机机臂状态的检测方法一实施例中无人机的机臂在展开状态的结构示意图,图3和图4是图2中的无人机在两个不同角度机臂在折叠状态的结构示意图。本实施例中,所述无人机200的两个机臂10分别设置有第一定位传感器20和第二定位传感器30,所述两个机臂10能够在折叠状态(如图3和图4所示)和展开状态(如图2所示)之间切换。Referring to FIG. 2 to FIG. 4 in conjunction, FIG. 2 is a schematic structural diagram of the arm of the unmanned aerial vehicle in the unfolded state in an embodiment of the method for detecting the arm state of the unmanned aerial vehicle of the present application, and FIG. 3 and FIG. A schematic diagram of the structure of the man-machine in the folded state of the man-machine at two different angles. In this embodiment, the two arms 10 of the UAV 200 are respectively provided with a first positioning sensor 20 and a second positioning sensor 30, and the two arms 10 can be in a folded state (as shown in FIG. 3 and FIG. 4 ). shown) and the expanded state (shown in Figure 2).
定位可以是确定移动物体在坐标系中的位置及本身的姿态。定位技术可以分为绝对定位技术和相对定位技术,相应的传感器也分为绝对定位传感器(测距法和惯导法)和相对定位传感器(磁性指南针法、活动标法、全球定位系统、路标导航法、模型匹配法)。定位传感器主要应用于太空月球车、自主行驶车辆、AGV(Autonomous Guided Vehicle)、移动机器人和移动式清洁设备等自主式移动设备。常用的定位传感器包括但不限于:超声波传感器、红外传感器、激光传感器、RTK传感器、视觉传感器,等等。The positioning can be to determine the position of the moving object in the coordinate system and its own attitude. Positioning technology can be divided into absolute positioning technology and relative positioning technology, and the corresponding sensors are also divided into absolute positioning sensors (ranging method and inertial navigation method) and relative positioning sensors (magnetic compass method, activity marking method, global positioning system, road sign navigation) method, model matching method). Positioning sensors are mainly used in autonomous mobile devices such as space lunar rovers, autonomous vehicles, AGVs (Autonomous Guided Vehicles), mobile robots and mobile cleaning equipment. Commonly used positioning sensors include but are not limited to: ultrasonic sensors, infrared sensors, laser sensors, RTK sensors, vision sensors, and the like.
在一实施例中,利用第一定位传感器和第二定位传感器中至少一个传感器探测的位置信息能够为无人机提供精确的定位,利用第一定位传感器和第二定位传感器探测的位置信息能够为无人机提供精确的定向。示例的,第一定位传感器和第二定位传感器均为RTK(Real Time Kinematic)传感器,具体包括RTK天线。RTK技术采用实时动态载波相位差分方法,能够实现厘米级的高精度定位,为工程放样、地形测绘等各种行业应用带来了新的测量原理和方法。近年来,用于行业应用的无人机多设置有RTK传感器。本实施例复用无人机上配置用于无人机本身精确定位或定向的第一定位传感器和第二定位传感器来检测两个机臂是否正常展开,无需安装额外的传感器,能够降低成本,降低无人机的结构复杂度。In one embodiment, the position information detected by at least one of the first positioning sensor and the second positioning sensor can provide accurate positioning for the drone, and the position information detected by the first positioning sensor and the second positioning sensor can be Drones provide precise orientation. For example, the first positioning sensor and the second positioning sensor are both RTK (Real Time Kinematic) sensors, and specifically include RTK antennas. RTK technology adopts real-time dynamic carrier phase difference method, which can realize centimeter-level high-precision positioning, and brings new measurement principles and methods to various industrial applications such as engineering stakeout and terrain mapping. In recent years, UAVs for industrial applications are mostly equipped with RTK sensors. This embodiment reuses the first positioning sensor and the second positioning sensor configured on the drone for precise positioning or orientation of the drone itself to detect whether the two arms are normally deployed, without installing additional sensors, which can reduce costs and reduce The structural complexity of UAVs.
在一实施例中,RTK板卡可以与RTK天线集成设置,或者RTK板卡也可以与RTK天线分离设置。例如,RTK板卡设置于无人机机身,RTK天线设置于无人机机臂。In one embodiment, the RTK board can be integrated with the RTK antenna, or the RTK board can be set separately from the RTK antenna. For example, the RTK board is set on the drone body, and the RTK antenna is set on the drone arm.
本实施例中,出于成本的考虑,在无人机的两个机臂分别设置第一定位传感器和第二定位传感器。实际应用中,也可以在每个机臂上设置一个定位传感器。In this embodiment, for the consideration of cost, the first positioning sensor and the second positioning sensor are respectively provided on the two arms of the drone. In practical applications, a positioning sensor can also be set on each arm.
如果两个机臂安装有动力组件,根据经验和理论通常情况下如果动力组件输出的动力对机臂的作用力的方向与机臂的折叠方向一致,那么该机臂是比较容易发生回折的。例如:动力组件包括桨叶,若桨叶的旋转方向为逆时针方向,则动力组件输出动力时对机臂的作用力的方向是顺时针方向,也即机臂对应受到的反扭矩为顺时针方向,如果机臂的折叠方向也是顺时针方向,该机臂很容易发生回折。If the two arms are equipped with power components, according to experience and theory, if the direction of the force output by the power components on the arms is consistent with the folding direction of the arms, then the arms are more likely to fold back. For example: the power assembly includes blades. If the rotation direction of the blades is counterclockwise, the direction of the force on the arm when the power assembly outputs power is clockwise, that is, the counter torque received by the arm is clockwise. If the folding direction of the machine arm is also clockwise, the machine arm is prone to fold back.
请参考图2至图4,第一定位传感器20和第一动力组件安装在第一机臂,第二定位传感器30和第二动力组件安装在第二机臂;第一动力组件的桨叶旋转方向为顺时针方向,第一机臂对应受到的反扭矩为逆时针方向,第一机臂的折叠方向为逆时针方向;第二动力组件的桨叶旋转方向为逆时针方向,第二机臂对应受到的反扭矩为顺时针方向,第二机臂的折叠方向为顺时针方向。也即,第一机臂和第二机臂容易产生机臂回折。此时可以有针对性地将第一定位传感器和第二定位传感器分别设置在这种容易发生回折的两个机臂上,既能够节约成本,又能够有针对性地检测容易发生回折的两个机臂是否正常展开,避免发生安全事件。Please refer to FIGS. 2 to 4 , the first positioning sensor 20 and the first power assembly are installed on the first arm, the second positioning sensor 30 and the second power assembly are installed on the second arm; the blades of the first power assembly rotate The direction is clockwise, the counter-torque corresponding to the first arm is counterclockwise, the folding direction of the first arm is counterclockwise; the rotation direction of the blades of the second power assembly is counterclockwise, the second arm The corresponding reaction torque is clockwise, and the folding direction of the second arm is clockwise. That is, the first arm and the second arm are likely to be folded back. At this time, the first positioning sensor and the second positioning sensor can be set on the two arms that are prone to turning back in a targeted manner, which not only saves costs, but also can detect the two arms that are prone to turning back in a targeted manner. Check whether the arms are normally deployed to avoid safety incidents.
两个机臂正常展开时之间的距离越大,当它们之间至少一个发生回折时,能够更加容易检测它们之间距离的变化。因此,可以将所述第一定位传感器和所述第二定位传感器分别设置在所述无人机的两个机臂的末端。The larger the distance between the two arms when they are normally deployed, the easier it is to detect the change in the distance between them when at least one of them is folded back. Therefore, the first positioning sensor and the second positioning sensor can be respectively arranged at the ends of the two arms of the drone.
所述方法包括:步骤S101、步骤S102以及步骤S103。The method includes: step S101, step S102 and step S103.
步骤S101:获取所述第一定位传感器和所述第二定位传感器探测的位置信息。Step S101: Acquire position information detected by the first positioning sensor and the second positioning sensor.
步骤S102:根据所述位置信息得到所述两个机臂之间的距离信息。Step S102: Obtain distance information between the two arms according to the position information.
步骤S103:根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Step S103: Determine whether the two arms are normally deployed according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed .
第一定位传感器和第二定位传感器能够探测到各自所在的位置信息,具体 来说,第一定位传感器和第二定位传感器能够探测到各自在机臂上的位置信息。根据第一定位传感器和所述第二定位传感器探测的位置信息即可得到第一定位传感器和所述第二定位传感器之间的距离信息,将第一定位传感器和所述第二定位传感器之间的距离信息作为两个机臂之间的距离信息。The first positioning sensor and the second positioning sensor can detect their respective position information. Specifically, the first positioning sensor and the second positioning sensor can detect their respective position information on the machine arm. The distance information between the first positioning sensor and the second positioning sensor can be obtained according to the position information detected by the first positioning sensor and the second positioning sensor. The distance information is taken as the distance information between the two arms.
标定距离信息用于指示所述两个机臂正常展开时的距离,两个机臂正常展开时的距离通常情况下是固定不变的或者变化很小。标定距离信息可以在无人机出厂的时候标定出来并保存在无人机的存储装置中;随着无人机使用时间的延长,无人机的机臂会有损耗,因此也可以在无人机出厂后,在使用期间定期或不定期在起飞前、起飞过程中对两个机臂正常展开时的距离重新进行标定,得到标定距离信息。The calibration distance information is used to indicate the distance when the two arms are normally deployed, and the distance when the two arms are normally deployed is usually fixed or changes little. The calibration distance information can be calibrated when the drone leaves the factory and stored in the storage device of the drone; with the extension of the use time of the drone, the arm of the drone will be worn out, so it can also be used when the drone is unmanned. After the aircraft leaves the factory, re-calibrate the distance between the two arms when the two arms are normally deployed before and during take-off regularly or irregularly during use, and obtain the calibrated distance information.
将当前这两个机臂之间的距离信息与指示所述两个机臂正常展开时的距离的标定距离信息进行比较,即可确定两个机臂是否正常展开。Whether the two arms are normally deployed can be determined by comparing the current distance information between the two arms with the calibrated distance information indicating the distance when the two arms are normally deployed.
一般情况下,如果当前两个机臂正常展开,当前这两个机臂之间的距离与两个机臂正常展开时的距离基本一致;如果当前两个机臂回折,当前这两个机臂之间的距离与两个机臂正常展开时的距离有差别:具体来说,如果一个机臂朝着远离另一个机臂的方向回折,当前这两个机臂之间的距离可以大于两个机臂正常展开时的距离,如果一个机臂朝着靠近另一个机臂的方向回折,当前这两个机臂之间的距离可以小于两个机臂正常展开时的距离。In general, if the current two arms are unfolded normally, the distance between the current two arms is basically the same as the distance when the two arms are normally unfolded; if the current two arms are folded back, the current two arms are The distance between the two arms is different from the distance when the two arms are normally deployed: Specifically, if one arm is folded back away from the other arm, the current distance between the two arms can be greater than the distance between the two arms. The distance when the arms are normally deployed. If one arm is folded back toward the other arm, the current distance between the two arms can be smaller than the distance when the two arms are normally deployed.
本申请实施例提供了一种无人机机臂状态的检测方法,无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,两个机臂能够在折叠状态和展开状态之间切换,获取所述第一定位传感器和所述第二定位传感器探测的位置信息;根据所述位置信息得到所述两个机臂之间的距离信息;根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。一方面,由于能够通过两个机臂上分别设置的两个定位传感器探测的位置信息得到两个机臂之间的距离信息,结合两个机臂正常展开时的标定距离信息,即可确定两个机臂是否正常展开,为后续避免无人机出现安全事故提供技术支持,当确定两个机臂至少一个没有正常展开时,可以控制无人机执行对应的安全操作,从而能够避免安全事故发生;另一方面,相对于现有技术在机臂上安装额外的传感器来检测 两个机臂是否正常展开,这容易增加结构复杂度和成本,本申请实施例中定位传感器是无人机的标准配置,直接利用无人机上标准配置的定位传感器探测的位置信息得到两个机臂之间的距离信息,进而确定两个机臂是否正常展开,因此能够降低成本,降低无人机的结构复杂度。The embodiment of the present application provides a method for detecting the state of an arm of a drone. The two arms of the drone are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be in a folded state and an unfolded state. Switch between the two arms to obtain the position information detected by the first positioning sensor and the second positioning sensor; obtain the distance information between the two arms according to the position information; according to the distance between the two arms The distance information and the calibration distance information are determined to determine whether the two arms are normally deployed, and the calibration distance information is used to indicate the distance when the two arms are normally deployed. On the one hand, since the distance information between the two arms can be obtained through the position information detected by the two positioning sensors respectively provided on the two arms, and combined with the calibration distance information when the two arms are normally deployed, the two arms can be determined. Whether each of the arms is normally deployed provides technical support for the subsequent avoidance of safety accidents in the drone. When it is determined that at least one of the two arms is not normally deployed, the drone can be controlled to perform the corresponding safety operation, thereby avoiding the occurrence of safety accidents. On the other hand, compared to the prior art, additional sensors are installed on the arms to detect whether the two arms are normally deployed, which easily increases the structural complexity and cost. In the embodiment of the present application, the positioning sensor is the standard of the drone Configuration, directly use the position information detected by the standard positioning sensor on the UAV to obtain the distance information between the two arms, and then determine whether the two arms are normally deployed, so it can reduce the cost and reduce the structural complexity of the UAV .
确定所述两个机臂是否正常展开最重要的意义是:如果确定两个机臂没有正常展开,需要控制无人机执行对应的安全操作,以避免安全事故发生,避免可能的坠机造成用户损失。The most important significance of determining whether the two arms are normally deployed is: if it is determined that the two arms are not normally deployed, it is necessary to control the drone to perform corresponding safety operations to avoid safety accidents and avoid possible crashes that cause users loss.
因此在一实施例中,所述方法还包括:步骤S104A,如图5所示。Therefore, in an embodiment, the method further includes: step S104A, as shown in FIG. 5 .
步骤S104A:若确定所述两个机臂中的至少一个没有正常展开,则根据所述无人机的状态,控制所述无人机执行对应的安全操作,所述无人机的状态包括未起飞状态和飞行状态。Step S104A: If it is determined that at least one of the two arms is not normally deployed, control the UAV to perform corresponding safety operations according to the state of the UAV, where the state of the UAV includes unmanned aerial vehicles. Takeoff status and flight status.
即本实施例中,当确定所述两个机臂中的至少一个没有正常展开时(即机臂异常),根据无人机在未起飞状态或飞行状态,控制无人机执行对应的安全操作,以避免安全事故发生,避免可能的坠机造成用户损失。That is, in this embodiment, when it is determined that at least one of the two arms is not unfolded normally (that is, the arm is abnormal), the drone is controlled to perform the corresponding safety operation according to the unmanned state or the flying state of the drone. , in order to avoid the occurrence of safety accidents and the loss of users caused by possible crashes.
其中,若所述无人机的状态为未起飞状态,则所述安全操作包括以下至少之一:不响应起飞指令;以及通过应用程序输出提示信息,所述提示信息用于提示用户检查机臂。Wherein, if the state of the drone is not taking off, the safety operation includes at least one of the following: not responding to the take-off command; and outputting prompt information through the application program, the prompt information is used to prompt the user to check the aircraft arm .
若在起飞前检测到两个机臂中的至少一个没有正常展开时,则控制无人机不响应起飞指令,其中起飞指令可以是用户发送的起飞指令;也可以通过应用程序输出提示信息,提示用户检查机臂;也可以不响应起飞指令,同时通过应用程序输出提示信息,提示用户检查机臂。通过这种方式,能够在起飞前检测到两个机臂中的至少一个没有正常展开时即可对无人机执行安全操作,避免机臂异常的无人机在没有预先干预的情况下起飞,提前避免后续可能的安全事故发生,起到预防的作用。If it is detected that at least one of the two arms does not unfold normally before take-off, the control drone will not respond to the take-off command. The user checks the arm; it can also not respond to the take-off command, and at the same time output a prompt message through the application program to prompt the user to check the arm. In this way, it is possible to perform safe operations on the UAV when it is detected that at least one of the two arms is not properly deployed before takeoff, so as to prevent the UAV with abnormal arms from taking off without prior intervention, To avoid possible subsequent safety accidents in advance, play a preventive role.
其中,若所述无人机的状态为飞行状态,则所述安全操作包括以下至少之一:调整所述无人机动力组件的动力输出以自动控制所述无人机降落;限制所述无人机的速度和加速度;以及通过应用程序输出提示信息,所述提示信息用于提示用户控制所述无人机进行降落。Wherein, if the state of the drone is a flying state, the safe operation includes at least one of the following: adjusting the power output of the power component of the drone to automatically control the landing of the drone; limiting the unmanned aerial vehicle speed and acceleration of the man-machine; and outputting prompt information through the application program, the prompt information is used to prompt the user to control the drone to land.
若在飞行过程中检测到两个机臂中的至少一个没有正常展开时,则可以调 整所述无人机动力组件的动力输出以自动控制所述无人机降落,例如如果是四旋翼无人机,检测到其中一个机臂异常后,可以调整所述无人机动力组件的动力输出,不再向机臂异常的机臂输出动力,将用于无人机飞行的动力调整到另外的三个机臂上,并通过这三个机臂控制无人机降落(例如当机臂已经折叠,当前无人机已经处于很危险的环境下,需要尽快控制无人机降落);也可以限制所述无人机的速度和加速度,例如:可以通过限制无人机的速度和加速度来禁止无人机进行大机动飞行,当用户发送大机动飞行指令时,可以通过限制无人机的速度和加速度的方式不响应用户的大机动飞行指令,以避免坠机(例如,当机臂回折程度不大时,无人机还可以以较小的速度和加速度飞行);也可以通过应用程序输出提示信息,提示用户控制所述无人机进行降落;也可以是上述几种安全操作相结合。If it is detected during the flight that at least one of the two arms is not properly deployed, the power output of the UAV power assembly can be adjusted to automatically control the landing of the UAV, for example, if it is a quadrotor unmanned aerial vehicle After detecting that one of the arms is abnormal, you can adjust the power output of the power component of the UAV, no longer output power to the arm with the abnormal arm, and adjust the power used for the UAV to fly to the other three. on one arm, and control the landing of the drone through these three arms (for example, when the arms have been folded, the current drone is already in a very dangerous environment, and the drone needs to be controlled to land as soon as possible); Describe the speed and acceleration of the UAV. For example, the UAV can be prohibited from performing large maneuvering flight by limiting the speed and acceleration of the UAV. When the user sends a large maneuvering flight command, the speed and acceleration of the UAV can be limited by The method does not respond to the user's large maneuvering flight instructions to avoid crashes (for example, when the arm is not folded back, the drone can also fly at a small speed and acceleration); it can also output prompt information through the app , prompting the user to control the drone to land; it can also be a combination of the above-mentioned safety operations.
总之在无人机处于飞行状态中通过上述方式也能够执行对应的安全操作,保护无人机,避免安全事故发生。In short, the above methods can also perform corresponding safety operations while the UAV is in flight to protect the UAV and avoid safety accidents.
在一实施例中,当确定无人机机臂异常时,还进一步精细化确定机臂回折级别,并据此执行精细化的安全操作,从而可以满足用户的精细化要求。即所述方法还包括:步骤S104B1和步骤S104B2,如图6所示。In one embodiment, when it is determined that the drone arm is abnormal, the arm return level is further refined and determined, and refined safety operations are performed accordingly, so as to meet the refined requirements of the user. That is, the method further includes: step S104B1 and step S104B2, as shown in FIG. 6 .
步骤S104B1:若确定所述两个机臂中的至少一个没有正常展开,则确定机臂回折级别。Step S104B1: If it is determined that at least one of the two arms is not unfolded normally, determine the level of the arm folding back.
步骤S104B2:根据所述机臂回折级别,控制所述无人机执行对应的安全操作。Step S104B2: Control the UAV to perform a corresponding safety operation according to the arm return level.
其中,可以将回折级别划分为两个级别,即步骤S104B2,所述根据所述机臂回折级别,控制所述无人机执行对应的安全操作,还可以包括:Wherein, the turn-back level can be divided into two levels, that is, step S104B2, the control of the drone to perform the corresponding safety operation according to the arm turn-back level may further include:
(1)若所述回折级别为第一回折级别,则控制所述无人机执行第一安全操作。(1) If the turn-back level is the first turn-back level, control the drone to perform a first safety operation.
(2)若所述回折级别为第二回折级别,则控制所述无人机执行第二安全操作,所述第二回折级别高于第一回折级别,所述第二安全操作不同于所述第一安全操作。(2) If the reversing level is the second reversing level, control the drone to perform a second safety operation, the second reversing level is higher than the first reversing level, and the second safe operation is different from the The first safe operation.
本实施例中,回折级别包括第一回折级别和第二回折级别,第二回折级别高于第一回折级别;也就是说,相比第一回折级别,第二回折级别回折的程度 更加厉害,相对来说无人机也处于一种更加危险的环境中。通过这种精细化的回折级别的确定,能够更加精确识别无人机当前所处的环境的危险程度,从而能够采取更加有针对性的安全操作。In this embodiment, the reversion level includes a first reversion level and a second reversion level, and the second reversion level is higher than the first reversion level; that is, compared with the first reversion level, the second reversion level is more severe, Drones are also in a relatively more dangerous environment. Through the determination of this refined return level, it is possible to more accurately identify the danger level of the environment in which the UAV is currently located, so that more targeted safety operations can be taken.
其中,所述第一安全操作包括:限制所述无人机的速度和加速度。Wherein, the first safety operation includes: limiting the speed and acceleration of the drone.
其中,所述第二安全操作包括:调整所述无人机动力组件的动力输出以自动控制所述无人机降落。Wherein, the second safety operation includes: adjusting the power output of the unmanned aerial vehicle power assembly to automatically control the landing of the unmanned aerial vehicle.
在一实施例中,为了避免测量本身带来的误差或者偶然因素带来的测量误差,可以多次测量得到多个位置信息,最终的距离信息为一个平均距离信息。即步骤S101,所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息,可以包括:在预定时间长度内获取所述第一定位传感器和所述第二定位传感器探测的多个位置信息。此时步骤S102,所述根据所述位置信息得到所述两个机臂之间的距离信息,可以包括:子步骤S1021和子步骤S1022,如图7所示。In an embodiment, in order to avoid the error caused by the measurement itself or the measurement error caused by accidental factors, multiple pieces of position information may be obtained by multiple measurements, and the final distance information is an average distance information. That is, in step S101, the obtaining the position information detected by the first positioning sensor and the second positioning sensor may include: obtaining multiple data detected by the first positioning sensor and the second positioning sensor within a predetermined period of time. location information. At this time, in step S102, the obtaining the distance information between the two arms according to the position information may include sub-step S1021 and sub-step S1022, as shown in FIG. 7 .
子步骤S1021:根据所述多个位置信息得到所述两个机臂之间的多个距离信息。Sub-step S1021: Obtain a plurality of distance information between the two arms according to the plurality of position information.
子步骤S1022:根据所述多个距离信息确定所述两个机臂之间的平均距离信息,将所述两个机臂之间的平均距离信息作为所述两个机臂之间的距离信息。Sub-step S1022: Determine the average distance information between the two arms according to the plurality of distance information, and use the average distance information between the two arms as the distance information between the two arms .
任何检测传感器在测量或检测的时候自身均存在误差(每次测量的数据都有偏差),而且还会有一些偶然因素导致的误差(例如受外界影响,测量数据突然变大或突然变小,外界影响消失后又恢复常态)。本实施例在预定时间长度内获取探测到的多个位置信息,得到对应的多个位置信息,将多个位置信息的平均距离信息作为两个机臂之间的距离信息,通过这种方式,能够减小测量误差和偶然因素的影响。Any detection sensor has its own error when measuring or detecting (the data of each measurement is biased), and there will also be errors caused by some accidental factors (for example, due to external influences, the measurement data suddenly becomes larger or smaller, return to normal after external influences disappear). In this embodiment, multiple pieces of detected position information are acquired within a predetermined period of time, and multiple pieces of corresponding piece of position information are obtained, and the average distance information of the pieces of position information is used as the distance information between the two arms. In this way, It can reduce the influence of measurement errors and accidental factors.
其中,为了进一步防止误检测,步骤S103,所述根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,还可以包括:子步骤S1031和子步骤S1032,如图8所示。Wherein, in order to further prevent false detection, in step S103, determining whether the two arms are normally deployed according to the distance information and the calibration distance information between the two arms may further include: sub-step S1031 and sub-step S1032, as shown in FIG. 8 .
子步骤S1031:根据所述多个距离信息得到所述多个距离信息对应的标准差信息。Sub-step S1031: Obtain standard deviation information corresponding to the plurality of distance information according to the plurality of distance information.
子步骤S1032:根据所述两个机臂之间的平均距离信息、所述标定距离信息和所述对应的标准差信息,确定所述两个机臂是否正常展开。Sub-step S1032: Determine whether the two arms are normally deployed according to the average distance information between the two arms, the calibrated distance information and the corresponding standard deviation information.
标准差(Standard Deviation),在概率统计中最常使用作为统计分布程度(statistical dispersion)上的测量。标准差定义是总体各单位测量值与其平均数离差平方的算术平均数的平方根。它反映组内个体间的离散程度,是一组数据平均值分散程度的一种度量。一个较大的标准差,代表大部分数值和其平均值之间差异较大;一个较小的标准差,代表这些数值较接近平均值。Standard Deviation, most commonly used in probability statistics as a measure of statistical dispersion. The standard deviation is defined as the square root of the arithmetic mean of the squared deviation of each unit measurement of the population from its mean. It reflects the degree of dispersion among individuals in a group, and is a measure of the degree of dispersion of the average value of a group of data. A larger standard deviation means that most values are more different from their mean; a smaller standard deviation means that these values are closer to the mean.
因此,本实施例中如果标准差较大,代表多个距离信息中大部分距离信息和平均距离信息之间差异较大,外界的偶然因素影响较大;如果标准差较小,代表多个距离信息中大部分距离信息和平均距离信息之间差异较小,外界的偶然因素影响较小。在平均距离信息的基础上再结合标准差信息,能够稳定、客观反映当前两个机臂是否正常展开。因此通过这种方式,能够防止误检测。Therefore, in this embodiment, if the standard deviation is large, it means that the difference between most of the distance information and the average distance information in the plurality of distance information is large, and the influence of external accidental factors is large; if the standard deviation is small, it means that multiple distances The difference between most of the distance information and the average distance information in the information is small, and the influence of external accidental factors is small. On the basis of the average distance information, combined with the standard deviation information, it can stably and objectively reflect whether the current two arms are normally deployed. In this way, therefore, false detection can be prevented.
实际应用中,当两个机臂之间的平均距离大于标准距离且标准差比较小时,能够确定至少一个机臂没有正常展开,至少一个机臂向远离另一个机臂的方向回折;当两个机臂之间的平均距离小于标准距离且标准差比较小时,能够确定至少一个机臂没有正常展开,至少一个机臂向靠近另一个机臂的方向回折。In practical applications, when the average distance between the two arms is greater than the standard distance and the standard deviation is relatively small, it can be determined that at least one arm is not unfolded normally, and at least one arm is folded back away from the other arm; When the average distance between the arms is smaller than the standard distance and the standard deviation is relatively small, it can be determined that at least one of the arms is not unfolded normally, and at least one of the arms is folded back toward the direction close to the other.
实际应用中,还可以对两个机臂正常展开时之间的距离进行校准。即所述方法还包括:若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。In practical applications, the distance between the two arms when they are normally deployed can also be calibrated. That is, the method further includes: if an arm calibration instruction is received, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
由于随着无人机使用时间的延长,无人机的机臂会有损耗,因此可以定期或不定期在起飞前、起飞过程中对两个机臂正常展开时的距离重新进行标定,得到标定距离信息。As the UAV's use time is prolonged, the UAV's arms will be worn out, so the distance between the two arms when the two arms are normally unfolded can be re-calibrated before and during take-off regularly or irregularly, and the calibration can be obtained. distance information.
机臂校准指令可以是用户输入的,使用场景包括:地面控制端的交互界面上显示有机臂校准的虚拟按键,用户点击该按键后地面控制端生成机臂校准指令并发送给无人机。机臂校准指令也可以是自动生成的,使用场景包括:无人机上电起飞后,若检测到搜星状态满足条件,则自动触发无人机开始机臂校准。The arm calibration command can be input by the user. The usage scenarios include: a virtual button for arm calibration is displayed on the interactive interface of the ground control terminal. After the user clicks the button, the ground control terminal generates the arm calibration command and sends it to the UAV. The arm calibration command can also be automatically generated. The usage scenarios include: after the UAV is powered on and taken off, if it is detected that the star search state meets the conditions, the UAV will be automatically triggered to start the arm calibration.
其中,所述方法还包括:若接收到机臂校准指令,则控制所述无人机飞行到预设高度;所述获取所述第一定位传感器和所述第二定位传感器探测的位置 信息以得到所述标定距离信息,还可以包括:在所述无人机处于所述预设高度时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。Wherein, the method further includes: if an arm calibration instruction is received, controlling the UAV to fly to a preset height; acquiring the position information detected by the first positioning sensor and the second positioning sensor to Obtaining the calibration distance information may further include: when the UAV is at the preset altitude, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information .
控制所述无人机飞行到预设高度,在所述无人机处于所述预设高度时,获取定位传感器探测的位置信息以得到所述标定距离信息,该校准场景与无人机的实际应用场景基本一致,能够使标定距离信息与无人机飞行时两个机臂正常展开时之间的距离更加一致,为后续确定两个机臂是否正常展开提供更加符合实际的标定距离信息。Control the drone to fly to a preset altitude, and when the drone is at the preset altitude, obtain the position information detected by the positioning sensor to obtain the calibration distance information, and the calibration scene is consistent with the actual situation of the drone. The application scenarios are basically the same, which can make the calibration distance information more consistent with the distance between the two arms when the drone is flying normally, and provide more realistic calibration distance information for subsequent determination of whether the two arms are normally deployed.
其中,所述方法还包括:若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器的搜星状态;所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,还可以包括:在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。Wherein, the method further includes: if an arm calibration instruction is received, acquiring the star search status of the first positioning sensor and the second positioning sensor; acquiring the first positioning sensor and the second positioning sensor Positioning the position information detected by the sensor to obtain the calibration distance information, may further include: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, obtaining the first positioning sensor and the second positioning sensor. The second positioning sensor detects the position information to obtain the calibration distance information.
定位传感器的搜星状态可以是指接收到多少颗卫星信号以及接收到的每颗卫星信号的强弱的状态。当接收到的卫星信号颗数越多时,定位就越准确。对于需要利用卫星通讯进行定位的定位传感器(例如GPS传感器、RTK传感器,等等),必须要同时几颗卫星同时通讯才会定位相对精确。在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,再获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,通过这种方式,能够使得到的标定距离信息更加准确。The satellite search status of the positioning sensor may refer to how many satellite signals are received and the status of the strength of each received satellite signal. When the number of received satellite signals is more, the positioning is more accurate. For positioning sensors (such as GPS sensors, RTK sensors, etc.) that need to use satellite communication for positioning, the positioning must be relatively accurate only when several satellites communicate at the same time. When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is obtained to obtain the calibration distance information, and the In this way, the obtained calibration distance information can be made more accurate.
在一实施例中,对于需要利用卫星通讯进行定位的定位传感器,步骤S101,所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息,包括:在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息。通过这种方式,能够使探测的位置信息更加准确,使根据探测的位置信息得到的距离信息更加准确,使对两个机臂是否正常展开的判断更加准确。In an embodiment, for a positioning sensor that needs to use satellite communication for positioning, in step S101, the acquiring the position information detected by the first positioning sensor and the second positioning sensor includes: in the first positioning sensor When the star search status of the second positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired. In this way, the detected position information can be made more accurate, the distance information obtained according to the detected position information can be made more accurate, and the judgment of whether the two arms are normally deployed can be made more accurate.
参见图9,图9是本申请无人机的控制装置一实施例的结构示意图,所述无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,所述两个机 臂能够在折叠状态和展开状态之间切换。需要说明的是,本实施例的控制装置能够执行上述无人机机臂状态的检测方法中的步骤,相关内容的详细说明,请参见上述无人机机臂状态的检测方法的相关内容,在此不再赘叙。Referring to FIG. 9, FIG. 9 is a schematic structural diagram of an embodiment of the control device of the unmanned aerial vehicle of the present application. The two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor. The arm can be switched between a folded state and an unfolded state. It should be noted that the control device of this embodiment can execute the steps in the above-mentioned method for detecting the arm state of the UAV. For a detailed description of the relevant content, please refer to the relevant content of the above-mentioned method for detecting the arm state of the UAV, in This will not be repeated here.
所述无人机的控制装置100包括:存储器1和处理器2;处理器2与存储器1通过总线连接。The control device 100 of the drone includes: a memory 1 and a processor 2; the processor 2 and the memory 1 are connected through a bus.
其中,处理器2可以是微控制单元、中央处理单元或数字信号处理器,等等。Wherein, the processor 2 may be a microcontroller unit, a central processing unit or a digital signal processor, and so on.
其中,存储器1可以是Flash芯片、只读存储器、磁盘、光盘、U盘或者移动硬盘等等。Wherein, the memory 1 may be a Flash chip, a read-only memory, a magnetic disk, an optical disk, a U disk, a mobile hard disk, and the like.
所述存储器1用于存储计算机程序;所述处理器2用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The memory 1 is used to store a computer program; the processor 2 is used to execute the computer program and implement the following steps when executing the computer program:
获取所述第一定位传感器和所述第二定位传感器探测的位置信息;根据所述位置信息得到所述两个机臂之间的距离信息;根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Obtain the position information detected by the first positioning sensor and the second positioning sensor; obtain the distance information between the two arms according to the position information; according to the distance information between the two arms and The calibration distance information is used to determine whether the two arms are normally deployed, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若确定所述两个机臂中的至少一个没有正常展开,则根据所述无人机的状态,控制所述无人机执行对应的安全操作,所述无人机的状态包括未起飞状态和飞行状态。Wherein, when executing the computer program, the processor implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, controlling the UAV according to the state of the UAV A corresponding safety operation is performed, and the state of the UAV includes a non-take-off state and a flight state.
其中,若所述无人机的状态为未起飞状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:不响应起飞指令;以及通过应用程序输出提示信息,所述提示信息用于提示用户检查机臂。Wherein, if the state of the UAV is not taking off, the processor implements at least one of the following steps when executing the computer program: not responding to the take-off command; and outputting prompt information through the application program, so that The above prompt information is used to prompt the user to check the machine arm.
其中,若所述无人机的状态为飞行状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:调整所述无人机动力组件的动力输出以自动控制所述无人机降落;限制所述无人机的速度和加速度;以及通过应用程序输出提示信息,所述提示信息用于提示用户控制所述无人机进行降落。Wherein, if the state of the UAV is a flying state, the processor implements at least one of the following steps when executing the computer program: adjusting the power output of the UAV power assembly to automatically control the the drone to land; limit the speed and acceleration of the drone; and output prompt information through the application program, the prompt information is used to prompt the user to control the drone to land.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若确定所述两个机臂中的至少一个没有正常展开,则确定机臂回折级别;根据所述机臂回折级别,控制所述无人机执行对应的安全操作。Wherein, when executing the computer program, the processor implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, determining the level of the arm folding back; The drones perform corresponding safety operations.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若所述回折 级别为第一回折级别,则控制所述无人机执行第一安全操作;若所述回折级别为第二回折级别,则控制所述无人机执行第二安全操作,所述第二回折级别高于第一回折级别,所述第二安全操作不同于所述第一安全操作。Wherein, when executing the computer program, the processor implements the following steps: if the turn-back level is a first turn-back level, controlling the drone to perform a first safety operation; if the turn-back level is a second turn-back level If the back-turning level is set, the drone is controlled to perform a second safe operation, the second back-turning level is higher than the first back-turning level, and the second safe operation is different from the first safe operation.
其中,所述第一安全操作包括:限制所述无人机的速度和加速度。Wherein, the first safety operation includes: limiting the speed and acceleration of the drone.
其中,所述第二安全操作包括:调整所述无人机动力组件的动力输出以自动控制所述无人机降落。Wherein, the second safety operation includes: adjusting the power output of the unmanned aerial vehicle power assembly to automatically control the landing of the unmanned aerial vehicle.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:在预定时间长度内获取所述第一定位传感器和所述第二定位传感器探测的多个位置信息;所述根据所述位置信息得到所述两个机臂之间的距离信息,包括:根据所述多个位置信息得到所述两个机臂之间的多个距离信息;根据所述多个距离信息确定所述两个机臂之间的平均距离信息,将所述两个机臂之间的平均距离信息作为所述两个机臂之间的距离信息。Wherein, when executing the computer program, the processor implements the following steps: acquiring multiple pieces of position information detected by the first positioning sensor and the second positioning sensor within a predetermined time length; Obtaining the distance information between the two arms from the information includes: obtaining a plurality of distance information between the two arms according to the plurality of position information; determining the two arms according to the plurality of distance information The average distance information between the arms, and the average distance information between the two arms is used as the distance information between the two arms.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:根据所述多个距离信息得到所述多个距离信息对应的标准差信息;根据所述两个机臂之间的平均距离信息、所述标定距离信息和所述对应的标准差信息,确定所述两个机臂是否正常展开。Wherein, when executing the computer program, the processor implements the following steps: obtaining standard deviation information corresponding to the plurality of distance information according to the plurality of distance information; according to the average distance between the two arms information, the calibration distance information and the corresponding standard deviation information to determine whether the two arms are normally deployed.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。Wherein, when executing the computer program, the processor implements the following steps: if an arm calibration instruction is received, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若接收到机臂校准指令,则控制所述无人机飞行到预设高度;所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:在所述无人机处于所述预设高度时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。Wherein, when executing the computer program, the processor implements the following steps: if receiving an arm calibration instruction, controlling the UAV to fly to a preset height; acquiring the first positioning sensor and the Obtaining the calibration distance information from the position information detected by the second positioning sensor includes: when the UAV is at the preset altitude, obtaining the positions detected by the first positioning sensor and the second positioning sensor information to obtain the calibration distance information.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器的搜星状态;所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位 置信息以得到所述标定距离信息。Wherein, when executing the computer program, the processor implements the following steps: obtaining the star search status of the first positioning sensor and the second positioning sensor if the arm calibration instruction is received; Obtaining the calibration distance information from the position information detected by the first positioning sensor and the second positioning sensor includes: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, obtaining all the information about the calibration distance. position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
其中,所述第一定位传感器和所述第二定位传感器包括RTK传感器。Wherein, the first positioning sensor and the second positioning sensor include RTK sensors.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息。Wherein, when executing the computer program, the processor implements the following steps: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, acquire the first positioning sensor and the second positioning sensor. The position information detected by the second positioning sensor.
其中,所述第一定位传感器和所述第二定位传感器分别设置在所述无人机的两个机臂的末端。Wherein, the first positioning sensor and the second positioning sensor are respectively arranged at the ends of the two arms of the drone.
其中,所述两个机臂安装有动力组件,所述两个机臂的折叠方向与所述动力组件输出动力时对所述机臂的作用力的方向一致。Wherein, power assemblies are installed on the two arms, and the folding directions of the two arms are consistent with the direction of the force acting on the arms when the power assemblies output power.
参见图10,图10是本申请无人机一实施例的结构示意图。结合参见图2至图4,所述无人机200的两个机臂10分别设置有第一定位传感器20和第二定位传感器30,所述两个机臂10能够在折叠状态和展开状态之间切换。需要说明的是,本实施例的无人机能够执行上述无人机机臂状态的检测方法中的步骤,相关内容的详细说明,请参见上述无人机机臂状态的检测方法的相关内容,在此不再赘叙。Referring to FIG. 10 , FIG. 10 is a schematic structural diagram of an embodiment of the unmanned aerial vehicle of the present application. 2 to 4 , the two arms 10 of the UAV 200 are respectively provided with a first positioning sensor 20 and a second positioning sensor 30 , and the two arms 10 can be in either a folded state or an unfolded state. switch between. It should be noted that the UAV of this embodiment can execute the steps in the above-mentioned method for detecting the state of the UAV's arm. For a detailed description of the relevant content, please refer to the relevant content of the above-mentioned method for detecting the state of the UAV's arm. I won't go into details here.
所述无人机200还包括:存储器11和处理器22;处理器22与存储器11通过总线连接。The drone 200 further includes: a memory 11 and a processor 22; the processor 22 is connected to the memory 11 through a bus.
其中,处理器22可以是微控制单元、中央处理单元或数字信号处理器,等等。Wherein, the processor 22 may be a microcontroller unit, a central processing unit or a digital signal processor, and so on.
其中,存储器11可以是Flash芯片、只读存储器、磁盘、光盘、U盘或者移动硬盘等等。Wherein, the memory 11 may be a Flash chip, a read-only memory, a magnetic disk, an optical disk, a U disk, a mobile hard disk, or the like.
所述存储器11用于存储计算机程序;所述处理器22用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The memory 11 is used to store a computer program; the processor 22 is used to execute the computer program and implement the following steps when executing the computer program:
获取所述第一定位传感器和所述第二定位传感器探测的位置信息;根据所述位置信息得到所述两个机臂之间的距离信息;根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Obtain the position information detected by the first positioning sensor and the second positioning sensor; obtain the distance information between the two arms according to the position information; according to the distance information between the two arms and The calibration distance information is used to determine whether the two arms are normally deployed, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若确定所述两个机臂中的至少一个没有正常展开,则根据所述无人机的状态,控制所述无 人机执行对应的安全操作,所述无人机的状态包括未起飞状态和飞行状态。Wherein, when executing the computer program, the processor implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, controlling the UAV according to the state of the UAV A corresponding safety operation is performed, and the state of the UAV includes a non-take-off state and a flying state.
其中,若所述无人机的状态为未起飞状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:不响应起飞指令;以及通过应用程序输出提示信息,所述提示信息用于提示用户检查机臂。Wherein, if the state of the UAV is not taking off, the processor implements at least one of the following steps when executing the computer program: not responding to the take-off command; and outputting prompt information through the application program, so that The above prompt information is used to prompt the user to check the machine arm.
其中,若所述无人机的状态为飞行状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:调整所述无人机动力组件的动力输出以自动控制所述无人机降落;限制所述无人机的速度和加速度;以及通过应用程序输出提示信息,所述提示信息用于提示用户控制所述无人机进行降落。Wherein, if the state of the UAV is a flying state, the processor implements at least one of the following steps when executing the computer program: adjusting the power output of the UAV power assembly to automatically control the the drone to land; limit the speed and acceleration of the drone; and output prompt information through the application program, the prompt information is used to prompt the user to control the drone to land.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若确定所述两个机臂中的至少一个没有正常展开,则确定机臂回折级别;根据所述机臂回折级别,控制所述无人机执行对应的安全操作。Wherein, when executing the computer program, the processor implements the following steps: if it is determined that at least one of the two arms is not unfolded normally, determining the level of the arm folding back; The drones perform corresponding safety operations.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若所述回折级别为第一回折级别,则控制所述无人机执行第一安全操作;若所述回折级别为第二回折级别,则控制所述无人机执行第二安全操作,所述第二回折级别高于第一回折级别,所述第二安全操作不同于所述第一安全操作。Wherein, when executing the computer program, the processor implements the following steps: if the turn-back level is a first turn-back level, controlling the drone to perform a first safety operation; if the turn-back level is a second turn-back level If the back-turning level is set, the drone is controlled to perform a second safe operation, the second back-turning level is higher than the first back-turning level, and the second safe operation is different from the first safe operation.
其中,所述第一安全操作包括:限制所述无人机的速度和加速度。Wherein, the first safety operation includes: limiting the speed and acceleration of the drone.
其中,所述第二安全操作包括:调整所述无人机动力组件的动力输出以自动控制所述无人机降落。Wherein, the second safety operation includes: adjusting the power output of the unmanned aerial vehicle power assembly to automatically control the landing of the unmanned aerial vehicle.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:在预定时间长度内获取所述第一定位传感器和所述第二定位传感器探测的多个位置信息;所述根据所述位置信息得到所述两个机臂之间的距离信息,包括:根据所述多个位置信息得到所述两个机臂之间的多个距离信息;根据所述多个距离信息确定所述两个机臂之间的平均距离信息,将所述两个机臂之间的平均距离信息作为所述两个机臂之间的距离信息。Wherein, when executing the computer program, the processor implements the following steps: acquiring multiple pieces of position information detected by the first positioning sensor and the second positioning sensor within a predetermined time length; Obtaining the distance information between the two arms from the information includes: obtaining a plurality of distance information between the two arms according to the plurality of position information; determining the two arms according to the plurality of distance information The average distance information between the arms, and the average distance information between the two arms is used as the distance information between the two arms.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:根据所述多个距离信息得到所述多个距离信息对应的标准差信息;根据所述两个机臂之间的平均距离信息、所述标定距离信息和所述对应的标准差信息,确定所述两个机臂是否正常展开。Wherein, when executing the computer program, the processor implements the following steps: obtaining standard deviation information corresponding to the plurality of distance information according to the plurality of distance information; according to the average distance between the two arms information, the calibration distance information and the corresponding standard deviation information to determine whether the two arms are normally deployed.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若接收到机 臂校准指令,则获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。Wherein, when executing the computer program, the processor implements the following steps: if an arm calibration instruction is received, acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若接收到机臂校准指令,则控制所述无人机飞行到预设高度;所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:在所述无人机处于所述预设高度时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。Wherein, when executing the computer program, the processor implements the following steps: if receiving an arm calibration instruction, controlling the UAV to fly to a preset height; obtaining the first positioning sensor and the Obtaining the calibration distance information from the position information detected by the second positioning sensor includes: when the UAV is at the preset altitude, obtaining the positions detected by the first positioning sensor and the second positioning sensor information to obtain the calibration distance information.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器的搜星状态;所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。Wherein, when executing the computer program, the processor implements the following steps: obtaining the star search status of the first positioning sensor and the second positioning sensor if an arm calibration instruction is received; Obtaining the calibration distance information by obtaining the position information detected by the first positioning sensor and the second positioning sensor includes: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, obtaining all the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information.
其中,所述第一定位传感器和所述第二定位传感器包括RTK传感器。Wherein, the first positioning sensor and the second positioning sensor include RTK sensors.
其中,所述处理器在执行所述计算机程序时,实现如下步骤:在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息。Wherein, when executing the computer program, the processor implements the following steps: when the star search states of the first positioning sensor and the second positioning sensor meet the requirements, acquire the first positioning sensor and the second positioning sensor. The position information detected by the second positioning sensor.
其中,所述第一定位传感器和所述第二定位传感器分别设置在所述无人机的两个机臂的末端。Wherein, the first positioning sensor and the second positioning sensor are respectively arranged at the ends of the two arms of the drone.
其中,所述两个机臂安装有动力组件,所述两个机臂的折叠方向与所述动力组件输出动力时对所述机臂的作用力的方向一致。Wherein, power assemblies are installed on the two arms, and the folding directions of the two arms are consistent with the direction of the force acting on the arms when the power assemblies output power.
本申请还提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如上任一项所述的无人机机臂状态的检测方法。相关内容的详细说明请参见上述相关内容部分,在此不再赘叙。The present application also provides a computer-readable storage medium, where the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor enables the processor to implement the UAV as described in any of the above Arm state detection method. For a detailed description of the relevant content, please refer to the above-mentioned relevant content section, which will not be repeated here.
其中,该计算机可读存储介质可以是上述控制装置或无人机的内部存储单元,例如硬盘或内存。该计算机可读存储介质也可以是外部存储设备,例如配备的插接式硬盘、智能存储卡、安全数字卡、闪存卡,等等。Wherein, the computer-readable storage medium may be the above-mentioned control device or an internal storage unit of the drone, such as a hard disk or a memory. The computer-readable storage medium may also be an external storage device, such as an equipped plug-in hard disk, smart memory card, secure digital card, flash memory card, and the like.
应当理解,在本申请说明书中所使用的术语仅仅是出于描述特定实施例的 目的而并不意在限制本申请。It should be understood that the terms used in the specification of the present application are only for the purpose of describing particular embodiments and are not intended to limit the present application.
还应当理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。It will also be understood that, as used in this specification and the appended claims, the term "and/or" refers to and including any and all possible combinations of one or more of the associated listed items.
以上所述,仅为本申请的具体实施例,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以权利要求的保护范围为准。The above are only specific embodiments of the present application, but the protection scope of the present application is not limited thereto. Any person skilled in the art can easily think of various equivalents within the technical scope disclosed in the present application. Modifications or substitutions shall be covered by the protection scope of this application. Therefore, the protection scope of the present application shall be subject to the protection scope of the claims.

Claims (52)

  1. 一种无人机机臂状态的检测方法,其特征在于,所述无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,所述两个机臂能够在折叠状态和展开状态之间切换,所述方法包括:A method for detecting the state of an arm of an unmanned aerial vehicle, characterized in that, two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be in a folded state and Switching between expanded states, the method includes:
    获取所述第一定位传感器和所述第二定位传感器探测的位置信息;acquiring position information detected by the first positioning sensor and the second positioning sensor;
    根据所述位置信息得到所述两个机臂之间的距离信息;obtain the distance information between the two arms according to the position information;
    根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
  2. 根据权利要求1所述的方法,其特征在于,所述方法还包括:The method according to claim 1, wherein the method further comprises:
    若确定所述两个机臂中的至少一个没有正常展开,则根据所述无人机的状态,控制所述无人机执行对应的安全操作,所述无人机的状态包括未起飞状态和飞行状态。If it is determined that at least one of the two arms is not unfolded normally, the drone is controlled to perform a corresponding safety operation according to the state of the drone, which includes a state of not taking off and a state of being unmanned. flight status.
  3. 根据权利要求2所述的方法,其特征在于,若所述无人机的状态为未起飞状态,则所述安全操作包括以下至少之一:The method according to claim 2, wherein if the state of the UAV is not taking off, the safety operation includes at least one of the following:
    不响应起飞指令;以及not responding to takeoff orders; and
    通过应用程序输出提示信息,所述提示信息用于提示用户检查机臂。The prompt information is output through the application program, and the prompt information is used to prompt the user to check the machine arm.
  4. 根据权利要求2所述的方法,其特征在于,若所述无人机的状态为飞行状态,则所述安全操作包括以下至少之一:The method according to claim 2, wherein if the state of the drone is a flying state, the safety operation includes at least one of the following:
    调整所述无人机动力组件的动力输出以自动控制所述无人机降落;adjusting the power output of the UAV power assembly to automatically control the UAV to land;
    限制所述无人机的速度和加速度;以及limit the speed and acceleration of the drone; and
    通过应用程序输出提示信息,所述提示信息用于提示用户控制所述无人机进行降落。The prompt information is output through the application, and the prompt information is used to prompt the user to control the drone to land.
  5. 根据权利要求1所述的方法,其特征在于,所述方法还包括:The method according to claim 1, wherein the method further comprises:
    若确定所述两个机臂中的至少一个没有正常展开,则确定机臂回折级别;If it is determined that at least one of the two arms is not unfolded normally, determining the level of the arm folding back;
    根据所述机臂回折级别,控制所述无人机执行对应的安全操作。The drone is controlled to perform a corresponding safety operation according to the level of retraction of the arm.
  6. 根据权利要求5所述的方法,其特征在于,所述根据所述机臂回折级别,控制所述无人机执行对应的安全操作,包括:The method according to claim 5, wherein the controlling the unmanned aerial vehicle to perform a corresponding safety operation according to the arm return level, comprising:
    若所述回折级别为第一回折级别,则控制所述无人机执行第一安全操作;If the turn-back level is the first turn-back level, controlling the drone to perform a first safety operation;
    若所述回折级别为第二回折级别,则控制所述无人机执行第二安全操作,所述第二回折级别高于第一回折级别,所述第二安全操作不同于所述第一安全操作。If the reversing level is the second reversing level, the drone is controlled to perform a second safety operation, the second reversing level is higher than the first reversing level, and the second safe operation is different from the first safety operation operate.
  7. 根据权利要求6所述的方法,其特征在于,所述第一安全操作包括:The method of claim 6, wherein the first security operation comprises:
    限制所述无人机的速度和加速度。Limit the speed and acceleration of the drone.
  8. 根据权利要求6所述的方法,其特征在于,所述第二安全操作包括:The method of claim 6, wherein the second security operation comprises:
    调整所述无人机动力组件的动力输出以自动控制所述无人机降落。The power output of the drone power assembly is adjusted to automatically control the landing of the drone.
  9. 根据权利要求1所述的方法,其特征在于,所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息,包括:The method according to claim 1, wherein the acquiring the position information detected by the first positioning sensor and the second positioning sensor comprises:
    在预定时间长度内获取所述第一定位传感器和所述第二定位传感器探测的多个位置信息;Acquiring a plurality of position information detected by the first positioning sensor and the second positioning sensor within a predetermined length of time;
    所述根据所述位置信息得到所述两个机臂之间的距离信息,包括:The obtaining the distance information between the two arms according to the position information includes:
    根据所述多个位置信息得到所述两个机臂之间的多个距离信息;Obtaining a plurality of distance information between the two arms according to the plurality of position information;
    根据所述多个距离信息确定所述两个机臂之间的平均距离信息,将所述两个机臂之间的平均距离信息作为所述两个机臂之间的距离信息。The average distance information between the two arms is determined according to the plurality of distance information, and the average distance information between the two arms is used as the distance information between the two arms.
  10. 根据权利要求9所述的方法,其特征在于,所述根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,包括:The method according to claim 9, wherein the determining whether the two arms are normally deployed according to the distance information and the calibration distance information between the two arms comprises:
    根据所述多个距离信息得到所述多个距离信息对应的标准差信息;obtaining standard deviation information corresponding to the plurality of distance information according to the plurality of distance information;
    根据所述两个机臂之间的平均距离信息、所述标定距离信息和所述对应的标准差信息,确定所述两个机臂是否正常展开。Whether the two arms are normally deployed is determined according to the average distance information between the two arms, the calibration distance information and the corresponding standard deviation information.
  11. 根据权利要求1所述的方法,其特征在于,所述方法还包括:The method according to claim 1, wherein the method further comprises:
    若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。If the arm calibration instruction is received, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  12. 根据权利要求11所述的方法,其特征在于,所述方法还包括:The method according to claim 11, wherein the method further comprises:
    若接收到机臂校准指令,则控制所述无人机飞行到预设高度;If receiving the arm calibration instruction, control the drone to fly to a preset altitude;
    所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:The acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information includes:
    在所述无人机处于所述预设高度时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。When the UAV is at the preset altitude, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  13. 根据权利要求11所述的方法,其特征在于,所述方法还包括:The method according to claim 11, wherein the method further comprises:
    若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器的搜星状态;If the arm calibration instruction is received, obtain the star search status of the first positioning sensor and the second positioning sensor;
    所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:The acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information includes:
    在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  14. 根据权利要求1所述的方法,其特征在于,所述第一定位传感器和所述第二定位传感器包括RTK传感器。The method of claim 1, wherein the first positioning sensor and the second positioning sensor comprise RTK sensors.
  15. 根据权利要求1所述的方法,其特征在于,所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息,包括:The method according to claim 1, wherein the acquiring the position information detected by the first positioning sensor and the second positioning sensor comprises:
    在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息。When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired.
  16. 根据权利要求1所述的方法,其特征在于,所述第一定位传感器和所述第二定位传感器分别设置在所述无人机的两个机臂的末端。The method according to claim 1, wherein the first positioning sensor and the second positioning sensor are respectively disposed at the ends of two arms of the drone.
  17. 根据权利要求1所述的方法,其特征在于,所述两个机臂安装有动力组件,所述两个机臂的折叠方向与所述动力组件输出动力时对所述机臂的作用力的方向一致。The method according to claim 1, wherein a power assembly is installed on the two arms, and the folding direction of the two arms is proportional to the force on the arms when the power assembly outputs power the same direction.
  18. 一种无人机的控制装置,其特征在于,所述无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,所述两个机臂能够在折叠状态和展开状态之间切换,所述无人机的控制装置包括:存储器和处理器;A control device for an unmanned aerial vehicle, characterized in that the two arms of the unmanned aerial vehicle are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be in a folded state or an unfolded state. switching between the two, the control device of the UAV includes: a memory and a processor;
    所述存储器用于存储计算机程序;the memory is used to store computer programs;
    所述处理器用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and implement the following steps when executing the computer program:
    获取所述第一定位传感器和所述第二定位传感器探测的位置信息;acquiring position information detected by the first positioning sensor and the second positioning sensor;
    根据所述位置信息得到所述两个机臂之间的距离信息;obtain the distance information between the two arms according to the position information;
    根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
  19. 根据权利要求18所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 18, wherein the processor implements the following steps when executing the computer program:
    若确定所述两个机臂中的至少一个没有正常展开,则根据所述无人机的状态,控制所述无人机执行对应的安全操作,所述无人机的状态包括未起飞状态和飞行状态。If it is determined that at least one of the two arms is not unfolded normally, the drone is controlled to perform a corresponding safety operation according to the state of the drone, which includes a state of not taking off and a state of being unmanned. flight status.
  20. 根据权利要求19所述的控制装置,其特征在于,若所述无人机的状态为未起飞状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:The control device according to claim 19, wherein if the state of the unmanned aerial vehicle is not taking off, the processor implements at least one of the following steps when executing the computer program:
    不响应起飞指令;以及not responding to takeoff orders; and
    通过应用程序输出提示信息,所述提示信息用于提示用户检查机臂。The prompt information is output through the application program, and the prompt information is used to prompt the user to check the machine arm.
  21. 根据权利要求19所述的控制装置,其特征在于,若所述无人机的状态为飞行状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:The control device according to claim 19, wherein if the state of the UAV is a flying state, the processor implements at least one of the following steps when executing the computer program:
    调整所述无人机动力组件的动力输出以自动控制所述无人机降落;adjusting the power output of the UAV power assembly to automatically control the UAV to land;
    限制所述无人机的速度和加速度;以及limit the speed and acceleration of the drone; and
    通过应用程序输出提示信息,所述提示信息用于提示用户控制所述无人机进行降落。The prompt information is output through the application, and the prompt information is used to prompt the user to control the drone to land.
  22. 根据权利要求18所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 18, wherein the processor implements the following steps when executing the computer program:
    若确定所述两个机臂中的至少一个没有正常展开,则确定机臂回折级别;If it is determined that at least one of the two arms is not unfolded normally, determining the level of the arm folding back;
    根据所述机臂回折级别,控制所述无人机执行对应的安全操作。The drone is controlled to perform a corresponding safety operation according to the level of retraction of the arm.
  23. 根据权利要求22所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 22, wherein the processor implements the following steps when executing the computer program:
    若所述回折级别为第一回折级别,则控制所述无人机执行第一安全操作;If the turn-back level is the first turn-back level, controlling the drone to perform a first safety operation;
    若所述回折级别为第二回折级别,则控制所述无人机执行第二安全操作,所述第二回折级别高于第一回折级别,所述第二安全操作不同于所述第一安全操作。If the reversing level is the second reversing level, the drone is controlled to perform a second safety operation, the second reversing level is higher than the first reversing level, and the second safe operation is different from the first safety operation operate.
  24. 根据权利要求23所述的控制装置,其特征在于,所述第一安全操作包括:The control device of claim 23, wherein the first safety operation comprises:
    限制所述无人机的速度和加速度。Limit the speed and acceleration of the drone.
  25. 根据权利要求23所述的控制装置,其特征在于,所述第二安全操作包括:The control device of claim 23, wherein the second safety operation comprises:
    调整所述无人机动力组件的动力输出以自动控制所述无人机降落。The power output of the drone power assembly is adjusted to automatically control the landing of the drone.
  26. 根据权利要求18所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 18, wherein the processor implements the following steps when executing the computer program:
    在预定时间长度内获取所述第一定位传感器和所述第二定位传感器探测的多个位置信息;Acquire a plurality of position information detected by the first positioning sensor and the second positioning sensor within a predetermined length of time;
    所述根据所述位置信息得到所述两个机臂之间的距离信息,包括:The obtaining the distance information between the two arms according to the position information includes:
    根据所述多个位置信息得到所述两个机臂之间的多个距离信息;Obtaining a plurality of distance information between the two arms according to the plurality of position information;
    根据所述多个距离信息确定所述两个机臂之间的平均距离信息,将所述两个机臂之间的平均距离信息作为所述两个机臂之间的距离信息。The average distance information between the two arms is determined according to the plurality of distance information, and the average distance information between the two arms is used as the distance information between the two arms.
  27. 根据权利要求26所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 26, wherein the processor implements the following steps when executing the computer program:
    根据所述多个距离信息得到所述多个距离信息对应的标准差信息;obtaining standard deviation information corresponding to the plurality of distance information according to the plurality of distance information;
    根据所述两个机臂之间的平均距离信息、所述标定距离信息和所述对应的标准差信息,确定所述两个机臂是否正常展开。Whether the two arms are normally deployed is determined according to the average distance information between the two arms, the calibration distance information and the corresponding standard deviation information.
  28. 根据权利要求18所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 18, wherein the processor implements the following steps when executing the computer program:
    若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。If the arm calibration instruction is received, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  29. 根据权利要求28所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 28, wherein the processor implements the following steps when executing the computer program:
    若接收到机臂校准指令,则控制所述无人机飞行到预设高度;If receiving the arm calibration instruction, control the drone to fly to a preset altitude;
    所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:The acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information includes:
    在所述无人机处于所述预设高度时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。When the UAV is at the preset altitude, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  30. 根据权利要求28所述的控制装置,其特征在于,所述处理器在执行 所述计算机程序时,实现如下步骤:The control device according to claim 28, wherein the processor implements the following steps when executing the computer program:
    若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器的搜星状态;If the arm calibration instruction is received, obtain the star search status of the first positioning sensor and the second positioning sensor;
    所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:The acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information includes:
    在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  31. 根据权利要求18所述的控制装置,其特征在于,所述第一定位传感器和所述第二定位传感器包括RTK传感器。19. The control device of claim 18, wherein the first positioning sensor and the second positioning sensor comprise RTK sensors.
  32. 根据权利要求18所述的控制装置,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The control device according to claim 18, wherein the processor implements the following steps when executing the computer program:
    在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息。When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired.
  33. 根据权利要求18所述的控制装置,其特征在于,所述第一定位传感器和所述第二定位传感器分别设置在所述无人机的两个机臂的末端。The control device according to claim 18, wherein the first positioning sensor and the second positioning sensor are respectively disposed at the ends of the two arms of the drone.
  34. 根据权利要求18所述的控制装置,其特征在于,所述两个机臂安装有动力组件,所述两个机臂的折叠方向与所述动力组件输出动力时对所述机臂的作用力的方向一致。The control device according to claim 18, wherein a power assembly is installed on the two arms, and the folding direction of the two arms is related to the force on the arms when the power assembly outputs power direction is the same.
  35. 一种无人机,其特征在于,所述无人机的两个机臂分别设置有第一定位传感器和第二定位传感器,所述两个机臂能够在折叠状态和展开状态之间切换,所述无人机包括:存储器和处理器;A UAV, characterized in that the two arms of the UAV are respectively provided with a first positioning sensor and a second positioning sensor, and the two arms can be switched between a folded state and an unfolded state, The UAV includes: a memory and a processor;
    所述存储器用于存储计算机程序;the memory is used to store computer programs;
    所述处理器用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and implement the following steps when executing the computer program:
    获取所述第一定位传感器和所述第二定位传感器探测的位置信息;acquiring position information detected by the first positioning sensor and the second positioning sensor;
    根据所述位置信息得到所述两个机臂之间的距离信息;obtain the distance information between the two arms according to the position information;
    根据所述两个机臂之间的距离信息和标定距离信息,确定所述两个机臂是否正常展开,所述标定距离信息用于指示所述两个机臂正常展开时的距离。Whether the two arms are normally deployed is determined according to the distance information between the two arms and the calibration distance information, and the calibration distance information is used to indicate the distance when the two arms are normally deployed.
  36. 根据权利要求35所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 35, wherein, when the processor executes the computer program, the following steps are implemented:
    若确定所述两个机臂中的至少一个没有正常展开,则根据所述无人机的状态,控制所述无人机执行对应的安全操作,所述无人机的状态包括未起飞状态和飞行状态。If it is determined that at least one of the two arms is not unfolded normally, the drone is controlled to perform a corresponding safety operation according to the state of the drone, which includes a state of not taking off and a state of being unmanned. flight status.
  37. 根据权利要求36所述的无人机,其特征在于,若所述无人机的状态为未起飞状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:The unmanned aerial vehicle according to claim 36, wherein, if the state of the unmanned aerial vehicle is a non-take-off state, the processor implements at least one of the following steps when executing the computer program:
    不响应起飞指令;以及not responding to takeoff orders; and
    通过应用程序输出提示信息,所述提示信息用于提示用户检查机臂。The prompt information is output through the application program, and the prompt information is used to prompt the user to check the machine arm.
  38. 根据权利要求36所述的无人机,其特征在于,若所述无人机的状态为飞行状态,则所述处理器在执行所述计算机程序时,实现如下至少之一的步骤:The unmanned aerial vehicle according to claim 36, wherein if the state of the unmanned aerial vehicle is a flying state, the processor implements at least one of the following steps when executing the computer program:
    调整所述无人机动力组件的动力输出以自动控制所述无人机降落;adjusting the power output of the UAV power assembly to automatically control the UAV to land;
    限制所述无人机的速度和加速度;以及limit the speed and acceleration of the drone; and
    通过应用程序输出提示信息,所述提示信息用于提示用户控制所述无人机进行降落。The prompt information is output through the application, and the prompt information is used to prompt the user to control the drone to land.
  39. 根据权利要求35所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 35, wherein, when the processor executes the computer program, the following steps are implemented:
    若确定所述两个机臂中的至少一个没有正常展开,则确定机臂回折级别;If it is determined that at least one of the two arms is not unfolded normally, determining the level of the arm folding back;
    根据所述机臂回折级别,控制所述无人机执行对应的安全操作。The drone is controlled to perform a corresponding safety operation according to the level of retraction of the arm.
  40. 根据权利要求39所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The drone according to claim 39, wherein when the processor executes the computer program, the following steps are implemented:
    若所述回折级别为第一回折级别,则控制所述无人机执行第一安全操作;If the turn-back level is the first turn-back level, controlling the drone to perform a first safety operation;
    若所述回折级别为第二回折级别,则控制所述无人机执行第二安全操作,所述第二回折级别高于第一回折级别,所述第二安全操作不同于所述第一安全操作。If the reversing level is the second reversing level, the drone is controlled to perform a second safety operation, the second reversing level is higher than the first reversing level, and the second safe operation is different from the first safety operation operate.
  41. 根据权利要求40所述的无人机,其特征在于,所述第一安全操作包括:The drone of claim 40, wherein the first safety operation comprises:
    限制所述无人机的速度和加速度。Limit the speed and acceleration of the drone.
  42. 根据权利要求40所述的无人机,其特征在于,所述第二安全操作包括:The drone of claim 40, wherein the second safety operation comprises:
    调整所述无人机动力组件的动力输出以自动控制所述无人机降落。The power output of the drone power assembly is adjusted to automatically control the landing of the drone.
  43. 根据权利要求35所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 35, wherein, when the processor executes the computer program, the following steps are implemented:
    在预定时间长度内获取所述第一定位传感器和所述第二定位传感器探测的多个位置信息;Acquire a plurality of position information detected by the first positioning sensor and the second positioning sensor within a predetermined length of time;
    所述根据所述位置信息得到所述两个机臂之间的距离信息,包括:The obtaining the distance information between the two arms according to the position information includes:
    根据所述多个位置信息得到所述两个机臂之间的多个距离信息;Obtaining a plurality of distance information between the two arms according to the plurality of position information;
    根据所述多个距离信息确定所述两个机臂之间的平均距离信息,将所述两个机臂之间的平均距离信息作为所述两个机臂之间的距离信息。The average distance information between the two arms is determined according to the plurality of distance information, and the average distance information between the two arms is used as the distance information between the two arms.
  44. 根据权利要求43所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 43, wherein, when the processor executes the computer program, the following steps are implemented:
    根据所述多个距离信息得到所述多个距离信息对应的标准差信息;obtaining standard deviation information corresponding to the plurality of distance information according to the plurality of distance information;
    根据所述两个机臂之间的平均距离信息、所述标定距离信息和所述对应的标准差信息,确定所述两个机臂是否正常展开。Whether the two arms are normally deployed is determined according to the average distance information between the two arms, the calibration distance information and the corresponding standard deviation information.
  45. 根据权利要求35所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 35, wherein, when the processor executes the computer program, the following steps are implemented:
    若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。If the arm calibration instruction is received, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  46. 根据权利要求45所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 45, wherein the processor implements the following steps when executing the computer program:
    若接收到机臂校准指令,则控制所述无人机飞行到预设高度;If receiving the arm calibration instruction, control the drone to fly to a preset altitude;
    所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:The acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information includes:
    在所述无人机处于所述预设高度时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。When the UAV is at the preset altitude, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  47. 根据权利要求45所述的无人机,其特征在于,所述处理器在执行所 述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 45, is characterized in that, when described processor executes described computer program, realizes the following steps:
    若接收到机臂校准指令,则获取所述第一定位传感器和所述第二定位传感器的搜星状态;If the arm calibration instruction is received, obtain the star search status of the first positioning sensor and the second positioning sensor;
    所述获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息,包括:The acquiring the position information detected by the first positioning sensor and the second positioning sensor to obtain the calibration distance information includes:
    在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息以得到所述标定距离信息。When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired to obtain the calibration distance information.
  48. 根据权利要求35所述的无人机,其特征在于,所述第一定位传感器和所述第二定位传感器包括RTK传感器。36. The drone of claim 35, wherein the first positioning sensor and the second positioning sensor comprise RTK sensors.
  49. 根据权利要求35所述的无人机,其特征在于,所述处理器在执行所述计算机程序时,实现如下步骤:The unmanned aerial vehicle according to claim 35, wherein, when the processor executes the computer program, the following steps are implemented:
    在所述第一定位传感器和所述第二定位传感器的搜星状态满足要求时,获取所述第一定位传感器和所述第二定位传感器探测的位置信息。When the star search states of the first positioning sensor and the second positioning sensor meet the requirements, the position information detected by the first positioning sensor and the second positioning sensor is acquired.
  50. 根据权利要求35所述的无人机,其特征在于,所述第一定位传感器和所述第二定位传感器分别设置在所述无人机的两个机臂的末端。The drone according to claim 35, wherein the first positioning sensor and the second positioning sensor are respectively arranged at the ends of the two arms of the drone.
  51. 根据权利要求35所述的无人机,其特征在于,所述两个机臂安装有动力组件,所述两个机臂的折叠方向与所述动力组件输出动力时对所述机臂的作用力的方向一致。The unmanned aerial vehicle according to claim 35, wherein a power assembly is installed on the two arms, and the folding direction of the two arms is related to the effect of the power assembly on the arms when the power assembly outputs power The direction of the force is the same.
  52. 一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如权利要求1-17任一项所述的无人机机臂状态的检测方法。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 implements the process according to any one of claims 1-17 The detection method of the UAV arm state.
PCT/CN2020/138087 2020-12-21 2020-12-21 Method for detecting arm state of unmanned aerial vehicle, control device of unmanned aerial vehicle, and unmanned aerial vehicle WO2022133676A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2020/138087 WO2022133676A1 (en) 2020-12-21 2020-12-21 Method for detecting arm state of unmanned aerial vehicle, control device of unmanned aerial vehicle, and unmanned aerial vehicle
CN202080079887.1A CN114787036A (en) 2020-12-21 2020-12-21 Unmanned aerial vehicle arm state detection method, unmanned aerial vehicle control device and unmanned aerial vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/138087 WO2022133676A1 (en) 2020-12-21 2020-12-21 Method for detecting arm state of unmanned aerial vehicle, control device of unmanned aerial vehicle, and unmanned aerial vehicle

Publications (1)

Publication Number Publication Date
WO2022133676A1 true WO2022133676A1 (en) 2022-06-30

Family

ID=82156955

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/138087 WO2022133676A1 (en) 2020-12-21 2020-12-21 Method for detecting arm state of unmanned aerial vehicle, control device of unmanned aerial vehicle, and unmanned aerial vehicle

Country Status (2)

Country Link
CN (1) CN114787036A (en)
WO (1) WO2022133676A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024021135A1 (en) * 2022-07-29 2024-02-01 深圳市大疆创新科技有限公司 Aircraft

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105059528A (en) * 2015-07-23 2015-11-18 致导科技(北京)有限公司 Foldable unmanned aerial vehicle
CN105416558A (en) * 2015-12-11 2016-03-23 广州极飞电子科技有限公司 Unmanned aerial vehicle frame, unmanned aerial vehicle and stability augmentation control method
CN205675222U (en) * 2016-02-22 2016-11-09 深圳市大疆创新科技有限公司 Frame and use the unmanned plane of this frame
CN206218241U (en) * 2016-11-04 2017-06-06 重庆零度智控智能科技有限公司 Unmanned plane
CN206719538U (en) * 2017-03-15 2017-12-08 深圳市大疆创新科技有限公司 Propulsion system, multi-rotor unmanned aerial vehicle and external member
WO2018032415A1 (en) * 2016-08-17 2018-02-22 SZ DJI Technology Co., Ltd. Systems and methods for operating unmanned aerial vehicles

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105059528A (en) * 2015-07-23 2015-11-18 致导科技(北京)有限公司 Foldable unmanned aerial vehicle
CN105416558A (en) * 2015-12-11 2016-03-23 广州极飞电子科技有限公司 Unmanned aerial vehicle frame, unmanned aerial vehicle and stability augmentation control method
CN205675222U (en) * 2016-02-22 2016-11-09 深圳市大疆创新科技有限公司 Frame and use the unmanned plane of this frame
WO2018032415A1 (en) * 2016-08-17 2018-02-22 SZ DJI Technology Co., Ltd. Systems and methods for operating unmanned aerial vehicles
CN206218241U (en) * 2016-11-04 2017-06-06 重庆零度智控智能科技有限公司 Unmanned plane
CN206719538U (en) * 2017-03-15 2017-12-08 深圳市大疆创新科技有限公司 Propulsion system, multi-rotor unmanned aerial vehicle and external member

Also Published As

Publication number Publication date
CN114787036A (en) 2022-07-22

Similar Documents

Publication Publication Date Title
US11474516B2 (en) Flight aiding method and system for unmanned aerial vehicle, unmanned aerial vehicle, and mobile terminal
US10527720B2 (en) Millimeter-wave terrain aided navigation system
US10745127B2 (en) Systems and methods for execution of recovery actions on an unmanned aerial vehicle
JP6506302B2 (en) Method and apparatus for operating a mobile platform
JP6900608B2 (en) How to fly an unmanned aerial vehicle to stationary and moving objects
CN110738872B (en) Flight control system for an air vehicle and related methods
KR101501528B1 (en) System and method for unmanned aerial vehicle collision avoidance
US9199725B2 (en) Control computer for an unmanned vehicle
WO2018005882A1 (en) Unmanned aerial vehicle wind turbine inspection systems and methods
CN105824319B (en) Method for avoiding one or more obstacles by an aircraft, associated computer program product, electronic system and aircraft
US10656643B1 (en) Safe and secure practical autonomy
CN110597297A (en) Aircraft return control method and device, aircraft and storage medium
WO2016172251A1 (en) Systems and methods for execution of recovery actions on an unmanned aerial vehicle
JP2008207705A (en) Computer, unmanned aircraft, and automatic landing method
WO2022133676A1 (en) Method for detecting arm state of unmanned aerial vehicle, control device of unmanned aerial vehicle, and unmanned aerial vehicle
WO2021237462A1 (en) Altitude limting method and apparatus for unmanned aerial vehicle, unmanned aerial vehicle, and storage medium
WO2019000328A1 (en) Control method of unmanned aerial vehicle, control terminal, and unmanned aerial vehicle
US10132932B1 (en) Geo-fencing systems and methods for aerial vehicles
CN110658831A (en) Ground altitude correction method and device and unmanned aerial vehicle
CN112731317A (en) Vehicle radar calibration method, device, equipment, medium and automatic driving vehicle
WO2021016749A1 (en) Multi-data fusion-based positioning method, movable platform and storage medium
US10809743B1 (en) System and method for recovery from wake vortex encounters
WO2020107473A1 (en) Parameter optimization method and apparatus for mobile platform, and control device and aerial vehicle
CA3047766C (en) Piloting assistance system for an aircraft, associated aircraft and process to assist with piloting of this aircraft
CN113272625A (en) Aircraft positioning method and device, aircraft and storage medium

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

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

Country of ref document: EP

Kind code of ref document: A1