WO2021217362A1 - Method and apparatus for inspecting installation of blades of unmanned aerial vehicle - Google Patents

Method and apparatus for inspecting installation of blades of unmanned aerial vehicle Download PDF

Info

Publication number
WO2021217362A1
WO2021217362A1 PCT/CN2020/087307 CN2020087307W WO2021217362A1 WO 2021217362 A1 WO2021217362 A1 WO 2021217362A1 CN 2020087307 W CN2020087307 W CN 2020087307W WO 2021217362 A1 WO2021217362 A1 WO 2021217362A1
Authority
WO
WIPO (PCT)
Prior art keywords
angular velocity
unmanned aerial
aerial vehicle
blade
installation
Prior art date
Application number
PCT/CN2020/087307
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 CN202080026377.8A priority Critical patent/CN113853556A/en
Priority to PCT/CN2020/087307 priority patent/WO2021217362A1/en
Publication of WO2021217362A1 publication Critical patent/WO2021217362A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B23/00Testing or monitoring of control systems or parts thereof
    • G05B23/02Electric testing or monitoring

Definitions

  • This application relates to the technical field of unmanned aerial vehicles, in particular to a method and device for detecting the installation of blades of an unmanned aerial vehicle.
  • UAVs such as rotary-wing UAVs
  • the quad-rotor drone includes four blades.
  • the improper installation of the blades includes the exchange of two or more blades, the wrong installation of one or more blades, and the improper installation of the blades. If the blade is installed incorrectly, it will cause takeoff failure, which is manifested as ground roll, uncontrolled ground flight, etc., which will cause great harm to the drone itself and the surrounding environment. This problem has long existed for drones with detachable blades.
  • This application shows a method and device for detecting the installation of blades of an unmanned aerial vehicle.
  • this application shows an unmanned aerial vehicle blade installation detection method, including:
  • Acquire take-off parameters of the unmanned aerial vehicle where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
  • this application shows an unmanned aerial vehicle blade installation detection device, including:
  • the acquisition module is used to acquire the take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
  • a determining module configured to determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
  • the execution module is used to execute corresponding operations according to the blade installation information.
  • this application shows a computing processing device, including:
  • a memory in which computer-readable codes are stored
  • One or more processors and when the computer-readable code is executed by the one or more processors, the computing processing device executes the aforementioned UAV blade installation detection method.
  • this application shows an unmanned aerial vehicle including an unmanned aerial vehicle and a control terminal;
  • the unmanned aerial vehicle includes a frame, a flight controller and a sensing system, the flight controller and the transmission
  • the sensor system is arranged in the frame;
  • the flight controller can transmit signals with the sensor system and the control terminal, and the control terminal can send control signals to the flight controller to control the The flight of unmanned aerial vehicles;
  • the flight controller is used to perform the following operations:
  • Acquire take-off parameters of the unmanned aerial vehicle where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
  • the present application shows an unmanned aerial vehicle, which is characterized by comprising: a frame, a flight controller, and a sensing system, the flight controller and the sensing system are arranged in the frame;
  • the flight controller is electrically connected to the sensing system;
  • the flight controller is used to perform the following operations:
  • the take-off parameters of the unmanned aerial vehicle including the motion state parameters obtained from the sensing system and the control command parameters obtained from the flight controller;
  • the present application shows a computer program product including instructions that, when the instructions are run on a computer, cause the computer to execute the aforementioned UAV blade installation detection method.
  • this application shows a computer-readable storage medium, including instructions, which when run on a computer, cause the computer to execute the aforementioned method for detecting the installation of an unmanned aerial vehicle blade
  • the method and device for detecting the installation of unmanned aerial vehicle blades proposed in the embodiments of the present application can deal with the harm to the unmanned aerial system and the surrounding environment that may be caused by the user taking off with the wrong installation of the blades.
  • the present invention uses the movement of the unmanned aerial vehicle State parameters and control command parameters monitor the takeoff process to determine whether the takeoff is abnormal, and perform further operations when abnormal, such as stopping the propeller, to protect the UAV and the surrounding environment.
  • the solution proposed by the embodiment of the present application can also determine the installation error of one or more blades in combination with the abnormal performance of the wrong blade, and issue an error prompt to facilitate the user to check and correct.
  • Fig. 1 is a schematic architecture diagram of an unmanned aerial system of the present application
  • Fig. 2 is a top view of the frame, motor and four blades of the unmanned aerial vehicle according to the embodiment of the present application.
  • Fig. 3 is a flowchart of a method for detecting the installation of a blade of an unmanned aerial vehicle according to an embodiment of the present application.
  • FIG. 4 is a sub-flow chart of S102 of the method for detecting the installation of blades of an unmanned aerial vehicle according to an embodiment of the present application.
  • Fig. 5 is a top view of the unmanned aerial vehicle according to an embodiment of the present application when the wrong blade is installed, and a side view showing the force state.
  • Fig. 6 is a block diagram of an unmanned aerial vehicle blade installation detection device according to an embodiment of the present application.
  • Fig. 7 schematically shows a block diagram of a computing processing device for executing the method according to the present invention.
  • Fig. 8 schematically shows a storage unit for holding or carrying program codes for implementing the method according to the present invention.
  • the embodiments of the present application provide a method and device for detecting the installation of a blade of an unmanned aerial vehicle, and a method and device for detecting the installation of a blade of an unmanned aerial vehicle.
  • the method and device are applied to an unmanned aerial system.
  • the unmanned aerial vehicle may be, for example, a rotorcraft, for example, a multi-rotor drone propelled by multiple propulsion devices through the air.
  • the embodiments of the present application are not Limited to this.
  • Fig. 1 is a schematic architecture diagram of an unmanned aerial system according to an embodiment of the present application.
  • the unmanned aerial vehicle of this embodiment is described by taking a rotary-wing drone as an example.
  • the unmanned aerial vehicle 100 may include an unmanned aerial vehicle 110, a display device 130 and a control terminal 140.
  • the unmanned aerial vehicle may be an unmanned aerial vehicle, which may include a power system 150, a flight control system 160, and a frame.
  • the power system 150 and the flight control system 160 may be arranged on the frame.
  • the UAV 110 can wirelessly communicate with the control terminal 140 and the display device 130.
  • the frame may include a fuselage and a tripod (also called a landing gear).
  • the fuselage may include a center frame and one or more arms connected to the center frame, and the one or more arms extend radially from the center frame.
  • the tripod is connected to the fuselage, and is used for supporting the UAV 110 when it lands.
  • the power system 150 may include one or more electronic governors (referred to as ESCs) 151, one or more propellers 21-24, and one or more motors corresponding to the one or more propellers 21-24. 4. In this embodiment, corresponding to four propellers 21-24, the number of motors is also four. In other embodiments, the number of motors and propellers may also be other.
  • the motor 152 is connected between the electronic governor 151 and the propeller 153.
  • the motor 152 and the propeller 153 can be arranged on the arm of the UAV 110; the electronic governor 151 is used to receive the driving signal generated by the flight control system 160, and According to the driving signal, a driving current is provided to the motor 152 to control the rotation speed of the motor 152.
  • the de-driving current can also be referred to as the ESC current.
  • the motor 152 is used to drive the propeller to rotate, thereby providing power for the flight of the unmanned aerial vehicle 110, and the power enables the unmanned aerial vehicle 110 to realize one or more degrees of freedom of movement.
  • UAV 110 may rotate about one or more rotation axes.
  • the aforementioned rotation axis may include a roll axis (Roll), a yaw axis (Yaw), and a pitch axis (pitch).
  • the motor 152 may be a DC motor or an AC motor.
  • the motor 152 may be a brushless motor or a brushed motor.
  • the flight control system 160 may include a flight controller 161 and a sensing system 162.
  • the sensing system 162 is used to measure the attitude information of the unmanned aerial vehicle, that is, the position information and state information of the unmanned aerial vehicle 110 in space, such as three-dimensional position, three-dimensional angle, three-dimensional velocity, three-dimensional acceleration, and three-dimensional angular velocity.
  • the sensing system 162 may include, for example, at least one of sensors such as a gyroscope, an ultrasonic sensor, an electronic compass, an inertial measurement unit (IMU), a vision sensor, a global navigation satellite system, and a barometer.
  • the global navigation satellite system may be the Global Positioning System (GPS).
  • the flight controller 161 is used to control the flight of the unmanned aerial vehicle 110.
  • the flight of the unmanned aerial vehicle 110 can be controlled according to the attitude information measured by the sensor system 162. It should be understood that the flight controller 161 can control the unmanned aerial vehicle 110 according to pre-programmed program instructions, and can also control the unmanned aerial vehicle 110 by responding to one or more control instructions from the control terminal 140.
  • the display device 130 is located on the ground end of the unmanned aerial vehicle 100, can communicate with the unmanned aerial vehicle 110 in a wireless manner, and can be used to display the attitude information of the unmanned aerial vehicle 110.
  • the image taken by the imaging device and the like may also be displayed on the display device 130. It should be understood that the display device 130 may be an independent device or integrated in the control terminal 140.
  • the control terminal 140 is located at the ground end of the unmanned aerial vehicle 100 and can communicate with the unmanned aerial vehicle 110 in a wireless manner for remote control of the unmanned aerial vehicle 110.
  • the UAV 110 may also be equipped with a speaker (not shown in the figure), which is used to play audio files, and the speaker may be directly fixed on the UAV 110.
  • the above-mentioned naming of the components of the unmanned aerial system is only for identification purposes, and should not be understood as a limitation to the embodiments of the present application.
  • the blade detection method described in the following embodiments may be executed by, for example, the flight controller 161, and the flight controller 161 transmits the signal back to the display device 130 on the ground.
  • This solution can currently be applied to a four-rotor unmanned aerial vehicle, and there are a total of 15 situations in which the user may install the wrong blade.
  • the following takes the X configuration quadrotor as an example.
  • Figure 2 shows a schematic diagram of an unmanned aerial vehicle with a quadrotor in the X configuration.
  • label A is the nose orientation of the unmanned aerial vehicle.
  • the frame of the unmanned aerial vehicle 110 is connected to four motors, namely the first motor 1, the second motor 2, the third motor 3, and the second motor.
  • Each motor is connected with a corresponding blade, which is a first blade 21, a second blade 22, a third blade 23, and a fourth blade 24 in sequence.
  • the first to fourth here are only for distinguishing the names of the four blades, and there is no relationship in any order.
  • the directions of motor rotation of the first motor 1, the second motor 3, the third motor 3, and the fourth motor 4 are counterclockwise, clockwise, counterclockwise, and clockwise in sequence.
  • the blades used by the first motor 1 and the third motor 3 are called forward blades, and the blades used by the second motor 2 and the fourth motor 4 are called reverse blades.
  • the difference between the forward and backward propellers is that their angles of attack are positive in their respective directions of rotation.
  • Installation errors include: the blades are reversed, the blades are reversed, and so on. Specifically, it can be divided into: the two blades on the same side of the UAV are installed reversely, the two blades on the opposite side of the UAV are installed reversely, a single blade is installed incorrectly, and three or more blades are installed incorrectly. , The blade is not installed, etc.
  • the following examples illustrate.
  • the error between the control command issued by the flight controller 161 and the actual motion feedback of the UAV 110 will be within a reasonable range; after any blade is installed incorrectly, If the flight attitude angle and angular velocity are abnormal, the flight controller 161 will output a control instruction to correct the flight attitude and angular velocity. Compared with the error of the actual motion feedback of the UAV 110, the control instruction is very large. The error of the controller command and feedback during the take-off process is used to determine whether the take-off is abnormal.
  • the aforementioned attitude angle may be the attitude angle information of the unmanned aerial vehicle for each coordinate axis in the coordinate system, for example, the attitude angle of the unmanned aerial vehicle for the three coordinate axes in the XYZ coordinate system, or the space coordinates of the unmanned aerial vehicle. The relationship with the rotation angle of the ground coordinate, etc.
  • thrust-to-weight ratio the ratio of its maximum power to the weight of the entire aircraft (hereinafter referred to as thrust-to-weight ratio) must reach a certain value. It can judge the actual power output and the change of the UAV status during the take-off process to judge whether the thrust-to-weight ratio is abnormal, and further judge whether the take-off is abnormal.
  • the UAV 110 will have a large attitude angle and angular velocity change during the acceleration of the motor. By judging the magnitude and direction of the UAV's angle and angular velocity, it can be judged which blade is reversed. .
  • FIG. 3 shows a flowchart of a method for detecting the installation of a blade of an unmanned aerial vehicle according to an embodiment of the application.
  • an embodiment of the present invention proposes a method for detecting the installation of blades of an unmanned aerial vehicle, which can detect whether the blades of an unmanned aerial vehicle are installed correctly based on the foregoing principle.
  • the detection method for the installation of the blades of the unmanned aerial vehicle includes:
  • S101 Acquire take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control instruction parameters;
  • S102 Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
  • the execution subject for example, the flight controller 161 in the UAV 110 shown in FIG. 1, is used to obtain the UAV takeoff parameters of the UAV 110.
  • the take-off parameters of the UAV may include the motion state parameters and the control instruction parameters of the UAV 110.
  • the motion state parameter may include, for example, at least one of the current angular velocity of the unmanned aerial vehicle and the current angular acceleration of the unmanned aerial vehicle.
  • the angular velocity of the UAV can include the roll angular velocity and the yaw angular velocity.
  • the UAV angular acceleration may include the yaw angular acceleration.
  • the roll angular velocity can be further divided into the front and rear roll angular velocity and the left and right roll angular velocity.
  • the motion state parameters can be read from the sensor system 162 shown in FIG. 1.
  • the control command parameter may include, for example, one or more of the motor tension command parameter of the unmanned aerial vehicle, the angle control command of the unmanned aerial vehicle, and the angular acceleration control command of the unmanned aerial vehicle.
  • the motor pulling force command parameter includes the amount of pulling force that the motor needs to provide.
  • the unmanned aerial vehicle angle control command is, for example, a command for controlling the angle of the unmanned aerial vehicle;
  • the unmanned aerial vehicle angular acceleration control command is, for example, a command for controlling the angular acceleration of the unmanned aerial vehicle.
  • the take-off parameters of the UAV may also include the ESC current parameters of the UAV. That is, the current parameters output by the ESC 151 of the UAV to each motor 1-4.
  • the control command parameters of the unmanned aerial vehicle may be parameters directly stored in the flight controller 161, and the flight controller 161 directly obtains these control command parameters.
  • the motor tension command parameter is derived from the command sent by the control terminal 140 to the flight controller 161 of the unmanned aerial vehicle. It contains the amount of pulling force that the motor needs to provide. This command is received by the receiving device of the unmanned aerial vehicle and sent to the flight controller 161, so the flight controller 161 can directly obtain the motor pull command parameters.
  • the UAV angle control command and the UAV angular acceleration control command may also be the command sent by the control terminal 140 to the flight controller 161 of the UAV.
  • the ESC current parameter is the magnitude of the current output by the ESC 151 to each motor 1-4, and can also be obtained by the flight controller 161.
  • the execution body such as the flight controller 161 may determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle.
  • FIG. 4 is a sub-flow chart of S102 of the method for detecting the installation of blades of an unmanned aerial vehicle according to an embodiment of the present application.
  • S102 may include S1020a to S1020c:
  • S1020a The execution subject determines that the blade is installed incorrectly according to the take-off parameters of the unmanned aerial vehicle.
  • the abnormal take-off of the unmanned aerial vehicle can be determined according to the movement state parameters and the control command parameters of the unmanned aerial vehicle, so as to determine whether there is a blade installation error.
  • the motion state parameters and control command parameters of the UAV can be used for comprehensive judgment.
  • the motion state parameters include, for example, the attitude angle, angular velocity, and angular acceleration of the UAV.
  • the control command parameter may include, for example, at least one of a motor tension command parameter, an unmanned aerial vehicle angle control command, an unmanned aerial vehicle angular velocity control command, and an unmanned aerial vehicle angular acceleration control command.
  • control parameters may also include the front and rear roll/left-right roll angular acceleration commands and corresponding thresholds of the UAV, the front-back roll/left-right roll angular velocity feedback and angular acceleration feedback, the front-back roll/left-right roll attitude angle, etc.
  • the front and rear roll/left-right roll angular acceleration commands and corresponding thresholds of the UAV the front-back roll/left-right roll angular velocity feedback and angular acceleration feedback, the front-back roll/left-right roll attitude angle, etc.
  • the front and rear roll/left-right roll angular acceleration commands and corresponding thresholds of the UAV the front-back roll/left-right roll angular velocity feedback and angular acceleration feedback, the front-back roll/left-right roll attitude angle, etc.
  • the front-back roll/left-right roll attitude angle etc.
  • the front-back roll/left-right roll attitude angle etc.
  • the front-back roll/left-right roll attitude angle etc.
  • the judgment can be determined by the following conditions:
  • ⁇ T is the attitude change at time T during the take-off of the unmanned aerial vehicle
  • ⁇ 0 is the attitude judgment threshold
  • ⁇ cmd is the attitude control command during the take-off process
  • ⁇ fbk is the attitude feedback
  • ⁇ err0 is the attitude control error judgment.
  • Threshold Is the angular acceleration control command
  • Is the angular acceleration command judgment threshold Is the actual angular acceleration feedback, rolling forward is negative and rolling backward is positive
  • Is the actual angular velocity feedback rolling forward is negative and rolling backward is positive
  • Is the angular velocity judgment threshold can be selected through actual tests, and is not particularly limited here.
  • the blade 21 may cause abnormal roll forward and roll right during takeoff. Specifically, when the parameters are as follows, it is considered that abnormal roll forward and roll right have occurred, so it can be judged There is a wrong blade.
  • ⁇ T is the attitude change at time T during the take-off of the unmanned aerial vehicle
  • ⁇ 0 is the attitude judgment threshold
  • ⁇ cmd is the attitude control command during the take-off process
  • ⁇ fbk is the attitude feedback
  • ⁇ err0 is the attitude control error judgment.
  • Threshold Is the angular acceleration control command
  • Is the angular acceleration command judgment threshold Is the actual angular acceleration feedback, rolling forward is negative and rolling backward is positive
  • Is the actual angular velocity feedback rolling forward is negative and rolling backward is positive
  • Is the angular velocity judgment threshold can be selected through actual tests, and is not particularly limited here.
  • ⁇ T is the change of the left and right roll attitude at time T during the take-off process of the unmanned aerial vehicle
  • ⁇ 0 is the left and right roll attitude change threshold
  • ⁇ cmd is the left and right roll attitude control command during takeoff
  • ⁇ fbk is the left and right roll attitude.
  • Rolling attitude feedback ⁇ err0 is the left and right rolling attitude control error judgment threshold
  • For the left and right roll angular acceleration control command Determine the threshold for the left and right roll angular acceleration command, It is the feedback of the actual left and right roll angular acceleration. Rolling to the left is negative and rolling to the right is positive. It is the feedback of the actual left and right rolling angular velocity. Rolling to the left is negative and rolling to the right is positive.
  • the threshold value for judging the angular velocity of the left and right rolls It is the threshold value for judging the angular velocity of the left and right rolls. It is worth noting that the aforementioned judgment threshold can be selected through actual tests, and is not particularly limited here. When it is judged that there is an abnormality in the forward roll and the right roll, it is considered that the take-off is abnormal, and it is judged that a blade installation error has occurred.
  • the execution subject may also execute S1020b to determine the improperly installed blade, for example, to determine which position one or more blades are installed incorrectly.
  • unmanned aerial vehicle's attitude and abnormal take-off parameters of the unmanned aerial vehicle it is also possible to determine the specific improperly installed blade.
  • the direction A of the nose of the UAV 110 is defined as “front”, and the opposite side is “rear”.
  • the side and back sides define “left” and “right” respectively.
  • the aforementioned “same side” means that two blades are arranged adjacently, that is, two blades that are adjacent clockwise or counterclockwise;
  • opposite side means that two blades are arranged oppositely, that is, two blades that are not adjacent clockwise or counterclockwise. Paddles.
  • the reverse installation of the same side blade shows a roll
  • the opposite installation shows a rotation
  • a single blade installation shows a roll or flip in two directions. If more than three blades are installed incorrectly, it means that the motor pull output command parameters are abnormal, or the ESC current value output is abnormal.
  • sending prompt information may also be executed, for example, including at least one of the following:
  • the corresponding prompt message will be sent out.
  • the execution body may send the determined information of the incorrectly installed blade (for example, the installation error of the blade 21) to a display device for display.
  • the display device is, for example, the display device 130 shown in FIG. 1. Or the user's VR glasses, mobile phone with App installed, etc.
  • the execution body may have a prompt device such as sound, light, etc., and according to the determined blade information of the installation error, the execution body may send out corresponding prompt information. For example, a light corresponding to the setting of the blade is used to prompt the user that the blade is installed incorrectly.
  • the present invention may further include: information prompting the correct installation method of the blade, for example, the correct installation can be directly displayed on the display device through the user's click Steps or pictures are convenient for users to correct.
  • the execution body for example, the flight controller 161, may execute corresponding operations according to the blade installation information.
  • the above-mentioned corresponding operation may include at least one of the following, for example:
  • S103a Send the prompt information to the display device
  • the flight controller 161 may send the determined blade installation information to the display device 130.
  • the display device 130 may be a mobile phone installed with the user connected to the flight controller 161 through signal transmission, a display device that is integrated with the unmanned aerial vehicle 110 but is provided separately, or a display screen integrated in the unmanned aerial vehicle.
  • the prompt message corresponding to the installation information sent by the flight controller 161 may be a message prompting a blade installation error, or a specific message prompting which blade is installed incorrectly, etc., which is not limited here.
  • a display device may be integrated on the flight controller 161, so the corresponding prompt information can be directly displayed on the flight controller 161 based on the blade installation information.
  • the prompt message can also be a message indicating that there is a blade installation error, or a specific message indicating which blade is installed incorrectly, etc., which is not limited here.
  • the flight controller 161 may directly control the rotation of the blades, that is, stop the motors corresponding to all the blades to avoid damage to the unmanned aerial vehicle. In some cases, in addition to controlling the rotation of the blades, the flight controller 161 can also control other functions of the unmanned aerial vehicle to stop working at the same time, so as to protect the unmanned aerial vehicle from damage.
  • S103a, S103b, or S103c can be executed, or two or more of them can be executed, and the order of execution is not limited.
  • S103a and S103c can be executed, and S103a can be executed first to send the prompt information to Display device; in step S103c, the rotation of the blades of the UAV is stopped. Or first execute S103c to stop the rotation of the blades of the UAV, and then execute S103a to send the prompt information to the display device or the like.
  • S102 is determining the installation information of the blades of the UAV according to the take-off parameters of the UAV, which may include: determining the propellers of the UAV according to the take-off parameters of the UAV. Blade installation error; in S103, according to the blade installation information, performing a corresponding operation includes: stopping the rotation of the blade of the unmanned aerial vehicle.
  • the method for detecting the installation of blades of an unmanned aerial vehicle proposed in the embodiment of the present invention can perform the technical effects of abnormal take-off protection and recognition of blade installation errors, which are specifically as follows:
  • the method for detecting the installation of the blades of the unmanned aerial vehicle proposed in the embodiment of the present invention can determine the take-off abnormality caused by the wrong installation of the blades of the unmanned aerial vehicle, and perform processing operations such as automatically stopping the propellers.
  • the present invention makes a strategy of automatically stopping the propeller by abnormal judgment for various situations of incorrect propeller installation.
  • the timeliness of abnormal judgment is improved, and the probability of ground roll and uncontrolled ground flight of the unmanned aerial vehicle with wrong propellers is greatly reduced.
  • the method for detecting the installation of the blades of the unmanned aerial vehicle uses the motion parameters and control parameters of the unmanned aerial vehicle to determine which blade or blades are installed incorrectly based on the unmanned aerial vehicle's motion performance and control output during abnormal takeoff. , Used to give users precise tips.
  • Table 1 has been used to determine the type of each installation error, the performance of the UAV, and the parameters required to determine whether the installation error is of this type. The following describes in detail the performance of each installation error and abnormal parameters through four common installation error situations.
  • the first case the two blades are installed incorrectly. This situation includes: 1. Two blades on the same side are installed reversely; 2. Two opposite blades are installed reversely.
  • Figure 5 shows a schematic diagram of the improper installation of the blade 21 and the blade 22 during take-off and roll.
  • the resultant force generated by blade 21 and blade 22 is F 12
  • the resultant force generated by blade 23 and blade 24 is F 34
  • the gravity of the unmanned aerial vehicle itself is recorded as G
  • the unmanned aerial vehicle is also supported by the ground.
  • the distance between the center of gravity of the unmanned aerial vehicle and motor 3 and motor 4 is L 34 , the distance from motor 1 and motor 2 is L 12 , the total length is L, and the moment of inertia of the unmanned aerial vehicle around the front leg is I.
  • is the angle of the UAV's head down relative to the horizontal plane, Is the corresponding angular acceleration.
  • the UAV 110 will generate a forward roll angular acceleration, and over time, the UAV 110 will generate a forward roll angular velocity, and finally roll forward.
  • the flight controller 161 will continue to increase the output of the motor 1 and motor 2, in order to increase the pulling force of the motor 1 and motor 2, and reverse the tendency of the unmanned aerial vehicle to roll forward, but because the blade 21 and the blade 22 is installed incorrectly, the generated force F 12 is downward, which is offset by the ground support reaction force, and cannot generate enough pulling force to reverse the forward rolling trend.
  • ⁇ T is the attitude change at time T during take-off of the unmanned aerial vehicle
  • ⁇ 0 is the attitude judgment threshold
  • ⁇ cmd is the attitude control command during the take-off process
  • ⁇ fbk is the attitude feedback
  • ⁇ err0 is the attitude control error judgment.
  • Threshold Is the angular acceleration control command
  • Is the angular acceleration command judgment threshold Is the actual angular acceleration feedback, rolling forward is negative and rolling backward is positive
  • Is the actual angular velocity feedback rolling forward is negative and rolling backward is positive
  • Is the angular velocity judgment threshold can be selected through actual tests, and is not particularly limited here.
  • Is the forward roll angular velocity of the UAV at time T forward is negative and backward is positive
  • Is the judgment threshold of the roll forward angular velocity which is a negative value with a large absolute value.
  • Is the angular velocity of the unmanned aerial vehicle rolling left and right at time T the left is negative and the right is positive
  • Is the judging threshold of the left and right roll angular velocity Is the yaw angular velocity of the unmanned aerial vehicle at time T, the counterclockwise rotation in the top view is negative, and the clockwise rotation is positive
  • Is the yaw angular velocity judgment threshold After the abnormality is judged, and the above conditions are met at the same time, it can be judged that the blade 21 and the blade 22 are installed incorrectly.
  • the aforementioned S102 that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong installation blade, may include:
  • S102a using the front and back roll angular velocity, left-right roll angular velocity, and yaw angular velocity of the UAV to determine the installation error of the same-side blades of the UAV may include four situations:
  • the front roll state, the back roll state, the left roll state, and the right roll state of the UAV here have been described by formulas above, or can be directly calculated by those skilled in the art, and are not limited here.
  • the forward roll state can be determined by the aforementioned formula:
  • the aforementioned right flip state can be determined by the aforementioned formula:
  • the UAV will behave as yaw during take-off. .
  • the downward force generated by blade 21 and blade 23 is less than the upward force generated by blade 22/blade 24, blade 21 and blade 23
  • the motor torque generated by the rotation is smaller than the motor torque generated by the rotation of the blade 22/the blade 24. This is determined by the aerodynamic design of the blade itself.
  • the movement of the unmanned aerial vehicle 110 on the ground can be expressed by the following equation:
  • F 24 is the pulling force generated by motor 2 and motor 4
  • F 13 is the downward thrust generated by motor 1 and motor 3
  • G is the gravity of the UAV
  • F pressure is the pressure on the ground by the UAV
  • T 24 is the motor 2.
  • T 13 is the motor torque generated by the rotation of the motor 1 and the motor 3
  • f friction is the ground friction coefficient
  • I z is the moment of inertia of the unmanned aerial vehicle's yaw
  • Satisfying the above-mentioned judgment conditions can be used to judge the installation and take-off abnormality of the blade 21 and the blade 23, and can also be used as an installation error condition of the blade 21 and the blade 23.
  • the method for judging the installation errors of the blades 22 and 24, the abnormal take-off and the installation errors of the blades is similar to the above method, and the attitude angle, angular velocity, angular acceleration, and control commands of the UAV can be used for comprehensive judgment.
  • the aforementioned S102 that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong blade installation, may include:
  • S102b that is, the use of the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration to determine the installation error of the opposite blade may include the following situations:
  • the motor 1 rotates the blade 21 to generate a downward thrust.
  • Motor 2, motor 3, and motor 4 are installed correctly to generate upward pulling force, and the motor gradually accelerates during takeoff.
  • the UAV 110 will roll forward and roll right at the same time. Take off anomalies comprehensively judge roll forward and roll right. Among them, the following parameters can be used to determine whether the UAV 110 has a forward roll abnormality or a right roll abnormality, that is, whether a blade installation error has occurred:
  • the flight controller 161 can issue an instruction to make the UAV automatically stop the propellers.
  • Is the forward roll angular velocity of the unmanned aerial vehicle at time T forward is negative and backward is positive
  • Is the judgment threshold of the roll forward angular velocity which is a negative value with a large absolute value.
  • Is the angular velocity of the unmanned aerial vehicle rolling left and right at time T the left is negative and the right is positive
  • the threshold for judging the angular velocity of the left and right rolls is a positive value with a relatively large absolute value.
  • Is the yaw angular velocity of the unmanned aerial vehicle at time T the counterclockwise rotation in the top view is negative, and the clockwise rotation is positive
  • Is the yaw angular velocity judgment threshold After it is judged that the abnormality occurs, and the above conditions are satisfied at the same time, it can be judged that the blade 21 is installed incorrectly.
  • the method for judging the abnormal take-off and blade installation error is similar to the above-mentioned method using the UAV attitude angle, angular velocity, angular acceleration, and control command to comprehensively judge.
  • the UAV 110 rolls toward the front and flips toward the left.
  • the blade 23 is incorrectly installed, the UAV 110 rolls toward the rear and flips toward the left.
  • the blade 24 is installed incorrectly, the UAV 110 rolls toward the rear and flips toward the right.
  • the aforementioned S102 that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong blade installation, includes:
  • the S102c that is, the use of the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration of the UAV to determine the installation error of a single blade may include the following situations:
  • the motor has 4 propellers during acceleration and take-off.
  • the direction of the resultant force generated by the blades is downward, and the UAV has a greater pressure on the ground.
  • the UAV will not have a large attitude change on the ground. In this case, it can be controlled by the output of the control and the actual output of the motor.
  • the abnormal takeoff is judged as follows:
  • lift cmd is the motor pulling force output command parameter
  • lift 0 is the motor pulling force output judgment threshold
  • ⁇ i esc is the sum of the 4 ESC currents
  • i 0 is the current judgment threshold
  • the aforementioned S102 that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong installation blade, may include:
  • the UAV's front and rear roll angular velocity, left-right roll angular velocity, yaw angular velocity, motor pull output command parameters and ESC current parameters are used to determine the installation errors of more than three blades of the UAV.
  • S102d may include the following situations:
  • the motor pull force output command parameter is greater than the motor pull force output command
  • the UAV 110 behaves as follows: on the corresponding motor without blades, the ESC current is very small and the resistance is large. Therefore, it can be judged whether the motor is not equipped with a blade by whether the value of the ESC current of each motor is less than the threshold value, or whether the corresponding resistance is greater than the threshold value.
  • the method for detecting the installation of blades of an unmanned aerial vehicle proposed in the embodiments of the present invention can realize the technical effects of take-off protection and recognition of improper installation of blades, which are specifically as follows:
  • the present invention makes a strategy of automatically stopping the propeller by abnormal judgment for various situations of incorrect propeller installation.
  • the timeliness of abnormal judgment is improved, and the probability of ground roll and uncontrolled ground flight of the unmanned aerial vehicle with wrong propellers is greatly reduced.
  • the method for detecting the installation of the blades of the unmanned aerial vehicle proposed in the embodiment of the present invention can determine which blade or blades are reversed according to the movement performance and control output of the unmanned aerial vehicle during abnormal takeoff, and prompt the user to find errors as soon as possible. Troubleshoot.
  • Fig. 6 shows an embodiment of a detection device for blade installation of an unmanned aerial vehicle according to the present application.
  • the UAV blade installation detection device includes the following modules:
  • the obtaining module 601 is used to obtain take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control instruction parameters;
  • the acquisition module 601 can acquire the UAV takeoff parameters of the UAV 110.
  • the take-off parameters of the UAV may include the motion state parameters and the control instruction parameters of the UAV 110.
  • the motion state parameters may include, for example, the current UAV angular velocity, the current UAV angular acceleration, and so on.
  • the angular velocity of the UAV can include the roll angular velocity and the yaw angular velocity.
  • the UAV angular acceleration may include the yaw angular acceleration.
  • the roll angular velocity can be further divided into the front and rear roll angular velocity and the left and right roll angular velocity.
  • the motion state parameters can be read from the sensor system 162 shown in FIG. 1.
  • the control command parameter may include, for example, one or more of the motor tension command parameter of the unmanned aerial vehicle, the angle control command of the unmanned aerial vehicle, and the angular acceleration control command of the unmanned aerial vehicle.
  • the motor pulling force command parameter includes the amount of pulling force that the motor needs to provide.
  • the unmanned aerial vehicle angle control command is, for example, a command for controlling the angle of the unmanned aerial vehicle;
  • the unmanned aerial vehicle angular acceleration control command is, for example, a command for controlling the angular acceleration of the unmanned aerial vehicle.
  • the take-off parameters of the UAV may also include the ESC current parameters of the UAV. That is, the current parameters output by the ESC 151 of the UAV to each motor 1-4.
  • the control command parameters of the unmanned aerial vehicle may be parameters directly stored in the flight controller 161, and the flight controller 161 directly obtains these control command parameters.
  • the motor tension command parameter is derived from the command sent by the control terminal 140 to the flight controller 161 of the unmanned aerial vehicle. It contains the amount of pulling force that the motor needs to provide. This command is received by the receiving device of the unmanned aerial vehicle and sent to the flight controller 161, so the flight controller 161 can directly obtain the motor pull command parameters.
  • the UAV angle control command and the UAV angular acceleration control command may also be the command sent by the control terminal 140 to the flight controller 161 of the UAV.
  • the ESC current parameter is the magnitude of the current output by the ESC 151 to each motor 1-4, and can also be obtained by the flight controller 161.
  • the determining module 602 is configured to determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
  • the determining module 602 may determine the blade installation error according to the take-off parameters of the UAV. Further, the determining module 602 can also execute S1020b to determine the improperly installed blades, for example, to determine which position one or more blades are installed incorrectly. The determining module 602 may also send out prompt information, for example, including at least one of the following: sending prompt information corresponding to the determined information of the improperly installed blade to the display device; sending out corresponding information according to the determined improperly installed blade information Prompt information.
  • the execution module 603 is configured to execute corresponding operations according to the blade installation information.
  • the execution module 603 may execute corresponding operations according to the blade installation information.
  • the aforementioned corresponding operation may include, for example, at least one of the following: sending prompt information to a display device; displaying corresponding prompt information according to the blade installation information; and stopping the rotation of the blades of the unmanned aerial vehicle.
  • the determining module is configured to perform the following operations:
  • the determination module is further configured to perform the following operations: determine the improperly installed blades according to the take-off parameters of the unmanned aerial vehicle.
  • the device further includes:
  • the sending module is used to send the prompt information corresponding to the determined information of the incorrectly installed blade to the display device;
  • the prompt module is used to send out corresponding prompt information according to the determined information of the improperly installed blade.
  • the motion state parameter includes at least one of the attitude information of the unmanned aerial vehicle, the angular velocity of the unmanned aerial vehicle, and the angular acceleration of the unmanned aerial vehicle.
  • control instruction parameters include: motor tension instruction parameters, unmanned aerial vehicle angle control instructions, unmanned aerial vehicle angular velocity control instructions, and unmanned aerial vehicle angular acceleration control instructions at least among them one.
  • the UAV take-off parameter further includes: the UAV ESC current parameter.
  • the angular velocity of the unmanned aerial vehicle includes a roll angular velocity and a yaw angular velocity; and the angular acceleration of the unmanned aerial vehicle includes a yaw angular acceleration.
  • the roll angular velocity includes the front-to-back roll angular velocity and the left-right roll angular velocity.
  • the motion state parameters include the angular velocity and angular acceleration of the UAV, and the angular velocity includes the forward and backward roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity.
  • the steps of judging the installation error of the blade by the takeoff parameters of the unmanned aerial vehicle and determining the installation error of the blade include:
  • the step of determining the installation error of the unmanned aerial vehicle's blades on the same side by using the front and rear roll angular velocity, the left-right roll angular velocity, and the yaw angular velocity of the unmanned aerial vehicle include:
  • the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the front roll state of the unmanned aerial vehicle, it is determined that it is close to the side of the nose of the unmanned aerial vehicle The installation of the first blade and the second blade is wrong;
  • the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the left rollover state of the unmanned aerial vehicle, it is determined that it is located on the longitudinal axis of the unmanned aerial vehicle
  • the second blade and the third blade on the first side of the direction are installed incorrectly;
  • the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left and right flip angular velocity, the yaw angular velocity, and the yaw angular acceleration.
  • the step of judging the installation error of the blade according to the take-off parameters of the UAV, and determining the installation error of the blade includes:
  • the front and back roll angular velocity, the left-right roll angular velocity, the yaw angular velocity and the yaw angular acceleration are used to determine the installation error of the blades on the opposite side of the unmanned aerial vehicle.
  • the step of determining the installation error of the opposite blade by using the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration includes:
  • the relationship satisfies the unmanned aerial vehicle heading first One direction rotation state, determining that the two blades located on the first diagonal of the UAV are installed incorrectly;
  • the relationship satisfies the unmanned aerial vehicle heading first In the two-direction rotation state, it is determined that the two blades on the second diagonal of the UAV are installed incorrectly.
  • the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left and right flip angular velocity, the yaw angular velocity, and the yaw angular acceleration.
  • the step of judging the installation error of the blade according to the take-off parameters of the UAV, and determining the installation error of the blade includes:
  • the installation error of a single blade is determined.
  • the step of determining the installation error of a single blade by using the front and back roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration of the unmanned aerial vehicle includes:
  • the state of rolling forward and turning to the right side determines that the first blade of the unmanned aerial vehicle is installed incorrectly;
  • the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied
  • the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied
  • the state of the human aircraft rolling toward the rear and turning toward the right determines that the fourth blade of the unmanned aircraft is installed incorrectly.
  • the motion state parameters include the angular velocity and angular acceleration of the UAV, the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity, and the control command
  • the parameters include motor tension output command parameters, and the UAV takeoff parameters also include ESC current parameters
  • the step of judging the installation error of the blade according to the take-off parameters of the unmanned aerial vehicle, and determining the installation error of the blade includes:
  • the use of the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, the motor pulling force output command parameter, and the ESC current parameter to determine the installation error of more than three blades The steps include:
  • the motor pull force output command parameter is greater than the motor pull force output command
  • control command parameter includes a motor pulling force output command parameter
  • UAV take-off parameter also includes an ESC current parameter and a propeller resistance value
  • Unmanned aerial vehicle take-off parameters to determine the installation error of the blade, and the steps to determine the installation of the wrong blade include:
  • the electric current parameter and the propeller resistance value of the UAV are used to determine that one or more blades are not installed.
  • the step of determining that one or more blades are not installed by using the ESC current parameter and the resistance value of the propeller includes:
  • the device for detecting the installation of blades of an unmanned aerial vehicle provided in the embodiment of the present invention can realize the technical effects of take-off protection and recognition of blade installation errors, which are specifically as follows:
  • the present invention makes a strategy of automatically stopping the propeller by abnormal judgment for various situations of incorrect propeller installation.
  • the comprehensive judgment of attitude angle, angular velocity change, control command output, motor output, etc. improves the timeliness of abnormal judgment, and greatly reduces the probability of ground roll and uncontrolled ground flight of unmanned aerial vehicles with wrong propellers.
  • the method for detecting the installation of UAV blades can determine which blade or blades are reversed according to the motion performance and control output of the UAV during abnormal takeoff, and prompt the user to find errors as soon as possible. Troubleshoot.
  • the description is relatively simple, and for related parts, please refer to the part of the description of the method embodiment.
  • the embodiment of the present application also shows an unmanned aerial system.
  • the unmanned aerial vehicle 100 includes an unmanned aerial vehicle 110 and a control terminal 140;
  • the unmanned aerial vehicle 110 includes a frame, a flight controller 161, and a control terminal 140.
  • the sensing system 162, the flight controller 161 and the sensing system 162 are arranged in the frame;
  • the flight controller 161 can transmit signals between the sensing system 162 and the control terminal 140,
  • the control terminal 140 can send a control signal to the flight controller 161 to control the flight of the UAV 110;
  • the flight controller 161 is used to perform the following operations:
  • Acquire take-off parameters of the unmanned aerial vehicle where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
  • the embodiment of the present application also shows an unmanned aerial vehicle 110.
  • the unmanned aerial vehicle 110 includes a frame, a flight controller 161, and a sensor system 162.
  • the flight controller 161 and the sensor The system 162 is installed in the frame; the flight controller 161 is electrically connected to the sensing system 162;
  • the flight controller is used to perform the following operations:
  • the take-off parameters of the unmanned aerial vehicle including the motion state parameters acquired from the sensing system 162 and the control command parameters acquired from the flight controller 161;
  • An embodiment of the present application also provides a computer program, including computer-readable code, which when the computer-readable code runs on a computing processing device, causes the computing processing device to execute the aforementioned UAV blade installation detection method.
  • the embodiment of the present application also provides a computer-readable storage medium on which a computer program is stored.
  • a computer program is stored.
  • the computer program is executed by a processor, each process of the above-mentioned photographing method embodiment is realized, and the same technical effect can be achieved. To avoid repetition, I won’t repeat it here.
  • the computer-readable storage medium such as read-only memory (Read-Only Memory, ROM for short), random access memory (Random Access Memory, RAM for short), magnetic disk, or optical disk, etc.
  • this application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware.
  • this application may adopt the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program codes.
  • the various component embodiments of the present invention may be implemented by hardware, or by software modules running on one or more processors, or by a combination of them.
  • a microprocessor or a digital signal processor (DSP) may be used in practice to implement some or all of the functions of some or all of the components in the computing processing device according to the embodiments of the present invention.
  • DSP digital signal processor
  • the present invention can also be implemented as a device or device program (for example, a computer program and a computer program product) for executing part or all of the methods described herein.
  • Such a program for realizing the present invention may be stored on a computer-readable medium, or may have the form of one or more signals.
  • Such a signal can be downloaded from an Internet website, or provided on a carrier signal, or provided in any other form.
  • FIG. 7 shows a computing processing device that can implement the method according to the present invention.
  • the computing processing device traditionally includes a processor 1010 and a computer program product in the form of a memory 1020 or a computer readable medium.
  • the memory 1020 may be an electronic memory such as flash memory, EEPROM (Electrically Erasable Programmable Read Only Memory), EPROM, hard disk, or ROM.
  • the memory 1020 has a storage space 1030 for executing program codes 1031 of any method steps in the above methods.
  • the storage space 1030 for program codes may include various program codes 1031 respectively used to implement various steps in the above method. These program codes can be read from or written into one or more computer program products.
  • These computer program products include program code carriers such as hard disks, compact disks (CDs), memory cards, or floppy disks. Such computer program products are usually portable or fixed storage units as described with reference to FIG. 8.
  • the storage unit may have a storage segment, storage space, etc. arranged similarly to the memory 1020 in the computing processing device of FIG. 7.
  • the program code can be compressed in an appropriate form, for example.
  • the storage unit includes computer-readable code 1031', that is, code that can be read by a processor such as 1010, which, when run by a computing processing device, causes the computing processing device to execute the method described above. The various steps.
  • These computer program instructions can also be stored in a computer-readable memory that can guide a computer or other programmable data processing terminal equipment to work in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture including the instruction device.
  • the instruction device implements the functions specified in one process or multiple processes in the flowchart and/or one block or multiple blocks in the block diagram.
  • These computer program instructions can also be loaded on a computer or other programmable data processing terminal equipment, so that a series of operation steps are executed on the computer or other programmable terminal equipment to produce computer-implemented processing, so that the computer or other programmable terminal equipment
  • the instructions executed above provide steps for implementing functions specified in a flow or multiple flows in the flowchart and/or a block or multiple blocks in the block diagram.

Abstract

A method and apparatus for inspecting the installation of blades (21, 22, 23, and 24) of an unmanned aerial vehicle (110). The method comprises: acquiring takeoff parameters of the unmanned aerial vehicle (110), the takeoff parameters of the unmanned aerial vehicle (110) comprising: a motion state parameter and a control instruction parameter (S101); determining incorrect installation information of the blades of the unmanned aerial vehicle (110) on the basis of the takeoff parameters of the unmanned aerial vehicle (110) (S102); and executing a corresponding operation on the basis of the incorrect installation information of the blades (21, 22, 23, and 24) (S103). The method implements the technical effects of takeoff protection and identification of incorrect installation of the blades (21, 22, 23, and 24), with respect to takeoff protection, allows a takeoff abnormality to be determined rapidly and the blades to be stopped automatically, and prevents the unmanned aerial vehicle (110) from tumbling and flying erratically as a result of taking off with the blades (21, 22, 23, and 24) being incorrectly installed, thus protecting the safety of the unmanned aerial vehicle (110) itself and the surrounding environment. With respect to the identification of incorrect installation of the blades (21, 22, 23, and 24), by determining an abnormal performance of the unmanned aerial vehicle (110) during takeoff, incorrect installation of which one or more of the blades (21, 22, 23, and 24) is identified accurately.

Description

一种无人飞行器桨叶安装检测方法及装置Method and device for detecting installation of blades of unmanned aerial vehicle 技术领域Technical field
本申请涉及无人飞行器技术领域,特别是涉及一种无人飞行器桨叶安装检测方法及装置。This application relates to the technical field of unmanned aerial vehicles, in particular to a method and device for detecting the installation of blades of an unmanned aerial vehicle.
背景技术Background technique
无人机,例如旋翼无人机的桨叶是可拆卸的,在用户安装过程中可能存在装错桨的情况。以四旋翼无人机为例,四旋翼无人机包括四个桨叶。桨叶的装错包括两个或两个以上桨叶互相调换、一个或多个桨叶正反安装错误、桨叶未安装等。桨叶安装错误之后会导致起飞失败,具体表现为地面翻滚、地面不受控飞行等,会对无人机本身和周围环境造成比较大危害。这一问题对于可拆卸桨叶的无人机是长期存在的。UAVs, such as rotary-wing UAVs, have detachable blades, and the wrong propeller may be installed during installation by the user. Taking a quad-rotor drone as an example, the quad-rotor drone includes four blades. The improper installation of the blades includes the exchange of two or more blades, the wrong installation of one or more blades, and the improper installation of the blades. If the blade is installed incorrectly, it will cause takeoff failure, which is manifested as ground roll, uncontrolled ground flight, etc., which will cause great harm to the drone itself and the surrounding environment. This problem has long existed for drones with detachable blades.
发明内容Summary of the invention
本申请示出了一种无人飞行器桨叶安装检测方法及装置。This application shows a method and device for detecting the installation of blades of an unmanned aerial vehicle.
第一方面,本申请示出了一种无人飞行器桨叶安装检测方法,包括:In the first aspect, this application shows an unmanned aerial vehicle blade installation detection method, including:
获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;Acquire take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
根据所述无人飞行器起飞参数,确定所述无人飞行系统的桨叶的安装信息;Determine the installation information of the blades of the unmanned aerial vehicle according to the takeoff parameters of the unmanned aerial vehicle;
根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
第二方面,本申请示出了一种无人飞行器桨叶安装检测装置,包括:In the second aspect, this application shows an unmanned aerial vehicle blade installation detection device, including:
获取模块,用于获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;The acquisition module is used to acquire the take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
确定模块,用于根据所述无人飞行器起飞参数,确定所述无人飞行系统的桨叶的安装信息;A determining module, configured to determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
执行模块,用于根据所述桨叶安装信息,执行对应的操作。The execution module is used to execute corresponding operations according to the blade installation information.
第三方面,本申请示出了一种计算处理设备,包括:In the third aspect, this application shows a computing processing device, including:
存储器,其中存储有计算机可读代码;A memory in which computer-readable codes are stored;
一个或多个处理器,当所述计算机可读代码被所述一个或多个处理器执行时,所述计算处理设备执行前述的无人飞行器桨叶安装检测方法。One or more processors, and when the computer-readable code is executed by the one or more processors, the computing processing device executes the aforementioned UAV blade installation detection method.
第四方面,本申请示出了一种无人飞行系统,包括无人飞行器和控制终端;所述无人飞行器包括机架、飞行控制器和传感系统,所述飞行控制器和所述传感系统设置于所述机架;所述飞行控制器能够与所述传感系统和所述控制终端之间传输信号,所述控制终端能够发送控制信号至所述飞行控制器,以控制所述无人飞行器的飞行;In the fourth aspect, this application shows an unmanned aerial vehicle including an unmanned aerial vehicle and a control terminal; the unmanned aerial vehicle includes a frame, a flight controller and a sensing system, the flight controller and the transmission The sensor system is arranged in the frame; the flight controller can transmit signals with the sensor system and the control terminal, and the control terminal can send control signals to the flight controller to control the The flight of unmanned aerial vehicles;
所述飞行控制器用于执行如下操作:The flight controller is used to perform the following operations:
获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;Acquire take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
第五方面,本申请示出了一种无人飞行器,其特征在于,包括:机架、飞行控制器和传感系统,所述飞行控制器和所述传感系统设置于所述机架;所述飞行控制器电性连接于所述传感系统;In a fifth aspect, the present application shows an unmanned aerial vehicle, which is characterized by comprising: a frame, a flight controller, and a sensing system, the flight controller and the sensing system are arranged in the frame; The flight controller is electrically connected to the sensing system;
所述飞行控制器用于执行如下操作:The flight controller is used to perform the following operations:
获取无人飞行器起飞参数,所述无人飞行器起飞参数包括从所述传感系统获取的运动状态参数和从所述飞行控制器获取的控制指令参数;Acquiring take-off parameters of an unmanned aerial vehicle, the take-off parameters of the unmanned aerial vehicle including the motion state parameters obtained from the sensing system and the control command parameters obtained from the flight controller;
根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
第六方面,本申请示出了一种包括指令的计算机程序产品,当所述指令在计算机上运行时,使得所述计算机机执行如前述的无人飞行器桨叶安装检测方法。In the sixth aspect, the present application shows a computer program product including instructions that, when the instructions are run on a computer, cause the computer to execute the aforementioned UAV blade installation detection method.
第七方面,本申请示出了一种计算机可读存储介质,包括指令,当其在计算机上运行时,使得计算机执行如前述的无人飞行器桨叶安装检测方法In the seventh aspect, this application shows a computer-readable storage medium, including instructions, which when run on a computer, cause the computer to execute the aforementioned method for detecting the installation of an unmanned aerial vehicle blade
本申请实施例提出的无人飞行器桨叶安装检测方法及装置,能够针对用户在桨叶安装错误情况下起飞可能造成的对无人飞行系统和周围环境的危害,本发明通过无人飞行器的运动状态参数和控制指令参数对起飞过程进行监控判断是否起飞异常,异常时进行进一步的操作,例如停桨,以对无人飞行器和周围环境进行保护。The method and device for detecting the installation of unmanned aerial vehicle blades proposed in the embodiments of the present application can deal with the harm to the unmanned aerial system and the surrounding environment that may be caused by the user taking off with the wrong installation of the blades. The present invention uses the movement of the unmanned aerial vehicle State parameters and control command parameters monitor the takeoff process to determine whether the takeoff is abnormal, and perform further operations when abnormal, such as stopping the propeller, to protect the UAV and the surrounding environment.
进一步地,本申请实施例提出的方案还能够结合装错桨叶的异常表现来判断某一个或者多个桨叶安装错误,并发出错误提示,方便用户检查和修正。Further, the solution proposed by the embodiment of the present application can also determine the installation error of one or more blades in combination with the abnormal performance of the wrong blade, and issue an error prompt to facilitate the user to check and correct.
附图说明Description of the drawings
图1是本申请的一种无人飞行系统的示意性架构图;Fig. 1 is a schematic architecture diagram of an unmanned aerial system of the present application;
图2是本申请实施例的无人飞行器的机架、电机和四个桨叶的俯视图。Fig. 2 is a top view of the frame, motor and four blades of the unmanned aerial vehicle according to the embodiment of the present application.
图3是本申请实施例的无人飞行器桨叶安装检测方法的流程图。Fig. 3 is a flowchart of a method for detecting the installation of a blade of an unmanned aerial vehicle according to an embodiment of the present application.
图4是本申请实施例的无人飞行器桨叶安装检测方法的S102的子流程图。FIG. 4 is a sub-flow chart of S102 of the method for detecting the installation of blades of an unmanned aerial vehicle according to an embodiment of the present application.
图5是本申请实施例的无人飞行器在装错桨叶时的俯视图,以及显示了受力状况的侧视图。Fig. 5 is a top view of the unmanned aerial vehicle according to an embodiment of the present application when the wrong blade is installed, and a side view showing the force state.
图6是本申请实施例的无人飞行器桨叶安装检测装置的方框图。Fig. 6 is a block diagram of an unmanned aerial vehicle blade installation detection device according to an embodiment of the present application.
图7示意性地示出了用于执行根据本发明的方法的计算处理设备的框图;以及Fig. 7 schematically shows a block diagram of a computing processing device for executing the method according to the present invention; and
图8示意性地示出了用于保持或者携带实现根据本发明的方法的程序代码的存储单元。Fig. 8 schematically shows a storage unit for holding or carrying program codes for implementing the method according to the present invention.
具体实施例Specific embodiment
下面结合附图和具体实施方式对本申请作进一步详细的说明。The application will be further described in detail below in conjunction with the drawings and specific implementations.
本申请的实施例提供了一种无人飞行器桨叶安装检测方法及装置,无人飞行器桨叶安装检测方法及装置。该方法和装置应用于无人飞行系统,该无人飞行器例如可以是旋翼无人机(rotorcraft),例如,由多个推动装置通过空气推动的多旋翼无人机,本申请的实施例并不限于此。The embodiments of the present application provide a method and device for detecting the installation of a blade of an unmanned aerial vehicle, and a method and device for detecting the installation of a blade of an unmanned aerial vehicle. The method and device are applied to an unmanned aerial system. The unmanned aerial vehicle may be, for example, a rotorcraft, for example, a multi-rotor drone propelled by multiple propulsion devices through the air. The embodiments of the present application are not Limited to this.
图1是根据本申请的实施例的无人飞行系统的示意性架构图。本实施例的无人飞行器以旋翼无人机为例进行说明。Fig. 1 is a schematic architecture diagram of an unmanned aerial system according to an embodiment of the present application. The unmanned aerial vehicle of this embodiment is described by taking a rotary-wing drone as an example.
无人飞行系统100可以包括无人飞行器110、显示设备130和控制终端140。无人飞行器可以是无人机,其可以包括动力系统150、飞行控制系统160和机架。动力系统150和飞行控制系统160可以设置在机架上。无人飞行器110可以与控制终端140和显示设备130进行无线通信。The unmanned aerial vehicle 100 may include an unmanned aerial vehicle 110, a display device 130 and a control terminal 140. The unmanned aerial vehicle may be an unmanned aerial vehicle, which may include a power system 150, a flight control system 160, and a frame. The power system 150 and the flight control system 160 may be arranged on the frame. The UAV 110 can wirelessly communicate with the control terminal 140 and the display device 130.
机架可以包括机身和脚架(也称为起落架)。机身可以包括中心架以及与中心架连接的一个或多个机臂,一个或多个机臂呈辐射状从中心架延伸出。脚架与机身连接,用于在无人飞行器110着陆时起支撑作用。The frame may include a fuselage and a tripod (also called a landing gear). The fuselage may include a center frame and one or more arms connected to the center frame, and the one or more arms extend radially from the center frame. The tripod is connected to the fuselage, and is used for supporting the UAV 110 when it lands.
动力系统150可以包括一个或多个电子调速器(简称为电调)151、一个或多个螺 旋桨21-24,以及与一个或多个螺旋桨21-24相对应的一个或多个电机1-4,在本实施例中,对应于四个螺旋桨21-24,电机的数量也为四个。在其他实施例中,电机和螺旋桨也可以是其他数目。电机152连接在电子调速器151与螺旋桨153之间,电机152和螺旋桨153可以设置在无人飞行器110的机臂上;电子调速器151用于接收飞行控制系统160产生的驱动信号,并根据驱动信号提供驱动电流给电机152,以控制电机152的转速。去驱动电流也可以称为电调电流。电机152用于驱动螺旋桨旋转,从而为无人飞行器110的飞行提供动力,该动力使得无人飞行器110能够实现一个或多个自由度的运动。在某些实施例中,无人飞行器110可以围绕一个或多个旋转轴旋转。例如,上述旋转轴可以包括横滚轴(Roll)、偏航轴(Yaw)和俯仰轴(pitch)。应理解,电机152可以是直流电机,也可以交流电机。另外,电机152可以是无刷电机,也可以是有刷电机。The power system 150 may include one or more electronic governors (referred to as ESCs) 151, one or more propellers 21-24, and one or more motors corresponding to the one or more propellers 21-24. 4. In this embodiment, corresponding to four propellers 21-24, the number of motors is also four. In other embodiments, the number of motors and propellers may also be other. The motor 152 is connected between the electronic governor 151 and the propeller 153. The motor 152 and the propeller 153 can be arranged on the arm of the UAV 110; the electronic governor 151 is used to receive the driving signal generated by the flight control system 160, and According to the driving signal, a driving current is provided to the motor 152 to control the rotation speed of the motor 152. The de-driving current can also be referred to as the ESC current. The motor 152 is used to drive the propeller to rotate, thereby providing power for the flight of the unmanned aerial vehicle 110, and the power enables the unmanned aerial vehicle 110 to realize one or more degrees of freedom of movement. In some embodiments, UAV 110 may rotate about one or more rotation axes. For example, the aforementioned rotation axis may include a roll axis (Roll), a yaw axis (Yaw), and a pitch axis (pitch). It should be understood that the motor 152 may be a DC motor or an AC motor. In addition, the motor 152 may be a brushless motor or a brushed motor.
飞行控制系统160可以包括飞行控制器161和传感系统162。传感系统162用于测量无人飞行器的姿态信息,即无人飞行器110在空间的位置信息和状态信息,例如,三维位置、三维角度、三维速度、三维加速度和三维角速度等。传感系统162例如可以包括陀螺仪、超声传感器、电子罗盘、惯性测量单元(Inertial Measurement Unit,IMU)、视觉传感器、全球导航卫星系统和气压计等传感器中的至少一种。例如,全球导航卫星系统可以是全球定位系统(Global Positioning System,GPS)。飞行控制器161用于控制无人飞行器110的飞行,例如,可以根据传感系统162测量的姿态信息控制无人飞行器110的飞行。应理解,飞行控制器161可以按照预先编好的程序指令对无人飞行器110进行控制,也可以通过响应来自控制终端140的一个或多个控制指令对无人飞行器110进行控制。The flight control system 160 may include a flight controller 161 and a sensing system 162. The sensing system 162 is used to measure the attitude information of the unmanned aerial vehicle, that is, the position information and state information of the unmanned aerial vehicle 110 in space, such as three-dimensional position, three-dimensional angle, three-dimensional velocity, three-dimensional acceleration, and three-dimensional angular velocity. The sensing system 162 may include, for example, at least one of sensors such as a gyroscope, an ultrasonic sensor, an electronic compass, an inertial measurement unit (IMU), a vision sensor, a global navigation satellite system, and a barometer. For example, the global navigation satellite system may be the Global Positioning System (GPS). The flight controller 161 is used to control the flight of the unmanned aerial vehicle 110. For example, the flight of the unmanned aerial vehicle 110 can be controlled according to the attitude information measured by the sensor system 162. It should be understood that the flight controller 161 can control the unmanned aerial vehicle 110 according to pre-programmed program instructions, and can also control the unmanned aerial vehicle 110 by responding to one or more control instructions from the control terminal 140.
显示设备130位于无人飞行系统100的地面端,可以通过无线方式与无人飞行器110进行通信,并且可以用于显示无人飞行器110的姿态信息。另外,还可以在显示设备130上显示成像装置拍摄的图像等。应理解,显示设备130可以是独立的设备,也可以集成在控制终端140中。The display device 130 is located on the ground end of the unmanned aerial vehicle 100, can communicate with the unmanned aerial vehicle 110 in a wireless manner, and can be used to display the attitude information of the unmanned aerial vehicle 110. In addition, the image taken by the imaging device and the like may also be displayed on the display device 130. It should be understood that the display device 130 may be an independent device or integrated in the control terminal 140.
控制终端140位于无人飞行系统100的地面端,可以通过无线方式与无人飞行器110进行通信,用于对无人飞行器110进行远程操纵。The control terminal 140 is located at the ground end of the unmanned aerial vehicle 100 and can communicate with the unmanned aerial vehicle 110 in a wireless manner for remote control of the unmanned aerial vehicle 110.
另外,无人飞行器110还可以机载有扬声器(图中未示出),该扬声器用于播放音频文件,扬声器可直接固定于无人飞行器110上。In addition, the UAV 110 may also be equipped with a speaker (not shown in the figure), which is used to play audio files, and the speaker may be directly fixed on the UAV 110.
应理解,上述对于无人飞行系统各组成部分的命名仅是出于标识的目的,并不应理 解为对本申请的实施例的限制。下面实施例所述的桨叶检测方法例如可以由飞行控制器161执行,并由飞行控制器161将信号回传至地面的显示设备130中。It should be understood that the above-mentioned naming of the components of the unmanned aerial system is only for identification purposes, and should not be understood as a limitation to the embodiments of the present application. The blade detection method described in the following embodiments may be executed by, for example, the flight controller 161, and the flight controller 161 transmits the signal back to the display device 130 on the ground.
本方案目前可以应用于四旋翼构型无人飞行器,用户可能装错桨叶的情况总共有15种。下面以X构型四旋翼为例说明。This solution can currently be applied to a four-rotor unmanned aerial vehicle, and there are a total of 15 situations in which the user may install the wrong blade. The following takes the X configuration quadrotor as an example.
图2所示为一种以X构型四旋翼的无人飞行器的示意图。如图2所示,标号A为无人飞行器的机头朝向,可见,无人飞行器110的机架连接有四个电机,分别为第一电机1、第二电机2、第三电机3和第四电机4。每一个电机连接有对应的桨叶,依序分别为第一桨叶21、第二桨叶22、第三桨叶23和第四桨叶24。此处的第一到第四仅为区别四个桨叶进行的命名,并无任何先后的关系。Figure 2 shows a schematic diagram of an unmanned aerial vehicle with a quadrotor in the X configuration. As shown in Figure 2, label A is the nose orientation of the unmanned aerial vehicle. It can be seen that the frame of the unmanned aerial vehicle 110 is connected to four motors, namely the first motor 1, the second motor 2, the third motor 3, and the second motor. Four motors 4. Each motor is connected with a corresponding blade, which is a first blade 21, a second blade 22, a third blade 23, and a fourth blade 24 in sequence. The first to fourth here are only for distinguishing the names of the four blades, and there is no relationship in any order.
第一电机1、第二电机3、第三电机3和第四电机4的电机旋转的方向依次为逆时针、顺时针、逆时针、顺时针。第一电机1和第三电机3使用的桨叶称为正桨,第二电机2和第四电机4使用的桨叶称为反桨。正反桨的区别在于其在各自的旋转方向上迎风攻角为正。The directions of motor rotation of the first motor 1, the second motor 3, the third motor 3, and the fourth motor 4 are counterclockwise, clockwise, counterclockwise, and clockwise in sequence. The blades used by the first motor 1 and the third motor 3 are called forward blades, and the blades used by the second motor 2 and the fourth motor 4 are called reverse blades. The difference between the forward and backward propellers is that their angles of attack are positive in their respective directions of rotation.
桨叶安装错误的方式可以有多种,安装错误包括:桨叶装反、桨叶对调等情况。具体来说,可以分为:无人飞行器同侧的两个桨叶装反、无人飞行器对侧的两个桨叶装反,单个桨叶安装错误、三个和三个以上桨叶安装错误、桨叶未安装等。以下举例进行说明。There can be many ways to install the blades incorrectly. Installation errors include: the blades are reversed, the blades are reversed, and so on. Specifically, it can be divided into: the two blades on the same side of the UAV are installed reversely, the two blades on the opposite side of the UAV are installed reversely, a single blade is installed incorrectly, and three or more blades are installed incorrectly. , The blade is not installed, etc. The following examples illustrate.
结合图1和图2所示,对于无人飞行器110的起飞异常的判断,例如可以有以下几种可用方法:As shown in FIG. 1 and FIG. 2, for judging the abnormal take-off of the UAV 110, for example, the following methods can be used:
1)正确安装桨叶21-24的无人飞行器在上述起飞过程中,其姿态角度和角速度会由控制器161控制在一个稳定状态,不会发散或者一直朝某个方向变化;任一桨叶安装错误后,该桨叶提供的拉力与正确安装时相反,会导致无人飞行器110在起飞过程中发生姿态侧翻,可通过判断起飞过程中无人飞行器角度和角速度的变化是否异常来判断起飞是否异常。1) During the above take-off process of the UAV with blades 21-24 correctly installed, its attitude angle and angular speed will be controlled by the controller 161 in a stable state, and will not diverge or change in a certain direction; any blade After the installation is wrong, the tension provided by the blade is opposite to that of the correct installation, which will cause the UAV 110 to roll over during takeoff. The takeoff can be judged by judging whether the angle and angular velocity of the UAV changes abnormally during the takeoff. Whether it is abnormal.
2)正确安装桨叶的无人飞行器在上述起飞过程中,其飞行控制器161发出的控制指令与无人飞行器110实际运动反馈的误差会在一个合理范围内;任一桨叶安装错误后,飞行姿态角度和角速度发生异常,飞行控制器161会输出矫正飞行姿态和角速度的 控制指令,该控制指令与无人飞行器110实际运动反馈的误差相比较正确安装的无人飞行器110很大,通过判断起飞过程中控制器指令与反馈的误差来判断起飞是否异常。前述的姿态角度,可以是无人飞行器在坐标系内针对每一坐标轴的姿态角度信息,例如无人飞行器在X-Y-Z坐标系内分别针对三个坐标轴的姿态角度,或者无人飞行器的空间坐标与对地坐标的旋转角度关系等。2) During the above take-off process of the UAV with the correct blades, the error between the control command issued by the flight controller 161 and the actual motion feedback of the UAV 110 will be within a reasonable range; after any blade is installed incorrectly, If the flight attitude angle and angular velocity are abnormal, the flight controller 161 will output a control instruction to correct the flight attitude and angular velocity. Compared with the error of the actual motion feedback of the UAV 110, the control instruction is very large. The error of the controller command and feedback during the take-off process is used to determine whether the take-off is abnormal. The aforementioned attitude angle may be the attitude angle information of the unmanned aerial vehicle for each coordinate axis in the coordinate system, for example, the attitude angle of the unmanned aerial vehicle for the three coordinate axes in the XYZ coordinate system, or the space coordinates of the unmanned aerial vehicle. The relationship with the rotation angle of the ground coordinate, etc.
3)对于一个满足飞行安全需求的无人飞行器110,其最大动力和整机重量的比例(下称推重比)要达到一定数值。可判断起飞过程中实际动力的输出和无人飞行器状态的变化来判定是否推重比异常,进一步判断起飞是否异常。3) For an unmanned aerial vehicle 110 that meets flight safety requirements, the ratio of its maximum power to the weight of the entire aircraft (hereinafter referred to as thrust-to-weight ratio) must reach a certain value. It can judge the actual power output and the change of the UAV status during the take-off process to judge whether the thrust-to-weight ratio is abnormal, and further judge whether the take-off is abnormal.
4)桨叶安装错误时,相同转速下,对应的电机的电流和正确安装桨叶的电机的电流相比会不同,可通过判断该异常来判断起飞是否异常。4) When the blade is installed incorrectly, at the same speed, the current of the corresponding motor will be different from the current of the motor with the blade correctly installed. You can judge whether the takeoff is abnormal by judging the abnormality.
对于无人飞行器110的哪个桨叶安装错误的识别,例如可以有以下几种可用方法:For the identification of which blade of the UAV 110 is installed incorrectly, for example, the following methods are available:
第一,桨叶安装错误后,无人飞行器110在电机加速的过程中会产生较大的姿态角度和角速度变化,通过判断无人飞行器角度和角速度的大小、方向可以判断出哪个桨叶装反。First, after the blades are installed incorrectly, the UAV 110 will have a large attitude angle and angular velocity change during the acceleration of the motor. By judging the magnitude and direction of the UAV's angle and angular velocity, it can be judged which blade is reversed. .
第二,桨叶安装错误后,其对应电机在相同转速下的电流与正确安装桨叶的电机相比会有一定差异,可用来判断哪个桨叶装反。Second, after the blade is installed incorrectly, the current of the corresponding motor at the same speed will be different from that of the motor with the blade installed correctly, which can be used to determine which blade is installed reversely.
图3所示为本申请一实施例的无人飞行器桨叶安装检测方法的流程图。如图3所示,本发明实施例提出一种无人飞行器桨叶安装检测方法,可以基于前述原理检测无人飞行器的桨叶安装正确与否。该无人飞行器桨叶安装检测方法包括:FIG. 3 shows a flowchart of a method for detecting the installation of a blade of an unmanned aerial vehicle according to an embodiment of the application. As shown in FIG. 3, an embodiment of the present invention proposes a method for detecting the installation of blades of an unmanned aerial vehicle, which can detect whether the blades of an unmanned aerial vehicle are installed correctly based on the foregoing principle. The detection method for the installation of the blades of the unmanned aerial vehicle includes:
S101,获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;S101: Acquire take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control instruction parameters;
S102,根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;S102: Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
S103,根据所述桨叶安装信息,执行对应的操作。S103: Perform a corresponding operation according to the blade installation information.
以下具体进行介绍。The following is a specific introduction.
在S101中,执行主体,例如是图1所示的无人飞行器110其中的飞行控制器161,用于获取无人飞行器110的无人飞行器起飞参数。无人飞行器起飞参数可以包括 无人飞行器110的运动状态参数和控制指令参数。In S101, the execution subject, for example, the flight controller 161 in the UAV 110 shown in FIG. 1, is used to obtain the UAV takeoff parameters of the UAV 110. The take-off parameters of the UAV may include the motion state parameters and the control instruction parameters of the UAV 110.
运动状态参数例如可以包括:当前的无人飞行器角速度、当前的无人飞行器角加速度的至少一种。其中无人飞行器角速度可以包括翻滚角速度和偏航角速度。无人飞行器角加速度可以包括偏航角加速度。进一步地,在一些实施例中,翻滚角速度可以进一步区分为前后翻滚角速度和左右翻转角速度。运动状态参数可以从图1所示的传感系统162读取获得。The motion state parameter may include, for example, at least one of the current angular velocity of the unmanned aerial vehicle and the current angular acceleration of the unmanned aerial vehicle. The angular velocity of the UAV can include the roll angular velocity and the yaw angular velocity. The UAV angular acceleration may include the yaw angular acceleration. Further, in some embodiments, the roll angular velocity can be further divided into the front and rear roll angular velocity and the left and right roll angular velocity. The motion state parameters can be read from the sensor system 162 shown in FIG. 1.
控制指令参数例如可以包括无人飞行器的电机拉力指令参数、无人飞行器角度控制指令、无人飞行器角加速度控制指令的一种或多种。The control command parameter may include, for example, one or more of the motor tension command parameter of the unmanned aerial vehicle, the angle control command of the unmanned aerial vehicle, and the angular acceleration control command of the unmanned aerial vehicle.
电机拉力指令参数包含了电机需要提供的拉力的大小。无人飞行器角度控制指令例如为用于控制无人飞行器的角度的指令;无人飞行器角加速度控制指令例如为用于控制无人飞行器的角加速度的指令。The motor pulling force command parameter includes the amount of pulling force that the motor needs to provide. The unmanned aerial vehicle angle control command is, for example, a command for controlling the angle of the unmanned aerial vehicle; the unmanned aerial vehicle angular acceleration control command is, for example, a command for controlling the angular acceleration of the unmanned aerial vehicle.
在一些实施例中,无人飞行器起飞参数还可以包括无人飞行器的电调电流参数。即无人飞行器的电调151所输出至每一个电机1-4的电流参数。In some embodiments, the take-off parameters of the UAV may also include the ESC current parameters of the UAV. That is, the current parameters output by the ESC 151 of the UAV to each motor 1-4.
无人飞行器的控制指令参数可以是直接存储在飞行控制器161中参数,由飞行控制器161直接获取这些控制指令参数。例如,电机拉力指令参数来源于控制终端140向无人飞行器的飞行控制器161发送的指令。其中包含电机需要提供的拉力大小。这一指令被无人飞行器的接收装置所接收并发送至飞行控制器161,因此飞行控制器161可以直接获取电机拉力指令参数。同理,无人飞行器角度控制指令、无人飞行器角加速度控制指令也可以是由和电调电流参数可以是由控制终端140向无人飞行器的飞行控制器161发送的指令。电调电流参数则是电调151输出至每一电机1-4的电流大小,也可以由飞行控制器161获取。The control command parameters of the unmanned aerial vehicle may be parameters directly stored in the flight controller 161, and the flight controller 161 directly obtains these control command parameters. For example, the motor tension command parameter is derived from the command sent by the control terminal 140 to the flight controller 161 of the unmanned aerial vehicle. It contains the amount of pulling force that the motor needs to provide. This command is received by the receiving device of the unmanned aerial vehicle and sent to the flight controller 161, so the flight controller 161 can directly obtain the motor pull command parameters. In the same way, the UAV angle control command and the UAV angular acceleration control command may also be the command sent by the control terminal 140 to the flight controller 161 of the UAV. The ESC current parameter is the magnitude of the current output by the ESC 151 to each motor 1-4, and can also be obtained by the flight controller 161.
在S102中,执行主体,例如飞行控制器161,可以根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息。In S102, the execution body, such as the flight controller 161, may determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle.
图4是本申请实施例的无人飞行器桨叶安装检测方法的S102的子流程图。如图4所示,S102可以包括S1020a到S1020c:FIG. 4 is a sub-flow chart of S102 of the method for detecting the installation of blades of an unmanned aerial vehicle according to an embodiment of the present application. As shown in Figure 4, S102 may include S1020a to S1020c:
S1020a,执行主体根据所述无人飞行器起飞参数确定桨叶安装错误。S1020a: The execution subject determines that the blade is installed incorrectly according to the take-off parameters of the unmanned aerial vehicle.
在实际应用中,可以根据无人飞行器的运动状态参数和控制指令参数,确定无人飞行器的起飞异常,从而判断出是否有桨叶安装错误。具体地,可以利用无人飞行器的运 动状态参数和控制指令参数综合判断。运动状态参数例如包括无人飞行器的姿态角度、角速度、角加速度。控制指令参数例如可以包括电机拉力指令参数、无人飞行器角度控制指令、无人飞行器角速度控制指令、无人飞行器角加速度控制指令至少其中之一。In practical applications, the abnormal take-off of the unmanned aerial vehicle can be determined according to the movement state parameters and the control command parameters of the unmanned aerial vehicle, so as to determine whether there is a blade installation error. Specifically, the motion state parameters and control command parameters of the UAV can be used for comprehensive judgment. The motion state parameters include, for example, the attitude angle, angular velocity, and angular acceleration of the UAV. The control command parameter may include, for example, at least one of a motor tension command parameter, an unmanned aerial vehicle angle control command, an unmanned aerial vehicle angular velocity control command, and an unmanned aerial vehicle angular acceleration control command.
在一些实施例中,控制参数还可以包括无人飞行器的前后翻滚/左右滚转角加速度指令及对应阈值、前后翻滚/左右滚转角速度反馈和角加速度反馈、前后翻滚/左右滚转姿态角度等一种或几种。In some embodiments, the control parameters may also include the front and rear roll/left-right roll angular acceleration commands and corresponding thresholds of the UAV, the front-back roll/left-right roll angular velocity feedback and angular acceleration feedback, the front-back roll/left-right roll attitude angle, etc. Kind or several kinds.
利用这些参数进行综合判断,当满足特定条件时,可以判断出桨叶装错,从而执行进一步的操作。Using these parameters to make comprehensive judgments, when certain conditions are met, it can be judged that the blades are installed incorrectly, so that further operations can be performed.
本领域技术人员可以明确的是,上述列举的运动参数和控制参数,在实际使用中并非限定为需要所有参数,本领域技术人员可以在所列举的基础上进行各种等同或者变化,从而判断是否有桨叶装错。以下举例进行说明。It is clear to those skilled in the art that the motion parameters and control parameters listed above are not limited to all parameters in actual use. Those skilled in the art can make various equivalents or changes on the basis of the list to determine whether There is a wrong blade installation. The following examples illustrate.
例如,如果是桨叶21和桨叶22安装错误导致起飞异常,其判断可由如下条件判定:For example, if the installation error of the blade 21 and the blade 22 causes the abnormal takeoff, the judgment can be determined by the following conditions:
Figure PCTCN2020087307-appb-000001
Figure PCTCN2020087307-appb-000001
以上三个条件满足其中之一即可判断起飞异常。其中α T为无人飞行器起飞过程中T时刻相对起飞前的姿态变化量,α 0为姿态判断阈值,α cmd为起飞过程中姿态控制指令,α fbk为姿态反馈,α err0为姿态控制误差判断阈值,
Figure PCTCN2020087307-appb-000002
为角加速度控制指令,
Figure PCTCN2020087307-appb-000003
为角加速度指令判断阈值,
Figure PCTCN2020087307-appb-000004
为实际角加速度反馈,向前滚为负向后滚为正,
Figure PCTCN2020087307-appb-000005
为实际角速度反馈,向前滚为负向后滚为正,
Figure PCTCN2020087307-appb-000006
为角速度判断阈值。值得注意的是,前述的判断阈值可以通过实际测试选定,在此并不特别限定。
If one of the above three conditions is met, it can be judged that the takeoff is abnormal. Among them, α T is the attitude change at time T during the take-off of the unmanned aerial vehicle, α 0 is the attitude judgment threshold, α cmd is the attitude control command during the take-off process, α fbk is the attitude feedback, and α err0 is the attitude control error judgment. Threshold,
Figure PCTCN2020087307-appb-000002
Is the angular acceleration control command,
Figure PCTCN2020087307-appb-000003
Is the angular acceleration command judgment threshold,
Figure PCTCN2020087307-appb-000004
Is the actual angular acceleration feedback, rolling forward is negative and rolling backward is positive,
Figure PCTCN2020087307-appb-000005
Is the actual angular velocity feedback, rolling forward is negative and rolling backward is positive,
Figure PCTCN2020087307-appb-000006
Is the angular velocity judgment threshold. It is worth noting that the aforementioned judgment threshold can be selected through actual tests, and is not particularly limited here.
再例如,如果是桨叶21安装错误,可能导致起飞时发生前滚异常和右滚异常,具体来说,当参数表现为如下时,则认为发生了前滚和右滚异常,因此可以判断出有装错的桨叶。For another example, if the blade 21 is installed incorrectly, it may cause abnormal roll forward and roll right during takeoff. Specifically, when the parameters are as follows, it is considered that abnormal roll forward and roll right have occurred, so it can be judged There is a wrong blade.
判断前滚异常公式如下:The formula for judging the roll-forward exception is as follows:
Figure PCTCN2020087307-appb-000007
Figure PCTCN2020087307-appb-000007
其中α T为无人飞行器起飞过程中T时刻相对起飞前的姿态变化量,α 0为姿态判断阈值,α cmd为起飞过程中姿态控制指令,α fbk为姿态反馈,α err0为姿态控制误差判断阈 值,
Figure PCTCN2020087307-appb-000008
为角加速度控制指令,
Figure PCTCN2020087307-appb-000009
为角加速度指令判断阈值,
Figure PCTCN2020087307-appb-000010
为实际角加速度反馈,向前滚为负向后滚为正,
Figure PCTCN2020087307-appb-000011
为实际角速度反馈,向前滚为负向后滚为正,
Figure PCTCN2020087307-appb-000012
为角速度判断阈值。值得注意的是,前述的判断阈值可以通过实际测试选定,在此并不特别限定。
Among them, α T is the attitude change at time T during the take-off of the unmanned aerial vehicle, α 0 is the attitude judgment threshold, α cmd is the attitude control command during the take-off process, α fbk is the attitude feedback, and α err0 is the attitude control error judgment. Threshold,
Figure PCTCN2020087307-appb-000008
Is the angular acceleration control command,
Figure PCTCN2020087307-appb-000009
Is the angular acceleration command judgment threshold,
Figure PCTCN2020087307-appb-000010
Is the actual angular acceleration feedback, rolling forward is negative and rolling backward is positive,
Figure PCTCN2020087307-appb-000011
Is the actual angular velocity feedback, rolling forward is negative and rolling backward is positive,
Figure PCTCN2020087307-appb-000012
Is the angular velocity judgment threshold. It is worth noting that the aforementioned judgment threshold can be selected through actual tests, and is not particularly limited here.
判断右滚异常公式如下:The formula for judging the right roll abnormality is as follows:
Figure PCTCN2020087307-appb-000013
Figure PCTCN2020087307-appb-000013
其中β T为无人飞行器起飞过程中T时刻相对起飞前的左右滚转姿态变化量,β 0为左右滚转姿态变化阈值,β cmd为起飞过程中左右滚转姿态控制指令,β fbk为左右滚转姿态反馈,β err0为左右滚转姿态控制误差判断阈值,
Figure PCTCN2020087307-appb-000014
为左右滚转角加速度控制指令,
Figure PCTCN2020087307-appb-000015
为左右滚转角加速度指令判断阈值,
Figure PCTCN2020087307-appb-000016
为实际左右滚转角加速度反馈,向左滚为负向右滚为正,
Figure PCTCN2020087307-appb-000017
为实际左右滚转角速度反馈,向左滚为负向右滚为正,
Figure PCTCN2020087307-appb-000018
为左右滚转角速度判断阈值。值得注意的是,前述的判断阈值可以通过实际测试选定,在此并不特别限定。当判断到前滚和右滚有一个异常时,即认为起飞异常,判断出现了桨叶安装错误。
Among them, β T is the change of the left and right roll attitude at time T during the take-off process of the unmanned aerial vehicle, β 0 is the left and right roll attitude change threshold, β cmd is the left and right roll attitude control command during takeoff, and β fbk is the left and right roll attitude. Rolling attitude feedback, β err0 is the left and right rolling attitude control error judgment threshold,
Figure PCTCN2020087307-appb-000014
For the left and right roll angular acceleration control command,
Figure PCTCN2020087307-appb-000015
Determine the threshold for the left and right roll angular acceleration command,
Figure PCTCN2020087307-appb-000016
It is the feedback of the actual left and right roll angular acceleration. Rolling to the left is negative and rolling to the right is positive.
Figure PCTCN2020087307-appb-000017
It is the feedback of the actual left and right rolling angular velocity. Rolling to the left is negative and rolling to the right is positive.
Figure PCTCN2020087307-appb-000018
It is the threshold value for judging the angular velocity of the left and right rolls. It is worth noting that the aforementioned judgment threshold can be selected through actual tests, and is not particularly limited here. When it is judged that there is an abnormality in the forward roll and the right roll, it is considered that the take-off is abnormal, and it is judged that a blade installation error has occurred.
在S1020a之后,进一步地,执行主体还可以执行S1020b确定安装错误的桨叶,例如判断是哪一位置个或多个的桨叶安装错误。After S1020a, further, the execution subject may also execute S1020b to determine the improperly installed blade, for example, to determine which position one or more blades are installed incorrectly.
根据前述的无人飞行器的姿态和无人飞行器起飞参数的异常,还可以判断出具体的安装错误的桨叶。无人飞行器的桨叶安装错误的形式有多种,表1所示为每一种安装错误的类型、无人飞行器的表现及判断是否为该类安装错误的参数。具体的原理将在后续详细说明。According to the aforementioned unmanned aerial vehicle's attitude and abnormal take-off parameters of the unmanned aerial vehicle, it is also possible to determine the specific improperly installed blade. There are many forms of unmanned aerial vehicle blade installation errors. Table 1 shows the type of each installation error, the performance of the unmanned aerial vehicle, and the parameters for judging whether it is such an installation error. The specific principle will be explained in detail later.
Figure PCTCN2020087307-appb-000019
Figure PCTCN2020087307-appb-000019
表1Table 1
在表1中,所列的参数对于判断哪一个或者多个桨叶装错并非全都是必要的,本领域技术人员可以根据需要获取参数进行判断。In Table 1, the listed parameters are not all necessary for determining which one or more blades are installed incorrectly, and those skilled in the art can obtain the parameters as needed to make a judgment.
在本申请实施例中,为了描述的清晰,将无人飞行器110的机头所在的方向A定义为“前”,则相反的一侧是“后”,无人飞行器的俯视图中机头的左侧和后侧分别定义了“左”和“右”。前述的“同侧”为两个桨叶相邻设置,即顺时针或逆时针相邻的两个桨 叶;“对侧”为两个桨叶相对设置,即顺时针或逆时针不相邻的两个桨叶。则根据上表,同侧桨叶装反表现为翻滚,对侧桨叶装反表现为旋转,单个桨叶装错表现为朝两个方向翻滚或翻转。如果是三个以上的桨叶装错,表现为电机拉力输出指令参数异常,或者电调电流值输出异常。In the embodiments of the present application, for clarity of description, the direction A of the nose of the UAV 110 is defined as “front”, and the opposite side is “rear”. The side and back sides define "left" and "right" respectively. The aforementioned "same side" means that two blades are arranged adjacently, that is, two blades that are adjacent clockwise or counterclockwise; "opposite side" means that two blades are arranged oppositely, that is, two blades that are not adjacent clockwise or counterclockwise. Paddles. According to the above table, the reverse installation of the same side blade shows a roll, the opposite installation shows a rotation, and a single blade installation shows a roll or flip in two directions. If more than three blades are installed incorrectly, it means that the motor pull output command parameters are abnormal, or the ESC current value output is abnormal.
通过上述方式,可以判断出桨叶是否安装错误以及哪一个或者多个桨叶安装错误。Through the above method, it can be determined whether the blade is installed incorrectly and which one or more blades are installed incorrectly.
在执行S1020b之后,还可以执行对S1020c:发出提示信息,例如包括如下至少一种:After S1020b is executed, S1020c: sending prompt information may also be executed, for example, including at least one of the following:
将确定出的安装错误的桨叶的信息对应的提示信息发送至显示设备;或者Send the determined prompt information corresponding to the information of the incorrectly installed blade to the display device; or
根据确定出的安装错误的桨叶的信息发出对应的提示信息。According to the determined information of the improperly installed blade, the corresponding prompt message will be sent out.
在一种情况下,执行主体可以将判断出的安装错误的桨叶的信息(例如桨叶21安装错误)发送至显示设备进行显示,显示设备例如是图1所示的显示设备130。或者是用户的VR眼镜、安装有App的手机等。In one case, the execution body may send the determined information of the incorrectly installed blade (for example, the installation error of the blade 21) to a display device for display. The display device is, for example, the display device 130 shown in FIG. 1. Or the user's VR glasses, mobile phone with App installed, etc.
在另一种情况下,执行主体可以带有声音、光线等提示装置,根据确定出的安装错误的桨叶信息,执行主体可以发出对应的提示信息。例如通过对应于桨叶设置的灯光提示用户该桨叶安装错误。In another case, the execution body may have a prompt device such as sound, light, etc., and according to the determined blade information of the installation error, the execution body may send out corresponding prompt information. For example, a light corresponding to the setting of the blade is used to prompt the user that the blade is installed incorrectly.
在发送至显示设备或者执行主体直接发出对应的提示信息之后,本发明可以进一步包括:提示正确的桨叶安装方式的信息,例如,可以通过用户的点选,直接在显示设备上显示正确的安装步骤或者图片等,方便用户修正。After sending the corresponding prompt information to the display device or the execution subject directly, the present invention may further include: information prompting the correct installation method of the blade, for example, the correct installation can be directly displayed on the display device through the user's click Steps or pictures are convenient for users to correct.
在S103中,执行主体,例如飞行控制器161,可以根据所述桨叶安装信息,执行对应的操作。In S103, the execution body, for example, the flight controller 161, may execute corresponding operations according to the blade installation information.
上述对应的操作例如可以包括一下至少其中之一:The above-mentioned corresponding operation may include at least one of the following, for example:
S103a,将提示信息发送至显示设备;S103a: Send the prompt information to the display device;
S103b,根据所述桨叶安装信息显示对应的提示信息;S103b: Display corresponding prompt information according to the blade installation information;
S103c,停止所述无人飞行器的桨叶转动。S103c: Stop the rotation of the blades of the unmanned aerial vehicle.
针对S103a,飞行控制器161可以将所判断出的桨叶安装信息发送至显示设备130。显示设备130可以是安装有与飞行控制器161通过信号传输的等方式连接的用户 的手机、与无人飞行器110成套但是分离设置的显示装置、集成于无人飞行器的显示屏幕等。飞行控制器161所发出的与安装信息对应的提示信息可以为提示有桨叶安装错误的信息,或者是具体的提示哪一桨叶安装错误的信息等,在此并不限制。For S103a, the flight controller 161 may send the determined blade installation information to the display device 130. The display device 130 may be a mobile phone installed with the user connected to the flight controller 161 through signal transmission, a display device that is integrated with the unmanned aerial vehicle 110 but is provided separately, or a display screen integrated in the unmanned aerial vehicle. The prompt message corresponding to the installation information sent by the flight controller 161 may be a message prompting a blade installation error, or a specific message prompting which blade is installed incorrectly, etc., which is not limited here.
针对S103b,飞行控制器161上可以集成有显示装置,因此可以直接在飞行控制器161上基于桨叶安装信息显示对应的提示信息。提示信息同样可以为提示有桨叶安装错误的信息,或者是具体的提示哪一桨叶安装错误的信息等,在此并不限制。For S103b, a display device may be integrated on the flight controller 161, so the corresponding prompt information can be directly displayed on the flight controller 161 based on the blade installation information. The prompt message can also be a message indicating that there is a blade installation error, or a specific message indicating which blade is installed incorrectly, etc., which is not limited here.
针对S103c,鉴于已经确定出桨叶安装信息,则飞行控制器161可以直接控制停止桨叶转动,即对所有的桨叶对应的电机进行停机,以避免损害无人飞行器。在一些情况下,飞行控制器161除了控制停止桨叶转动以外,还可以控制无人飞行器的其他功能同时停止工作,以保护无人飞行器免于损坏。Regarding S103c, since the blade installation information has been determined, the flight controller 161 may directly control the rotation of the blades, that is, stop the motors corresponding to all the blades to avoid damage to the unmanned aerial vehicle. In some cases, in addition to controlling the rotation of the blades, the flight controller 161 can also control other functions of the unmanned aerial vehicle to stop working at the same time, so as to protect the unmanned aerial vehicle from damage.
在本发明的方案中,可以仅执行S103a、S103b或者S103c,也可以执行两者或者两者以上,并且执行的顺序并不限制,例如,可以执行S103a和S103c,先执行S103a将提示信息发送至显示设备;在执行S103c停止所述无人飞行器的桨叶转动。或者先执行S103c停止所述无人飞行器的桨叶转动,再执行S103a将提示信息发送至显示设备等。In the solution of the present invention, only S103a, S103b, or S103c can be executed, or two or more of them can be executed, and the order of execution is not limited. For example, S103a and S103c can be executed, and S103a can be executed first to send the prompt information to Display device; in step S103c, the rotation of the blades of the UAV is stopped. Or first execute S103c to stop the rotation of the blades of the UAV, and then execute S103a to send the prompt information to the display device or the like.
在一些实施例中,S102即根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息,可以包括:根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶安装错误;所述S103根据所述桨叶安装信息,执行对应的操作包括:停止所述无人飞行器的桨叶转动。In some embodiments, S102 is determining the installation information of the blades of the UAV according to the take-off parameters of the UAV, which may include: determining the propellers of the UAV according to the take-off parameters of the UAV. Blade installation error; in S103, according to the blade installation information, performing a corresponding operation includes: stopping the rotation of the blade of the unmanned aerial vehicle.
本发明实施例提出的无人飞行器桨叶安装检测方法,可以进行起飞异常保护和桨叶安装错误识别的技术效果,具体如下:The method for detecting the installation of blades of an unmanned aerial vehicle proposed in the embodiment of the present invention can perform the technical effects of abnormal take-off protection and recognition of blade installation errors, which are specifically as follows:
本发明实施例提出的无人飞行器桨叶安装检测方法,可以判断无人飞行器桨叶安装错误导致的起飞异常,并进行自动停桨等处理操作。The method for detecting the installation of the blades of the unmanned aerial vehicle proposed in the embodiment of the present invention can determine the take-off abnormality caused by the wrong installation of the blades of the unmanned aerial vehicle, and perform processing operations such as automatically stopping the propellers.
本发明针对多种装错桨情况都做了异常判断自动停桨的策略。通过利用运动参数和控制参数综合判断,提高了异常判断的及时性,大大降低了装错桨起飞无人飞行器发生地面翻滚以及地面不受控飞行的概率。The present invention makes a strategy of automatically stopping the propeller by abnormal judgment for various situations of incorrect propeller installation. Through the comprehensive judgment of motion parameters and control parameters, the timeliness of abnormal judgment is improved, and the probability of ground roll and uncontrolled ground flight of the unmanned aerial vehicle with wrong propellers is greatly reduced.
此外,本发明实施例提出的无人飞行器桨叶安装检测方法,利用无人飞行器的运动 参数和控制参数,可以根据起飞异常时无人飞行器运动表现和控制输出判断出哪个或者哪些桨叶装反,用来给用户精准提示。In addition, the method for detecting the installation of the blades of the unmanned aerial vehicle proposed in the embodiment of the present invention uses the motion parameters and control parameters of the unmanned aerial vehicle to determine which blade or blades are installed incorrectly based on the unmanned aerial vehicle's motion performance and control output during abnormal takeoff. , Used to give users precise tips.
在S102中,前述已经利用表1确定了每一种安装错误的类型、无人飞行器的表现及判断是否为该类安装错误所需要的参数。以下通过四种常见的安装错误情况,对每一种安装错误的表现和表现异常的参数等进行详细说明。In S102, Table 1 has been used to determine the type of each installation error, the performance of the UAV, and the parameters required to determine whether the installation error is of this type. The following describes in detail the performance of each installation error and abnormal parameters through four common installation error situations.
第一种情况:两个桨叶安装错误。这种情况包括:1,同侧两个桨叶装反;2,对角两个桨叶装反。The first case: the two blades are installed incorrectly. This situation includes: 1. Two blades on the same side are installed reversely; 2. Two opposite blades are installed reversely.
对于装错2个桨叶的起飞过程:同侧2个桨叶装错(包括桨叶21/桨叶22、桨叶22/桨叶23、桨叶23/桨叶24、桨叶21/桨叶24共4种情况)无人飞行器会表现在地面绕一侧翻滚(前、后、左、右)。以桨叶21/桨叶22装反为例:For the takeoff process with two wrong blades installed: two blades on the same side are installed wrong (including blade 21/blade 22, blade 22/blade 23, blade 23/blade 24, blade 21/blade There are 4 situations in Ye 24) The UAV will roll around one side on the ground (front, back, left, right). Take blade 21/blade 22 reversed as an example:
如图5所示为桨叶21和桨叶22装错起飞翻滚示意图。起飞过程中桨叶21和桨叶22产生的合力为F 12,桨叶23和桨叶24产生的合力为F 34,无人飞行器本身的重力记为G,无人飞行器还受到地面的支反力F 支反力 Figure 5 shows a schematic diagram of the improper installation of the blade 21 and the blade 22 during take-off and roll. During takeoff, the resultant force generated by blade 21 and blade 22 is F 12 , the resultant force generated by blade 23 and blade 24 is F 34 , the gravity of the unmanned aerial vehicle itself is recorded as G, and the unmanned aerial vehicle is also supported by the ground. Force F reaction force
无人飞行器重心位置距离电机3和电机4距离为L 34,距离电机1和电机2距离为L 12,总长L,无人飞行器绕前脚架的转动惯量为I。 The distance between the center of gravity of the unmanned aerial vehicle and motor 3 and motor 4 is L 34 , the distance from motor 1 and motor 2 is L 12 , the total length is L, and the moment of inertia of the unmanned aerial vehicle around the front leg is I.
对于无人飞行器110在地面翻滚的情况,可以用力矩角加速度方程表示:For the situation that the UAV 110 rolls on the ground, it can be expressed by the moment angular acceleration equation:
Figure PCTCN2020087307-appb-000020
Figure PCTCN2020087307-appb-000020
其中,α为无人飞行器相对水平面低头的角度,
Figure PCTCN2020087307-appb-000021
为对应的角加速度。
Among them, α is the angle of the UAV's head down relative to the horizontal plane,
Figure PCTCN2020087307-appb-000021
Is the corresponding angular acceleration.
可见随着电机转速提高,无人飞行器110会产生一个向前翻滚的角加速度,随时间积累无人飞行器110会产生一个向前的翻滚的角速度,最终向前姿态翻滚。It can be seen that as the motor speed increases, the UAV 110 will generate a forward roll angular acceleration, and over time, the UAV 110 will generate a forward roll angular velocity, and finally roll forward.
在这个过程中,飞行控制器161虽然会不断加大电机1和电机2的输出,以期提高电机1和电机2的拉力,扭转无人飞行器向前翻滚的趋势,但因为桨叶21和桨叶22装错,产生的力F 12是向下的,由地面支反力抵消,无法产生足够拉力扭转向前翻滚趋势。 In this process, although the flight controller 161 will continue to increase the output of the motor 1 and motor 2, in order to increase the pulling force of the motor 1 and motor 2, and reverse the tendency of the unmanned aerial vehicle to roll forward, but because the blade 21 and the blade 22 is installed incorrectly, the generated force F 12 is downward, which is offset by the ground support reaction force, and cannot generate enough pulling force to reverse the forward rolling trend.
综上分析,针对桨叶21和桨叶22装错起飞异常的判断可由如下条件判定:Based on the above analysis, the judgment for the abnormal takeoff of the blade 21 and the blade 22 installed incorrectly can be judged by the following conditions:
Figure PCTCN2020087307-appb-000022
Figure PCTCN2020087307-appb-000022
以上三个条件满足其中之一即可判断起飞异常。其中α T为无人飞行器起飞过程中T 时刻相对起飞前的姿态变化量,α 0为姿态判断阈值,α cmd为起飞过程中姿态控制指令,α fbk为姿态反馈,α err0为姿态控制误差判断阈值,
Figure PCTCN2020087307-appb-000023
为角加速度控制指令,
Figure PCTCN2020087307-appb-000024
为角加速度指令判断阈值,
Figure PCTCN2020087307-appb-000025
为实际角加速度反馈,向前滚为负向后滚为正,
Figure PCTCN2020087307-appb-000026
为实际角速度反馈,向前滚为负向后滚为正,
Figure PCTCN2020087307-appb-000027
为角速度判断阈值。值得注意的是,前述的判断阈值可以通过实际测试选定,在此并不特别限定。
If one of the above three conditions is met, it can be judged that the takeoff is abnormal. Among them, α T is the attitude change at time T during take-off of the unmanned aerial vehicle, α 0 is the attitude judgment threshold, α cmd is the attitude control command during the take-off process, α fbk is the attitude feedback, and α err0 is the attitude control error judgment. Threshold,
Figure PCTCN2020087307-appb-000023
Is the angular acceleration control command,
Figure PCTCN2020087307-appb-000024
Is the angular acceleration command judgment threshold,
Figure PCTCN2020087307-appb-000025
Is the actual angular acceleration feedback, rolling forward is negative and rolling backward is positive,
Figure PCTCN2020087307-appb-000026
Is the actual angular velocity feedback, rolling forward is negative and rolling backward is positive,
Figure PCTCN2020087307-appb-000027
Is the angular velocity judgment threshold. It is worth noting that the aforementioned judgment threshold can be selected through actual tests, and is not particularly limited here.
针对桨叶21和桨叶22装错桨叶的识别,可通过如下条件判断:For the identification of the blade 21 and the blade 22 with the wrong blade, the following conditions can be used to judge:
Figure PCTCN2020087307-appb-000028
Figure PCTCN2020087307-appb-000028
其中
Figure PCTCN2020087307-appb-000029
为T时刻无人飞行器前翻角速度,向前为负向后为正,
Figure PCTCN2020087307-appb-000030
为前滚角速度判断阈值,是一个绝对值较大的负值,
Figure PCTCN2020087307-appb-000031
为T时刻无人飞行器左右滚转的角速度,向左为负向右为正,
Figure PCTCN2020087307-appb-000032
为左右滚转角速度判断阈值,
Figure PCTCN2020087307-appb-000033
为T时刻无人飞行器偏航(yaw)角速度,俯视图上逆时针旋转为负,顺时针旋转为正,
Figure PCTCN2020087307-appb-000034
为偏航(yaw)角速度判断阈值。在判断发生异常后,同时满足上述条件即可判定桨叶21和桨叶22安装错误。
in
Figure PCTCN2020087307-appb-000029
Is the forward roll angular velocity of the UAV at time T, forward is negative and backward is positive,
Figure PCTCN2020087307-appb-000030
Is the judgment threshold of the roll forward angular velocity, which is a negative value with a large absolute value.
Figure PCTCN2020087307-appb-000031
Is the angular velocity of the unmanned aerial vehicle rolling left and right at time T, the left is negative and the right is positive,
Figure PCTCN2020087307-appb-000032
Is the judging threshold of the left and right roll angular velocity,
Figure PCTCN2020087307-appb-000033
Is the yaw angular velocity of the unmanned aerial vehicle at time T, the counterclockwise rotation in the top view is negative, and the clockwise rotation is positive,
Figure PCTCN2020087307-appb-000034
Is the yaw angular velocity judgment threshold. After the abnormality is judged, and the above conditions are met at the same time, it can be judged that the blade 21 and the blade 22 are installed incorrectly.
针对桨叶22和桨叶23号、桨叶23和桨叶24号、桨叶21和桨叶24安装错误情况,起飞异常以及桨叶安装错误判断方法与上述方法类似,可以利用无人飞行器姿态角度、角速度、角加速度、控制指令综合判断。For the installation errors of blade 22 and blade 23, blade 23 and blade 24, blade 21 and blade 24, takeoff abnormality and blade installation error judgment method is similar to the above method, you can use the UAV attitude Comprehensive judgment of angle, angular velocity, angular acceleration, and control commands.
也就是说,前述S102,即所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶,可以包括:That is to say, the aforementioned S102, that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong installation blade, may include:
S102a,利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误。S102a, using the front and rear roll angular velocity, the left-right roll angular velocity, and the yaw angular velocity of the unmanned aerial vehicle to determine the installation error of the same side blades of the unmanned aerial vehicle.
具体地,S102a,利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误,可以包括四种情况:Specifically, S102a, using the front and back roll angular velocity, left-right roll angular velocity, and yaw angular velocity of the UAV to determine the installation error of the same-side blades of the UAV may include four situations:
S1021a,当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器前翻滚状态,确定靠近无人飞行器机头一侧的第一桨叶和第二桨叶安装错误;S1021a: When the front and rear roll angular velocity thresholds, the left-right roll angular velocity thresholds, the left-right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds meet the front roll state of the UAV, it is determined that it is close to the nose of the UAV. Wrong installation of the first blade and the second blade on one side;
S1022a,当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器后翻滚状态, 确定远离所述无人飞行器机头一侧的第三桨叶和第四桨叶安装错误;S1022a: When the front and rear roll angular velocity thresholds, the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds meet the rollover state of the UAV, it is determined that it is far away from the UAV. The third and fourth blades on the side of the nose are installed incorrectly;
S1023a,当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器左翻转状态,确定位于所述无人飞行器纵轴方向第一侧的第二桨叶和第三桨叶安装错误;S1023a: When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the unmanned aerial vehicle's left turning state, it is determined to be located in the unmanned aerial vehicle The second blade and the third blade on the first side of the longitudinal axis are installed incorrectly;
S1024a,当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器右翻转状态,确定位于所述无人飞行器纵轴方向第二侧的第一桨叶和第四桨叶装反。S1024a: When the front and rear roll angular velocity thresholds, the left-right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds meet the right turning state of the unmanned aerial vehicle, it is determined that it is located in the unmanned aerial vehicle. The first blade and the fourth blade on the second side in the longitudinal direction are reversed.
这里的无人飞行器前翻滚状态、后翻滚状态、左翻转状态、右翻转状态已在前述通过公式进行了说明,或者可以由本领域技术人员直接推算获得,在此并不限定。例如前翻滚状态可以由前述如下公式确定:The front roll state, the back roll state, the left roll state, and the right roll state of the UAV here have been described by formulas above, or can be directly calculated by those skilled in the art, and are not limited here. For example, the forward roll state can be determined by the aforementioned formula:
Figure PCTCN2020087307-appb-000035
Figure PCTCN2020087307-appb-000035
前述右翻转状态可以由前述如下公式确定:The aforementioned right flip state can be determined by the aforementioned formula:
Figure PCTCN2020087307-appb-000036
Figure PCTCN2020087307-appb-000036
针对对角2个桨叶装错的情况(包括桨叶21/桨叶23、桨叶22/桨叶24装错两种情况),无人飞行器在起飞过程中会表现为偏航(yaw)。以桨叶21/桨叶23装错为例,相同转速下,桨叶21和桨叶23产生向下的力要小于桨叶22/桨叶24产生向上的力,桨叶21和桨叶23旋转产生的电机转矩要比桨叶22/桨叶24旋转产生的电机转矩小。这是由桨叶本身气动设计决定的。无人飞行器110在地面运动情况可由如下方程表达:In view of the situation where the two diagonal blades are installed incorrectly (including the two cases of blade 21/blade 23 and blade 22/blade 24 incorrectly installed), the UAV will behave as yaw during take-off. . Take the wrong installation of blade 21/blade 23 as an example. At the same speed, the downward force generated by blade 21 and blade 23 is less than the upward force generated by blade 22/blade 24, blade 21 and blade 23 The motor torque generated by the rotation is smaller than the motor torque generated by the rotation of the blade 22/the blade 24. This is determined by the aerodynamic design of the blade itself. The movement of the unmanned aerial vehicle 110 on the ground can be expressed by the following equation:
Figure PCTCN2020087307-appb-000037
Figure PCTCN2020087307-appb-000037
其中,F 24为电机2和电机4产生的拉力,F 13为电机1和电机3产生的向下推力,G为无人飞行器重力,F 压力为无人飞行器对地面压力,T 24为电机2和电机4旋转产生的电机扭矩,T 13为电机1和电机3旋转产生的电机扭矩,f 摩擦为地面摩擦系数,I z为无人飞行器偏航(yaw)的转动惯量,
Figure PCTCN2020087307-appb-000038
为偏航(yaw)角速度。
Among them, F 24 is the pulling force generated by motor 2 and motor 4, F 13 is the downward thrust generated by motor 1 and motor 3, G is the gravity of the UAV, F pressure is the pressure on the ground by the UAV, and T 24 is the motor 2. And the motor torque generated by the rotation of the motor 4, T 13 is the motor torque generated by the rotation of the motor 1 and the motor 3, f friction is the ground friction coefficient, I z is the moment of inertia of the unmanned aerial vehicle's yaw,
Figure PCTCN2020087307-appb-000038
Is the yaw angular velocity.
由上述方程可知,随着转速逐渐提高,无人飞行器对地面压力逐渐减小,电机2和电机4产生的电机扭矩逐渐变大,最终会产生一个对应电机2和电机4的电机扭矩的无 人飞行器角加速度,随时间积累无人飞行器表现为在地面旋转。It can be seen from the above equation that as the speed gradually increases, the UAV's pressure on the ground gradually decreases, and the motor torque generated by the motor 2 and motor 4 gradually increases, and eventually an unmanned aircraft corresponding to the motor torque of the motor 2 and motor 4 will be generated. The angular acceleration of the aircraft, accumulated over time, the unmanned aircraft appears to rotate on the ground.
综上分析针对桨叶21和桨叶23的安装错误起飞异常的判断可由如下条件判断:Based on the above analysis, the judgment of the installation error of the blade 21 and the blade 23 and the abnormal take-off can be judged by the following conditions:
Figure PCTCN2020087307-appb-000039
Figure PCTCN2020087307-appb-000039
满足上述判断条件既可判断桨叶21和桨叶23安装起飞异常也可作为桨叶21和桨叶23的安装错误条件。Satisfying the above-mentioned judgment conditions can be used to judge the installation and take-off abnormality of the blade 21 and the blade 23, and can also be used as an installation error condition of the blade 21 and the blade 23.
针对桨叶22和桨叶24安装错误情况,起飞异常以及桨叶安装错误判断方法与上述方法类似,可以利用无人飞行器姿态角度、角速度、角加速度、控制指令综合判断。The method for judging the installation errors of the blades 22 and 24, the abnormal take-off and the installation errors of the blades is similar to the above method, and the attitude angle, angular velocity, angular acceleration, and control commands of the UAV can be used for comprehensive judgment.
由此可知,前述S102,即所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶,可以包括:From this, it can be seen that the aforementioned S102, that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong blade installation, may include:
S102b,利用前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定所述无人飞行器相对侧桨叶安装错误。S102b, using the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration to determine the installation error of the opposite blades of the unmanned aerial vehicle.
具体地,S102b,即所述利用前后翻滚角速度、左右翻转角速度、偏航角速度、偏航角加速度确定对侧桨叶安装错误,可以包括如下情形:Specifically, S102b, that is, the use of the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration to determine the installation error of the opposite blade may include the following situations:
S1021b,当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第一方向旋转状态,确定位于所述无人飞行器的第一对角线上的两个桨叶安装错误;S1021b, when the relationship between the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, meet the requirements of the unmanned aerial vehicle Rotate toward the first direction, and determine that the two blades on the first diagonal of the UAV are installed incorrectly;
S1022b,当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第二方向旋转状态,确定位于所述无人飞行器的第二对角线上的两个桨叶安装错误。S1022b, when the front and rear roll angular velocity thresholds, the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds, the yaw angular acceleration and the yaw angular acceleration thresholds, meet the requirements of the unmanned aerial vehicle. Rotating toward the second direction, it is determined that the two blades on the second diagonal of the UAV are installed incorrectly.
第二种情况,对于装错1个桨叶(桨叶21、桨叶22、桨叶23、桨叶24其中之一装错,共4种情况)的起飞过程,无人飞行器110会绕对应装错桨叶的电机的脚架旋转。以电机1对应的桨叶21装错为例:In the second case, for the take-off process when a wrong blade is installed (one of blade 21, blade 22, blade 23, blade 24 is installed wrong, there are 4 cases in total), the UAV 110 will go around the corresponding The tripod of the motor with the wrong blade rotates. Take the wrong installation of the blade 21 corresponding to the motor 1 as an example:
电机1的桨叶21装错后,电机1旋转桨叶21,会产生向下的推力。电机2、电机3和电机4安装正确产生向上的拉力,起飞过程中电机逐渐加速。无人飞行器110会同时 前滚与右滚。起飞异常综合判断前滚与右滚。其中,如下参数可以判定无人飞行器110是否发生了前滚异常与右滚异常,即判断是否发生了桨叶安装错误:After the blade 21 of the motor 1 is installed incorrectly, the motor 1 rotates the blade 21 to generate a downward thrust. Motor 2, motor 3, and motor 4 are installed correctly to generate upward pulling force, and the motor gradually accelerates during takeoff. The UAV 110 will roll forward and roll right at the same time. Take off anomalies comprehensively judge roll forward and roll right. Among them, the following parameters can be used to determine whether the UAV 110 has a forward roll abnormality or a right roll abnormality, that is, whether a blade installation error has occurred:
判断前滚异常可以由前述如下公式确定:Judging the roll-forward abnormality can be determined by the aforementioned formula:
Figure PCTCN2020087307-appb-000040
Figure PCTCN2020087307-appb-000040
判断右滚异常可以由前述如下公式确定:Judging the right roll abnormality can be determined by the aforementioned formula:
Figure PCTCN2020087307-appb-000041
Figure PCTCN2020087307-appb-000041
当判断到有一个异常时,即认为起飞异常,飞行控制器161可以发出指令使得无人飞行器自动停桨。When it is judged that there is an abnormality, it is considered that the take-off is abnormal, and the flight controller 161 can issue an instruction to make the UAV automatically stop the propellers.
以桨叶21装错为例,可通过如下条件判断桨叶21是否装错:Taking the incorrect installation of the blade 21 as an example, the following conditions can be used to determine whether the blade 21 is installed incorrectly:
Figure PCTCN2020087307-appb-000042
Figure PCTCN2020087307-appb-000042
其中
Figure PCTCN2020087307-appb-000043
为T时刻无人飞行器前滚角速度,向前为负向后为正,
Figure PCTCN2020087307-appb-000044
为前滚角速度判断阈值,是一个绝对值较大的负值,
Figure PCTCN2020087307-appb-000045
为T时刻无人飞行器左右滚转的角速度,向左为负向右为正,
Figure PCTCN2020087307-appb-000046
为左右滚转角速度判断阈值,是一个绝对值较大的正值,
Figure PCTCN2020087307-appb-000047
为T时刻无人飞行器偏航(yaw)角速度,俯视图上逆时针旋转为负,顺时针旋转为正,
Figure PCTCN2020087307-appb-000048
为偏航(yaw)角速度判断阈值。在判断发生异常后,同时满足上述条件即可判定桨叶21安装错误。
in
Figure PCTCN2020087307-appb-000043
Is the forward roll angular velocity of the unmanned aerial vehicle at time T, forward is negative and backward is positive,
Figure PCTCN2020087307-appb-000044
Is the judgment threshold of the roll forward angular velocity, which is a negative value with a large absolute value.
Figure PCTCN2020087307-appb-000045
Is the angular velocity of the unmanned aerial vehicle rolling left and right at time T, the left is negative and the right is positive,
Figure PCTCN2020087307-appb-000046
The threshold for judging the angular velocity of the left and right rolls is a positive value with a relatively large absolute value.
Figure PCTCN2020087307-appb-000047
Is the yaw angular velocity of the unmanned aerial vehicle at time T, the counterclockwise rotation in the top view is negative, and the clockwise rotation is positive,
Figure PCTCN2020087307-appb-000048
Is the yaw angular velocity judgment threshold. After it is judged that the abnormality occurs, and the above conditions are satisfied at the same time, it can be judged that the blade 21 is installed incorrectly.
对于桨叶22、桨叶23或者桨叶24装错的情况,起飞异常以及桨叶安装错误判断方法与上述方法类似利用无人飞行器姿态角度、角速度、角加速度、控制指令综合判断。当桨叶22安装错误时,无人飞行器110朝向前方翻滚和朝向左侧翻转。当桨叶23安装错误时,无人飞行器110朝向后方翻滚和朝向左侧翻转。当桨叶24安装错误时,无人飞行器110朝向后方翻滚和朝向右侧翻转。For the case where the blade 22, the blade 23, or the blade 24 is incorrectly installed, the method for judging the abnormal take-off and blade installation error is similar to the above-mentioned method using the UAV attitude angle, angular velocity, angular acceleration, and control command to comprehensively judge. When the blade 22 is installed incorrectly, the UAV 110 rolls toward the front and flips toward the left. When the blade 23 is incorrectly installed, the UAV 110 rolls toward the rear and flips toward the left. When the blade 24 is installed incorrectly, the UAV 110 rolls toward the rear and flips toward the right.
因此,前述S102,即所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶,包括:Therefore, the aforementioned S102, that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong blade installation, includes:
S102c,利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误。S102c, using the front and back roll angular velocity, left-right roll angular velocity, yaw angular velocity, and yaw angular acceleration of the UAV to determine the installation error of a single blade.
具体地,所述S102c,即所述利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误,可以包括如下情况:Specifically, the S102c, that is, the use of the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration of the UAV to determine the installation error of a single blade may include the following situations:
S1021c,当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足朝向前方翻滚和朝向右侧翻转的状态,确定所述无人飞行器的第一桨叶安装错误;S1021c, when the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the relationship between the yaw angular acceleration and the yaw angular acceleration threshold Meet the state of rolling toward the front and turning toward the right, and determine that the first blade of the unmanned aerial vehicle is installed incorrectly;
S1022c,当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足朝向前方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第二桨叶安装错误;S1022c, when the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are related Meet the states of rolling toward the front and turning toward the left, and determine that the second blade of the unmanned aerial vehicle is installed incorrectly;
S1023c,当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第三桨叶安装错误;S1023c, when the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are related Meet the conditions of the unmanned aerial vehicle rolling towards the rear and turning towards the left side, and it is determined that the third blade of the unmanned aerial vehicle is installed incorrectly;
S1024c,当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向右侧翻转的状态,确定所述无人飞行器的第四桨叶安装错误。S1024c, when the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the relationship between the yaw angular acceleration and the yaw angular acceleration threshold It is determined that the unmanned aerial vehicle rolls towards the rear and rolls towards the right, and it is determined that the fourth blade of the unmanned aerial vehicle is installed incorrectly.
第三种情况,对于装错3个桨叶(共三种情况)或4个桨叶(一种情况)的情况,由于装错3个及3个以上,电机在加速起飞过程中4个桨叶产生的合力方向向下,无人飞行器对地面的压力也较大,此时无人飞行器在地面不会有较大的姿态变化,在此情况下,可以通过控制的输出和电机实际输出来判断起飞异常,如下:In the third case, in the case of incorrect installation of 3 blades (three cases in total) or 4 blades (one case), because 3 or more are installed incorrectly, the motor has 4 propellers during acceleration and take-off. The direction of the resultant force generated by the blades is downward, and the UAV has a greater pressure on the ground. At this time, the UAV will not have a large attitude change on the ground. In this case, it can be controlled by the output of the control and the actual output of the motor. The abnormal takeoff is judged as follows:
Figure PCTCN2020087307-appb-000049
Figure PCTCN2020087307-appb-000049
其中,lift cmd为电机拉力输出指令参数,lift 0为电机拉力输出判断阈值,∑i esc为4个电调电流和,i 0为电流判断阈值。 Among them, lift cmd is the motor pulling force output command parameter, lift 0 is the motor pulling force output judgment threshold, Σi esc is the sum of the 4 ESC currents, and i 0 is the current judgment threshold.
根据上述条件,当电机拉力输出指令参数超过一定阈值且实际电调电流超过一定阈值时,无人飞行器姿态几乎无变化,且无人飞行器110仍不起飞,即可判定起飞异常,则可以进行对应的操作,例如指示停桨。According to the above conditions, when the motor pull force output command parameter exceeds a certain threshold and the actual ESC current exceeds a certain threshold, there is almost no change in the attitude of the UAV, and the UAV 110 still does not take off, it can be determined that the takeoff is abnormal, and the corresponding operation can be performed. Operation, such as instructing to stop the oars.
因此,前述S102,即所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶,可以包括:Therefore, the aforementioned S102, that is, judging the installation error of the blade according to the take-off parameters of the UAV, and determining the wrong installation blade, may include:
S102d,利用无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度、电机拉力输出指令参数和电调电流参数确定无人飞行器的三个以上的桨叶安装错误。In S102d, the UAV's front and rear roll angular velocity, left-right roll angular velocity, yaw angular velocity, motor pull output command parameters and ESC current parameters are used to determine the installation errors of more than three blades of the UAV.
具体地,S102d,可以包括如下情况:Specifically, S102d may include the following situations:
当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值满足指定关系,且所述电机拉力输出指令参数大于电机拉力输出指令阈值、电调电流参数大于电调电流参数阈值时,判断所述无人飞行器的三个以上的桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold meet the specified relationship, and the motor pull force output command parameter is greater than the motor pull force output command When the threshold value and the ESC current parameter are greater than the ESC current parameter threshold value, it is determined that more than three blades of the UAV are installed incorrectly.
第四种情况,一个或多个桨叶未安装:此时无人飞行器110的表现为,在对应的没有装桨叶的电机上,电调电流很小,电阻很大。因此可以分别通过每个电机的电调电流的值是否小于阈值,或者对应的电阻是否大于阈值,判断该电机是否没有安装桨叶。In the fourth case, one or more blades are not installed: At this time, the UAV 110 behaves as follows: on the corresponding motor without blades, the ESC current is very small and the resistance is large. Therefore, it can be judged whether the motor is not equipped with a blade by whether the value of the ESC current of each motor is less than the threshold value, or whether the corresponding resistance is greater than the threshold value.
综上所述,本发明实施例提出的无人飞行器桨叶安装检测方法,可以实现起飞保护和桨叶装错识别的技术效果,具体如下:In summary, the method for detecting the installation of blades of an unmanned aerial vehicle proposed in the embodiments of the present invention can realize the technical effects of take-off protection and recognition of improper installation of blades, which are specifically as follows:
本发明针对多种装错桨情况都做了异常判断自动停桨的策略。通过综合判断姿态角度、角速度变化,控制指令输出,电机输出等提高了异常判断的及时性,大大降低了装错桨起飞无人飞行器发生地面翻滚以及地面不受控飞行的概率。The present invention makes a strategy of automatically stopping the propeller by abnormal judgment for various situations of incorrect propeller installation. By comprehensively judging the attitude angle, angular velocity change, control command output, motor output, etc., the timeliness of abnormal judgment is improved, and the probability of ground roll and uncontrolled ground flight of the unmanned aerial vehicle with wrong propellers is greatly reduced.
此外,本发明实施例提出的无人飞行器桨叶安装检测方法可以根据起飞异常时无人飞行器运动表现和控制输出判断出哪个或者哪些桨叶装反,并对用户进行提示,以尽快发现错误、排除故障。In addition, the method for detecting the installation of the blades of the unmanned aerial vehicle proposed in the embodiment of the present invention can determine which blade or blades are reversed according to the movement performance and control output of the unmanned aerial vehicle during abnormal takeoff, and prompt the user to find errors as soon as possible. Troubleshoot.
图6所示为本申请无人飞行器桨叶安装检测装置的实施例。如图6所示,所述无人 飞行器桨叶安装检测装置包括如下模块:Fig. 6 shows an embodiment of a detection device for blade installation of an unmanned aerial vehicle according to the present application. As shown in Figure 6, the UAV blade installation detection device includes the following modules:
获取模块601,用于获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;The obtaining module 601 is used to obtain take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control instruction parameters;
具体地,获取模块601可以获取无人飞行器110的无人飞行器起飞参数。无人飞行器起飞参数可以包括无人飞行器110的运动状态参数和控制指令参数。Specifically, the acquisition module 601 can acquire the UAV takeoff parameters of the UAV 110. The take-off parameters of the UAV may include the motion state parameters and the control instruction parameters of the UAV 110.
运动状态参数例如可以包括:当前的无人飞行器角速度、当前的无人飞行器角加速度等。其中无人飞行器角速度可以包括翻滚角速度和偏航角速度。无人飞行器角加速度可以包括偏航角加速度。进一步地,在一些实施例中,翻滚角速度可以进一步区分为前后翻滚角速度和左右翻转角速度。运动状态参数可以从图1所示的传感系统162读取获得。The motion state parameters may include, for example, the current UAV angular velocity, the current UAV angular acceleration, and so on. The angular velocity of the UAV can include the roll angular velocity and the yaw angular velocity. The UAV angular acceleration may include the yaw angular acceleration. Further, in some embodiments, the roll angular velocity can be further divided into the front and rear roll angular velocity and the left and right roll angular velocity. The motion state parameters can be read from the sensor system 162 shown in FIG. 1.
控制指令参数例如可以包括无人飞行器的电机拉力指令参数、无人飞行器角度控制指令、无人飞行器角加速度控制指令的一种或多种。The control command parameter may include, for example, one or more of the motor tension command parameter of the unmanned aerial vehicle, the angle control command of the unmanned aerial vehicle, and the angular acceleration control command of the unmanned aerial vehicle.
电机拉力指令参数包含了电机需要提供的拉力的大小。无人飞行器角度控制指令例如为用于控制无人飞行器的角度的指令;无人飞行器角加速度控制指令例如为用于控制无人飞行器的角加速度的指令。The motor pulling force command parameter includes the amount of pulling force that the motor needs to provide. The unmanned aerial vehicle angle control command is, for example, a command for controlling the angle of the unmanned aerial vehicle; the unmanned aerial vehicle angular acceleration control command is, for example, a command for controlling the angular acceleration of the unmanned aerial vehicle.
在一些实施例中,无人飞行器起飞参数还可以包括无人飞行器的电调电流参数。即无人飞行器的电调151所输出至每一个电机1-4的电流参数。In some embodiments, the take-off parameters of the UAV may also include the ESC current parameters of the UAV. That is, the current parameters output by the ESC 151 of the UAV to each motor 1-4.
无人飞行器的控制指令参数可以是直接存储在飞行控制器161中参数,由飞行控制器161直接获取这些控制指令参数。例如,电机拉力指令参数来源于控制终端140向无人飞行器的飞行控制器161发送的指令。其中包含电机需要提供的拉力大小。这一指令被无人飞行器的接收装置所接收并发送至飞行控制器161,因此飞行控制器161可以直接获取电机拉力指令参数。同理,无人飞行器角度控制指令、无人飞行器角加速度控制指令也可以是由和电调电流参数可以是由控制终端140向无人飞行器的飞行控制器161发送的指令。电调电流参数则是电调151输出至每一电机1-4的电流大小,也可以由飞行控制器161获取。The control command parameters of the unmanned aerial vehicle may be parameters directly stored in the flight controller 161, and the flight controller 161 directly obtains these control command parameters. For example, the motor tension command parameter is derived from the command sent by the control terminal 140 to the flight controller 161 of the unmanned aerial vehicle. It contains the amount of pulling force that the motor needs to provide. This command is received by the receiving device of the unmanned aerial vehicle and sent to the flight controller 161, so the flight controller 161 can directly obtain the motor pull command parameters. In the same way, the UAV angle control command and the UAV angular acceleration control command may also be the command sent by the control terminal 140 to the flight controller 161 of the UAV. The ESC current parameter is the magnitude of the current output by the ESC 151 to each motor 1-4, and can also be obtained by the flight controller 161.
确定模块602,用于根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;The determining module 602 is configured to determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
确定模块602可以根据所述无人飞行器起飞参数确定桨叶安装错误。进一步地,确定模块602还可以执行S1020b确定安装错误的桨叶,例如判断是哪一位置个或多个的 桨叶安装错误。确定模块602还可以发出提示信息,例如包括如下至少一种:将确定出的安装错误的桨叶的信息对应的提示信息发送至显示设备;已经根据确定出的安装错误的桨叶的信息发出对应的提示信息。The determining module 602 may determine the blade installation error according to the take-off parameters of the UAV. Further, the determining module 602 can also execute S1020b to determine the improperly installed blades, for example, to determine which position one or more blades are installed incorrectly. The determining module 602 may also send out prompt information, for example, including at least one of the following: sending prompt information corresponding to the determined information of the improperly installed blade to the display device; sending out corresponding information according to the determined improperly installed blade information Prompt information.
执行模块603,用于根据所述桨叶安装信息,执行对应的操作。The execution module 603 is configured to execute corresponding operations according to the blade installation information.
执行模块603可以根据所述桨叶安装信息,执行对应的操作。上述对应的操作例如可以包括一下至少其中之一:将提示信息发送至显示设备;根据所述桨叶安装信息显示对应的提示信息;停止所述无人飞行器的桨叶转动。The execution module 603 may execute corresponding operations according to the blade installation information. The aforementioned corresponding operation may include, for example, at least one of the following: sending prompt information to a display device; displaying corresponding prompt information according to the blade installation information; and stopping the rotation of the blades of the unmanned aerial vehicle.
在无人飞行器桨叶安装检测装置的一实施例中,所述确定模块用于执行如下操作:In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the determining module is configured to perform the following operations:
根据所述无人飞行器起飞参数判断桨叶安装错误。According to the take-off parameters of the unmanned aerial vehicle, it is determined that the blade is installed incorrectly.
在无人飞行器桨叶安装检测装置的一实施例中,所述确定模块还用于执行如下操作:根据所述无人飞行器起飞参数确定安装错误的桨叶。In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the determination module is further configured to perform the following operations: determine the improperly installed blades according to the take-off parameters of the unmanned aerial vehicle.
在无人飞行器桨叶安装检测装置的一实施例中,所述装置还包括:In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the device further includes:
发送模块,用于将确定出的安装错误的桨叶的信息对应的提示信息发送至显示设备;或The sending module is used to send the prompt information corresponding to the determined information of the incorrectly installed blade to the display device; or
提示模块,用于根据确定出的安装错误的桨叶的信息发出对应的提示信息。The prompt module is used to send out corresponding prompt information according to the determined information of the improperly installed blade.
在无人飞行器桨叶安装检测装置的一实施例中,所述运动状态参数包括:无人飞行器姿态信息、无人飞行器角速度、无人飞行器角加速度至少其中之一。In an embodiment of the device for detecting the installation of the blades of the unmanned aerial vehicle, the motion state parameter includes at least one of the attitude information of the unmanned aerial vehicle, the angular velocity of the unmanned aerial vehicle, and the angular acceleration of the unmanned aerial vehicle.
在无人飞行器桨叶安装检测装置的一实施例中,所述控制指令参数包括:电机拉力指令参数、无人飞行器角度控制指令、无人飞行器角速度控制指令、无人飞行器角加速度控制指令至少其中之一。In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the control instruction parameters include: motor tension instruction parameters, unmanned aerial vehicle angle control instructions, unmanned aerial vehicle angular velocity control instructions, and unmanned aerial vehicle angular acceleration control instructions at least among them one.
在无人飞行器桨叶安装检测装置的一实施例中,所述无人飞行器起飞参数还包括:无人飞行器电调电流参数。In an embodiment of the UAV blade installation detection device, the UAV take-off parameter further includes: the UAV ESC current parameter.
在无人飞行器桨叶安装检测装置的一实施例中,所述无人飞行器角速度包括:翻滚角速度、偏航角速度;所述无人飞行器角加速度包括:偏航角加速度。In an embodiment of the device for detecting the installation of a blade of an unmanned aerial vehicle, the angular velocity of the unmanned aerial vehicle includes a roll angular velocity and a yaw angular velocity; and the angular acceleration of the unmanned aerial vehicle includes a yaw angular acceleration.
在无人飞行器桨叶安装检测装置的一实施例中,所述翻滚角速度包括前后翻滚角速度和左右翻转角速度。In an embodiment of the device for detecting the installation of the blades of the unmanned aerial vehicle, the roll angular velocity includes the front-to-back roll angular velocity and the left-right roll angular velocity.
在无人飞行器桨叶安装检测装置的一实施例中,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度和偏航角速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步 骤包括:In an embodiment of the UAV blade installation detection device, the motion state parameters include the angular velocity and angular acceleration of the UAV, and the angular velocity includes the forward and backward roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity. The steps of judging the installation error of the blade by the takeoff parameters of the unmanned aerial vehicle and determining the installation error of the blade include:
利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误。Using the front and back roll angular velocity, the left-right roll angular velocity, and the yaw angular velocity of the unmanned aerial vehicle to determine the installation error of the same side blades of the unmanned aerial vehicle.
在无人飞行器桨叶安装检测装置的一实施例中,所述利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误的步骤包括:In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the step of determining the installation error of the unmanned aerial vehicle's blades on the same side by using the front and rear roll angular velocity, the left-right roll angular velocity, and the yaw angular velocity of the unmanned aerial vehicle include:
当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器前翻滚状态,确定靠近无人飞行器机头一侧的第一桨叶和第二桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the front roll state of the unmanned aerial vehicle, it is determined that it is close to the side of the nose of the unmanned aerial vehicle The installation of the first blade and the second blade is wrong;
当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器后翻滚状态,确定远离所述无人飞行器机头一侧的第三桨叶和第四桨叶安装错误;When the relationship between the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold meets the unmanned aerial vehicle's post-rolling state, it is determined to be far away from the unmanned aerial vehicle nose Wrong installation of the third and fourth blades on one side;
当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器左翻转状态,确定位于所述无人飞行器纵轴方向第一侧的第二桨叶和第三桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the left rollover state of the unmanned aerial vehicle, it is determined that it is located on the longitudinal axis of the unmanned aerial vehicle The second blade and the third blade on the first side of the direction are installed incorrectly;
当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器右翻转状态,确定位于所述无人飞行器纵轴方向第二侧的第一桨叶和第四桨叶装反。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the right turning state of the unmanned aerial vehicle, it is determined that it is located on the longitudinal axis of the unmanned aerial vehicle The first blade and the fourth blade on the second side of the direction are reversed.
在无人飞行器桨叶安装检测装置的一实施例中,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left and right flip angular velocity, the yaw angular velocity, and the yaw angular acceleration. The step of judging the installation error of the blade according to the take-off parameters of the UAV, and determining the installation error of the blade includes:
利用前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定所述无人飞行器相对侧桨叶安装错误。The front and back roll angular velocity, the left-right roll angular velocity, the yaw angular velocity and the yaw angular acceleration are used to determine the installation error of the blades on the opposite side of the unmanned aerial vehicle.
在无人飞行器桨叶安装检测装置的一实施例中,所述利用前后翻滚角速度、左右翻转角速度、偏航角速度、偏航角加速度确定对侧桨叶安装错误的步骤包括:In an embodiment of the device for detecting the installation of a blade of an unmanned aerial vehicle, the step of determining the installation error of the opposite blade by using the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration includes:
当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第一方向旋转状态,确定位于所述无人飞行器的第一对角线上的两个 桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship satisfies the unmanned aerial vehicle heading first One direction rotation state, determining that the two blades located on the first diagonal of the UAV are installed incorrectly;
当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第二方向旋转状态,确定位于所述无人飞行器的第二对角线上的两个桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship satisfies the unmanned aerial vehicle heading first In the two-direction rotation state, it is determined that the two blades on the second diagonal of the UAV are installed incorrectly.
在无人飞行器桨叶安装检测装置的一实施例中,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left and right flip angular velocity, the yaw angular velocity, and the yaw angular acceleration. The step of judging the installation error of the blade according to the take-off parameters of the UAV, and determining the installation error of the blade includes:
利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误。Using the front and back roll angular velocity, left-right roll angular velocity, yaw angular velocity, and yaw angular acceleration of the unmanned aerial vehicle, the installation error of a single blade is determined.
在无人飞行器桨叶安装检测装置的一实施例中,所述利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误的步骤包括:In an embodiment of the UAV blade installation detection device, the step of determining the installation error of a single blade by using the front and back roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration of the unmanned aerial vehicle includes:
当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足朝向前方翻滚和朝向右侧翻转的状态,确定所述无人飞行器的第一桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship meets the orientation The state of rolling forward and turning to the right side determines that the first blade of the unmanned aerial vehicle is installed incorrectly;
当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足朝向前方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第二桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship meets the orientation The state of rolling forward and turning to the left, it is determined that the second blade of the UAV is installed incorrectly;
当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第三桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied The state of the human aircraft rolling toward the rear and turning toward the left, and it is determined that the third blade of the unmanned aircraft is installed incorrectly;
当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向右侧翻转的状态,确定所述无人飞行器 的第四桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied The state of the human aircraft rolling toward the rear and turning toward the right determines that the fourth blade of the unmanned aircraft is installed incorrectly.
在无人飞行器桨叶安装检测装置的一实施例中,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度和偏航角速度,所述控制指令参数包括电机拉力输出指令参数,所述无人飞行器起飞参数还包括电调电流参数,In an embodiment of the UAV blade installation detection device, the motion state parameters include the angular velocity and angular acceleration of the UAV, the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity, and the control command The parameters include motor tension output command parameters, and the UAV takeoff parameters also include ESC current parameters,
所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The step of judging the installation error of the blade according to the take-off parameters of the unmanned aerial vehicle, and determining the installation error of the blade includes:
利用无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度、电机拉力输出指令参数和电调电流参数确定无人飞行器的三个或三个以上的桨叶安装错误。Use the UAV's front and rear roll angular velocity, left-right flip angular velocity, yaw angular velocity, motor pull output command parameters and ESC current parameters to determine the installation errors of three or more blades of the UAV.
在无人飞行器桨叶安装检测装置的一实施例中,所述利用前后翻滚角速度、左右翻转角速度、偏航角速度、电机拉力输出指令参数、电调电流参数确定三个以上的桨叶安装错误的步骤包括:In an embodiment of the detection device for the installation of the blades of the unmanned aerial vehicle, the use of the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, the motor pulling force output command parameter, and the ESC current parameter to determine the installation error of more than three blades The steps include:
当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值满足指定关系,且所述电机拉力输出指令参数大于电机拉力输出指令阈值、电调电流参数大于电调电流参数阈值时,判断所述无人飞行器的三个以上的桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold meet the specified relationship, and the motor pull force output command parameter is greater than the motor pull force output command When the threshold value and the ESC current parameter are greater than the ESC current parameter threshold value, it is determined that more than three blades of the UAV are installed incorrectly.
在无人飞行器桨叶安装检测装置的一实施例中,所述控制指令参数包括电机拉力输出指令参数,所述无人飞行器起飞参数还包括电调电流参数和螺旋桨电阻值,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:In an embodiment of the UAV blade installation detection device, the control command parameter includes a motor pulling force output command parameter, the UAV take-off parameter also includes an ESC current parameter and a propeller resistance value, and the Unmanned aerial vehicle take-off parameters to determine the installation error of the blade, and the steps to determine the installation of the wrong blade include:
利用所述无人飞行器的电调电流参数和螺旋桨电阻值确定一个或一个以上的桨叶未安装。The electric current parameter and the propeller resistance value of the UAV are used to determine that one or more blades are not installed.
在无人飞行器桨叶安装检测装置的一实施例中,所述利用电调电流参数和螺旋桨电阻值确定一个或一个以上的桨叶未安装的步骤包括:In an embodiment of the device for detecting the installation of blades of an unmanned aerial vehicle, the step of determining that one or more blades are not installed by using the ESC current parameter and the resistance value of the propeller includes:
当判断其中一个螺旋桨的电机对应的所述电调电流参数小于对应的电调电流参数阈值,且所述螺旋桨电阻值大于对应的电阻阈值时,判断所述螺旋桨的电机对应的桨叶未安装。When it is determined that the ESC current parameter corresponding to the motor of one of the propellers is less than the corresponding ESC current parameter threshold, and the propeller resistance value is greater than the corresponding resistance threshold, it is determined that the blade corresponding to the motor of the propeller is not installed.
本发明实施例提出的无人飞行器桨叶安装检测装置,可以实现起飞保护和桨叶装错识别的技术效果,具体如下:The device for detecting the installation of blades of an unmanned aerial vehicle provided in the embodiment of the present invention can realize the technical effects of take-off protection and recognition of blade installation errors, which are specifically as follows:
本发明针对多种装错桨情况都做了异常判断自动停桨的策略。通过综合判断姿态角 度、角速度变化,控制指令输出,电机输出等提高了异常判断的及时性,大大降低了装错桨起飞无人飞行器发生地面翻滚以及地面不受控飞行的概率。The present invention makes a strategy of automatically stopping the propeller by abnormal judgment for various situations of incorrect propeller installation. The comprehensive judgment of attitude angle, angular velocity change, control command output, motor output, etc. improves the timeliness of abnormal judgment, and greatly reduces the probability of ground roll and uncontrolled ground flight of unmanned aerial vehicles with wrong propellers.
此外,本发明实施例提出的无人飞行器桨叶安装检测方法可以根据起飞异常时无人飞行器运动表现和控制输出判断出哪个或者哪些桨叶装反,并对用户进行提示,以尽快发现错误、排除故障。In addition, the method for detecting the installation of UAV blades according to the embodiment of the present invention can determine which blade or blades are reversed according to the motion performance and control output of the UAV during abnormal takeoff, and prompt the user to find errors as soon as possible. Troubleshoot.
对于装置实施例而言,由于其与方法实施例基本相似,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。As for the device embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and for related parts, please refer to the part of the description of the method embodiment.
本申请实施例还示出一种无人飞行系统,参考图1所示,无人飞行系统100包括无人飞行器110和控制终端140;所述无人飞行器110包括机架、飞行控制器161和传感系统162,所述飞行控制器161和所述传感系统162设置于所述机架;所述飞行控制器161能够与所述传感系统162和所述控制终端140之间传输信号,所述控制终端140能够发送控制信号至所述飞行控制器161,以控制所述无人飞行器110的飞行;The embodiment of the present application also shows an unmanned aerial system. As shown in FIG. 1, the unmanned aerial vehicle 100 includes an unmanned aerial vehicle 110 and a control terminal 140; the unmanned aerial vehicle 110 includes a frame, a flight controller 161, and a control terminal 140. The sensing system 162, the flight controller 161 and the sensing system 162 are arranged in the frame; the flight controller 161 can transmit signals between the sensing system 162 and the control terminal 140, The control terminal 140 can send a control signal to the flight controller 161 to control the flight of the UAV 110;
所述飞行控制器161用于执行如下操作:The flight controller 161 is used to perform the following operations:
获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;Acquire take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
本申请实施例还示出一种无人飞行器110,参考图1所示,无人飞行器110包括:机架、飞行控制器161和传感系统162,所述飞行控制器161和所述传感系统162设置于所述机架;所述飞行控制器161电性连接于所述传感系统162;The embodiment of the present application also shows an unmanned aerial vehicle 110. As shown in FIG. 1, the unmanned aerial vehicle 110 includes a frame, a flight controller 161, and a sensor system 162. The flight controller 161 and the sensor The system 162 is installed in the frame; the flight controller 161 is electrically connected to the sensing system 162;
所述飞行控制器用于执行如下操作:The flight controller is used to perform the following operations:
获取无人飞行器起飞参数,所述无人飞行器起飞参数包括从所述传感系统162获取的运动状态参数和从所述飞行控制器161获取的控制指令参数;Acquiring take-off parameters of the unmanned aerial vehicle, the take-off parameters of the unmanned aerial vehicle including the motion state parameters acquired from the sensing system 162 and the control command parameters acquired from the flight controller 161;
根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
本申请实施例还提供一种计算机程序,包括计算机可读代码,当所述计算机可读代 码在计算处理设备上运行时,导致所述计算处理设备执行前述的无人飞行器桨叶安装检测方法。An embodiment of the present application also provides a computer program, including computer-readable code, which when the computer-readable code runs on a computing processing device, causes the computing processing device to execute the aforementioned UAV blade installation detection method.
本申请实施例还提供一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,该计算机程序被处理器执行时实现上述拍摄方法实施例的各个过程,且能达到相同的技术效果,为避免重复,这里不再赘述。其中,所述的计算机可读存储介质,如只读存储器(Read-Only Memory,简称ROM)、随机存取存储器(Random Access Memory,简称RAM)、磁碟或者光盘等。The embodiment of the present application also provides a computer-readable storage medium on which a computer program is stored. When the computer program is executed by a processor, each process of the above-mentioned photographing method embodiment is realized, and the same technical effect can be achieved. To avoid repetition, I won’t repeat it here. Wherein, the computer-readable storage medium, such as read-only memory (Read-Only Memory, ROM for short), random access memory (Random Access Memory, RAM for short), magnetic disk, or optical disk, etc.
本说明书中的各个实施例均采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似的部分互相参见即可。The various embodiments in this specification are described in a progressive manner, and each embodiment focuses on the differences from other embodiments, and the same or similar parts between the various embodiments can be referred to each other.
本领域内的技术人员应明白,本申请的实施例可提供为方法、装置、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。Those skilled in the art should understand that the embodiments of the present application may be provided as methods, devices, or computer program products. Therefore, this application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Moreover, this application may adopt the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program codes.
本发明的各个部件实施例可以以硬件实现,或者以在一个或者多个处理器上运行的软件模块实现,或者以它们的组合实现。本领域的技术人员应当理解,可以在实践中使用微处理器或者数字信号处理器(DSP)来实现根据本发明实施例的计算处理设备中的一些或者全部部件的一些或者全部功能。本发明还可以实现为用于执行这里所描述的方法的一部分或者全部的设备或者装置程序(例如,计算机程序和计算机程序产品)。这样的实现本发明的程序可以存储在计算机可读介质上,或者可以具有一个或者多个信号的形式。这样的信号可以从因特网网站上下载得到,或者在载体信号上提供,或者以任何其他形式提供。The various component embodiments of the present invention may be implemented by hardware, or by software modules running on one or more processors, or by a combination of them. Those skilled in the art should understand that a microprocessor or a digital signal processor (DSP) may be used in practice to implement some or all of the functions of some or all of the components in the computing processing device according to the embodiments of the present invention. The present invention can also be implemented as a device or device program (for example, a computer program and a computer program product) for executing part or all of the methods described herein. Such a program for realizing the present invention may be stored on a computer-readable medium, or may have the form of one or more signals. Such a signal can be downloaded from an Internet website, or provided on a carrier signal, or provided in any other form.
例如,图7示出了可以实现根据本发明的方法的计算处理设备。该计算处理设备传统上包括处理器1010和以存储器1020形式的计算机程序产品或者计算机可读介质。存储器1020可以是诸如闪存、EEPROM(电可擦除可编程只读存储器)、EPROM、硬盘或者ROM之类的电子存储器。存储器1020具有用于执行上述方法中的任何方法步骤的程序代码1031的存储空间1030。例如,用于程序代码的存储空间1030可以包括分别用于实现上面的方法中的各种步骤的各个程序代码1031。这些程序代码可以从一个或者多个计算机程序产品中读出或者写入到这一个或者多个计算机程序产品中。这些计算机程序 产品包括诸如硬盘,紧致盘(CD)、存储卡或者软盘之类的程序代码载体。这样的计算机程序产品通常为如参考图8所述的便携式或者固定存储单元。该存储单元可以具有与图7的计算处理设备中的存储器1020类似布置的存储段、存储空间等。程序代码可以例如以适当形式进行压缩。通常,存储单元包括计算机可读代码1031’,即可以由例如诸如1010之类的处理器读取的代码,这些代码当由计算处理设备运行时,导致该计算处理设备执行上面所描述的方法中的各个步骤。For example, FIG. 7 shows a computing processing device that can implement the method according to the present invention. The computing processing device traditionally includes a processor 1010 and a computer program product in the form of a memory 1020 or a computer readable medium. The memory 1020 may be an electronic memory such as flash memory, EEPROM (Electrically Erasable Programmable Read Only Memory), EPROM, hard disk, or ROM. The memory 1020 has a storage space 1030 for executing program codes 1031 of any method steps in the above methods. For example, the storage space 1030 for program codes may include various program codes 1031 respectively used to implement various steps in the above method. These program codes can be read from or written into one or more computer program products. These computer program products include program code carriers such as hard disks, compact disks (CDs), memory cards, or floppy disks. Such computer program products are usually portable or fixed storage units as described with reference to FIG. 8. The storage unit may have a storage segment, storage space, etc. arranged similarly to the memory 1020 in the computing processing device of FIG. 7. The program code can be compressed in an appropriate form, for example. Generally, the storage unit includes computer-readable code 1031', that is, code that can be read by a processor such as 1010, which, when run by a computing processing device, causes the computing processing device to execute the method described above. The various steps.
本申请是参照根据本申请的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。This application is described with reference to flowcharts and/or block diagrams of methods, terminal devices (systems), and computer program products according to this application. It should be understood that each process and/or block in the flowchart and/or block diagram, and the combination of processes and/or blocks in the flowchart and/or block diagram can be realized by computer program instructions. These computer program instructions can be provided to the processors of general-purpose computers, special-purpose computers, embedded processors, or other programmable data processing terminal equipment to generate a machine, so that instructions executed by the processor of the computer or other programmable data processing terminal equipment A device for realizing the functions specified in a flow or multiple flows in the flowchart and/or a block or multiple blocks in the block diagram is generated.
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。These computer program instructions can also be stored in a computer-readable memory that can guide a computer or other programmable data processing terminal equipment to work in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture including the instruction device. The instruction device implements the functions specified in one process or multiple processes in the flowchart and/or one block or multiple blocks in the block diagram.
这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上,使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。These computer program instructions can also be loaded on a computer or other programmable data processing terminal equipment, so that a series of operation steps are executed on the computer or other programmable terminal equipment to produce computer-implemented processing, so that the computer or other programmable terminal equipment The instructions executed above provide steps for implementing functions specified in a flow or multiple flows in the flowchart and/or a block or multiple blocks in the block diagram.
尽管已描述了本申请的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例做出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本申请范围的所有变更和修改。Although the preferred embodiments of the present application have been described, those skilled in the art can make additional changes and modifications to these embodiments once they learn the basic creative concept. Therefore, the appended claims are intended to be interpreted as including the preferred embodiments and all changes and modifications falling within the scope of the present application.
最后,还需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、 方法、物品或者终端设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。Finally, it should be noted that in this article, relational terms such as first and second are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply these entities. Or there is any such actual relationship or sequence between operations. Moreover, the terms "including", "including" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or terminal device including a series of elements not only includes those elements, but also includes those elements that are not explicitly listed. Other elements listed, or also include elements inherent to this process, method, article, or terminal device. If there are no more restrictions, the element defined by the sentence "including a..." does not exclude the existence of other same elements in the process, method, article, or terminal device that includes the element.

Claims (47)

  1. 一种无人飞行器桨叶安装检测方法,其特征在于,包括:An unmanned aerial vehicle blade installation detection method, which is characterized in that it comprises:
    获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;Acquire take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
    根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶安装信息;Determine the blade installation information of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
    根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
  2. 根据权利要求1所述的方法,其特征在于,所述根据所述桨叶安装信息,执行对应的操作的步骤包括以下至少一种:The method according to claim 1, wherein the step of performing a corresponding operation according to the blade installation information comprises at least one of the following:
    将所述安装信息对应的提示信息发送至显示设备;或Send the prompt information corresponding to the installation information to the display device; or
    根据所述桨叶安装信息发出对应的提示信息;或Send corresponding prompt information according to the blade installation information; or
    停止所述无人飞行器的桨叶转动。Stop the rotation of the blades of the UAV.
  3. 根据权利要求1所述的方法,其特征在于,所述根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息包括:The method according to claim 1, wherein the determining the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle comprises:
    根据所述无人飞行器起飞参数确定桨叶安装错误。According to the take-off parameters of the unmanned aerial vehicle, it is determined that the blade is installed incorrectly.
  4. 根据权利要求3所述的方法,其特征在于,所述根据所述无人飞行器起飞参数确定桨叶安装错误之后,所述根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息的步骤还包括:The method according to claim 3, characterized in that, after determining the blade installation error according to the take-off parameters of the UAV, the determining the blade of the UAV according to the take-off parameters of the UAV The installation information steps also include:
    根据所述无人飞行器起飞参数确定安装错误的桨叶。Determine the improperly installed blade according to the take-off parameters of the unmanned aerial vehicle.
  5. 根据权利要求4所述的方法,其特征在于,所述根据所述无人飞行器起飞参数确定安装错误的桨叶之后,所述方法还包括:The method according to claim 4, wherein after determining the improperly installed blade according to the takeoff parameters of the UAV, the method further comprises:
    将确定出的安装错误的桨叶的信息对应的提示信息发送至显示设备;或Send the determined prompt information corresponding to the information of the incorrectly installed blade to the display device; or
    根据确定出的安装错误的桨叶的信息发出对应的提示信息。According to the determined information of the improperly installed blade, the corresponding prompt message will be sent out.
  6. 根据权利要求1所述的方法,其特征在于,所述运动状态参数包括:无人飞行器姿态角度、无人飞行器角速度、无人飞行器角加速度至少其中之一。The method according to claim 1, wherein the motion state parameter comprises at least one of the attitude angle of the unmanned aerial vehicle, the angular velocity of the unmanned aerial vehicle, and the angular acceleration of the unmanned aerial vehicle.
  7. 根据权利要求1所述的方法,其特征在于,所述控制指令参数包括:电机拉力指令参数、无人飞行器角度控制指令、无人飞行器角速度控制指令、无人飞行器角加速度控制指令至少其中之一。The method according to claim 1, wherein the control command parameter comprises at least one of a motor tension command parameter, an unmanned aerial vehicle angle control command, an unmanned aerial vehicle angular velocity control command, and an unmanned aerial vehicle angular acceleration control command .
  8. 根据权利要求1所述的方法,其特征在于,所述无人飞行器起飞参数还包括:无人飞行器电调电流参数。The method according to claim 1, wherein the take-off parameters of the UAV further comprise: electric current parameters of the UAV.
  9. 根据权利要求6或7所述的方法,其特征在于,所述无人飞行器角速度包括:翻滚角速度、偏航角速度;所述无人飞行器角加速度包括:偏航角加速度。The method according to claim 6 or 7, wherein the UAV angular velocity includes a roll angular velocity and a yaw angular velocity; and the UAV angular acceleration includes a yaw angular acceleration.
  10. 根据权利要求9所述的方法,其特征在于,所述翻滚角速度包括前后翻滚角速度和左右翻转角速度。The method according to claim 9, wherein the roll angular velocity includes the front and rear roll angular velocity and the left and right roll angular velocity.
  11. 根据权利要求4所述的方法,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度和偏航角速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The method according to claim 4, wherein the motion state parameters include the angular velocity and angular acceleration of the UAV, the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity, and the The steps of judging the incorrect installation of the blades by the take-off parameters of the human aircraft and determining the incorrect installation of the blades include:
    利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误。Using the front and back roll angular velocity, the left-right roll angular velocity, and the yaw angular velocity of the unmanned aerial vehicle to determine the installation error of the same side blades of the unmanned aerial vehicle.
  12. 根据权利要求11所述的方法,其特征在于,所述利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误的步骤包括:The method according to claim 11, wherein the step of using the front and rear roll angular velocity, the left-right roll angular velocity, and the yaw angular velocity of the UAV to determine the installation error of the same-side blades of the UAV comprises:
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器前翻滚状态,确定靠近无人飞行器机头一侧的第一桨叶和第二桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the front roll state of the unmanned aerial vehicle, it is determined that it is close to the side of the nose of the unmanned aerial vehicle The installation of the first blade and the second blade is wrong;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器后翻滚状态,确定远离所述无人飞行器机头一侧的第三桨叶和第四桨叶安装错误;When the relationship between the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold meets the unmanned aerial vehicle's post-rolling state, it is determined to be far away from the unmanned aerial vehicle nose Wrong installation of the third and fourth blades on one side;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器左翻转状态,确定位于所述无人飞行器纵轴方向第一侧的第二桨叶和第三桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the left rollover state of the unmanned aerial vehicle, it is determined that it is located on the longitudinal axis of the unmanned aerial vehicle The second blade and the third blade on the first side of the direction are installed incorrectly;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器右翻转状态,确定位于所述无人飞行器纵轴方向第二侧的第一桨叶和第四桨叶装反。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the right turning state of the unmanned aerial vehicle, it is determined that it is located on the longitudinal axis of the unmanned aerial vehicle The first blade and the fourth blade on the second side of the direction are reversed.
  13. 根据权利要求4所述的方法,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The method according to claim 4, wherein the motion state parameters include the angular velocity and angular acceleration of the UAV, and the angular velocity includes the forward and backward roll angular velocity, the left and right flip angular velocity, the yaw angular velocity, and the yaw angular acceleration. The steps of judging the installation error of the blade according to the take-off parameters of the UAV, and determining the installation error of the blade include:
    利用前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定所述无人飞行器相对侧桨叶安装错误。The front and back roll angular velocity, the left-right roll angular velocity, the yaw angular velocity and the yaw angular acceleration are used to determine the installation error of the blades on the opposite side of the unmanned aerial vehicle.
  14. 根据权利要求13所述的方法,其特征在于,所述利用前后翻滚角速度、左右翻转角速度、偏航角速度、偏航角加速度确定对侧桨叶安装错误的步骤包括:The method according to claim 13, wherein the step of determining the installation error of the opposite blade by using the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration comprises:
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第一方向旋转状态,确定位于所述无人飞行器的第一对角线上的两个桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship satisfies the unmanned aerial vehicle heading first One direction rotation state, determining that the two blades located on the first diagonal of the UAV are installed incorrectly;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第二方向旋转状态,确定位于所述无人飞行器的第二对角线上的两个桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship satisfies the unmanned aerial vehicle heading first In the two-direction rotation state, it is determined that the two blades on the second diagonal of the UAV are installed incorrectly.
  15. 根据权利要求4所述的方法,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The method according to claim 4, wherein the motion state parameters include the angular velocity and angular acceleration of the UAV, and the angular velocity includes the forward and backward roll angular velocity, the left and right flip angular velocity, the yaw angular velocity, and the yaw angular acceleration. The steps of judging the installation error of the blade according to the take-off parameters of the UAV, and determining the installation error of the blade include:
    利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误。Using the front and back roll angular velocity, left-right roll angular velocity, yaw angular velocity, and yaw angular acceleration of the unmanned aerial vehicle, the installation error of a single blade is determined.
  16. 根据权利要求15所述的方法,其特征在于,所述利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误的步骤包括:The method according to claim 15, wherein the step of determining the installation error of a single blade by using the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration of the UAV comprises:
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足朝向前方翻滚和朝向右侧翻转的状态,确定所述无人飞行器的第一桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship meets the orientation The state of rolling forward and turning to the right side determines that the first blade of the unmanned aerial vehicle is installed incorrectly;
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足朝向前方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第二桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship meets the orientation The state of rolling forward and turning to the left, it is determined that the second blade of the UAV is installed incorrectly;
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第三桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied The state of the human aircraft rolling toward the rear and turning toward the left, and it is determined that the third blade of the unmanned aircraft is installed incorrectly;
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向右侧翻转的状态,确定所述无人飞行器的第四桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied The state of the human aircraft rolling toward the rear and turning toward the right determines that the fourth blade of the unmanned aircraft is installed incorrectly.
  17. 根据权利要求4所述的方法,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度和偏航角速度,所述控制指令参数包括电机拉力输出指令参数,所述无人飞行器起飞参数还包括电调电流参数,The method according to claim 4, wherein the motion state parameters include the angular velocity and angular acceleration of the UAV, the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity, and the control command parameters include Motor pull output command parameters, the UAV takeoff parameters also include ESC current parameters,
    所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The step of judging the installation error of the blade according to the take-off parameters of the unmanned aerial vehicle, and determining the installation error of the blade includes:
    利用无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度、电机拉力输出指令参数和电调电流参数确定无人飞行器的三个或三个以上的桨叶安装错误。Use the UAV's front and rear roll angular velocity, left-right flip angular velocity, yaw angular velocity, motor pull output command parameters and ESC current parameters to determine the installation errors of three or more blades of the UAV.
  18. 根据权利要求17所述的方法,其特征在于,所述利用前后翻滚角速度、左右翻转角速度、偏航角速度、电机拉力输出指令参数、电调电流参数确定三个以上的桨叶安装错误的步骤包括:The method according to claim 17, wherein the step of using the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, the motor pull output command parameter, and the ESC current parameter to determine more than three blade installation errors comprises :
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值满足指定关系,且所述电机拉力输出指令参数大于电机拉力输出指令阈值、电调电流参数大于电调电流参数阈值时,判断所述无人飞行器的三个以上的桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold meet the specified relationship, and the motor pull force output command parameter is greater than the motor pull force output command When the threshold value and the ESC current parameter are greater than the ESC current parameter threshold value, it is determined that more than three blades of the UAV are installed incorrectly.
  19. 根据权利要求4所述的方法,其特征在于,所述控制指令参数包括电机拉力输出指令参数,所述无人飞行器起飞参数还包括电调电流参数和螺旋桨电阻值,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The method according to claim 4, wherein the control command parameter includes a motor pull force output command parameter, the UAV takeoff parameter further includes an ESC current parameter and a propeller resistance value, and the control command parameter includes a motor pull force output command parameter. The steps of judging the incorrect installation of the blades by the aircraft take-off parameters and determining the incorrect installation of the blades include:
    利用所述无人飞行器的电调电流参数和螺旋桨电阻值确定一个或一个以上的桨叶未安装。The electric current parameter and the propeller resistance value of the UAV are used to determine that one or more blades are not installed.
  20. 根据权利要求19所述的方法,其特征在于,所述利用电调电流参数和螺旋桨 电阻值确定一个或一个以上的桨叶未安装的步骤包括:The method according to claim 19, wherein the step of determining that one or more blades are not installed by using the ESC current parameter and the propeller resistance value comprises:
    当判断其中一个螺旋桨的电机对应的所述电调电流参数小于对应的电调电流参数阈值,且所述螺旋桨电阻值大于对应的电阻阈值时,判断所述螺旋桨的电机对应的桨叶未安装。When it is determined that the ESC current parameter corresponding to the motor of one of the propellers is less than the corresponding ESC current parameter threshold, and the propeller resistance value is greater than the corresponding resistance threshold, it is determined that the blade corresponding to the motor of the propeller is not installed.
  21. 一种无人飞行器桨叶安装检测装置,其特征在于,包括:An unmanned aerial vehicle blade installation detection device, which is characterized in that it comprises:
    获取模块,用于获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;The acquisition module is used to acquire the take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
    确定模块,用于根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;A determining module, configured to determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
    执行模块,用于根据所述桨叶安装信息,执行对应的操作。The execution module is used to execute corresponding operations according to the blade installation information.
  22. 根据权利要求21所述的无人飞行器桨叶安装检测装置,其特征在于,所述执行模块用于执行如下操作的至少一种:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 21, wherein the execution module is configured to perform at least one of the following operations:
    将所述安装信息对应的提示信息发送至显示设备;或Send the prompt information corresponding to the installation information to the display device; or
    根据所述桨叶安装信息显示对应的提示信息;或Display the corresponding prompt information according to the blade installation information; or
    停止所述无人飞行器的桨叶转动。Stop the rotation of the blades of the UAV.
  23. 根据权利要求21所述的无人飞行器桨叶安装检测装置,其特征在于,所述确定模块用于执行如下操作:The device for detecting the installation of blades of an unmanned aerial vehicle according to claim 21, wherein the determining module is configured to perform the following operations:
    根据所述无人飞行器起飞参数判断桨叶安装错误。According to the take-off parameters of the unmanned aerial vehicle, it is determined that the blade is installed incorrectly.
  24. 根据权利要求23所述的无人飞行器桨叶安装检测装置,其特征在于,所述确定模块还用于执行如下操作:根据所述无人飞行器起飞参数确定安装错误的桨叶。The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 23, wherein the determining module is further configured to perform the following operation: determining the incorrectly installed blade according to the take-off parameters of the unmanned aerial vehicle.
  25. 据权利要求24所述的无人飞行器桨叶安装检测装置,其特征在于,所述装置还包括:The device for detecting the installation of blades of an unmanned aerial vehicle according to claim 24, wherein the device further comprises:
    发送模块,用于将确定出的安装错误的桨叶的信息对应的提示信息发送至显示设备;或The sending module is used to send the prompt information corresponding to the determined information of the incorrectly installed blade to the display device; or
    提示模块,用于根据确定出的安装错误的桨叶的信息发出对应的提示信息。The prompt module is used to send out corresponding prompt information according to the determined information of the improperly installed blade.
  26. 根据权利要求21所述的无人飞行器桨叶安装检测装置,其特征在于,所述运动状态参数包括:无人飞行器姿态信息、无人飞行器角速度、无人飞行器角加速度至少其中之一。The device for detecting the installation of blades of an unmanned aerial vehicle according to claim 21, wherein the motion state parameter includes at least one of the attitude information of the unmanned aerial vehicle, the angular velocity of the unmanned aerial vehicle, and the angular acceleration of the unmanned aerial vehicle.
  27. 根据权利要求21所述的无人飞行器桨叶安装检测装置,其特征在于,所述控 制指令参数包括:电机拉力指令参数、无人飞行器角度控制指令、无人飞行器角速度控制指令、无人飞行器角加速度控制指令至少其中之一。The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 21, wherein the control instruction parameters include: motor tension instruction parameters, unmanned aerial vehicle angle control instructions, unmanned aerial vehicle angular velocity control instructions, unmanned aerial vehicle angle At least one of the acceleration control commands.
  28. 根据权利要求21所述的无人飞行器桨叶安装检测装置,其特征在于,所述无人飞行器起飞参数还包括:无人飞行器电调电流参数。The device for detecting the installation of blades of an unmanned aerial vehicle according to claim 21, wherein the take-off parameters of the unmanned aerial vehicle further comprise: an electric current parameter of the unmanned aerial vehicle.
  29. 根据权利要求26或27所述的无人飞行器桨叶安装检测装置,其特征在于,所述无人飞行器角速度包括:翻滚角速度、偏航角速度;所述无人飞行器角加速度包括:偏航角加速度。The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 26 or 27, wherein the angular velocity of the unmanned aerial vehicle comprises: a roll angular velocity and a yaw angular velocity; and the angular acceleration of the unmanned aerial vehicle comprises: a yaw angular acceleration .
  30. 根据权利要求29所述的无人飞行器桨叶安装检测装置,其特征在于,所述翻滚角速度包括前后翻滚角速度和左右翻转角速度。The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 29, wherein the roll angular velocity includes a front-to-back roll angular velocity and a left-to-right roll angular velocity.
  31. 根据权利要求24所述的无人飞行器桨叶安装检测装置,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度和偏航角速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 24, wherein the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity. The step of judging the installation error of the blade according to the take-off parameters of the UAV, and determining the installation error of the blade includes:
    利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误。Using the front and back roll angular velocity, the left-right roll angular velocity, and the yaw angular velocity of the unmanned aerial vehicle to determine the installation error of the same side blades of the unmanned aerial vehicle.
  32. 根据权利要求31所述的无人飞行器桨叶安装检测装置,其特征在于,所述利用所述无人飞行器的前后翻滚角速度、左右翻转角速度和偏航角速度确定所述无人飞行器的同侧桨叶安装错误的步骤包括:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 31, wherein the unmanned aerial vehicle's forward and backward roll angular velocity, left-right overturn angular velocity, and yaw angular velocity are used to determine the same side propeller of the unmanned aerial vehicle. The steps of Ye installation error include:
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器前翻滚状态,确定靠近无人飞行器机头一侧的第一桨叶和第二桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the front roll state of the unmanned aerial vehicle, it is determined that it is close to the side of the nose of the unmanned aerial vehicle The installation of the first blade and the second blade is wrong;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器后翻滚状态,确定远离所述无人飞行器机头一侧的第三桨叶和第四桨叶安装错误;When the relationship between the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold meets the unmanned aerial vehicle's post-rolling state, it is determined to be far away from the unmanned aerial vehicle nose Wrong installation of the third and fourth blades on one side;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器左翻转状态,确定位于所述无人飞行器纵轴方向第一侧的第二桨叶和第三桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the left rollover state of the unmanned aerial vehicle, it is determined that it is located on the longitudinal axis of the unmanned aerial vehicle The second blade and the third blade on the first side of the direction are installed incorrectly;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值的关系满足无人飞行器右翻转状态,确定位于 所述无人飞行器纵轴方向第二侧的第一桨叶和第四桨叶装反。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left-right roll angular velocity and the left-right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity thresholds satisfy the right turning state of the unmanned aerial vehicle, it is determined that it is located on the longitudinal axis of the unmanned aerial vehicle The first blade and the fourth blade on the second side of the direction are reversed.
  33. 根据权利要求24所述的无人飞行器桨叶安装检测装置,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 24, wherein the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity. And yaw angular acceleration, the steps of judging the installation error of the blade according to the take-off parameters of the unmanned aerial vehicle, and determining the installation error of the blade include:
    利用前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定所述无人飞行器相对侧桨叶安装错误。The front and back roll angular velocity, the left-right roll angular velocity, the yaw angular velocity and the yaw angular acceleration are used to determine the installation error of the blades on the opposite side of the unmanned aerial vehicle.
  34. 根据权利要求33所述的无人飞行器桨叶安装检测装置,其特征在于,所述利用前后翻滚角速度、左右翻转角速度、偏航角速度、偏航角加速度确定对侧桨叶安装错误的步骤包括:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 33, wherein the step of determining the installation error of the opposite blade by using the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity, and the yaw angular acceleration comprises:
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第一方向旋转状态,确定位于所述无人飞行器的第一对角线上的两个桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship satisfies the unmanned aerial vehicle heading first One direction rotation state, determining that the two blades located on the first diagonal of the UAV are installed incorrectly;
    当所述前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向第二方向旋转状态,确定位于所述无人飞行器的第二对角线上的两个桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship satisfies the unmanned aerial vehicle heading first In the two-direction rotation state, it is determined that the two blades on the second diagonal of the UAV are installed incorrectly.
  35. 根据权利要求24所述的无人飞行器桨叶安装检测装置,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 24, wherein the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity. And yaw angular acceleration, the steps of judging the installation error of the blade according to the take-off parameters of the unmanned aerial vehicle, and determining the installation error of the blade include:
    利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误。Using the front and back roll angular velocity, left-right roll angular velocity, yaw angular velocity, and yaw angular acceleration of the unmanned aerial vehicle, the installation error of a single blade is determined.
  36. 根据权利要求35所述的无人飞行器桨叶安装检测装置,其特征在于,所述利用所述无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度和偏航角加速度确定单个桨叶安装错误的步骤包括:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 35, wherein the use of the front and rear roll angular velocity, the left-right roll angular velocity, the yaw angular velocity and the yaw angular acceleration of the unmanned aerial vehicle to determine the installation of a single blade The wrong steps include:
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度 阈值的关系满足朝向前方翻滚和朝向右侧翻转的状态,确定所述无人飞行器的第一桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship meets the orientation The state of rolling forward and turning to the right side determines that the first blade of the unmanned aerial vehicle is installed incorrectly;
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足朝向前方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第二桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold, the relationship meets the orientation The state of rolling forward and turning to the left, it is determined that the second blade of the UAV is installed incorrectly;
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向左侧翻转的状态,确定所述无人飞行器的第三桨叶安装错误;When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the unmanned aerial vehicle, the left and right roll angular velocity and the left and right roll angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied The state of the human aircraft rolling toward the rear and turning toward the left, and it is determined that the third blade of the unmanned aircraft is installed incorrectly;
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、所述左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值、偏航角加速度和偏航角加速度阈值的关系满足无人飞行器朝向后方翻滚和朝向右侧翻转的状态,确定所述无人飞行器的第四桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold, the yaw angular acceleration and the yaw angular acceleration threshold are satisfied The state of the human aircraft rolling toward the rear and turning toward the right determines that the fourth blade of the unmanned aircraft is installed incorrectly.
  37. 根据权利要求24所述的无人飞行器桨叶安装检测装置,其特征在于,所述运动状态参数包括无人飞行器的角速度和角加速度,所述角速度包括前后翻滚角速度、左右翻转角速度和偏航角速度,所述控制指令参数包括电机拉力输出指令参数,所述无人飞行器起飞参数还包括电调电流参数,The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 24, wherein the motion state parameters include the angular velocity and angular acceleration of the unmanned aerial vehicle, and the angular velocity includes the front and rear roll angular velocity, the left-right flip angular velocity, and the yaw angular velocity. , The control command parameters include motor pull force output command parameters, and the UAV takeoff parameters also include ESC current parameters,
    所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The step of judging the installation error of the blade according to the take-off parameters of the unmanned aerial vehicle, and determining the installation error of the blade includes:
    利用无人飞行器的前后翻滚角速度、左右翻转角速度、偏航角速度、电机拉力输出指令参数和电调电流参数确定无人飞行器的三个或三个以上的桨叶安装错误。Use the UAV's front and rear roll angular velocity, left-right flip angular velocity, yaw angular velocity, motor pull output command parameters and ESC current parameters to determine the installation errors of three or more blades of the UAV.
  38. 根据权利要求37所述的无人飞行器桨叶安装检测装置,其特征在于,所述利用前后翻滚角速度、左右翻转角速度、偏航角速度、电机拉力输出指令参数、电调电流参数确定三个以上的桨叶安装错误的步骤包括:The unmanned aerial vehicle blade installation detection device according to claim 37, wherein the use of the front and rear roll angular velocity, the left-right flip angular velocity, the yaw angular velocity, the motor pulling force output command parameter, and the ESC current parameter to determine more than three The steps to install the improper blade include:
    当所述无人飞行器的前后翻滚角速度和前后翻滚角速度阈值、左右翻转角速度和左右翻转角速度阈值、偏航角速度和偏航角速度阈值满足指定关系,且所述电机拉力输出指令参数大于电机拉力输出指令阈值、电调电流参数大于电调电流参数阈值时,判断所述无人飞行器的三个以上的桨叶安装错误。When the front and rear roll angular velocity and the front and rear roll angular velocity thresholds of the UAV, the left and right flip angular velocity and the left and right flip angular velocity thresholds, the yaw angular velocity and the yaw angular velocity threshold meet the specified relationship, and the motor pull force output command parameter is greater than the motor pull force output command When the threshold value and the ESC current parameter are greater than the ESC current parameter threshold value, it is determined that more than three blades of the UAV are installed incorrectly.
  39. 根据权利要求24所述的无人飞行器桨叶安装检测装置,其特征在于,所述控制指令参数包括电机拉力输出指令参数,所述无人飞行器起飞参数还包括电调电流参数和螺旋桨电阻值,所述根据所述无人飞行器起飞参数判断桨叶安装错误,并确定安装错误的桨叶的步骤包括:The device for detecting the installation of blades of an unmanned aerial vehicle according to claim 24, wherein the control command parameters include motor pull output command parameters, and the unmanned aerial vehicle take-off parameters further include ESC current parameters and propeller resistance values, The step of judging the installation error of the blade according to the take-off parameters of the unmanned aerial vehicle, and determining the installation error of the blade includes:
    利用所述无人飞行器的电调电流参数和螺旋桨电阻值确定一个或一个以上的桨叶未安装。The electric current parameter and the propeller resistance value of the UAV are used to determine that one or more blades are not installed.
  40. 根据权利要求39所述的无人飞行器桨叶安装检测装置,其特征在于,所述利用电调电流参数和螺旋桨电阻值确定一个或一个以上的桨叶未安装的步骤包括:The device for detecting the installation of a blade of an unmanned aerial vehicle according to claim 39, wherein the step of determining that one or more blades are not installed by using the ESC current parameter and the resistance value of the propeller comprises:
    当判断其中一个螺旋桨的电机对应的所述电调电流参数小于对应的电调电流参数阈值,且所述螺旋桨电阻值大于对应的电阻阈值时,判断所述螺旋桨的电机对应的桨叶未安装。When it is determined that the ESC current parameter corresponding to the motor of one of the propellers is less than the corresponding ESC current parameter threshold, and the propeller resistance value is greater than the corresponding resistance threshold, it is determined that the blade corresponding to the motor of the propeller is not installed.
  41. 一种计算处理设备,其特征在于,包括:A computing processing device, characterized in that it comprises:
    存储器,其中存储有计算机可读代码;A memory in which computer-readable codes are stored;
    一个或多个处理器,当所述计算机可读代码被所述一个或多个处理器执行时,所述计算处理设备执行如权利要求1-20中任一项所述的无人飞行器桨叶安装检测方法。One or more processors, when the computer-readable code is executed by the one or more processors, the computing processing device executes the unmanned aerial vehicle blade according to any one of claims 1-20 Installation detection method.
  42. 根据权利要求41所述的计算处理设备,其特征在于,所述计算机处理设备是无人飞行器的飞行控制器。The computing processing device of claim 41, wherein the computer processing device is a flight controller of an unmanned aerial vehicle.
  43. 一种无人飞行系统,包括无人飞行器和控制终端;所述无人飞行器包括机架、飞行控制器和传感系统;所述飞行控制器能够与所述传感系统和所述控制终端之间传输信号,所述控制终端能够发送控制信号至所述飞行控制器,以控制所述无人飞行器的飞行;An unmanned aerial vehicle includes an unmanned aerial vehicle and a control terminal; the unmanned aerial vehicle includes a frame, a flight controller, and a sensing system; the flight controller can interact with the sensing system and the control terminal. Transmitting signals between them, the control terminal can send control signals to the flight controller to control the flight of the unmanned aerial vehicle;
    所述飞行控制器用于执行如下操作:The flight controller is used to perform the following operations:
    获取无人飞行器起飞参数,所述无人飞行器起飞参数包括:运动状态参数和控制指令参数;Acquire take-off parameters of the unmanned aerial vehicle, where the take-off parameters of the unmanned aerial vehicle include: motion state parameters and control command parameters;
    根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
    根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
  44. 根据权利要求43所述的无人飞行系统,其特征在于,所述无人飞行系统还包括显示设备,用于接收所述飞行控制器传输的控制信号并对应地显示信息。The unmanned flight system of claim 43, wherein the unmanned flight system further comprises a display device for receiving the control signal transmitted by the flight controller and correspondingly displaying information.
  45. 一种无人飞行器,其特征在于,包括:机架、飞行控制器和传感系统;所述飞 行控制器能够与所述传感系统之间传输信号;An unmanned aerial vehicle, characterized by comprising: a frame, a flight controller, and a sensing system; the flight controller can transmit signals with the sensing system;
    所述飞行控制器用于执行如下操作:The flight controller is used to perform the following operations:
    获取无人飞行器起飞参数,所述无人飞行器起飞参数包括从所述传感系统获取的运动状态参数和从所述飞行控制器获取的控制指令参数;Acquiring take-off parameters of an unmanned aerial vehicle, the take-off parameters of the unmanned aerial vehicle including the motion state parameters obtained from the sensing system and the control command parameters obtained from the flight controller;
    根据所述无人飞行器起飞参数,确定所述无人飞行器的桨叶的安装信息;Determine the installation information of the blades of the unmanned aerial vehicle according to the take-off parameters of the unmanned aerial vehicle;
    根据所述桨叶安装信息,执行对应的操作。Perform corresponding operations according to the blade installation information.
  46. 一种包括指令的计算机程序产品,其特征在于,当所述指令在计算机上运行时,使得所述计算机机执行如权利要求1-20中任一项所述的无人飞行器桨叶安装检测方法。A computer program product comprising instructions, characterized in that, when the instructions are run on a computer, the computer is caused to execute the method for detecting the installation of an unmanned aerial vehicle blade according to any one of claims 1-20 .
  47. 一种计算机可读存储介质,其特征在于,包括指令,当其在计算机上运行时,使得计算机执行如权利要求1-20中任一项所述的无人飞行器桨叶安装检测方法。A computer-readable storage medium, characterized by comprising instructions, which when run on a computer, causes the computer to execute the method for detecting the installation of an unmanned aerial vehicle blade according to any one of claims 1-20.
PCT/CN2020/087307 2020-04-27 2020-04-27 Method and apparatus for inspecting installation of blades of unmanned aerial vehicle WO2021217362A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202080026377.8A CN113853556A (en) 2020-04-27 2020-04-27 Unmanned aerial vehicle blade installation detection method and device
PCT/CN2020/087307 WO2021217362A1 (en) 2020-04-27 2020-04-27 Method and apparatus for inspecting installation of blades of unmanned aerial vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/087307 WO2021217362A1 (en) 2020-04-27 2020-04-27 Method and apparatus for inspecting installation of blades of unmanned aerial vehicle

Publications (1)

Publication Number Publication Date
WO2021217362A1 true WO2021217362A1 (en) 2021-11-04

Family

ID=78332284

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/087307 WO2021217362A1 (en) 2020-04-27 2020-04-27 Method and apparatus for inspecting installation of blades of unmanned aerial vehicle

Country Status (2)

Country Link
CN (1) CN113853556A (en)
WO (1) WO2021217362A1 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050125103A1 (en) * 2002-03-18 2005-06-09 Rogeli Ferrer Method and device for detecting defects of at least one rotary wing aircraf rotor
CN103625650A (en) * 2012-08-21 2014-03-12 贝尔直升机德事隆公司 Aircraft environmental sensors and system
CN103995529A (en) * 2014-05-20 2014-08-20 西南交通大学 On-line diagnosis method for mechanical installation faults of rotor craft
CN105116271A (en) * 2015-08-07 2015-12-02 深圳一电科技有限公司 Blade detection device and method, blade assembly, aircraft and control method thereof
CN106123941A (en) * 2016-06-13 2016-11-16 零度智控(北京)智能科技有限公司 Unmanned plane rotor detection method and device

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050125103A1 (en) * 2002-03-18 2005-06-09 Rogeli Ferrer Method and device for detecting defects of at least one rotary wing aircraf rotor
CN103625650A (en) * 2012-08-21 2014-03-12 贝尔直升机德事隆公司 Aircraft environmental sensors and system
CN103995529A (en) * 2014-05-20 2014-08-20 西南交通大学 On-line diagnosis method for mechanical installation faults of rotor craft
CN105116271A (en) * 2015-08-07 2015-12-02 深圳一电科技有限公司 Blade detection device and method, blade assembly, aircraft and control method thereof
CN106123941A (en) * 2016-06-13 2016-11-16 零度智控(北京)智能科技有限公司 Unmanned plane rotor detection method and device

Also Published As

Publication number Publication date
CN113853556A (en) 2021-12-28

Similar Documents

Publication Publication Date Title
US11640178B2 (en) Unmanned aircraft, device for controlling unmanned aircraft, method for controlling unmanned aircraft, and device for detecting failure of unmanned aircraft
JP6239619B2 (en) Flying camera with a string assembly for positioning and interaction
US20230002074A1 (en) Autonomous Aerial Vehicle Hardware Configuration
Sharf et al. Ground effect experiments and model validation with Draganflyer X8 rotorcraft
US20170153650A1 (en) Multiple rotors aircraft and control method
CN111650955B (en) Control method of climbing robot and climbing robot
WO2018068193A1 (en) Control method, control device, flight control system, and multi-rotor unmanned aerial vehicle
US20240067335A1 (en) Method and device for determining abnormally mounted propeller in unmanned aerial vehicle (uav)
WO2019000328A1 (en) Control method of unmanned aerial vehicle, control terminal, and unmanned aerial vehicle
CN112313149B (en) Aircraft with a plurality of aircraft body
CN111977006A (en) Method and device for initializing joint angle and aircraft
JP2019057185A (en) Flying device, flying method, and program
WO2021217362A1 (en) Method and apparatus for inspecting installation of blades of unmanned aerial vehicle
CN108475066B (en) Unmanned aerial vehicle attitude calculation method, flight controller and unmanned aerial vehicle
CN108698694B (en) Control method, aircraft control system and rotorcraft
US20220261011A1 (en) Motor control device, moving body, motor control method, and program
KR101621461B1 (en) Quad-Rotor position control system and control method thereof
CN113767350A (en) Power output detection method and equipment for unmanned aerial vehicle
WO2020014930A1 (en) Unmanned aerial vehicle control method and device and unmanned aerial vehicle
CN116101507A (en) Control method and device for rotorcraft, rotorcraft and storage medium
TWI783438B (en) Fixed-wing vertical take-off and landing aircraft and automatic control method thereof
CN113296527B (en) Flight control method of small rotor aerial robot in non-zero initial state
US20240134397A1 (en) Aerial vehicle, control method, and program

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

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

Country of ref document: EP

Kind code of ref document: A1