WO2019119201A1 - Gimbal control method, unmanned aerial vehicle, gimbal, and storage medium - Google Patents

Abstract

Provided in an embodiment of the present invention are a gimbal control method, an unmanned aerial vehicle, a gimbal, and a storage medium. The gimbal control method is implemented in an unmanned aerial vehicle provided with a gimbal. The method comprises: detecting whether an unmanned aerial vehicle enters a preset state; and if the unmanned aerial vehicle is detected to have entered the preset state, transmitting a control instruction to a gimbal, wherein the control instruction is used to instruct the gimbal to move to, and remain at, a target joint angle from a current joint angle. The joint angle is an angle of a gimbal shaft relative to the gimbal in a joint coordinate system. In the embodiment of the present invention, controlling a gimbal to move from a current joint angle to a target joint angle effectively ensures that the gimbal does not reach a position-limiting position, thereby realizing protection and control of the gimbal, and ensuring safety of the gimbal.

Description

PTZ control method, drone, pan/tilt and storage medium Technical field

The present invention relates to the field of control technologies, and in particular, to a cloud platform control method, a drone, a cloud platform, and a storage medium.

Background technique

With the development of computer technology and the needs of users, the development of aircraft like drones is getting faster and faster. Among them, drones mainly include pan/tilt and body. During the flight, the drone may have various faults or bombings due to the reasons of the drone itself or improper operation of the user.

After various failures or bombings of the drone, it is necessary to perform corresponding after-sales treatment on the drone, usually copying the flight data of the drone to facilitate investigation of the cause of the malfunction or bombing of the drone. In the process of copying data, the drone may not be able to maintain balance due to the missing part of the body, which leads to the turbulence of the gimbal and even directly hit the mechanical limit, which reduces the service life of the gimbal. In severe cases, it may even burn out. Motor.

Therefore, how to better control the gimbal in this situation has become a research hotspot.

Summary of the invention

The embodiment of the invention provides a cloud platform control method, a drone, a cloud platform, a system and a storage medium, which can improve the security of the cloud platform.

In a first aspect, an embodiment of the present invention provides a pan/tilt control method, which is applied to a drone, and the drone is provided with a pan/tilt. The method includes:

Detecting whether the drone enters a preset state;

If it is detected that the drone enters a preset state, sending a control instruction to the pan/tilt;

The control command is used to indicate that the gimbal moves from a current joint angle to a target joint angle and is maintained under the target joint angle, and the joint angle refers to a joint of the pan-tilt axis relative to the pan-tilt The angle of the coordinate system.

In a second aspect, the embodiment of the present invention further provides another pan/tilt control method, which is applied to a cloud platform, and the cloud platform is disposed on a drone, and the method includes:

Receiving a control instruction when the drone is in a preset state;

The pan/tilt is controlled to move from the current joint angle to the target joint angle and is maintained at the target joint angle, which is the angle of the pan-tilt axis relative to the joint coordinate system of the pan-tilt.

In a third aspect, an embodiment of the present invention provides a drone, including:

body;

a power system disposed on the fuselage for providing flight power;

a cloud platform mounted on the fuselage;

a processor, disposed in the body, the processor, configured to perform the following steps:

Detecting whether the drone enters a preset state;

If it is detected that the drone enters a preset state, sending a control instruction to the pan/tilt;

The control command is used to indicate that the gimbal moves from a current joint angle to a target joint angle and is maintained under the target joint angle, and the joint angle refers to a joint of the pan-tilt axis relative to the pan-tilt The angle of the coordinate system.

In a fourth aspect, an embodiment of the present invention provides a cloud platform, where the cloud platform is mounted on a drone, and includes:

PTZ axis

Angle sensor;

a processor, the processor, configured to perform the following steps:

Receiving a control instruction when the drone is in a preset state;

The pan/tilt is controlled to move from the current joint angle to the target joint angle and is maintained at the target joint angle, which is the angle of the pan-tilt axis relative to the joint coordinate system of the pan-tilt.

In a fifth aspect, an embodiment of the present invention provides a computer readable storage medium, where the computer readable storage medium stores a computer program, and when the computer program is executed by a processor, implements the first aspect or the second aspect, PTZ control method.

In the embodiment of the present invention, the UAV detects a state in which the UAV is currently located, and if it detects that the UAV is in a preset state, sends a control instruction to the PTZ to indicate the PTZ The current joint angle is moved to the target joint angle and remains under the target joint angle during subsequent copying of the data. By controlling the movement of the gimbal to the target joint angle, it is possible to effectively ensure that the gimbal does not reach the limit position, realize the protection control of the gimbal, and ensure the safety of the gimbal.

DRAWINGS

In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the embodiments will be briefly described below. Obviously, the drawings in the following description are some implementations of the present invention. For example, other drawings may be obtained from those of ordinary skill in the art in light of the inventive work.

1 is a schematic diagram of an interaction process of a PTZ control method according to an embodiment of the present invention;

2 is a schematic flowchart of a PTZ control method according to an embodiment of the present invention;

3 is a schematic flowchart diagram of another PTZ control method according to an embodiment of the present invention;

4 is a schematic flowchart diagram of still another method for controlling a PTZ according to an embodiment of the present invention;

FIG. 5 is a schematic flowchart diagram of still another method for controlling a pan/tilt according to an embodiment of the present invention; FIG.

6 is a schematic block diagram of a drone according to an embodiment of the present invention;

FIG. 7 is a schematic block diagram of a cloud platform according to an embodiment of the present invention.

Detailed ways

The technical solutions in the embodiments of the present invention are clearly and completely described in the following with reference to the accompanying drawings in the embodiments of the present invention. It is obvious that the described embodiments are part of the embodiments of the present invention, but not all embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of the present invention without creative efforts are within the scope of the present invention.

Some embodiments of the present invention are described in detail below with reference to the accompanying drawings. The features of the embodiments and examples described below can be combined with each other without conflict.

The pan/tilt control method provided by the embodiment of the present invention can be applied to a cloud station after the UAV detects that the data in the storage device of the drone is copied after the UAV malfunctions or flies. control. The pan/tilt control method can be applied to a drone, and can also be applied to other intelligent terminals such as an unmanned car; the storage device can be a black box of the drone; the data can include a flying height, a flight Any one or more of the flight data of direction, flight speed, and acceleration.

The PTZ control method provided by the embodiment of the present invention may be implemented according to the interaction between the UAV and the PTZ in the system, and the interaction method of the UAV and the PTZ is described below with reference to the accompanying drawings, and respectively The control methods applied to the drone and the pan/tilt are described in detail.

Referring to FIG. 1, FIG. 1 is a schematic diagram of an interaction process of a PTZ control method according to an embodiment of the present invention. Specifically, the method implementation of the embodiment of the present invention includes the following steps.

S101: The drone detects whether data in the storage device of the drone is copied.

In the embodiment of the present invention, the drone can detect whether the data of the storage device of the drone is copied, wherein the data may include any one or more of a flight height, a flight direction, a flight speed, and an acceleration. Flight data, the storage device is explained as described above. For example, the drone can detect whether any one or more of the flight altitudes, flight directions, flight speeds, and accelerations stored in the black box of the drone are copied.

S102: If the detection result is yes, determine that the drone enters a preset state.

In the embodiment of the present invention, if the UAV detects that the data of the storage device of the UAV is copied, the UAV may determine that the UAV is currently in a preset state. For example, if the drone detects that the flight data stored in the black box of the drone is copied, the drone may determine that the state of the drone is currently in a preset state. It can be understood that determining whether the drone enters the preset state may also be an instruction of whether the drone receives the sensor calibration. For example, when it is detected that the unmanned aerial vehicle needs to enter the compass correction command, it is determined that the drone enters the preset state. Of course, the step of determining that the drone enters a preset state may also be triggered by other means, which are not enumerated here.

S103: The drone sends a control command to the pan/tilt of the drone.

In the embodiment of the present invention, if the UAV is detected to enter a preset state, the UAV may send a control instruction to the PTZ. The control command is used to indicate that the gimbal moves from a current joint angle to a target joint angle and is maintained under the target joint angle, and the joint angle refers to a joint of the pan-tilt axis relative to the pan-tilt The angle of the coordinate system.

S104: The pan/tilt receives the control instruction of the drone.

In the embodiment of the present invention, the pan/tilt can receive the control command sent by the drone. The control command is further configured to control the pan/tilt to enter a joint angle closed-loop operation mode from the attitude closed-loop operation mode, and the pan-tilt moves from the current joint angle to the target joint angle in the joint-angle closed-loop operation mode. The pan/tilt is used to hang a load, and the pan/tilt includes at least one pan/tilt axis. In the attitude closed-loop mode of operation, the pan-tilt axis moves to achieve a desired attitude in the geodetic coordinate system; in the joint-angle closed-loop mode of operation, the pan-tilt axis moves such that the pan-tilt axis is in the joint angular coordinate system Achieve the desired angle. The closed-loop operation mode of the joint angle and the closed-loop operation mode of the attitude will not be described again.

S105: The pan/tilt controls the pan/tilt to move from the current joint angle to the target joint angle and remains under the target joint angle.

In the embodiment of the present invention, the pan/tilt may control the pan/tilt to enter the joint angle closed-loop operation mode from the attitude closed-loop operation mode according to the received control instruction, and the pan-tilt is in the closed-loop operation mode of the joint angle from the current The joint angle moves to the target joint angle. In one embodiment, the target joint angle is 0 degrees.

In an embodiment, after the pan/tilt receives the control instruction, the current joint angle of the gimbal may be acquired, and the interpretation of the joint angle is as described above. For example, after receiving the control command, the pan/tilt may acquire a joint angle of 30° of the current gimbal axis of the gimbal relative to the joint coordinate system of the gimbal.

In an embodiment, the pan/tilt may plan a motion curve of the pan/tilt according to a current joint angle and a target joint angle of the gimbal, and control the pan-tilt from the current joint according to the motion curve. The angle moves to the target joint angle. The motion curve may be a curve of any shape, which is not limited in the embodiment of the present invention, and only needs to satisfy the adjustment of the pan head from the position corresponding to the current joint angle to the position corresponding to the target joint angle. For example, if the current joint angle of the pan/tilt acquired by the pan/tilt is 3° and the target joint angle is 0°, the pan/tilt can be planned to move from the current joint angle of 3° to the target joint angle of 0°. Movement curve.

In an embodiment, the pan/tilt may determine a motion parameter of the pan/tilt according to the current joint angle of the gimbal and the target joint angle in planning the motion curve of the pan/tilt, and According to the motion parameter of the pan/tilt, the motion curve of the pan/tilt is planned.

In one embodiment, the motion parameter includes any one or more of a motion time, an angular velocity, and an angular acceleration, and the pan/tilt may be according to any one of the pan/tilt motion time, an angular velocity, and an angular acceleration. Multiple, plan the motion curve of the gimbal. For example, if the pan/tilt acquires the current joint angle of the pan/tilt head at 30° and the target joint angle is 0°, the pan/tilt head controls the pan/tilt head to move from a position corresponding to the current joint angle of 30°. The position corresponding to the target joint angle of 0° needs to be rotated at an angle of 30°. It is assumed that the motion parameter of the pan/tilt is set as follows: the time information for completing the pan-tilt movement is 10 s, the angular acceleration within the first ^2.5 s is constant 1.6 m/s ² , the middle 5 s is moving at a constant angular acceleration, and the latter is within ^2.5 s. The acceleration is -1.6m/s ² . The pan/tilt may plan a motion curve of the pan/tilt moving from a current joint angle of 30° to the target joint angle of 0° according to the set motion parameters of the pan/tilt.

In one embodiment, the target joint angle may also be the current joint angle of the gimbal. When the target joint angle is the current joint angle of the gimbal, when the drone enters the preset state, the gimbal enters the joint angle closed-loop operation mode, and when the drone is in the preset state, the gimbal maintains the current joint angle .

S106: The pan/tilt receives the end command sent by the drone, and controls the pan/tilt to enter the attitude closed-loop operation mode from the joint angle closed-loop operation mode.

In the embodiment of the present invention, if the pan/tilt receives the end command sent by the drone, the pan/tilt may be controlled to enter the attitude closed-loop operation mode from the joint angle closed-loop operation mode. The attitude angle of the pan/tilt in the attitude closed-loop operation mode is an attitude angle or a preset attitude angle before the pan-tilt enters the closed-loop operation mode of the joint angle. In an embodiment, the pan/tilt may control a position of the pan/tilt head from a position corresponding to the target joint angle to a position corresponding to the attitude angle or a preset attitude angle position in the attitude closed-loop operation mode. .

In the joint angle closed loop mode, the pan/tilt is controlled to move from the current joint angle to a position where the joint angle is zero. Specifically, the T-shaped velocity planning can be performed according to the current joint angle of the gimbal, and the trapezoidal motion curve is automatically planned, so that the gimbal smoothly runs to a position where the joint angle is zero. The attitude closed-loop operation mode is controlled by the attitude of the gimbal. During the movement of the movable object, the attitude of the gimbal is controlled, so that the gimbal moves in accordance with the movement of the movable object, so that the gimbal is relatively movable. The automatic control process in which the moving object remains relatively stationary.

In another embodiment, after receiving the end command sent by the drone, the pan/tilt may also control the pan/tilt to be powered on again.

In the embodiment of the present invention, the drone determines the current state of the drone by detecting whether the data in the storage device of the drone is copied, and if it is a preset state, The pan/tilt head of the drone sends a control command, and after receiving the control command, the pan/tilt head can control the pan/tilt head to move from the current joint angle to the target joint angle, and keep in the process of subsequently copying the data. Under the target joint angle, the drone sends an end command to the pan/tilt if it detects that the preset state of the drone is over, and the pan/tilt controls according to the received end instruction. The pan/tilt enters the attitude closed-loop operation mode from the joint angle closed-loop operation mode, thereby ending the control of the pan/tilt in the joint angle closed-loop operation mode. It can be seen that, in this manner, the embodiment of the present invention can realize the protection control of the pan/tilt and ensure the security of the pan/tilt.

Referring to FIG. 2, FIG. 2 is a schematic flowchart of a PTZ control method according to an embodiment of the present invention. The method may be performed by a UAV. Specifically, the method in the embodiment of the present invention includes the following steps.

S201: Detect whether the drone enters a preset state.

In the embodiment of the present invention, the drone can detect whether the drone enters a preset state. In one embodiment, the drone can detect whether data in the storage device of the drone is copied. If the detection result is yes, it can be determined that the current state of the drone is pre- Set the status. Wherein, the data includes any one or more flight data of flight altitude, flight direction, flight speed, and acceleration.

It can be understood that determining whether the drone enters the preset state may also be an instruction of whether the drone receives the sensor calibration. For example, when it is detected that the unmanned aerial vehicle needs to enter the compass correction command, it is determined that the drone enters the preset state. Of course, the step of determining that the drone enters a preset state may also be triggered by other means, which are not enumerated here.

S202: If it is detected that the drone enters a preset state, send a control instruction to the pan/tilt.

In the embodiment of the present invention, if the UAV is detected to enter a preset state, the UAV may send a control instruction to the PTZ. The control command is used to instruct a closed-loop operation mode from the attitude closed-loop operation mode, and the pan-tilt moves from the current joint angle to the target joint angle in the joint-angle closed-loop operation mode, and remains at the target Below the joint angle, wherein the joint angle refers to the angle of the gimbal axis relative to the joint coordinate system of the gimbal. In one embodiment, the target joint angle is 0 degrees. In another embodiment, the target joint angle may also be the current joint angle of the gimbal. When the target joint angle is the current joint angle of the gimbal, when the drone enters the preset state, the gimbal enters the joint angle closed-loop operation mode, and when the drone is in the preset state, the gimbal maintains the current joint angle .

In one embodiment, after the drone sends the control command to the pan/tilt, the current joint angle of the gimbal may be acquired, and the joint angle is explained as described above. For example, after the drone sends the control command to the pan/tilt, the joint angle of the current pan-tilt axis of the gimbal relative to the joint coordinate system of the gimbal may be acquired as 30°.

In an embodiment, the UAV may further plan a motion curve of the PTZ according to the current joint angle of the PTZ and the target joint angle after sending a control instruction to the PTZ, and according to The motion curve controls movement of the pan/tilt from the current joint angle to the target joint angle. The motion curve may be a trapezoidal motion curve or a motion curve of other shapes. The embodiment of the present invention is not limited, and only needs to meet the smooth adjustment of the position of the gimbal from the current joint angle to The position corresponding to the target joint angle.

In an embodiment, if the drone detects that the preset state of the drone is over, an end command may be sent to the pan/tilt to control the pan-tilt closed-loop operation mode from the joint angle. Entering the attitude closed-loop operation mode, and controlling the position of the pan-tilt from the target joint angle movement in the joint angle closed-loop operation mode to the attitude angle in the attitude closed-loop operation mode. The attitude angle of the pan/tilt in the attitude closed-loop operation mode is an attitude angle or a preset attitude angle before the pan-tilt enters the closed-loop operation mode of the joint angle. In other embodiments, when the drone detects that the preset state of the drone is over, the drone can also be controlled to be powered back on.

In the embodiment of the present invention, the UAV detects the current state of the UAV, and if it detects that the UAV enters the preset state, sends a control command to the PTZ to indicate the PTZ The attitude closed loop mode of operation enters a joint angle closed loop mode of operation and moves from the current joint angle to the target joint angle in the joint angle closed loop mode of operation and remains at the target during subsequent copying of data The position of the joint angle. By controlling the movement of the gimbal from the current joint angle and maintaining the target joint angle, it is possible to effectively ensure that the gimbal does not reach the limit position, realize the protection control of the gimbal, and ensure the safety of the gimbal.

Referring to FIG. 3, FIG. 3 is a schematic flowchart of another method for controlling a pan/tilt according to an embodiment of the present invention. The method may be performed by a drone, wherein the difference between the embodiment of the present invention and the embodiment corresponding to FIG. The UAV can plan the motion curve of the PTZ according to the acquired current joint angle of the PTZ and the target joint angle, and control the PTZ from the current joint according to the motion curve. The angle moves to the target joint angle. Specifically, the method of the embodiment of the present invention includes the following steps.

S301: Detect whether the drone enters a preset state.

In the embodiment of the present invention, the drone can detect whether the drone enters a preset state. Wherein the preset state of the drone is determined by whether data in the storage device of the drone is copied, if the drone detects the storage device of the drone The data is copied, and it can be determined that the state in which the drone is currently located is a preset state. Wherein, the data includes any one or more flight data of flight altitude, flight direction, flight speed, and acceleration.

It can be understood that determining whether the drone enters the preset state may also be an instruction of whether the drone receives the sensor calibration. For example, when it is detected that the unmanned aerial vehicle needs to enter the compass correction command, it is determined that the drone enters the preset state. Of course, the step of determining that the drone enters a preset state may also be triggered by other means, which are not enumerated here.

S302: If it is detected that the UAV enters a preset state, send a control instruction to the PTZ.

In the embodiment of the present invention, if the UAV detects that the UAV enters a preset state, the UAV may send a control instruction to the PTZ. The control instruction is used to instruct the pan/tilt to enter a joint angle closed-loop operation mode from the attitude closed-loop operation mode, and control the pan-tilt to move from the current joint angle to the target joint angle in the joint angle closed-loop operation mode, And remaining under the target joint angle, the joint angle is explained as described above. In one embodiment, the target joint angle is 0 degrees.

S303: Acquire a current joint angle of the gimbal.

In the embodiment of the present invention, the UAV can acquire the current joint angle of the gimbal, and the interpretation of the joint angle is as described above. For example, after the drone sends the control command to the pan/tilt, the joint angle of the current pan/tilt axis of the gimbal relative to the joint coordinate system of the gimbal may be acquired, for example, the joint angle is 3°.

S304: Plan a motion curve of the pan/tilt according to the current joint angle of the gimbal and the target joint angle.

In the embodiment of the present invention, after the UAV sends the control command to the PTZ and obtains the current joint angle of the PTZ and the target joint angle, the UAV may be based on the current joint angle of the PTZ. The target joint angle is planned for the movement curve of the gimbal. The motion curve may be a trapezoidal motion curve or a motion curve of other shapes. The embodiment of the present invention is not limited, and only needs to meet the smooth adjustment of the position of the gimbal from the current joint angle to The position corresponding to the target joint angle.

In an embodiment, the drone may plan a motion curve of the pan/tilt by determining a motion parameter of the pan/tilt. Specifically, the drone may be based on a current joint angle and a location of the gimbal. Describe a target joint angle, determine a motion parameter of the pan/tilt, and plan a motion curve of the pan/tilt according to the motion parameter.

In an embodiment, the motion parameter of the pan/tilt may include any one or more of a motion time, an angular velocity, and an angular acceleration, and the drone may be according to the pan/tilt motion time, the angular velocity, and the angular acceleration. Plan any one or more of the motion curves of the gimbal. For example, if the drone acquires the current joint angle of the gimbal is 30° and the target joint angle is 0°, the drone controls the corresponding position of the gimbal from the current joint angle of 30°. The position corresponding to the target joint angle 0° needs to be rotated by 30°. It is assumed that the motion parameter of the pan/tilt is set to: the time information for completing the pan/tilt movement is 10s, and the first 2.5s inner angle The acceleration is constant at 1.6 m/s ² , the middle 5 s is moving at a constant angular acceleration, and the angular acceleration in the latter 2.5 s is -1.6 m/s ² . The drone may plan a motion curve of the pan/tilt moving from a current joint angle of 30° to the target joint angle of 0° according to the set motion parameters of the pan/tilt.

In one embodiment, the target joint angle may also be the current joint angle of the gimbal. When the target joint angle is the current joint angle of the gimbal, when the drone enters the preset state, the gimbal enters the joint angle closed-loop operation mode, and when the drone is in the preset state, the gimbal maintains the current joint angle .

S305: Control, according to the motion curve, the pan/tilt moving from the current joint angle to the target joint angle.

In the embodiment of the present invention, after planning the motion curve of the pan/tilt, the drone may control the pan/tilt to move from the current joint angle to the target joint angle according to the planned motion curve. For example, if the motion curve planned by the drone is a trapezoidal motion curve, the drone may control the pan/tilt corresponding to the current joint angle of 3° according to the planned trapezoidal motion curve. The position is smoothly moved to a position corresponding to the target joint angle of 0°.

In one embodiment, if the drone detects that data in the preset storage device of the drone stops being copied, the drone may determine the pre-determination of the drone The state is ended, and an end command is sent to the pan/tilt to control the pan/tilt to enter the attitude closed-loop mode of operation from the joint angle closed-loop mode of operation. The attitude angle of the pan/tilt in the attitude closed-loop operation mode is an attitude angle or a preset attitude angle before the pan-tilt enters the closed-loop operation mode of the joint angle. In one embodiment, the drone may control the position of the pan/tilt from the position corresponding to the target joint angle to the position corresponding to the attitude angle or the preset attitude angle in the attitude closed-loop operation mode. . In other embodiments, when the drone detects that the preset state of the drone is over, the drone or pan/tilt can also be controlled to be powered back on.

In the embodiment of the present invention, the UAV detects the current state of the UAV, and if it detects that the UAV enters the preset state, sends a control command to the PTZ to indicate the PTZ The attitude closed loop mode of operation enters a joint angle closed loop mode of operation and moves from the current joint angle to the target joint angle in the joint angle closed loop mode of operation and remains at the target joint angle during subsequent copying of the data position. By controlling the movement of the gimbal from the current joint angle to the target joint angle, it is possible to effectively ensure that the gimbal does not reach the limit position, realize the protection control of the gimbal, and ensure the safety of the gimbal.

Referring to FIG. 4, FIG. 4 is a schematic flowchart diagram of still another method for controlling a PTZ according to an embodiment of the present invention, where the method may be performed by a PTZ. Specifically, the method of the embodiment of the present invention includes the following steps.

S401: Receive a control instruction when the drone is in a preset state.

In the embodiment of the present invention, the pan/tilt may receive a control instruction sent when the drone is in a preset state; or the pan/tilt may receive a control instruction input by the user. The control command is configured to control the pan/tilt to enter a joint angle closed-loop operation mode from the attitude closed-loop operation mode, and the pan-tilt moves from the current joint angle to the target joint angle in the joint-angle closed-loop operation mode. In an embodiment, after receiving the control instruction, the pan/tilt may acquire the current joint angle of the gimbal through an angle sensor of the pan/tilt. For example, after receiving the control instruction, the pan/tilt may acquire, by the angle sensor, a joint angle of the current pan-tilt axis of the gimbal relative to the joint coordinate system of the pan-tilt head by 3°.

S402: Control the pan/tilt to move from the current joint angle to the target joint angle and keep under the target joint angle.

In the embodiment of the present invention, the pan/tilt may control the pan/tilt to enter a joint angle closed-loop operation mode from the attitude closed-loop operation mode according to the control instruction, and the pan-tilt is from the current joint in the joint-angle closed-loop operation mode. The horn moves to the target joint angle, and during the subsequent copying of the data, the gimbal remains below the target joint angle. Here, the explanation of the joint angle is as described above. In one embodiment, the target joint angle is 0 degrees.

In one embodiment, the target joint angle may also be the current joint angle of the gimbal. When the target joint angle is the current joint angle of the gimbal, when the drone enters the preset state, the gimbal enters the joint angle closed-loop operation mode, and when the drone is in the preset state, the gimbal maintains the current joint angle .

In one embodiment, the pan/tilt may receive an end command, and when the end command is received, control the pan-tilt from the joint angle closed-loop operation mode to the attitude closed-loop operation mode, and control the pan-tilt The target joint angle is moved to an attitude angle or a preset attitude angle in the attitude closed loop operation mode, or the pan/tilt is controlled to be powered on again. The end instruction may be sent by the drone; or the end instruction may be input by a user. The end instruction is used to notify the cloud station that the preset state of the drone is over.

In one embodiment, if the pan/tilt receives an end command sent by the drone, the pan/tilt may be controlled to enter the attitude closed-loop mode of operation from the joint angle closed-loop mode of operation. The attitude angle of the pan/tilt in the attitude closed-loop operation mode is an attitude angle or a preset attitude angle before the pan-tilt enters the closed-loop operation mode of the joint angle. In one embodiment, the pan/tilt may control the position of the pan/tilt from the position corresponding to the target joint angle to the position corresponding to the attitude angle in the attitude closed-loop operation mode.

In the embodiment of the present invention, the cloud platform controls the pan-tilt to move from the current joint angle to the target joint angle by receiving a control command sent by the drone in a preset state, and remains in the process of subsequent data copying. The position of the target joint angle. By controlling the movement of the gimbal from the current joint angle to the target joint angle, it is possible to effectively ensure that the gimbal does not reach the limit position, realize the protection control of the gimbal, and ensure the safety of the gimbal.

Referring to FIG. 5, FIG. 5 is a schematic flowchart diagram of still another method for controlling a PTZ according to an embodiment of the present invention, where the method may be performed by a PTZ. The difference between the embodiment of the present invention and the corresponding embodiment of FIG. 4 is that the pan/tilt can plan the motion curve of the pan/tilt according to the acquired current joint angle of the gimbal and the target joint angle. Specifically, the method of the embodiment of the present invention includes the following steps.

S501: Receive a control command when the drone is in a preset state.

In the embodiment of the present invention, the pan/tilt may receive a control instruction sent by the drone to the pan/tilt after entering the preset state; or the pan/tilt may receive a control instruction input by the user. The control command is configured to control the pan/tilt to enter a joint angle closed-loop operation mode from the attitude closed-loop operation mode, and the pan-tilt moves from the current joint angle to the target joint angle in the joint-angle closed-loop operation mode.

S502: Acquire a current joint angle of the gimbal.

In the embodiment of the present invention, the pan/tilt receives the control instruction about moving from the attitude closed loop operation mode to the joint angle closed loop operation mode, and moving from the current joint angle to the target joint angle in the joint angle closed loop operation mode. Thereafter, the current joint angle of the pan/tilt head may be acquired by an angle sensor of the pan/tilt head, wherein the angle sensor may be a Hall sensor or a magnetic encoder. For example, after receiving the control instruction, the pan/tilt may acquire, by the angle sensor, a joint angle of the current pan-tilt axis of the gimbal relative to the joint coordinate system of the pan-tilt head by 3°.

S503: Plan a motion curve of the pan/tilt according to the current joint angle of the gimbal and the target joint angle.

In the embodiment of the present invention, the pan/tilt may plan the motion curve of the pan/tilt according to the acquired current joint angle of the gimbal and the target joint angle. Wherein, the explanation of the motion curve is as described above, and details are not described herein again.

In an embodiment, the pan/tilt may plan a motion curve of the pan/tilt head by determining a motion parameter of the pan/tilt head, and the pan-tilt may determine a motion curve of the pan-tilt Determining the current joint angle of the gimbal and the target joint angle, determining a motion parameter of the pan/tilt, and planning a motion curve of the pan/tilt according to the motion parameter of the pan/tilt. The motion parameter may include any one or more of a motion time, an angular velocity, and an angular acceleration. For example, the pan/tilt may plan the motion curve of the pan/tilt according to any one or more of the motion time, the angular velocity, and the angular acceleration of the pan-tilt movement. For example, if the pan/tilt acquires the current joint angle of the pan/tilt head at 30° and the target joint angle is 0°, the pan/tilt head controls the pan/tilt head to move from a position corresponding to the current joint angle of 30°. The position corresponding to the target joint angle of 0° needs to be rotated at an angle of 30°. It is assumed that the motion parameter of the pan/tilt is set as follows: the time information for completing the pan-tilt movement is 10 s, the angular acceleration within the first ^2.5 s is constant 1.6 m/s ² , the middle 5 s is moving at a constant angular acceleration, and the latter is within ^2.5 s. The acceleration is -1.6m/s ² . The pan/tilt may plan a motion curve of the pan/tilt from a current joint angle of 30° to a target joint angle of 0° according to the set motion parameters of the pan/tilt.

In one embodiment, the target joint angle may also be the current joint angle of the gimbal. When the target joint angle is the current joint angle of the gimbal, when the drone enters the preset state, the gimbal enters the joint angle closed-loop operation mode, and when the drone is in the preset state, the gimbal maintains the current joint angle .

S504: Control the pan/tilt to move from the current joint angle to the target joint angle and keep under the target joint angle.

In the embodiment of the present invention, the pan/tilt may control the pan/tilt to smoothly move from the position corresponding to the current joint angle to the target joint angle according to the planned motion curve of the pan/tilt head. position.

In one embodiment, the pan/tilt may receive an end command, and when the end command is received, control the pan-tilt from the joint angle closed-loop operation mode to the attitude closed-loop operation mode, and control the pan-tilt The target joint angle is moved to an attitude angle or a preset attitude angle in the attitude closed loop operation mode, or the pan/tilt is controlled to be powered on again. The end instruction may be sent by the drone; or the end instruction may be input by a user. The explanation of the end instruction is as described above.

In an embodiment, the pan/tilt may receive an end command sent by the drone, and when the end command is received, control the pan/tilt to enter a gesture closed-loop operation mode from the joint angle closed-loop operation mode, And controlling an attitude angle or a preset attitude angle of the pan/tilt moving from the target joint angle to the attitude closed-loop operation mode. The attitude angle of the pan/tilt in the attitude closed-loop operation mode is an attitude angle or a preset attitude angle before the pan-tilt enters the closed-loop operation mode of the joint angle.

In the embodiment of the present invention, the pan/tilt obtains the current joint angle of the gimbal by the control instruction sent by the drone in a preset state, and the current joint angle and the target joint angle of the gimbal, and the cloud is planned. The motion curve of the table, thereby controlling the pan/tilt movement from the current joint angle to the target joint angle, and maintaining the position of the target joint angle during subsequent data copying. In this way, the protection and control of the gimbal is realized, and the security of the gimbal is guaranteed.

Referring to FIG. 6, FIG. 6 is a schematic block diagram of a drone according to an embodiment of the present invention. The drone in the embodiment of the present invention as shown in FIG. 6 may include: one or more processors 601; one or more input devices 602, one or more output devices 603, and memory 604. The above processor 601, input device 602, output device 603, and memory 604 are connected by a bus 605. The memory 604 is used to store a computer program, the computer program including program instructions, and the processor 601 is configured to execute program instructions stored in the memory 604. Wherein, the processor 601 is configured to invoke the program instruction to execute:

Detecting whether the drone enters a preset state;

If it is detected that the drone enters a preset state, sending a control instruction to the pan/tilt;

The control command is used to indicate that the gimbal moves from a current joint angle to a target joint angle and is maintained under the target joint angle, and the joint angle refers to a joint of the pan-tilt axis relative to the pan-tilt The angle of the coordinate system.

Further, the target joint angle is 0 degrees or the current joint angle of the gimbal or other preset joint angle.

Further, the preset state is whether data in the storage device of the drone is copied.

Further, the control instruction is further configured to instruct the pan/tilt to enter a joint angle closed-loop operation mode from the attitude closed-loop operation mode, and the pan-tilt moves from the current joint angle to the target joint angle in the joint-angle closed-loop operation mode.

Further, the data includes any one or more of flight data of flight altitude, flight direction, flight speed, and acceleration.

Further, the processor 601 calls the program instructions stored in the memory 604 to also perform the following steps:

Obtain the current joint angle of the gimbal.

Further, the processor 601 calls a program instruction stored in the memory 604 for performing the following steps:

Planning a motion curve of the pan/tilt according to a current joint angle of the gimbal and a target joint angle;

And controlling the pan/tilt to move from the current joint angle to the target joint angle according to the motion curve.

Further, the processor 601 calls a program instruction stored in the memory 604 for performing the following steps:

Determining a motion parameter of the pan/tilt according to a current joint angle of the pan/tilt and a target joint angle;

A motion curve of the pan/tilt is planned according to the motion parameter.

Further, the motion parameter includes one or more of a motion time, an angular velocity, and an angular acceleration.

Further, the processor 601 calls a program instruction stored in the memory 604 for performing the following steps:

If it is detected that the preset state of the drone is over, sending an end instruction to the pan/tilt to control the pan-tilt to enter the attitude closed-loop operation mode from the joint angle closed-loop operation mode, or control the The drone or pan/tilt is powered back on.

In the embodiment of the present invention, the UAV detects the current state of the UAV, and if it detects that the UAV enters the preset state, sends a control command to the PTZ to indicate the PTZ The attitude closed loop mode of operation enters a joint angle closed loop mode of operation and moves from the current joint angle to the target joint angle in the joint angle closed loop mode of operation and remains at the target during subsequent copying of data The position of the joint angle. By controlling the movement of the gimbal from the current joint angle and maintaining the target joint angle, it is possible to effectively ensure that the gimbal does not reach the limit position, realize the protection control of the gimbal, and ensure the safety of the gimbal.

It should be understood that, in the embodiment of the present invention, the processor 601 may be a central processing unit (CPU), and the processor may also be another general-purpose processor, a digital signal processor (DSP). , Application Specific Integrated Circuit (ASIC), Field-Programmable Gate Array (FPGA) or other programmable logic device, discrete gate or transistor logic device, discrete hardware component, etc. The general purpose processor may be a microprocessor or the processor or any conventional processor or the like.

Input device 602 can include a touchpad, microphone, etc., and output device 603 can include a display (LCD, etc.), a speaker, and the like.

The memory 604 can include read only memory and random access memory and provides instructions and data to the processor 601. A portion of the memory 604 may also include a non-volatile random access memory. For example, the memory 604 can also store information of the device type.

In a specific implementation, the processor 601, the input device 602, and the output device 603 described in the embodiments of the present invention may perform the PTZ control method described in the embodiment of FIG. 1, FIG. 2 or FIG. 3 provided by the embodiment of the present invention. The implementation manner of the UAV described in the embodiment of the present invention may also be implemented, and details are not described herein again.

Referring to FIG. 7, FIG. 7 is a schematic block diagram of a cloud platform according to an embodiment of the present invention. The pan/tilt in the embodiment of the present invention as shown in FIG. 7 may include: one or more processors 701; one or more angle sensors 702. The processor 701 and the angle sensor 702 are connected by a bus 703. The processor 701 is configured to perform the following steps:

Receiving a control instruction when the drone is in a preset state;

The pan/tilt is controlled to move from the current joint angle to the target joint angle and is maintained at the target joint angle, which is the angle of the pan-tilt axis relative to the joint coordinate system of the pan-tilt.

Further, the target joint angle is 0 degrees or the current joint angle of the gimbal or other preset joint angle.

Further, the processor 701 is configured to perform the following steps:

Receiving a control command sent by the drone;

Or, receive a control command input by the user.

Further, the control instruction is used to control the pan/tilt to enter a joint angle closed-loop operation mode from the attitude closed-loop operation mode, and the pan-tilt moves from the current joint angle to the target joint angle in the joint-angle closed-loop operation mode.

Further, the processor 701 is configured to perform the following steps:

The current joint angle of the gimbal is acquired by the angle sensor 702.

Further, the angle sensor 702 is a Hall sensor, or a magnetic encoder.

Further, the processor 701 is configured to perform the following steps:

Planning a motion curve of the pan/tilt according to a current joint angle of the gimbal and a target joint angle;

And controlling the pan/tilt to move from the current joint angle to the target joint angle according to the motion curve.

Further, the processor 701 is configured to perform the following steps:

Determining a motion parameter of the pan/tilt according to a current joint angle of the pan/tilt and a target joint angle;

A motion curve of the pan/tilt is planned according to the motion parameter.

Further, the motion parameter includes one or more of time information, angular velocity, and angular acceleration.

Further, the processor 701 is configured to perform the following steps:

If the end command sent by the drone is received, the pan/tilt is controlled to enter the attitude closed loop operation mode from the joint angle closed loop operation mode or to control the pan/tilt to be powered on again.

In the embodiment of the present invention, the cloud platform controls the pan-tilt to move from the current joint angle to the target joint angle by receiving a control command sent by the drone in a preset state, and remains in the process of subsequent data copying. The position of the target joint angle. By controlling the movement of the gimbal from the current joint angle to the target joint angle, it is possible to effectively ensure that the gimbal does not reach the limit position, realize the protection control of the gimbal, and ensure the safety of the gimbal.

In a specific implementation, the processor 701 and the angle sensor 702 described in the embodiment of the present invention may implement the implementation manner of the PTZ control method described in the embodiment of FIG. 4 or FIG. 5 provided by the embodiment of the present invention, and may also execute the present embodiment. The implementation of the gimbal described in the embodiments of the present invention is not described herein again.

An embodiment of the present invention further provides a drone, including: a fuselage; a power system disposed on the fuselage for providing flight power; a pan/tilt head mounted on the body; and a processor disposed at In the body, the processor is configured to detect whether the drone enters a preset state; if the drone is detected to enter a preset state, send a control instruction to the pan/tilt.

For the specific implementation of the processor in the UAV, reference may be made to the PTZ control method in the embodiment corresponding to FIG. 2 or FIG. 3, and details are not described herein again. Among them, the drone can be a four-rotor UAV, a six-rotor UAV, a multi-rotor UAV, and the like. The power system may include a motor, an ESC, a propeller, etc., wherein the motor is responsible for driving the aircraft propeller, and the ESC is responsible for controlling the speed of the motor of the aircraft.

The embodiment of the present invention further provides a cloud platform, the cloud platform is mounted on the unmanned aerial vehicle, and includes: a pan/tilt axis; an angle sensor; a processor, and the processor is configured to: when the Receiving a control command; controlling the pan-tilt to move from a current joint angle to a target joint angle, and maintaining the target joint angle, the joint angle being a joint of the pan-tilt axis relative to the pan-tilt The angle of the coordinate system. For the specific implementation of the processor in the PTZ, refer to the PTZ control method in the embodiment corresponding to FIG. 4 or FIG. 5, and details are not described herein again. Wherein, the angle sensor may be a Hall sensor or a magnetic encoder.

The embodiment of the present invention further provides a computer readable storage medium, where the computer readable storage medium stores a computer program, and when the computer program is executed by the processor, the present invention implements FIG. 1, FIG. 2, FIG. 3, and FIG. 4 or the PTZ control method described in the embodiment corresponding to FIG. 5, the UAV described in the embodiment corresponding to FIG. 6 or the PTZ described in the embodiment corresponding to FIG. 7 may also be implemented. Narration.

The computer readable storage medium may be an internal storage unit of a drone or pan/tilt as described in any of the preceding embodiments, such as a hard disk or a memory. The computer readable storage medium may also be an external storage device of the drone or pan/tilt, such as a plug-in hard disk equipped on the device, a smart memory card (SMC), and a secure digital (Secure) Digital, SD) cards, flash cards, etc. Further, the computer readable storage medium may also include both an internal storage unit of the drone or pan/tilt and an external storage device. The computer readable storage medium is for storing the computer program and other programs and data required by the drone or pan/tilt. The computer readable storage medium can also be used to temporarily store data that has been output or is about to be output.

One of ordinary skill in the art can understand that all or part of the process of implementing the foregoing embodiments can be completed by a computer program to instruct related hardware, and the program can be stored in a computer readable storage medium. When executed, the flow of an embodiment of the methods as described above may be included. The storage medium may be a magnetic disk, an optical disk, a read-only memory (ROM), or a random access memory (RAM).

The above disclosure is only a part of the embodiments of the present invention, and the scope of the present invention is not limited thereto, and thus equivalent changes made in the claims of the present invention are still within the scope of the present invention.

Claims (40)

A pan/tilt control method is characterized in that it is applied to a drone, and the drone is provided with a pan/tilt. The method includes: Detecting whether the drone enters a preset state; If it is detected that the drone enters a preset state, sending a control instruction to the pan/tilt; The control command is used to indicate that the gimbal moves from a current joint angle to a target joint angle and is maintained under the target joint angle, and the joint angle refers to a joint of the pan-tilt axis relative to the pan-tilt The angle of the coordinate system. The method of claim 1 wherein said target joint angle is 0 degrees. The method according to claim 1, wherein the preset state is whether data in the storage device of the drone is copied. The method according to claim 1, wherein the control command is further configured to instruct the pan/tilt to enter a joint angle closed-loop operation mode from an attitude closed-loop operation mode, and the pan-tilt is in the joint angle closed-loop operation mode. Move from the current joint angle to the target joint angle. The method of claim 3 wherein said data comprises any one or more of flight altitude, flight direction, flight speed, acceleration. The method of claim 1 further comprising: Obtain the current joint angle of the gimbal. The method of claim 1 further comprising: Planning a motion curve of the pan/tilt according to a current joint angle of the gimbal and a target joint angle; And controlling the pan/tilt to move from the current joint angle to the target joint angle according to the motion curve. The method according to claim 7, wherein the planning a motion curve of the pan/tilt according to the current joint angle of the gimbal and the target joint angle comprises: Determining a motion parameter of the pan/tilt according to a current joint angle of the pan/tilt and a target joint angle; A motion curve of the pan/tilt is planned according to the motion parameter. The method of claim 8 wherein the motion parameter comprises one or more of a motion time, an angular velocity, and an angular acceleration. The method of claim 4, wherein the method further comprises: If it is detected that the preset state of the drone is over, an end command is sent to the pan/tilt to control the pan/tilt to enter the attitude closed loop operation mode from the joint angle closed loop operation mode. A pan/tilt control method is characterized in that it is applied to a cloud platform, and the cloud platform is disposed on a drone, and the method includes: Receiving a control instruction when the drone is in a preset state; The pan/tilt is controlled to move from the current joint angle to the target joint angle and is maintained at the target joint angle, which is the angle of the pan-tilt axis relative to the joint coordinate system of the pan-tilt. The method of claim 11 wherein said target joint angle is 0 degrees. The method according to claim 11, wherein the receiving the control instruction comprises: Receiving a control command sent by the drone; Or, receive a control command input by the user. The method according to claim 11, wherein the control command is used to control the pan/tilt to enter a joint angle closed-loop operation mode from an attitude closed-loop operation mode, and the pan-tilt is in the joint-angle closed-loop operation mode. The current joint angle moves to the target joint angle. The method according to claim 11, wherein after receiving the control instruction, the method comprises: Obtain the current joint angle of the gimbal. The method of claim 11 wherein the method further comprises: Planning a motion curve of the pan/tilt according to a current joint angle of the gimbal and a target joint angle; And controlling the pan/tilt to move from the current joint angle to the target joint angle according to the motion curve. The method according to claim 16, wherein the planning the motion curve of the pan/tilt according to the current joint angle of the gimbal and the target joint angle comprises: Determining a motion parameter of the pan/tilt according to a current joint angle of the pan/tilt and a target joint angle; A motion curve of the pan/tilt is planned according to the motion parameter. The method of claim 17, wherein the motion parameter comprises one or more of a motion time, an angular velocity, and an angular acceleration. The method of claim 14, wherein the method further comprises: If the end command sent by the drone is received, the pan/tilt is controlled to enter the attitude closed loop operation mode from the joint angle closed loop operation mode. A drone, characterized in that it comprises: body; a power system disposed on the fuselage for providing flight power; a cloud platform mounted on the fuselage; a processor, disposed in the body, the processor, configured to perform the following steps: Detecting whether the drone enters a preset state; If it is detected that the drone enters a preset state, sending a control instruction to the pan/tilt; The control command is used to indicate that the gimbal moves from a current joint angle to a target joint angle and is maintained under the target joint angle, and the joint angle refers to a joint of the pan-tilt axis relative to the pan-tilt The angle of the coordinate system. The drone according to claim 20, wherein said target joint angle is 0 degrees. The drone according to claim 20, wherein said preset state is whether data in said storage device of said drone is copied. The drone according to claim 20, wherein the control command is further configured to instruct the pan/tilt to enter a joint angle closed-loop operation mode from an attitude closed-loop operation mode, and the pan-tilt is closed-loop operated at the joint angle The mode moves from the current joint angle to the target joint angle. The drone according to claim 22, wherein said data comprises any one or more of flight data of flight altitude, flight direction, flight speed, and acceleration. The drone according to claim 20, wherein said processor is configured to perform the following steps: Obtain the current joint angle of the gimbal. The drone according to claim 20, wherein said processor is configured to perform the following steps: Planning a motion curve of the pan/tilt according to a current joint angle of the gimbal; And controlling the pan/tilt to move from the current joint angle to the target joint angle according to the motion curve. The drone according to claim 26, wherein said processor is operative to perform the following steps: Determining a motion parameter of the pan/tilt according to a current joint angle of the pan/tilt and a target joint angle; A motion curve of the pan/tilt is planned according to the motion parameter. The drone according to claim 27, wherein said motion parameter comprises one or more of time information and/or angular acceleration information. The drone according to claim 23, wherein said processor is configured to perform the following steps: If it is detected that the preset state of the drone is over, an end command is sent to the pan/tilt to control the pan/tilt to enter the attitude closed loop operation mode from the joint angle closed loop operation mode. A cloud platform, the cloud platform is mounted on a drone, and is characterized in that: PTZ axis Angle sensor; a processor, the processor, configured to perform the following steps: Receiving a control instruction when the drone is in a preset state; The pan/tilt is controlled to move from the current joint angle to the target joint angle and is maintained at the target joint angle, which is the angle of the pan-tilt axis relative to the joint coordinate system of the pan-tilt. The platform according to claim 30, wherein said target joint angle is 0 degrees. The pan/tilt head according to claim 30, wherein the processor is configured to perform the following steps: Receiving a control command sent by the drone; Or, receive a control command input by the user. The pan/tilt head according to claim 30, wherein the control command is further configured to control the pan/tilt head to enter a joint angle closed-loop operation mode from an attitude closed-loop operation mode, and the pan-tilt is in the joint angle closed-loop operation mode Move from the current joint angle to the target joint angle. The pan/tilt head according to claim 30, wherein the processor is configured to perform the following steps: The current joint angle of the gimbal is acquired by the angle sensor. The pan/tilt head according to claim 34, wherein the angle sensor is a Hall sensor or a magnetic encoder. The pan/tilt head according to claim 30, wherein the processor is configured to perform the following steps: Planning a motion curve of the pan/tilt according to a current joint angle of the gimbal and a target joint angle; And controlling the pan/tilt to move from the current joint angle to the target joint angle according to the motion curve. The pan/tilt head according to claim 36, wherein the processor is configured to perform the following steps: Determining a motion parameter of the pan/tilt according to a current joint angle of the pan/tilt and a target joint angle; A motion curve of the pan/tilt is planned according to the motion parameter. The pan/tilt head according to claim 37, wherein the motion parameter comprises one or more of time information, angular velocity, and angular acceleration. The pan/tilt head according to claim 33, wherein the processor is configured to perform the following steps: If the end command sent by the drone is received, the pan/tilt is controlled to enter the attitude closed loop operation mode from the joint angle closed loop operation mode. A computer readable storage medium storing a computer program, wherein the computer program is executed by a processor to implement the method of any one of claims 1 to 20.

Images