WO2020062280A1 - Control method for gimbal, gimbal, mobile platform and computer readable storage medium - Google Patents

Control method for gimbal, gimbal, mobile platform and computer readable storage medium Download PDF

Info

Publication number
WO2020062280A1
WO2020062280A1 PCT/CN2018/109184 CN2018109184W WO2020062280A1 WO 2020062280 A1 WO2020062280 A1 WO 2020062280A1 CN 2018109184 W CN2018109184 W CN 2018109184W WO 2020062280 A1 WO2020062280 A1 WO 2020062280A1
Authority
WO
WIPO (PCT)
Prior art keywords
shaft structure
preset
gimbal
torque
human
Prior art date
Application number
PCT/CN2018/109184
Other languages
French (fr)
Chinese (zh)
Inventor
刘帅
Original Assignee
深圳市大疆创新科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to PCT/CN2018/109184 priority Critical patent/WO2020062280A1/en
Priority to CN201880013283.XA priority patent/CN110352394A/en
Publication of WO2020062280A1 publication Critical patent/WO2020062280A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback

Definitions

  • the invention relates to the technical field of PTZ, in particular to a control method of the PTZ, a PTZ, a mobile platform, and a computer-readable storage medium.
  • Camera shake usually affects the captured image or video.
  • the camera can be set on the gimbal and the adjustment ability of the gimbal can be used to keep the camera stable. After the gimbal with mechanical limit is pushed by the hand, when returning to the posture before the hand push, it is easy to hit the mechanical limit due to the shortest path and other reasons.
  • Embodiments of the present invention provide a control method for a PTZ, a PTZ, a mobile platform, and a computer-readable storage medium.
  • the control method according to the embodiment of the present invention is used for a pan / tilt head.
  • the pan / tilt head includes at least one shaft structure.
  • the control method includes: obtaining a working parameter of the shaft structure; and detecting that the working parameter conforms to human power to push the shaft.
  • a manual pushing angle of the rotating shaft structure relative to the initial position is determined according to a preset rotation speed; and when it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition At this time, the rotating shaft structure is driven back to the initial position along the opposite direction that forms the pushing angle of the human power.
  • the gimbal includes at least one shaft structure and a processor, the processor is configured to: obtain a working parameter of the shaft structure, and when it is detected that the working parameter meets a preset condition for manually pushing the shaft structure , Determining a human pushing angle of the rotating shaft structure relative to the initial position according to a preset rotation speed, and when detecting that the working parameter changes from meeting the preset condition to not meeting the preset condition, the The manual pushing direction of the opposite direction drives the rotating shaft structure to return to the initial position.
  • a mobile platform includes a main body and the above-mentioned head, and the head is disposed on the main body.
  • a computer-readable storage medium stores a computer program thereon, and the computer program can be executed by a processor to complete the control method described above.
  • Embodiments of the present invention provide a control method for a PTZ, a PTZ, a mobile platform, and a computer-readable storage medium.
  • the control method of the gimbal when the working parameters of the shaft structure meet the preset conditions, it is judged that the gimbal is pushed by human force.
  • the manpower pushing angle of the shaft structure relative to the initial position can be determined according to the preset rotation speed, so that the When the working parameter changes from meeting the preset condition to not meeting the preset condition, that is, at the end of the manual pushing, the shaft structure is driven back to the initial position in the opposite direction that forms the manual pushing angle.
  • FIG. 1 is a schematic flowchart of a control method for a pan / tilt according to some embodiments of the present invention
  • FIGS. 2 and 3 are schematic diagrams of a pan / tilt head according to some embodiments of the present invention.
  • 4 to 13 are schematic flowcharts of a control method for a pan / tilt according to some embodiments of the present invention.
  • FIG. 14 is a schematic diagram of a mobile platform according to some embodiments of the present invention.
  • FIG. 15 is a schematic diagram of a connection between a PTZ and a computer-readable storage medium according to some embodiments of the present invention.
  • Aircraft 1000 Aircraft 1000, gimbal 100, pivot structure 10, pivot motor 12, yaw axis motor 122, roll axis motor 124, pitch axis motor 126, pivot frame 14, yaw axis frame 142, roll axis frame 144, pitch axis
  • first and second are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Therefore, the features defined as “first” and “second” may explicitly or implicitly include one or more of the features. In the description of the present invention, the meaning of "plurality” is two or more, unless specifically defined otherwise.
  • connection should be understood in a broad sense unless otherwise specified and limited.
  • they may be fixed connections or removable.
  • Connection, or integral connection can be mechanical, electrical, or can communicate with each other; can be directly connected, or indirectly connected through an intermediate medium, can be the internal communication of two elements or the interaction of two elements relationship.
  • connection, or integral connection can be mechanical, electrical, or can communicate with each other; can be directly connected, or indirectly connected through an intermediate medium, can be the internal communication of two elements or the interaction of two elements relationship.
  • control methods include:
  • the gimbal 100 includes at least one rotating shaft structure 10 and a processor 20.
  • the processor 20 is configured to: obtain the working parameters of the rotating shaft structure 10, and detect that the working parameters are consistent with human power
  • the preset conditions of the shaft structure 10 are determined, the manual pushing angle of the shaft structure 10 relative to the initial position is determined according to the preset rotation speed, and when the working parameter is detected to change from meeting the preset conditions to not meeting the preset conditions, the The human pushes the opposite direction of the angle, and drives the rotating shaft structure 10 to return to the initial position.
  • control method according to the embodiment of the present invention can be implemented by the PTZ 100 according to the embodiment of the present invention, where step 012, step 016, and step 018 can be implemented by the processor 20.
  • FIG. 2 and FIG. 3 are only schematic descriptions and are not limited. After the description here, the definitions are not repeated later.
  • the pan / tilt head 100 and the pan / tilt head 100 according to the embodiment of the present invention, when the working parameters of the rotary shaft structure 10 meet the preset conditions, it is judged that the pan / tilt head 100 is pushed by human power.
  • the manual pushing angle at the initial position so that when the working parameters change from meeting the preset conditions to not meeting the preset conditions, that is, at the end of the manual pushing, the rotating shaft structure 10 is driven back to the initial position in the opposite direction of the manual pushing angle.
  • manpower can push the shaft structure to rotate, it means that there is no mechanical limit in the process of manipulating the shaft structure.
  • the gimbal 100 In the process of controlling the rotation of the shaft structure to the initial position, if the gimbal 100 has a mechanical limit, It can avoid hitting the mechanical limit of the gimbal 100.
  • the manual pushing angle needs to be offset, that is, the rotating shaft structure 10 needs to be driven in the opposite direction of the manual pushing angle, and the size of the rotating angle of the rotating shaft structure 10 needs to be the manual pushing angle to prevent The shaft structure 10 deviates from the initial position.
  • the rotating shaft structure 10 is pushed from the H position (initial position) to the I position. Then, at the end of the manual pushing, the direction of the manual pushing angle is the direction from the H position to the I position. The original line returns from the I position to the H position.
  • the rotating shaft structure 10 is pushed from the H position (initial position) to the I position, and then from the I position to the J position, and the J position is between the H position and the I position.
  • the direction for forming the human pushing angle is the direction from the H position to the J position, and the rotating shaft structure 10 returns directly from the J position to the H position.
  • the pan / tilt head 100 can also realize 360-degree rotation without mechanical limit through a slip ring or the like.
  • the control method according to the embodiment of the present invention can move in the opposite direction of the angle of the human push.
  • the rotating shaft structure 10 is driven back to the initial position, that is, the head 100 can be returned to the initial position. That is, the embodiment of the present invention is also applicable to the PTZ 100 without mechanical limit.
  • the human-powered rotating shaft structure 10 can be regarded as a human-powered moving head 100, and when the human-powered moving the head 100 is equivalent to pushing the rotating shaft structure 10 to rotate.
  • the PTZ 100 includes a handheld PTZ 100.
  • the handheld pan / tilt head 100 further includes, for example, a photographing section 30, a display screen 40, and a handheld section 50.
  • the handheld section 50 is used to support the photographing section 30, and the display screen 40 is disposed on the handheld section 50.
  • the imaging section 30 can be used to capture an image. Since the handheld PTZ 100 is prone to be pushed by humans during use, the control method of the embodiment of the present invention can control the handheld PTZ 100 to return to the initial position after the handheld PTZ 100 is pushed by humans.
  • the at least one rotation shaft structure 10 includes a rotation shaft structure 10 corresponding to a yaw axis, a rotation shaft structure 10 corresponding to a roll axis, and a pitch axis corresponding to a pitch axis.
  • Each of the rotating shaft structures 10 may include a rotating shaft motor 12 and a rotating shaft frame 14.
  • the rotating shaft structure 10 corresponding to the yaw axis may include a yaw shaft motor 122 and a yaw shaft frame 142.
  • the rotating shaft structure 10 corresponding to a roll axis may include a roll shaft.
  • the motor 124 and the roll axis frame 144 may be used to the rotating shaft structures 10.
  • the rotation shaft structure 10 corresponding to the pitch axis may include a pitch axis motor 126 and a pitch axis frame 146.
  • corresponding control of each shaft structure 10 may be performed according to the working parameters of each shaft structure 10.
  • the human pushing angle is a vector.
  • One rotation direction of the rotation shaft structure 10 can be defined as a positive rotation direction and the other rotation direction is a reverse rotation direction.
  • the direction corresponding to the human pushing angle can be rotated by the rotation shaft structure 10.
  • the direction is OK.
  • each rotation shaft structure 10 includes a forward rotation direction and a reverse rotation direction.
  • the rotating shaft structure 10 when the working parameters do not meet the preset conditions, that is, when the manual operation of the rotating shaft structure 10 does not occur, the rotating shaft structure 10 may be controlled to rotate or the rotating shaft structure 10 may be stopped according to user input.
  • control method according to the embodiment of the present invention may be executed at a preset period, for example, the preset period is 0.001 second.
  • the preset period may also be 0.01 second, 0.005 second, 0.1 second, etc. It is set by user input, which is not specifically limited here.
  • the manual driving of the rotating shaft structure 10 Compared with controlling the rotation of the rotating shaft structure 10 by a remote control or other methods, the manual driving of the rotating shaft structure 10 generally has a large difference in the parameter values of the working parameters determined when the manual driving of the rotating shaft structure 10. Therefore, it can be judged whether the rotating shaft structure 10 is pushed by human power by judging whether the working parameters meet the preset conditions.
  • step 016 includes:
  • Step 0161 When the working parameter meets the preset condition and lasts for the first predetermined period of time, the manual pushing angle of the rotating shaft structure 10 relative to the initial position is determined according to the preset rotation speed.
  • the processor 20 is configured to determine the relative position of the rotating shaft structure 10 relative to the initial position according to a preset rotation speed when the operating parameters meet a preset condition and last for a first predetermined duration. Human push angle.
  • step 0161 may be implemented by the processor 20.
  • the parameter values of the operating parameters of the shaft structure 10 determined when a human touches the shaft structure 10 by mistake may generally have a large difference, but the duration of the human touch by mistake by the shaft structure 10 is generally short.
  • the working parameter meets the preset conditions and lasts for the first predetermined period of time it can be considered that at this time, the rotating shaft structure 10 is manually pushed by the human. Therefore, the manual pushing angle of the rotating shaft structure 10 relative to the initial position can be determined according to the preset rotation speed.
  • the shaft structure 10 may be controlled to rotate or stop according to a user input.
  • the first predetermined duration may be stored in the PTZ 100 in advance or determined by a user input. In one embodiment, the first predetermined duration is 1 second, and the preset period is 0.001 second. In 1 second, if the determined working parameters for 1000 times meet the preset conditions, it is considered that the shaft structure 10 is pushed by human power.
  • the next predetermined working time can be re-determined when the working parameters meet the preset conditions. That is, the timing will be restarted when the next working parameter meets the preset conditions.
  • determining the human-driven angle of the rotating shaft structure 10 relative to the initial position according to a preset rotation speed includes:
  • 0163 Determine the manual pushing angle of the shaft structure 10 relative to the initial position according to the integration result.
  • the desired posture component is updated according to the posture and the integration result when the rotating shaft structure 10 is located at the initial position.
  • the processor 20 is configured to integrate a preset rotation speed to the desired attitude component of the shaft structure 10 as a real-time attitude of the shaft structure 10 when the shaft structure 10 is manually pushed by a human.
  • the component and the human-driven angle of the rotating shaft structure 10 relative to the initial position are determined according to the integration result.
  • the desired posture component is updated according to the posture and the integration result when the rotating shaft structure 10 is located at the initial position.
  • steps 0162 and 0163 can be implemented by the processor 20.
  • the desired attitude component of the rotation axis structure 10 may refer to a component corresponding to the rotation axis structure 10 in the desired attitude of the gimbal 100.
  • the gimbal 100 includes a rotation axis structure 10 corresponding to a yaw axis, and a rotation axis structure 10 corresponding to a roll axis.
  • the desired attitude (yaw, roll, pitch) of the gimbal 100 is (A, B, C)
  • the expected attitude component of the rotation axis structure 10 corresponding to the yaw axis is A, corresponding to roll
  • the expected attitude component of the shaft structure 10 of the shaft is B, and the expected attitude component of the shaft structure 10 corresponding to the pitch axis is C.
  • the above explanation is also applicable to the real-time attitude component of the shaft structure 10.
  • the real-time attitude component can be obtained through measurement by an inertial measurement unit (such as a gyroscope, an accelerometer) and the like provided on the gimbal 100.
  • the preset rotation speed can be integrated.
  • the desired posture component is gradually brought closer to the real-time posture component, and the preset posture is completed when the desired posture component is controlled to be converted into the real-time posture component.
  • the integral of the rotation speed At this time, the human pushing angle can be obtained according to the integral result.
  • the preset rotation speed is the attitude conversion speed at which the desired attitude component is converted into the real-time attitude component.
  • the real-time attitude of the gimbal precedes the desired attitude, and the desired attitude component is controlled to be a real-time attitude.
  • Component is a process of virtual control.
  • the control method according to the embodiment of the present invention is executed at a preset period.
  • the desired attitude component can be updated according to the attitude and integration result when the shaft structure 10 is located at the initial position.
  • the desired attitude component is updated. It may be the attitude when the shaft structure 10 is located at the initial position, and in subsequent integration of the preset rotation speed, the expected posture component is determined according to the attitude and the human pushing angle when the shaft structure 10 is located at the initial position.
  • the human push angle can be accumulated according to the integration result of each time. In this way, it is possible to accurately integrate the preset rotation speed to obtain an accurate human pushing angle.
  • step 018 includes:
  • Step 0181 When the working parameter changes from meeting the preset condition to not meeting the preset condition, and the working parameter does not meet the preset condition for a second predetermined period of time, the rotary shaft structure 10 is driven back in the opposite direction that forms the human pushing angle. initial position.
  • the processor 20 is configured to continue to perform a second predetermined operation when the operating parameter changes from meeting the preset condition to not meeting the preset condition, and the operating parameter does not meet the preset condition.
  • the shaft structure 10 is driven back to the initial position along the opposite direction of the angle formed by the manual force.
  • step 0181 may be implemented by the processor 20.
  • the working parameter may be determined whether the working parameter does not meet the preset condition after the working parameter changes from meeting the preset condition to not meeting the preset condition. For a second predetermined duration, when the working parameters do not meet the preset conditions for a second predetermined duration, it can be considered that the human push has ended at this time, so the rotary shaft structure 10 can be driven back to the initial position in the opposite direction of the human push angle.
  • the working parameters do not meet the preset conditions but do not last for the second predetermined duration, it can be considered that the hand pushing has not ended at this time, so the working parameters can be re-compliant with the preset conditions, or the working parameters can be re-compliant with the preset conditions.
  • the manual pushing angle of the rotating shaft structure 10 relative to the initial position is continued to be determined according to the preset rotation speed.
  • the second predetermined duration may be stored in the PTZ 100 in advance or determined by a user input, and the second predetermined duration is, for example, 1 second.
  • the first predetermined duration and the second predetermined duration may be the same or different, which is not specifically limited herein.
  • the method further includes:
  • the processor 20 is further configured to determine a direction for forming the human pushing angle as a first direction if the human pushing angle is greater than a preset value, and If it is smaller than the preset value, it is determined that the direction forming the human pushing angle is the second direction.
  • steps 022 and 024 can be implemented by the processor 20.
  • the preset value is, for example, 0. If the human pushing angle is greater than 0, the direction for forming the human pushing angle is determined to be the first direction, and the first direction may be the positive rotation direction of the rotating shaft structure 10, of course, it may also be the rotating shaft structure. Counter rotation direction of 10; if the human pushing angle is smaller than a preset value, the direction for forming the human pushing angle is determined to be the second direction, and the second direction may be the counter rotating direction of the shaft structure 10, of course, it may also be the Positive rotation direction, the first direction and the second direction are opposite directions. In this way, the direction of the manual pushing angle can be quickly determined.
  • the rotating shaft structure 10 is pushed from the K position (initial position) to the L position, wherein the preset rotation speed is the first direction, such as the direction from the K position to the L position, which results in the formed human pushing angle. Also the first direction.
  • the rotating shaft structure 10 is pushed from the K position (initial position) to the N position, where the K position is between the L position and the N position, and the preset rotation speed is the second direction, such as the K position to N
  • the direction of the position causes the formed human-driven angle to be the second direction.
  • the preset rotation speed for integration is the preset Euler angular velocity of the shaft structure 10.
  • the preset Euler angular velocity can be used to quickly and accurately integrate to obtain the human pushing angle, that is, to obtain the Euler angle deviation of the attitude of the gimbal 100 at the initial position from the real-time attitude.
  • the determination process of the preset Euler angular velocity includes:
  • the preset joint angular velocity is converted into a preset Set Euler angular velocity.
  • the processor 20 is configured to use a preset joint angular velocity, a translation relationship between a gimbal joint angle coordinate system and a gimbal body coordinate system, and a gimbal body coordinate.
  • the conversion relationship between the system and the Euler coordinate system converts the preset joint angular velocity to the preset Euler angular velocity.
  • step 026 may be implemented by the processor 20.
  • the angular velocity pre-stored in the gimbal 100 or input by the user is generally the joint angular velocity.
  • the joint angular velocity may be converted into Euler angular velocity, and the Euler angular velocity is used to control the shaft structure 10.
  • the preset joint angular velocity W j can be converted to the angular velocity W b in the PTZ body coordinate system according to the conversion relationship R j ⁇ b between the gimbal joint angle coordinate system and the gimbal body coordinate system.
  • W b R j ⁇ b * W j .
  • R j ⁇ b is a Jacobian matrix
  • R j ⁇ b is determined by the configuration of the gimbal.
  • the configuration of the gimbal is different, and R j ⁇ b is different.
  • the head of the triaxial R j ⁇ b may biaxial PTZ different R j ⁇ b.
  • a pan / tilt head 100 with three rotation axis structures 10 of ZXY is taken as an example.
  • Z is a yaw axis
  • X is a roll axis
  • Y is a pitch axis
  • a yaw frame 142 for example.
  • the roll axis frame 144 is the middle frame
  • the pitch axis frame 146 is the inner frame
  • the yaw axis motor 122 is used to drive the yaw axis frame 142 to rotate to drive the roll axis motor 124 and the roll axis frame 144
  • the pitch axis motor 126 and the pitch axis frame 146 and the load mounted on the gimbal 100 are rotated.
  • the roll axis motor 124 is used to drive the roll axis frame 144 to rotate, so as to drive the pitch axis motor 126 and the pitch axis frame 146 and load rotation.
  • the pitch axis motor 126 is used to drive the pitch axis frame 146 to rotate to drive the load to rotate.
  • the rotation axis Voutz of the coordinate axis of the yaw axis joint angle is [0, 0, 1]
  • the rotation axis Vmidx of the coordinate axis of the roll axis joint angle is [1, 0, 0]
  • the coordinate axis of the joint angle of the pitch axis is [0, 1, 0].
  • Vinny, Vmidx, and Voutz are the rotation axes of the coordinate axes of the pitch joint angle, the roll joint angle, and the yaw joint angle, respectively.
  • V outz ⁇ b R y ′ * R x ′ * R z ′ * V outz
  • V midx ⁇ b R y ′ * R x ′ * V midx
  • V inny ⁇ b R y ′ * V inny
  • Ry ', Rx', and Rz ' correspond to the transpose of Ry, Rx, and Rz, respectively.
  • Ry, Rx, and Rz are the joint angle coordinate system around the Y axis (pitch axis), X axis (roll axis), and Z axis, respectively.
  • Yaw axis rotation matrix to the reference coordinate system.
  • Ry, Rx, Rz can be as follows:
  • the reference coordinate system is a coordinate system with a joint angle of 0, and A is a conversion angle of the joint angle coordinate system to the reference coordinate system.
  • inn_joint_ang_rad is the joint angle of the inner frame
  • mid_joint_ang_rad is the joint angle of the middle frame
  • inn_euler_ang_rad is the Euler angle of the inner frame
  • mid_euler_ang_rad is the Euler angle of the middle frame
  • the Euler angle of the inner frame and the Euler angle of the middle frame are the expected Euler angles when the gimbal 100 is not updated.
  • the joint angle of the middle frame is 40 degrees
  • the joint angle of the inner frame is 40 degrees
  • the Euler angle of the inner frame is 10
  • the Euler angle of the middle frame is 0,
  • the joint angular velocity is [0, 0,1]
  • the Euler angular velocity of the gimbal 100 defaults to the joint angular velocity [0,0,1].
  • the Euler angular velocity of the gimbal 100 is [-0.3830, 0.6428, 0.6634]
  • the preset Euler angular velocity corresponding to the rotation axis structure of the yaw axis is 0.6634 instead of 1.
  • the rotation path of the structure 10 is conducive to driving the PTZ 100 from the real-time posture at the end of the manual push to the initial position.
  • the obtained preset Euler angular velocity is used for integration, and the obtained manpower pushing angle is Euler angle, thereby avoiding the calculation of the joint angle deviation generated when the manpower pushes the gimbal 100, thereby avoiding the fact that one attitude corresponds to many
  • a unique operation is needed to determine the unique solution.
  • the preset joint angle when the preset joint angle is converted into the preset Euler angle, since the inner frame joint angle, the inner frame Euler angle, the middle frame joint angle, and the middle frame Euler angle are involved in the conversion process, the inner frame When the joint angle, inner frame Euler angle, middle frame joint angle, and middle frame Euler angle change, the preset Euler angle also changes accordingly. In this way, the preset Euler angle converted from the preset joint angle depends more on the attitude change of the gimbal, which can be updated and changed to achieve more accurate integration and attitude conversion control.
  • the yaw axis frame 142 is an outer frame
  • the roll axis frame 144 is a middle frame
  • the pitch axis frame 146 is an inner frame. It can be understood that, in other embodiments, the connection relationship of each frame may be other. This is not specifically limited.
  • the shaft structure 10 includes a shaft motor 12, and the operating parameter includes a desired torque of the shaft motor 12. By judging whether the desired torque meets a preset condition, it can be accurately judged whether the rotating shaft structure 10 is pushed by human power.
  • the process of obtaining the desired torque includes:
  • the processor 20 is configured to obtain a desired attitude component of the shaft structure 10 and a real-time attitude component of the shaft structure 10 when the shaft structure 10 is pushed by a human force, and according to the desired attitude component. Determine the desired torque with the real-time attitude component.
  • steps 028 and 032 can be implemented by the processor 20.
  • the method of the foregoing embodiment may be adopted to obtain a desired pose component and a real-time pose component.
  • Determining the desired torque according to the desired attitude component and the real-time attitude component can be understood as: determining the desired torque through the deviation of the desired attitude component and the real-time attitude component, and the deviation of the desired attitude component and the real-time attitude component is positively related to the expected torque.
  • the desired torque can be accurately determined based on the desired attitude component and the real-time attitude component.
  • the desired torque is the amount of torque that the corresponding shaft motor 12 needs to output when the shaft structure 10 moves from the real-time attitude component to the desired attitude component.
  • control method further includes: 014: Determine whether the working parameter of the shaft structure 10 meets a preset condition that the shaft structure 10 is pushed by a human force.
  • step 014 may specifically include:
  • 0141 Determine whether the absolute value of the desired torque is greater than or equal to the preset torque
  • the processor 20 is further configured to determine whether the absolute value of the desired torque is greater than or equal to the preset torque, and when the absolute value of the desired torque is greater than or equal to the preset torque To determine that the working parameters meet the preset conditions, and when the absolute value of the desired torque is less than the preset torque, determine that the working parameters do not meet the preset conditions.
  • step 0141, step 0142, and step 0143 can be implemented by the processor 20.
  • the expected torque determined when the rotation shaft structure 10 is pushed by a human body is generally larger. Therefore, the preset torque can be set based on empirical values to compare the desired torque with the preset torque. Among them, in order to distinguish the direction in which the shaft structure 10 is manually pushed by humans, the expected torque is a vector and the preset torque is a scalar quantity. Therefore, whether or not the absolute value of the desired torque is greater than or equal to the preset torque can be used to determine whether the shaft is pushed by a human force. Structure 10.
  • the working parameter meets the preset conditions, that is, it is determined that the shaft structure 10 is manually pushed by the human; when the absolute value of the desired torque is less than the preset torque, the working parameter is determined not to meet the preset torque.
  • the condition that is, it is judged that the shaft structure 10 is not pushed by human power. In this way, it can be accurately judged whether the working parameters meet the preset conditions.
  • step 0141 includes:
  • the processor 20 is configured to determine whether a desired torque is greater than or equal to a preset torque when the direction in which the shaft structure 10 is pushed by a human force is a third direction; and / or When the direction in which the rotating shaft structure 10 is pushed by human power is the fourth direction, it is determined whether the desired torque is less than or equal to an opposite number of the preset torque.
  • steps 0144 and 0145 can be implemented by the processor 20.
  • the expected torque is greater than 0, so it can be determined whether the expected torque is greater than or equal to a preset torque;
  • the torque is less than 0, so it can be determined whether the desired torque is less than or equal to the inverse of the preset torque.
  • the third direction may be the normal rotation direction of the rotation shaft structure 10 or the reverse rotation direction of the rotation shaft structure 10
  • the fourth direction may be the reverse rotation direction of the rotation shaft structure 10 or the normal rotation direction of the rotation shaft structure 10, the third direction It is opposite to the fourth direction. In this way, it is possible to accurately determine whether the desired torque meets a preset condition according to the direction in which the rotating shaft structure 10 is pushed by human power.
  • the comparison result of the desired torque and the preset torque may not be determined according to the direction in which the PTZ 100 is pushed by human power.
  • the direction of the manpower to push the gimbal is uncertain, but the expected torque is sequentially compared with the preset torque and the reverse of the preset torque, so that it can also be determined whether the desired torque is greater than the preset torque or the opposite of the preset torque. It can also be located between the preset torque and the opposite of the preset torque, and it can also detect whether there is any manpower pushing the gimbal.
  • the operating parameters of the shaft structure 10 may also include a desired current of the shaft structure 10, and the desired current may be determined according to a desired attitude component and a real-time attitude component of the corresponding shaft structure 10.
  • the expected current and the preset current may be compared, where the desired current is a vector and the preset current is a scalar. When the desired current is greater than or equal to the preset current or the desired current is less than or equal to the inverse of the preset current It is judged that the shaft structure 10 is pushed by a human being, and when the expected current is larger than the preset current and smaller than the preset current, it is determined that the shaft structure is not pushed by a manpower.
  • M the desired torque
  • Ca the desired torque
  • I the current
  • the method further includes:
  • the processor 20 is further configured to compare a desired posture component with a real-time posture component, and determine a direction in which the human body pushes the shaft structure 10 according to the comparison result.
  • steps 034 and 036 can be implemented by the processor 20.
  • the deviation between the desired attitude component and the real-time attitude component can be calculated, such as the Euler angle difference.
  • the Euler angle difference is greater than zero, it indicates that the direction in which the rotary shaft structure 10 is pushed by human power is one of the directions, for example, the third direction.
  • the attitude difference is less than zero, it indicates that the direction in which the rotary shaft structure 10 is pushed by human power is another direction, for example, the fourth direction.
  • the direction in which the shaft structure 10 is manually pushed by the human is, for example, a third direction; the Euler angle corresponding to the desired attitude component is less than the real-time
  • the direction in which the rotary shaft structure 10 is pushed by human power is, for example, the fourth direction. In this way, it is possible to quickly determine the direction in which the human-powered shaft structure 10 is pushed by the desired posture component and the real-time posture component.
  • the third direction of the embodiment of the present invention may be the first direction or the second direction.
  • the fourth direction of the embodiment of the present invention may be the second direction or the first direction. direction.
  • the direction of the preset rotation speed is the same as the direction in which the shaft structure 10 is pushed by a human. In this way, the direction of the preset rotation speed is in accordance with the direction of the manual pushing shaft structure 10, that is, the direction of the preset rotation speed is accurate, so that the integration result of integrating the preset rotation speed and the human pushing angle obtained by accumulating the integration result are more accurate.
  • the torque value of the shaft motor 12 is generally greater than the torque value when the shaft structure 10 is controlled by a remote control.
  • the preset torque in this embodiment is preset according to a temperature protection strategy of the motor, and the preset torque is a lower limit value for determining a torque value when a human is pushing the shaft structure 10.
  • different shaft motors 12 may have different temperature protection strategies, and a constant preset torque may be set according to different temperature protection strategies of the shaft motors 12. In this way, comparison and judgment of the desired torque and the preset torque can be facilitated.
  • the preset torque is adjusted in real time according to the temperature protection strategy of the rotating shaft motor 12, that is, during the process of pushing the PTZ 100 manually, the preset torque is changed to meet different requirements.
  • the preset torque may be negatively related to the temperature of the shaft motor 12, that is, the higher the temperature of the shaft motor 12, the smaller the preset torque; the lower the temperature of the shaft motor 12, the larger the preset torque, and thus, the preset
  • the acquisition of the torque is more accurate, so that the determination result of judging whether the human body pushes the rotating shaft structure 10 by the desired torque and the preset torque is more accurate.
  • the PTZ 100 of the embodiment of the present invention can be applied to a mobile platform, that is, the mobile platform can include the PTZ 100 of any one of the foregoing embodiments.
  • the mobile platform may further include a main body, and the PTZ 100 is disposed on the main body.
  • the body of the mobile platform may be a handheld part of the handheld PTZ.
  • the mobile platform may include, for example, a cart, an aircraft, a robot, and the like, and the gimbal 100 on the body may be equipped with an imaging device and / or a shooting device and / or other functional modules.
  • the mobile platform is an aircraft 1000.
  • the aircraft 1000 includes a gimbal 100 and a main body 200.
  • the main body 200 includes, for example, a center frame, an arm connected to the center frame, and the arm. Connected power unit, etc. It can be understood that the body of the mobile platform corresponds to the type of the mobile platform. For example, when the mobile platform is a cart, the body is a cart.
  • a computer-readable storage medium 400 includes a computer program, and the computer program can be executed by the processor 20 to implement the control method of any one of the foregoing embodiments.
  • the computer program may be executed by the processor 20 to complete the control method described in the following steps:
  • the computer program can also be executed by the processor 20 to complete the control method described in the following steps:
  • Step 0161 When the working parameter meets the preset condition and lasts for the first predetermined period of time, the manual pushing angle of the rotating shaft structure 10 relative to the initial position is determined according to the preset rotation speed.
  • Any process or method description in a flowchart or otherwise described herein can be understood as representing a module, fragment, or portion of code that includes one or more executable instructions for performing a particular logical function or step of a process
  • the scope of the preferred embodiments of the present invention includes additional implementations, in which the functions may be performed out of the order shown or discussed, including performing the functions in a substantially simultaneous manner or in the reverse order according to the functions involved, which should It is understood by those skilled in the art to which the embodiments of the present invention pertain.
  • Logic and / or steps represented in a flowchart or otherwise described herein, for example, a ordered list of executable instructions that may be considered to perform a logical function may be embodied in any computer-readable medium, For use by, or in combination with, an instruction execution system, device, or device (such as a computer-based system, a system that includes a processor, or another system that can fetch and execute instructions from an instruction execution system, device, or device) Or equipment.
  • a "computer-readable medium” may be any device that can contain, store, communicate, propagate, or transmit a program for use by or in connection with an instruction execution system, apparatus, or device.
  • computer-readable media include the following: electrical connections (electronic devices) with one or more wirings, portable computer disk cartridges (magnetic devices), random access memory (RAM), Read-only memory (ROM), erasable and editable read-only memory (EPROM or flash memory), fiber optic devices, and portable optical disk read-only memory (CDROM).
  • the computer-readable medium may even be paper or other suitable medium on which the program can be printed, because, for example, by optically scanning the paper or other medium, followed by editing, interpretation, or other suitable Processing to obtain the program electronically and then store it in computer memory.
  • a person of ordinary skill in the art can understand that performing all or part of the steps carried by the foregoing implementation method can be completed by a program instructing related hardware.
  • the program can be stored in a computer-readable storage medium, and the program is executing , Including one or a combination of the steps of the method embodiments.
  • each functional unit in each embodiment of the present invention may be integrated into one processing module, or each unit may exist separately physically, or two or more units may be integrated into one module.
  • the above integrated modules can be executed in the form of hardware or software functional modules. When the integrated module is executed in the form of a software functional module and sold or used as an independent product, it may also be stored in a computer-readable storage medium.
  • the aforementioned storage medium may be a read-only memory, a magnetic disk, or an optical disk.

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Accessories Of Cameras (AREA)
  • Toys (AREA)

Abstract

Disclosed are a control method for a gimbal (100), a gimbal (100), a mobile platform and a computer readable storage medium (400). The control method comprises the following steps: acquiring working parameters of a rotating shaft structure (10) (012); when detecting that the working parameters are in conformity with preset conditions for pushing the rotating shaft structure (10) with manpower, determining an angle of manpower pushing for the rotating shaft structure (10) with respect to an initial position according to a preset rotating speed; when detecting that the working parameters change from being in conformity with to not being in conformity with the preset conditions, driving the rotating shaft structure (10) to return to the initial position in a direction opposite to the direction of forming the angle of manpower pushing (018).

Description

云台的控制方法、云台、移动平台和计算机可读存储介质Control method of gimbal, gimbal, mobile platform and computer-readable storage medium 技术领域Technical field
本发明涉及云台技术领域,特别涉及一种云台的控制方法、云台、移动平台和计算机可读存储介质。The invention relates to the technical field of PTZ, in particular to a control method of the PTZ, a PTZ, a mobile platform, and a computer-readable storage medium.
背景技术Background technique
相机的抖动通常会影响拍摄的图像或视频,为了提高相机的防抖能力,可以将相机设置在云台上,利用云台的调节能力来保持相机的稳定。带机械限位的云台被手推后,在返回手推前的姿态时,容易因为最短路径等原因而撞到机械限位。Camera shake usually affects the captured image or video. In order to improve the camera's anti-shake ability, the camera can be set on the gimbal and the adjustment ability of the gimbal can be used to keep the camera stable. After the gimbal with mechanical limit is pushed by the hand, when returning to the posture before the hand push, it is easy to hit the mechanical limit due to the shortest path and other reasons.
发明内容Summary of the Invention
本发明的实施方式提供一种云台的控制方法、云台、移动平台和计算机可读存储介质。Embodiments of the present invention provide a control method for a PTZ, a PTZ, a mobile platform, and a computer-readable storage medium.
本发明实施方式的控制方法用于云台,所述云台包括至少一个转轴结构,所述控制方法包括:获取所述转轴结构的工作参数;在检测到所述工作参数符合人力推动所述转轴结构的预设条件时,根据预设转动速度确定所述转轴结构相对于初始位置的人力推动角度;及在检测到所述工作参数从符合所述预设条件变成不符合所述预设条件时,沿着形成所述人力推动角度的相反方向,驱动所述转轴结构回到所述初始位置。The control method according to the embodiment of the present invention is used for a pan / tilt head. The pan / tilt head includes at least one shaft structure. The control method includes: obtaining a working parameter of the shaft structure; and detecting that the working parameter conforms to human power to push the shaft. When the structure has a preset condition, a manual pushing angle of the rotating shaft structure relative to the initial position is determined according to a preset rotation speed; and when it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition At this time, the rotating shaft structure is driven back to the initial position along the opposite direction that forms the pushing angle of the human power.
本发明实施方式的云台包括至少一个转轴结构和处理器,所述处理器用于:获取所述转轴结构的工作参数、在检测到所述工作参数符合人力推动所述转轴结构的预设条件时,根据预设转动速度确定所述转轴结构相对于初始位置的人力推动角度、及在检测到所述工作参数从符合所述预设条件变成不符合所述预设条件时,沿着形成所述人力推动角度的相反方向,驱动所述转轴结构回到所述初始位置。The gimbal according to the embodiment of the present invention includes at least one shaft structure and a processor, the processor is configured to: obtain a working parameter of the shaft structure, and when it is detected that the working parameter meets a preset condition for manually pushing the shaft structure , Determining a human pushing angle of the rotating shaft structure relative to the initial position according to a preset rotation speed, and when detecting that the working parameter changes from meeting the preset condition to not meeting the preset condition, the The manual pushing direction of the opposite direction drives the rotating shaft structure to return to the initial position.
本发明实施方式的移动平台包括本体和上述云台,所述云台设置在所述本体上。A mobile platform according to an embodiment of the present invention includes a main body and the above-mentioned head, and the head is disposed on the main body.
本发明实施方式的计算机可读存储介质,其上存储有计算机程序,所述计算机程序可被处理器执行以完成上述控制方法。A computer-readable storage medium according to an embodiment of the present invention stores a computer program thereon, and the computer program can be executed by a processor to complete the control method described above.
本发明实施方式提供了一种云台的控制方法、云台、移动平台和计算机可读存储介质。在云台的控制方法中,在转轴结构的工作参数符合预设条件时,判断云台被人力推动,此时可以根据预设转动速度确定转轴结构相对于初始位置的人力推动角度,从而可以在工作参数从符合预设条件变成不符合预设条件时,即人力推动结束时,沿着形成人力推动角度的相反方向驱动转轴结构回到初始位置。如此可知,既然人力能够推动转轴结构转动,则说明转轴结构在人力推动的过程中可以不存在机械限位,则在控制转轴结构回转至初始位 置的过程中,可以避免撞到云台的机械限位。Embodiments of the present invention provide a control method for a PTZ, a PTZ, a mobile platform, and a computer-readable storage medium. In the control method of the gimbal, when the working parameters of the shaft structure meet the preset conditions, it is judged that the gimbal is pushed by human force. At this time, the manpower pushing angle of the shaft structure relative to the initial position can be determined according to the preset rotation speed, so that the When the working parameter changes from meeting the preset condition to not meeting the preset condition, that is, at the end of the manual pushing, the shaft structure is driven back to the initial position in the opposite direction that forms the manual pushing angle. It can be seen that, since manpower can push the shaft structure to rotate, it means that there is no mechanical limit in the process of manipulating the shaft structure. In the process of controlling the rotation of the shaft structure to the initial position, it can avoid hitting the mechanical limit of the gimbal. Bit.
本发明的实施方式的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实施方式的实践了解到。Additional aspects and advantages of the embodiments of the present invention will be given in part in the following description, part of which will become apparent from the following description, or be learned through practice of the embodiments of the present invention.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
本发明的上述和/或附加的方面和优点从结合下面附图对实施方式的描述中将变得明显和容易理解,其中:The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which:
图1是本发明某些实施方式的云台的控制方法的流程示意图;FIG. 1 is a schematic flowchart of a control method for a pan / tilt according to some embodiments of the present invention; FIG.
图2和图3是本发明某些实施方式的云台的示意图;2 and 3 are schematic diagrams of a pan / tilt head according to some embodiments of the present invention;
图4至图13是本发明某些实施方式的云台的控制方法的流程示意图;4 to 13 are schematic flowcharts of a control method for a pan / tilt according to some embodiments of the present invention;
图14是本发明某些实施方式的移动平台的示意图;14 is a schematic diagram of a mobile platform according to some embodiments of the present invention;
图15是本发明某些实施方式的云台和计算机可读存储介质的连接示意图。FIG. 15 is a schematic diagram of a connection between a PTZ and a computer-readable storage medium according to some embodiments of the present invention.
主要元件符号附图说明:Description of main component symbols:
飞行器1000、云台100、转轴结构10、转轴电机12、偏航轴电机122、横滚轴电机124、俯仰轴电机126、转轴框架14、偏航轴框架142、横滚轴框架144、俯仰轴框架146、处理器20、拍摄部30、显示屏40、手持部50、本体200、计算机可读存储介质400。 Aircraft 1000, gimbal 100, pivot structure 10, pivot motor 12, yaw axis motor 122, roll axis motor 124, pitch axis motor 126, pivot frame 14, yaw axis frame 142, roll axis frame 144, pitch axis The frame 146, the processor 20, the photographing section 30, the display screen 40, the handheld section 50, the main body 200, and the computer-readable storage medium 400.
具体实施方式detailed description
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。Hereinafter, embodiments of the present invention will be described in detail. Examples of the embodiments are shown in the drawings, wherein the same or similar reference numerals represent the same or similar elements or elements having the same or similar functions throughout. The embodiments described below with reference to the drawings are exemplary and are only used to explain the present invention, but should not be construed as limiting the present invention.
在本发明的描述中,需要理解的是,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个所述特征。在本发明的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。In the description of the present invention, it should be understood that the terms “first” and “second” are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Therefore, the features defined as “first” and “second” may explicitly or implicitly include one or more of the features. In the description of the present invention, the meaning of "plurality" is two or more, unless specifically defined otherwise.
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接或可以相互通信;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。In the description of the present invention, it should be noted that the terms "installation", "connected", and "connected" should be understood in a broad sense unless otherwise specified and limited. For example, they may be fixed connections or removable. Connection, or integral connection; can be mechanical, electrical, or can communicate with each other; can be directly connected, or indirectly connected through an intermediate medium, can be the internal communication of two elements or the interaction of two elements relationship. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention can be understood according to specific situations.
下文的公开提供了许多不同的实施方式或例子用来实现本发明的不同结构。为了简化本发明的公开,下文中对特定例子的部件和设置进行描述。当然,它们仅仅为示例,并且 目的不在于限制本发明。此外,本发明可以在不同例子中重复参考数字和/或参考字母,这种重复是为了简化和清楚的目的,其本身不指示所讨论各种实施方式和/或设置之间的关系。此外,本发明提供了的各种特定的工艺和材料的例子,但是本领域普通技术人员可以意识到其他工艺的应用和/或其他材料的使用。The following disclosure provides many different implementations or examples for implementing different structures of the present invention. To simplify the disclosure of the present invention, the components and settings of specific examples are described below. Of course, they are merely examples and are not intended to limit the invention. Furthermore, the present invention may repeat reference numerals and / or reference letters in different examples, and such repetition is for the purpose of simplicity and clarity, and does not itself indicate the relationship between the various embodiments and / or settings discussed. In addition, the present invention provides examples of various specific processes and materials, but those of ordinary skill in the art may be aware of the application of other processes and / or the use of other materials.
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。Hereinafter, embodiments of the present invention will be described in detail. Examples of the embodiments are shown in the drawings, wherein the same or similar reference numerals represent the same or similar elements or elements having the same or similar functions throughout. The embodiments described below with reference to the drawings are exemplary and are only used to explain the present invention, but should not be construed as limiting the present invention.
请参阅图1至图3,本发明实施方式的控制方法可以用于云台100,云台100包括至少一个转轴结构10。控制方法包括:Please refer to FIG. 1 to FIG. 3. The control method according to the embodiment of the present invention can be applied to the pan / tilt head 100, and the pan / tilt head 100 includes at least one shaft structure 10. Control methods include:
012:获取转轴结构10的工作参数;012: Obtain the working parameters of the shaft structure 10.
016:在检测到工作参数符合人力推动转轴结构10的预设条件时,根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度;及016: when it is detected that the working parameters meet the preset conditions of the manual pushing shaft structure 10, determine the manual pushing angle of the rotating shaft structure 10 relative to the initial position according to the preset rotation speed; and
018:在检测到工作参数从符合预设条件变成不符合预设条件时,沿着形成人力推动角度的相反方向,驱动转轴结构10回到初始位置。018: When it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition, the rotary shaft structure 10 is driven back to the initial position along the opposite direction that forms the pushing angle of the human force.
请继续参阅图2和图3,本发明实施方式的云台100包括至少一个转轴结构10和处理器20,处理器20用于:获取转轴结构10的工作参数、在检测到工作参数符合人力推动转轴结构10的预设条件时,根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度、及在检测到工作参数从符合预设条件变成不符合预设条件时,沿着形成人力推动角度的相反方向,驱动转轴结构10回到初始位置。Please continue to refer to FIG. 2 and FIG. 3. The gimbal 100 according to the embodiment of the present invention includes at least one rotating shaft structure 10 and a processor 20. The processor 20 is configured to: obtain the working parameters of the rotating shaft structure 10, and detect that the working parameters are consistent with human power When the preset conditions of the shaft structure 10 are determined, the manual pushing angle of the shaft structure 10 relative to the initial position is determined according to the preset rotation speed, and when the working parameter is detected to change from meeting the preset conditions to not meeting the preset conditions, the The human pushes the opposite direction of the angle, and drives the rotating shaft structure 10 to return to the initial position.
也即是说,本发明实施方式的控制方法可以由本发明实施方式的云台100实现,其中,步骤012、步骤016和步骤018可以由处理器20实现。That is to say, the control method according to the embodiment of the present invention can be implemented by the PTZ 100 according to the embodiment of the present invention, where step 012, step 016, and step 018 can be implemented by the processor 20.
可以理解,图2、图3中所示处理器的位置仅为示意性说明,并不进行限定,此处说明之后,在后面即不再重复限定。It can be understood that the positions of the processors shown in FIG. 2 and FIG. 3 are only schematic descriptions and are not limited. After the description here, the definitions are not repeated later.
本发明实施方式的云台100的控制方法和云台100,在转轴结构10的工作参数符合预设条件时,判断云台100被人力推动,此时可以根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度,从而可以在工作参数从符合预设条件变成不符合预设条件时,即人力推动结束时,沿着形成人力推动角度的相反方向驱动转轴结构10回到初始位置。如此可知,既然人力能够推动转轴结构转动,则说明转轴结构在人力推动的过程中可以不存在机械限位,则在控制转轴结构回转至初始位置的过程中,若云台100具有机械限位,则能避免撞到云台100的机械限位。同时,返回初始位置时,需要抵消人力推动角度,即既需要沿着形成人力推动角度的相反方向驱动转轴结构10,还需要使得转轴结构10转动的角度的大小为人力推动角度的大小,以防止转轴结构10偏离初始位置。According to the control method of the pan / tilt head 100 and the pan / tilt head 100 according to the embodiment of the present invention, when the working parameters of the rotary shaft structure 10 meet the preset conditions, it is judged that the pan / tilt head 100 is pushed by human power. The manual pushing angle at the initial position, so that when the working parameters change from meeting the preset conditions to not meeting the preset conditions, that is, at the end of the manual pushing, the rotating shaft structure 10 is driven back to the initial position in the opposite direction of the manual pushing angle. . It can be seen that, since manpower can push the shaft structure to rotate, it means that there is no mechanical limit in the process of manipulating the shaft structure. In the process of controlling the rotation of the shaft structure to the initial position, if the gimbal 100 has a mechanical limit, It can avoid hitting the mechanical limit of the gimbal 100. At the same time, when returning to the initial position, the manual pushing angle needs to be offset, that is, the rotating shaft structure 10 needs to be driven in the opposite direction of the manual pushing angle, and the size of the rotating angle of the rotating shaft structure 10 needs to be the manual pushing angle to prevent The shaft structure 10 deviates from the initial position.
在一个实施例中,转轴结构10从H位置(初始位置)被推动到了I位置,则在人力推动结束时,形成人力推动角度的方向为从H位置至I位置的方向,转轴结构10可以按原线路从I位置返回到H位置。In one embodiment, the rotating shaft structure 10 is pushed from the H position (initial position) to the I position. Then, at the end of the manual pushing, the direction of the manual pushing angle is the direction from the H position to the I position. The original line returns from the I position to the H position.
在另一个实施例中,转轴结构10从H位置(初始位置)被推动到了I位置,再从I位置推动到了J位置,J位置位于H位置和I位置之间,则在人力推动结束时,形成人力推动角度的方向为从H位置至J位置的方向,转轴结构10直接从J位置返回到H位置。In another embodiment, the rotating shaft structure 10 is pushed from the H position (initial position) to the I position, and then from the I position to the J position, and the J position is between the H position and the I position. The direction for forming the human pushing angle is the direction from the H position to the J position, and the rotating shaft structure 10 returns directly from the J position to the H position.
另外,云台100也可以通过滑环等实现360度无机械限位的转动,对应地,本发明实施方式的控制方法可以在云台100被人力推动后,沿着形成人力推动角度的相反方向驱动转轴结构10回到初始位置,即使得云台100能返回初始位置。也就是说,本发明实施例同样适用于无机械限位的云台100。In addition, the pan / tilt head 100 can also realize 360-degree rotation without mechanical limit through a slip ring or the like. Correspondingly, after the pan / tilt head 100 is pushed by a human being, the control method according to the embodiment of the present invention can move in the opposite direction of the angle of the human push. The rotating shaft structure 10 is driven back to the initial position, that is, the head 100 can be returned to the initial position. That is, the embodiment of the present invention is also applicable to the PTZ 100 without mechanical limit.
可以理解,本发明实施方式中,人力推动转轴结构10可视作人力推动云台100,在人力推动云台100时,相当于推动转轴结构10转动。It can be understood that, in the embodiment of the present invention, the human-powered rotating shaft structure 10 can be regarded as a human-powered moving head 100, and when the human-powered moving the head 100 is equivalent to pushing the rotating shaft structure 10 to rotate.
请继续参阅图2,在某些实施方式中,云台100包括手持云台100。手持云台100例如还包括拍摄部30、显示屏40和手持部50,手持部50用于支撑拍摄部30,显示屏40设置在手持部50上。拍摄部30可以用于拍摄图像。由于手持云台100在使用过程中,容易出现被人力推动的情况,因此,本发明实施方式的控制方法可以在手持云台100被人力推动后控制手持云台100返回初始位置。Please continue to refer to FIG. 2. In some embodiments, the PTZ 100 includes a handheld PTZ 100. The handheld pan / tilt head 100 further includes, for example, a photographing section 30, a display screen 40, and a handheld section 50. The handheld section 50 is used to support the photographing section 30, and the display screen 40 is disposed on the handheld section 50. The imaging section 30 can be used to capture an image. Since the handheld PTZ 100 is prone to be pushed by humans during use, the control method of the embodiment of the present invention can control the handheld PTZ 100 to return to the initial position after the handheld PTZ 100 is pushed by humans.
请继续参阅图3,在某些实施方式中,至少一个转轴结构10包括对应偏航(yaw)轴的转轴结构10、对应横滚(roll)轴的转轴结构10和对应俯仰(pitch)轴的转轴结构10中的至少一个。每个转轴结构10可以包括转轴电机12和转轴框架14,对应偏航轴的转轴结构10可以包括偏航轴电机122和偏航轴框架142,对应横滚轴的转轴结构10可以包括横滚轴电机124和横滚轴框架144,对应俯仰轴的转轴结构10可以包括俯仰轴电机126和俯仰轴框架146。在转轴结构10为多个时,可以根据每个转轴结构10的工作参数分别对各个转轴结构10进行对应的控制。Please continue to refer to FIG. 3. In some embodiments, the at least one rotation shaft structure 10 includes a rotation shaft structure 10 corresponding to a yaw axis, a rotation shaft structure 10 corresponding to a roll axis, and a pitch axis corresponding to a pitch axis. At least one of the shaft structures 10. Each of the rotating shaft structures 10 may include a rotating shaft motor 12 and a rotating shaft frame 14. The rotating shaft structure 10 corresponding to the yaw axis may include a yaw shaft motor 122 and a yaw shaft frame 142. The rotating shaft structure 10 corresponding to a roll axis may include a roll shaft. The motor 124 and the roll axis frame 144. The rotation shaft structure 10 corresponding to the pitch axis may include a pitch axis motor 126 and a pitch axis frame 146. When there are a plurality of shaft structures 10, corresponding control of each shaft structure 10 may be performed according to the working parameters of each shaft structure 10.
在本发明实施方式中,人力推动角度为矢量,可以通过定义转轴结构10的一个旋转方向为正旋转方向,另一个旋转方向为反旋转方向,人力推动角度对应的方向可以通过转轴结构10的旋转方向确定。在转轴结构10为多个时,各个转轴结构10均包括正旋转方向和反旋转方向。In the embodiment of the present invention, the human pushing angle is a vector. One rotation direction of the rotation shaft structure 10 can be defined as a positive rotation direction and the other rotation direction is a reverse rotation direction. The direction corresponding to the human pushing angle can be rotated by the rotation shaft structure 10. The direction is OK. When there are a plurality of rotation shaft structures 10, each rotation shaft structure 10 includes a forward rotation direction and a reverse rotation direction.
在某些实施方式中,在工作参数不符合预设条件时,即没有发生人力推动转轴结构10时,可以根据用户输入控制转轴结构10转动或控制转轴结构10停止。In some embodiments, when the working parameters do not meet the preset conditions, that is, when the manual operation of the rotating shaft structure 10 does not occur, the rotating shaft structure 10 may be controlled to rotate or the rotating shaft structure 10 may be stopped according to user input.
在某些实施方式中,本发明实施方式的控制方法可以以预设周期执行,预设周期例如为0.001秒,当然,预设周期也可以是0.01秒、0.005秒、0.1秒等,也可以根据用户输入 进行设置,在此不作具体限定。In some embodiments, the control method according to the embodiment of the present invention may be executed at a preset period, for example, the preset period is 0.001 second. Of course, the preset period may also be 0.01 second, 0.005 second, 0.1 second, etc. It is set by user input, which is not specifically limited here.
人力推动转轴结构10与通过遥控器等其他方式控制转轴结构10转动相比较,人力推动转轴结构10时确定的工作参数的参数值一般会有较大差异。因此,可以通过判断工作参数是否符合预设条件来判断转轴结构10是否被人力推动。Compared with controlling the rotation of the rotating shaft structure 10 by a remote control or other methods, the manual driving of the rotating shaft structure 10 generally has a large difference in the parameter values of the working parameters determined when the manual driving of the rotating shaft structure 10. Therefore, it can be judged whether the rotating shaft structure 10 is pushed by human power by judging whether the working parameters meet the preset conditions.
请参阅图4,在某些实施方式中,步骤016包括:Referring to FIG. 4, in some embodiments, step 016 includes:
步骤0161:在工作参数符合预设条件且持续第一预定时长时,根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度。Step 0161: When the working parameter meets the preset condition and lasts for the first predetermined period of time, the manual pushing angle of the rotating shaft structure 10 relative to the initial position is determined according to the preset rotation speed.
以图2的手持云台为例,在某些实施方式中,处理器20用于在工作参数符合预设条件且持续第一预定时长时,根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度。Taking the handheld gimbal of FIG. 2 as an example, in some implementations, the processor 20 is configured to determine the relative position of the rotating shaft structure 10 relative to the initial position according to a preset rotation speed when the operating parameters meet a preset condition and last for a first predetermined duration. Human push angle.
也即是说,步骤0161可以由处理器20实现。That is, step 0161 may be implemented by the processor 20.
在某些实施方式中,在人力误触转轴结构10时确定的转轴结构10的工作参数的参数值一般也会有较大差异,但是人力误触转轴结构10的持续时间一般比较短。为了区分人力推动转轴结构10和人力误触转轴结构10,可以判断工作参数符合预设条件是否持续第一预定时长。在工作参数符合预设条件且持续第一预定时长时,可以认为此时为人力推动转轴结构10,因此,可以根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度。在工作参数符合预设条件但没有持续第一预定时长时,则可以认为此时可能为人力误触转轴结构10,因此,可以根据用户输入控制转轴结构10转动或控制转轴结构10停止。其中,第一预定时长可以预先保存在云台100中或由用户输入确定。在一个实施例中,第一预定时长为1秒,预设周期为0.001秒,则在1秒内,若1000次确定的工作参数均符合预设条件,则认为人力推动转轴结构10,若其中有一次确定的工作参数不符合预设条件,例如第1000次不符合预设条件,则认为不是人力推动转轴结构10,可以在下一次工作参数符合预设条件时重新判断是否持续第一预定时长,即在下一次工作参数符合预设条件时重新开始计时。In some implementations, the parameter values of the operating parameters of the shaft structure 10 determined when a human touches the shaft structure 10 by mistake may generally have a large difference, but the duration of the human touch by mistake by the shaft structure 10 is generally short. In order to distinguish between the manual pushing shaft structure 10 and the manual touching shaft structure 10 by mistake, it can be determined whether the working parameter meets the preset condition for the first predetermined duration. When the working parameter meets the preset conditions and lasts for the first predetermined period of time, it can be considered that at this time, the rotating shaft structure 10 is manually pushed by the human. Therefore, the manual pushing angle of the rotating shaft structure 10 relative to the initial position can be determined according to the preset rotation speed. When the working parameter meets the preset conditions but does not last for the first predetermined duration, it may be considered that it is possible that a human may accidentally touch the shaft structure 10 at this time. Therefore, the shaft structure 10 may be controlled to rotate or stop according to a user input. The first predetermined duration may be stored in the PTZ 100 in advance or determined by a user input. In one embodiment, the first predetermined duration is 1 second, and the preset period is 0.001 second. In 1 second, if the determined working parameters for 1000 times meet the preset conditions, it is considered that the shaft structure 10 is pushed by human power. Once the determined working parameters do not meet the preset conditions, for example, if the 1000th time does not meet the preset conditions, it is considered that the shaft structure 10 is not manually pushed, and the next predetermined working time can be re-determined when the working parameters meet the preset conditions. That is, the timing will be restarted when the next working parameter meets the preset conditions.
请参阅图5,在某些实施方式中,根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度,包括:Referring to FIG. 5, in some embodiments, determining the human-driven angle of the rotating shaft structure 10 relative to the initial position according to a preset rotation speed includes:
0162:对预设转动速度进行积分至转轴结构10的期望姿态分量为人力推动转轴结构10时转轴结构10的实时姿态分量;0162: Integrate the preset rotation speed to the desired attitude component of the shaft structure 10 as the real-time attitude component of the shaft structure 10 when the shaft structure 10 is pushed by a human force;
0163:根据积分结果,确定转轴结构10相对于初始位置的人力推动角度。其中,期望姿态分量为根据转轴结构10位于初始位置时的姿态以及积分结果更新。0163: Determine the manual pushing angle of the shaft structure 10 relative to the initial position according to the integration result. The desired posture component is updated according to the posture and the integration result when the rotating shaft structure 10 is located at the initial position.
以图2的手持云台为例,在某些实施方式中,处理器20用于对预设转动速度进行积分至转轴结构10的期望姿态分量为人力推动转轴结构10时转轴结构10的实时姿态分量、及 根据积分结果,确定转轴结构10相对于初始位置的人力推动角度。其中,期望姿态分量为根据转轴结构10位于初始位置时的姿态以及积分结果更新。Taking the handheld gimbal of FIG. 2 as an example, in some implementations, the processor 20 is configured to integrate a preset rotation speed to the desired attitude component of the shaft structure 10 as a real-time attitude of the shaft structure 10 when the shaft structure 10 is manually pushed by a human. The component and the human-driven angle of the rotating shaft structure 10 relative to the initial position are determined according to the integration result. The desired posture component is updated according to the posture and the integration result when the rotating shaft structure 10 is located at the initial position.
也即是说,步骤0162和步骤0163可以由处理器20实现。That is, steps 0162 and 0163 can be implemented by the processor 20.
具体地,转轴结构10的期望姿态分量可以是指云台100的期望姿态中与转轴结构10对应的分量,例如云台100包括对应偏航轴的转轴结构10、对应横滚轴的转轴结构10和对应俯仰轴的转轴结构10,云台100的期望姿态(yaw,roll,pitch)为(A,B,C),则对应偏航轴的转轴结构10的期望姿态分量为A,对应横滚轴的转轴结构10的期望姿态分量为B,对应俯仰轴的转轴结构10的期望姿态分量为C,上述解释也适用于转轴结构10的实时姿态分量。实时姿态分量可以通过设置在云台100上的惯性测量单元(例如陀螺仪、加速度计)等测量获得。在转轴结构10被人力推动时,可以对预设转动速度进行积分,在积分过程中,使得期望姿态分量逐渐靠近实时姿态分量,并在控制期望姿态分量转换为实时姿态分量时,完成对预设转动速度的积分,此时根据积分结果即可获得人力推动角度。其中,预设转动速度为期望姿态分量转换为实时姿态分量的姿态转换速度,在实际应用中,由于人力推动云台的原因,云台的实时姿态先于期望姿态,控制期望姿态分量为实时姿态分量是一个虚拟控制的过程。Specifically, the desired attitude component of the rotation axis structure 10 may refer to a component corresponding to the rotation axis structure 10 in the desired attitude of the gimbal 100. For example, the gimbal 100 includes a rotation axis structure 10 corresponding to a yaw axis, and a rotation axis structure 10 corresponding to a roll axis. And the rotation axis structure 10 corresponding to the pitch axis, the desired attitude (yaw, roll, pitch) of the gimbal 100 is (A, B, C), then the expected attitude component of the rotation axis structure 10 corresponding to the yaw axis is A, corresponding to roll The expected attitude component of the shaft structure 10 of the shaft is B, and the expected attitude component of the shaft structure 10 corresponding to the pitch axis is C. The above explanation is also applicable to the real-time attitude component of the shaft structure 10. The real-time attitude component can be obtained through measurement by an inertial measurement unit (such as a gyroscope, an accelerometer) and the like provided on the gimbal 100. When the shaft structure 10 is pushed by a human, the preset rotation speed can be integrated. During the integration process, the desired posture component is gradually brought closer to the real-time posture component, and the preset posture is completed when the desired posture component is controlled to be converted into the real-time posture component. The integral of the rotation speed. At this time, the human pushing angle can be obtained according to the integral result. Among them, the preset rotation speed is the attitude conversion speed at which the desired attitude component is converted into the real-time attitude component. In practical applications, due to the human push the gimbal, the real-time attitude of the gimbal precedes the desired attitude, and the desired attitude component is controlled to be a real-time attitude. Component is a process of virtual control.
另外,本发明实施方式的控制方法以预设周期执行,期望姿态分量可以根据转轴结构10位于初始位置时的姿态以及积分结果更新,在第一次对预设转动速度进行积分时,期望姿态分量可以为转轴结构10位于初始位置时的姿态,在后续对预设转动速度进行积分时,期望姿态分量根据转轴结构10位于初始位置时的姿态和人力推动角度确定。其中,人力推动角度可以根据每次的积分结果进行累加获得。如此,能够准确地对预设转动速度进行积分以获得准确的人力推动角度。In addition, the control method according to the embodiment of the present invention is executed at a preset period. The desired attitude component can be updated according to the attitude and integration result when the shaft structure 10 is located at the initial position. When integrating the preset rotational speed for the first time, the desired attitude component is updated. It may be the attitude when the shaft structure 10 is located at the initial position, and in subsequent integration of the preset rotation speed, the expected posture component is determined according to the attitude and the human pushing angle when the shaft structure 10 is located at the initial position. Among them, the human push angle can be accumulated according to the integration result of each time. In this way, it is possible to accurately integrate the preset rotation speed to obtain an accurate human pushing angle.
请参阅图6,在某些实施方式中,步骤018包括:Referring to FIG. 6, in some embodiments, step 018 includes:
步骤0181:在工作参数从符合预设条件变成不符合预设条件,且工作参数不符合预设条件持续第二预定时长时,沿着形成人力推动角度的相反方向,驱动转轴结构10回到初始位置。Step 0181: When the working parameter changes from meeting the preset condition to not meeting the preset condition, and the working parameter does not meet the preset condition for a second predetermined period of time, the rotary shaft structure 10 is driven back in the opposite direction that forms the human pushing angle. initial position.
以图2的手持云台为例,在某些实施方式中,处理器20用于在工作参数从符合预设条件变成不符合预设条件,且工作参数不符合预设条件持续第二预定时长时,沿着形成人力推动角度的相反方向,驱动转轴结构10回到初始位置。Taking the handheld gimbal of FIG. 2 as an example, in some implementations, the processor 20 is configured to continue to perform a second predetermined operation when the operating parameter changes from meeting the preset condition to not meeting the preset condition, and the operating parameter does not meet the preset condition. When the duration is long, the shaft structure 10 is driven back to the initial position along the opposite direction of the angle formed by the manual force.
也即是说,步骤0181可以由处理器20实现。That is, step 0181 may be implemented by the processor 20.
具体地,为了减少或避免在人力推动转轴结构10时误判断为结束人力推动的问题,可以在工作参数从符合预设条件变成不符合预设条件后,判断工作参数不符合预设条件是否持续第二预定时长,在工作参数不符合预设条件持续第二预定时长时,可以认为此时已经 结束人力推动,因此可以沿着形成人力推动角度的相反方向,驱动转轴结构10回到初始位置;在工作参数不符合预设条件但没有持续第二预定时长时,则可以认为此时手推还没结束,因此,可以在工作参数重新符合预设条件,或在工作参数重新符合预设条件且持续第一预定时长时,根据预设转动速度继续确定转轴结构10相对于初始位置的人力推动角度。其中,第二预定时长可以预先保存在云台100中或由用户输入确定,第二预定时长例如为1秒。另外,第一预定时长和第二预定时长可以相同或不同,在此不作具体限定。Specifically, in order to reduce or avoid the problem of erroneously judging that the manual driving is ended when the manual shaft driving structure 10 is pushed, the working parameter may be determined whether the working parameter does not meet the preset condition after the working parameter changes from meeting the preset condition to not meeting the preset condition. For a second predetermined duration, when the working parameters do not meet the preset conditions for a second predetermined duration, it can be considered that the human push has ended at this time, so the rotary shaft structure 10 can be driven back to the initial position in the opposite direction of the human push angle. ; When the working parameters do not meet the preset conditions but do not last for the second predetermined duration, it can be considered that the hand pushing has not ended at this time, so the working parameters can be re-compliant with the preset conditions, or the working parameters can be re-compliant with the preset conditions. For a first predetermined period of time, the manual pushing angle of the rotating shaft structure 10 relative to the initial position is continued to be determined according to the preset rotation speed. The second predetermined duration may be stored in the PTZ 100 in advance or determined by a user input, and the second predetermined duration is, for example, 1 second. In addition, the first predetermined duration and the second predetermined duration may be the same or different, which is not specifically limited herein.
请参阅图7,在某些实施方式中,方法还包括:Referring to FIG. 7, in some embodiments, the method further includes:
022:若人力推动角度大于预设值,则确定形成人力推动角度的方向为第一方向;022: If the human-driven angle is greater than a preset value, determine that the direction forming the human-driven angle is the first direction;
024:若人力推动角度小于预设值,则确定形成人力推动角度的方向为第二方向。024: If the human pushing angle is less than a preset value, determine that the direction forming the human pushing angle is the second direction.
以图2的手持云台为例,在某些实施方式中,处理器20还用于若人力推动角度大于预设值,则确定形成人力推动角度的方向为第一方向、及若人力推动角度小于预设值,则确定形成人力推动角度的方向为第二方向。Taking the handheld gimbal of FIG. 2 as an example, in some embodiments, the processor 20 is further configured to determine a direction for forming the human pushing angle as a first direction if the human pushing angle is greater than a preset value, and If it is smaller than the preset value, it is determined that the direction forming the human pushing angle is the second direction.
也即是说,步骤022和步骤024可以由处理器20实现。That is, steps 022 and 024 can be implemented by the processor 20.
具体地,预设值例如为0,若人力推动角度大于0,则确定形成人力推动角度的方向为第一方向,第一方向可以为转轴结构10的正旋转方向,当然,也可以为转轴结构10的反旋转方向;若人力推动角度小于预设值,则确定形成人力推动角度的方向为第二方向,第二方向可以为转轴结构10的反旋转方向,当然,也可以为转轴结构10的正旋转方向,第一方向和第二方向为相反方向。如此,可以快速地确定人力推动角度的方向。Specifically, the preset value is, for example, 0. If the human pushing angle is greater than 0, the direction for forming the human pushing angle is determined to be the first direction, and the first direction may be the positive rotation direction of the rotating shaft structure 10, of course, it may also be the rotating shaft structure. Counter rotation direction of 10; if the human pushing angle is smaller than a preset value, the direction for forming the human pushing angle is determined to be the second direction, and the second direction may be the counter rotating direction of the shaft structure 10, of course, it may also be the Positive rotation direction, the first direction and the second direction are opposite directions. In this way, the direction of the manual pushing angle can be quickly determined.
在一个实施例中,假设转轴结构10从K位置(初始位置)被推动到了L位置,其中,预设转动速度为第一方向,如K位置至L位置的方向,则导致形成的人力推动角度也为第一方向。在另一个实施例中,转轴结构10从K位置(初始位置)被推动到了N位置,其中,K位置位于L位置与N位置之间,预设转动速度为第二方向,如K位置至N位置的方向,则导致形成的人力推动角度也为第二方向。In one embodiment, it is assumed that the rotating shaft structure 10 is pushed from the K position (initial position) to the L position, wherein the preset rotation speed is the first direction, such as the direction from the K position to the L position, which results in the formed human pushing angle. Also the first direction. In another embodiment, the rotating shaft structure 10 is pushed from the K position (initial position) to the N position, where the K position is between the L position and the N position, and the preset rotation speed is the second direction, such as the K position to N The direction of the position causes the formed human-driven angle to be the second direction.
在某些实施方式中,为了精确控制云台回转至初始位置,用于积分的预设转动速度为转轴结构10的预设欧拉角速度。如此,可以通过预设欧拉角速度快速且准确地进行积分以获得人力推动角度,即获得云台100位于初始位置的姿态相对于实时姿态的欧拉角偏差。In some embodiments, in order to precisely control the gimbal to rotate to the initial position, the preset rotation speed for integration is the preset Euler angular velocity of the shaft structure 10. In this way, the preset Euler angular velocity can be used to quickly and accurately integrate to obtain the human pushing angle, that is, to obtain the Euler angle deviation of the attitude of the gimbal 100 at the initial position from the real-time attitude.
请参阅图8,在某些实施方式中,预设欧拉角速度的确定过程包括:Referring to FIG. 8, in some embodiments, the determination process of the preset Euler angular velocity includes:
026:依据预设关节角速度、云台关节角坐标系和云台本体坐标系之间的转换关系、云台本体坐标系和欧拉坐标系之间的转换关系,将预设关节角速度转换为预设欧拉角速度。026: According to the preset joint angular velocity, the translation relationship between the PTZ joint angle coordinate system and the PTZ body coordinate system, and the conversion relationship between the PTZ body coordinate system and the Euler coordinate system, the preset joint angular velocity is converted into a preset Set Euler angular velocity.
以图2的手持云台为例,在某些实施方式中,处理器20用于依据预设关节角速度、云台关节角坐标系和云台本体坐标系之间的转换关系、云台本体坐标系和欧拉坐标系之间的转换关系,将预设关节角速度转换为预设欧拉角速度。Taking the handheld gimbal of FIG. 2 as an example, in some implementations, the processor 20 is configured to use a preset joint angular velocity, a translation relationship between a gimbal joint angle coordinate system and a gimbal body coordinate system, and a gimbal body coordinate. The conversion relationship between the system and the Euler coordinate system converts the preset joint angular velocity to the preset Euler angular velocity.
也即是说,步骤026可以由处理器20实现。That is, step 026 may be implemented by the processor 20.
具体地,云台100中预先存储的或用户输入的角速度一般为关节角速度,为了便于精确控制,可以将关节角速度转换为欧拉角速度,再利用欧拉角速度控制转轴结构10。首先,可以根据云台关节角坐标系和云台本体坐标系之间的转换关系R j→b将预设关节角速度W j转换为云台本体坐标系下的角速度W b,W b=R j→b*W j。其中,R j→b为雅克比矩阵,R j→b由云台的构型确定,云台的构型不同,R j→b则不同。例如,三轴云台的R j→b可以与二轴云台的R j→b不同。 Specifically, the angular velocity pre-stored in the gimbal 100 or input by the user is generally the joint angular velocity. In order to facilitate accurate control, the joint angular velocity may be converted into Euler angular velocity, and the Euler angular velocity is used to control the shaft structure 10. First, the preset joint angular velocity W j can be converted to the angular velocity W b in the PTZ body coordinate system according to the conversion relationship R j → b between the gimbal joint angle coordinate system and the gimbal body coordinate system. W b = R j → b * W j . Among them, R j → b is a Jacobian matrix, R j → b is determined by the configuration of the gimbal. The configuration of the gimbal is different, and R j → b is different. For example, the head of the triaxial R j → b may biaxial PTZ different R j → b.
请再次参阅图3,本实施方式以ZXY三个转轴结构10的云台100为例,其中,Z例如为偏航轴,X例如为横滚轴,Y例如为俯仰轴,偏航轴框架142为外框,横滚轴框架144为中框,俯仰轴框架146为内框,偏航轴电机122用于驱动偏航轴框架142转动,以驱动横滚轴电机124和横滚轴框架144、俯仰轴电机126和俯仰轴框架146以及搭载在云台100上的负载转动,横滚轴电机124用于驱动横滚轴框架144转动,以驱动俯仰轴电机126和俯仰轴框架146以及负载转动,俯仰轴电机126用于驱动俯仰轴框架146转动,以驱动负载转动。偏航轴关节角的坐标轴的旋转轴Voutz为[0,0,1],横滚轴关节角的坐标轴的旋转轴Vmidx为[1,0,0],俯仰轴关节角的坐标轴的旋转轴Vinny为[0,1,0]。其中,Vinny、Vmidx、Voutz分别为俯仰关节角、横滚关节角、偏航关节角的坐标轴的旋转轴。将Voutz、Vmidx、Vinny分别转换至云台本体坐标系:Please refer to FIG. 3 again. In this embodiment, a pan / tilt head 100 with three rotation axis structures 10 of ZXY is taken as an example. Among them, Z is a yaw axis, X is a roll axis, Y is a pitch axis, and a yaw frame 142, for example. Is the outer frame, the roll axis frame 144 is the middle frame, the pitch axis frame 146 is the inner frame, and the yaw axis motor 122 is used to drive the yaw axis frame 142 to rotate to drive the roll axis motor 124 and the roll axis frame 144, The pitch axis motor 126 and the pitch axis frame 146 and the load mounted on the gimbal 100 are rotated. The roll axis motor 124 is used to drive the roll axis frame 144 to rotate, so as to drive the pitch axis motor 126 and the pitch axis frame 146 and load rotation. The pitch axis motor 126 is used to drive the pitch axis frame 146 to rotate to drive the load to rotate. The rotation axis Voutz of the coordinate axis of the yaw axis joint angle is [0, 0, 1], the rotation axis Vmidx of the coordinate axis of the roll axis joint angle is [1, 0, 0], and the coordinate axis of the joint angle of the pitch axis The rotation axis Vinny is [0, 1, 0]. Among them, Vinny, Vmidx, and Voutz are the rotation axes of the coordinate axes of the pitch joint angle, the roll joint angle, and the yaw joint angle, respectively. Transform Voutz, Vmidx, Vinny to the PTZ body coordinate system:
V outz→b=R y'*R x'*R z'*V outz V outz → b = R y ′ * R x ′ * R z ′ * V outz
V midx→b=R y'*R x'*V midx V midx → b = R y ′ * R x ′ * V midx
V inny→b=R y'*V inny V inny → b = R y ′ * V inny
其中,Ry'、Rx'、Rz'分别对应Ry、Rx、Rz的转置,Ry、Rx、Rz分别为关节角坐标系绕Y轴(俯仰轴)、X轴(横滚轴)、Z轴(偏航轴)到参考坐标系的旋转矩阵。例如,Ry、Rx、Rz可分别如下:Among them, Ry ', Rx', and Rz 'correspond to the transpose of Ry, Rx, and Rz, respectively. Ry, Rx, and Rz are the joint angle coordinate system around the Y axis (pitch axis), X axis (roll axis), and Z axis, respectively. (Yaw axis) rotation matrix to the reference coordinate system. For example, Ry, Rx, Rz can be as follows:
Figure PCTCN2018109184-appb-000001
Figure PCTCN2018109184-appb-000001
Figure PCTCN2018109184-appb-000002
Figure PCTCN2018109184-appb-000002
Figure PCTCN2018109184-appb-000003
Figure PCTCN2018109184-appb-000003
其中,参考坐标系为关节角为0的坐标系,A为关节角坐标系到参考坐标系的转换角度。The reference coordinate system is a coordinate system with a joint angle of 0, and A is a conversion angle of the joint angle coordinate system to the reference coordinate system.
Figure PCTCN2018109184-appb-000004
Figure PCTCN2018109184-appb-000004
其中,inn_joint_ang_rad为内框关节角,mid_joint_ang_rad为中框关节角。Among them, inn_joint_ang_rad is the joint angle of the inner frame, and mid_joint_ang_rad is the joint angle of the middle frame.
然后,可以根据云台本体坐标系和欧拉坐标系之间的转换关系
Figure PCTCN2018109184-appb-000005
将W b转换为预设欧拉角速度
Figure PCTCN2018109184-appb-000006
其中,
Figure PCTCN2018109184-appb-000007
为如下:
Then, according to the transformation relationship between the gimbal body coordinate system and Euler coordinate system
Figure PCTCN2018109184-appb-000005
Convert W b to preset Euler angular velocity
Figure PCTCN2018109184-appb-000006
among them,
Figure PCTCN2018109184-appb-000007
As follows:
Figure PCTCN2018109184-appb-000008
Figure PCTCN2018109184-appb-000008
其中,inn_euler_ang_rad为内框欧拉角,mid_euler_ang_rad为中框欧拉角,内框欧拉角和中框欧拉角均为云台100未更新时的期望欧拉角。Among them, inn_euler_ang_rad is the Euler angle of the inner frame, mid_euler_ang_rad is the Euler angle of the middle frame, and the Euler angle of the inner frame and the Euler angle of the middle frame are the expected Euler angles when the gimbal 100 is not updated.
在一具体实施中,依据上述转换关系,假设中框关节角为40度、内框关节角为40度,内框欧拉角为10,中框欧拉角为0,关节角速度为[0,0,1],若不经过上述坐标系之间的转换,则云台100欧拉角速度默认为关节角速度[0,0,1]。而经过上述坐标系之间的转换后,云台100的欧拉角速度为[-0.3830,0.6428,0.6634],则对应偏航轴的转轴结构的预设欧拉角速度为0.6634,而非1。如此可知,将预设关节角速度经由云台本体坐标系的转换,可以得到更为精确的预设欧拉角速度,从而在利用得到的预设欧拉角速度进行积分时,能够更为精准地反映转轴结构10的转动路径,有利于将云台100从人力推动结束时的实时姿态驱动至初始位置。同时,利用得到的预设欧拉角速度进行积分,得到的人力推动角度为欧拉角,由此避免了对于人力推动云台100时产生的关节角偏差的计算,从而避免了由于一个姿态对应多个关节角而存在多解时需要确定唯一解的复杂运算。In a specific implementation, according to the above conversion relationship, it is assumed that the joint angle of the middle frame is 40 degrees, the joint angle of the inner frame is 40 degrees, the Euler angle of the inner frame is 10, the Euler angle of the middle frame is 0, and the joint angular velocity is [0, 0,1], if the conversion between the above coordinate systems is not performed, the Euler angular velocity of the gimbal 100 defaults to the joint angular velocity [0,0,1]. After the conversion between the above coordinate systems, the Euler angular velocity of the gimbal 100 is [-0.3830, 0.6428, 0.6634], and the preset Euler angular velocity corresponding to the rotation axis structure of the yaw axis is 0.6634 instead of 1. It can be known that by transforming the preset joint angular velocity through the coordinate system of the gimbal body, a more accurate preset Euler angular velocity can be obtained, so that when using the obtained preset Euler angular velocity for integration, it can more accurately reflect the rotation axis The rotation path of the structure 10 is conducive to driving the PTZ 100 from the real-time posture at the end of the manual push to the initial position. At the same time, the obtained preset Euler angular velocity is used for integration, and the obtained manpower pushing angle is Euler angle, thereby avoiding the calculation of the joint angle deviation generated when the manpower pushes the gimbal 100, thereby avoiding the fact that one attitude corresponds to many When there are multiple joint angles and there are multiple solutions, a unique operation is needed to determine the unique solution.
可以理解,在由预设关节角转换为预设欧拉角时,由于在转换过程中涉及内框关节角、内框欧拉角、中框关节角、中框欧拉角,则当内框关节角、内框欧拉角、中框关节角、中框欧拉角变化时,预设欧拉角也相应变化。如此,由预设关节角转换的预设欧拉角更依赖于云台的姿态变化,可更新变化,能够达到更为精准的积分以及姿态转换控制。It can be understood that when the preset joint angle is converted into the preset Euler angle, since the inner frame joint angle, the inner frame Euler angle, the middle frame joint angle, and the middle frame Euler angle are involved in the conversion process, the inner frame When the joint angle, inner frame Euler angle, middle frame joint angle, and middle frame Euler angle change, the preset Euler angle also changes accordingly. In this way, the preset Euler angle converted from the preset joint angle depends more on the attitude change of the gimbal, which can be updated and changed to achieve more accurate integration and attitude conversion control.
在上述示例中偏航轴框架142为外框、横滚轴框架144为中框、俯仰轴框架146为内框,可以理解,在其他实施方式中,各个框架的连接关系也可以是其他,在此不作具体限定。In the above example, the yaw axis frame 142 is an outer frame, the roll axis frame 144 is a middle frame, and the pitch axis frame 146 is an inner frame. It can be understood that, in other embodiments, the connection relationship of each frame may be other. This is not specifically limited.
在某些实施方式中,转轴结构10包括转轴电机12,工作参数包括转轴电机12的期望扭矩。通过判断期望扭矩是否符合预设条件可以准确地判断转轴结构10是否被人力推动。In some embodiments, the shaft structure 10 includes a shaft motor 12, and the operating parameter includes a desired torque of the shaft motor 12. By judging whether the desired torque meets a preset condition, it can be accurately judged whether the rotating shaft structure 10 is pushed by human power.
请参阅图9,在某些实施方式中,期望扭矩的获取过程包括:Referring to FIG. 9, in some embodiments, the process of obtaining the desired torque includes:
028:获取转轴结构10的期望姿态分量以及人力推动转轴结构10时转轴结构10的实 时姿态分量;及028: Obtain a desired attitude component of the shaft structure 10 and a real-time attitude component of the shaft structure 10 when the shaft structure 10 is pushed by a human force; and
032:根据期望姿态分量与实时姿态分量确定期望扭矩。032: Determine the desired torque according to the desired attitude component and the real-time attitude component.
以图2的手持云台为例,在某些实施方式中,处理器20用于获取转轴结构10的期望姿态分量以及人力推动转轴结构10时转轴结构10的实时姿态分量、及根据期望姿态分量与实时姿态分量确定期望扭矩。Taking the handheld gimbal of FIG. 2 as an example, in some implementations, the processor 20 is configured to obtain a desired attitude component of the shaft structure 10 and a real-time attitude component of the shaft structure 10 when the shaft structure 10 is pushed by a human force, and according to the desired attitude component. Determine the desired torque with the real-time attitude component.
也即是说,步骤028和步骤032可以由处理器20实现。That is, steps 028 and 032 can be implemented by the processor 20.
具体地,可以采用上述实施方式的方法获取期望姿态分量和实时姿态分量。根据期望姿态分量与实时姿态分量确定期望扭矩,可以理解为:通过期望姿态分量与实时姿态分量的偏差确定期望扭矩,期望姿态分量与实时姿态分量的偏差和期望扭矩正相关。如此,可以根据期望姿态分量和实时姿态分量准确地确定期望扭矩。Specifically, the method of the foregoing embodiment may be adopted to obtain a desired pose component and a real-time pose component. Determining the desired torque according to the desired attitude component and the real-time attitude component can be understood as: determining the desired torque through the deviation of the desired attitude component and the real-time attitude component, and the deviation of the desired attitude component and the real-time attitude component is positively related to the expected torque. As such, the desired torque can be accurately determined based on the desired attitude component and the real-time attitude component.
其中,期望扭矩为上述转轴结构10由实时姿态分量运动至期望姿态分量时,其对应的转轴电机12所需输出的扭矩大小。The desired torque is the amount of torque that the corresponding shaft motor 12 needs to output when the shaft structure 10 moves from the real-time attitude component to the desired attitude component.
在某些实施方式中,控制方法还包括:014:判断转轴结构10的工作参数是否符合人力推动转轴结构10的预设条件。当工作参数包括期望扭矩时,请参阅图10,步骤014可以具体包括:In some embodiments, the control method further includes: 014: Determine whether the working parameter of the shaft structure 10 meets a preset condition that the shaft structure 10 is pushed by a human force. When the operating parameters include the desired torque, please refer to FIG. 10, step 014 may specifically include:
0141:判断期望扭矩的绝对值是否大于或等于预设扭矩;0141: Determine whether the absolute value of the desired torque is greater than or equal to the preset torque;
0142:在期望扭矩的绝对值大于或等于预设扭矩时,确定工作参数符合预设条件;及0142: When the absolute value of the desired torque is greater than or equal to the preset torque, determine that the operating parameters meet the preset conditions; and
0143:在期望扭矩的绝对值小于预设扭矩时,确定工作参数不符合预设条件。0143: When the absolute value of the desired torque is smaller than the preset torque, it is determined that the operating parameters do not meet the preset conditions.
以图2的手持云台为例,在某些实施方式中,处理器20还用于判断期望扭矩的绝对值是否大于或等于预设扭矩、在期望扭矩的绝对值大于或等于预设扭矩时,确定工作参数符合预设条件、及在期望扭矩的绝对值小于预设扭矩时,确定工作参数不符合预设条件。Taking the handheld gimbal of FIG. 2 as an example, in some embodiments, the processor 20 is further configured to determine whether the absolute value of the desired torque is greater than or equal to the preset torque, and when the absolute value of the desired torque is greater than or equal to the preset torque To determine that the working parameters meet the preset conditions, and when the absolute value of the desired torque is less than the preset torque, determine that the working parameters do not meet the preset conditions.
也即是说,步骤0141、步骤0142和步骤0143可以由处理器20实现。That is, step 0141, step 0142, and step 0143 can be implemented by the processor 20.
具体地,由于人力推动转轴结构10与通过遥控器等其他方式控制转轴结构10转动相比较,人力推动转轴结构10时确定的期望扭矩一般会比较大。因此,可以根据经验值对预设扭矩进行设置,以对期望扭矩和预设扭矩进行比较。其中,为了区别于人力推动转轴结构10的方向的不同,期望扭矩为矢量,预设扭矩为标量,因此,可以通过判断期望扭矩的绝对值是否大于或等于预设扭矩,来判断是否人力推动转轴结构10。在期望扭矩的绝对值大于或等于预设扭矩时,确定工作参数符合预设条件,即判断为人力推动转轴结构10;在期望扭矩的绝对值小于预设扭矩时,确定工作参数不符合预设条件,即判断为不是人力推动转轴结构10。如此,可以准确地判断工作参数是否符合预设条件。Specifically, compared with controlling the rotation of the rotation shaft structure 10 by a human remote control and other methods by using a remote controller, the expected torque determined when the rotation shaft structure 10 is pushed by a human body is generally larger. Therefore, the preset torque can be set based on empirical values to compare the desired torque with the preset torque. Among them, in order to distinguish the direction in which the shaft structure 10 is manually pushed by humans, the expected torque is a vector and the preset torque is a scalar quantity. Therefore, whether or not the absolute value of the desired torque is greater than or equal to the preset torque can be used to determine whether the shaft is pushed by a human force. Structure 10. When the absolute value of the desired torque is greater than or equal to the preset torque, it is determined that the working parameter meets the preset conditions, that is, it is determined that the shaft structure 10 is manually pushed by the human; when the absolute value of the desired torque is less than the preset torque, the working parameter is determined not to meet the preset torque. The condition, that is, it is judged that the shaft structure 10 is not pushed by human power. In this way, it can be accurately judged whether the working parameters meet the preset conditions.
请参阅图11和图12,在某些实施方式中,步骤0141包括:Please refer to FIG. 11 and FIG. 12. In some embodiments, step 0141 includes:
0144:当人力推动转轴结构10的方向为第三方向时,判断期望扭矩是否大于或等于预 设扭矩;和/或0144: when the direction in which the shaft structure 10 is pushed by human power is the third direction, determine whether the desired torque is greater than or equal to a preset torque; and / or
0145:当人力推动转轴结构10的方向为第四方向时,判断期望扭矩是否小于或等于预设扭矩的相反数。0145: When the direction in which the shaft structure 10 is pushed by a human force is the fourth direction, it is determined whether the desired torque is less than or equal to an opposite number of the preset torque.
以图2的手持云台为例,在某些实施方式中,处理器20用于当人力推动转轴结构10的方向为第三方向时,判断期望扭矩是否大于或等于预设扭矩;和/或当人力推动转轴结构10的方向为第四方向时,判断期望扭矩是否小于或等于预设扭矩的相反数。Taking the handheld gimbal of FIG. 2 as an example, in some implementations, the processor 20 is configured to determine whether a desired torque is greater than or equal to a preset torque when the direction in which the shaft structure 10 is pushed by a human force is a third direction; and / or When the direction in which the rotating shaft structure 10 is pushed by human power is the fourth direction, it is determined whether the desired torque is less than or equal to an opposite number of the preset torque.
也即是说,步骤0144和步骤0145可以由处理器20实现。That is, steps 0144 and 0145 can be implemented by the processor 20.
具体地,当人力推动转轴结构10的方向为第三方向时,期望扭矩大于0,因此可以判断期望扭矩是否大于或等于预设扭矩;当人力推动转轴结构10的方向为第四方向时,期望扭矩小于0,因此可以判断期望扭矩是否小于或等于预设扭矩的相反数。其中,第三方向可以为转轴结构10的正旋转方向或转轴结构10的反旋转方向,对应地,第四方向可以为转轴结构10的反旋转方向或转轴结构10的正旋转方向,第三方向和第四方向为相反方向。如此,可以根据人力推动转轴结构10的方向,准确地判断期望扭矩是否符合预设条件。Specifically, when the direction in which the shaft structure 10 is pushed by a human being is a third direction, the expected torque is greater than 0, so it can be determined whether the expected torque is greater than or equal to a preset torque; The torque is less than 0, so it can be determined whether the desired torque is less than or equal to the inverse of the preset torque. Wherein, the third direction may be the normal rotation direction of the rotation shaft structure 10 or the reverse rotation direction of the rotation shaft structure 10, and correspondingly, the fourth direction may be the reverse rotation direction of the rotation shaft structure 10 or the normal rotation direction of the rotation shaft structure 10, the third direction It is opposite to the fourth direction. In this way, it is possible to accurately determine whether the desired torque meets a preset condition according to the direction in which the rotating shaft structure 10 is pushed by human power.
可以理解,在实际应用中,也可以不根据人力推动云台100的方向来确定期望扭矩与预设扭矩的比较结果。例如,不确定人力推动云台的方向,而是依次将期望扭矩与预设扭矩、预设扭矩的相反数进行比较,从而也可以确定期望扭矩是大于预设扭矩,还是小于预设扭矩的相反数,亦或是位于预设扭矩与预设扭矩的相反数之间,进而也可以检测到是否有人力推动云台。It can be understood that, in actual applications, the comparison result of the desired torque and the preset torque may not be determined according to the direction in which the PTZ 100 is pushed by human power. For example, the direction of the manpower to push the gimbal is uncertain, but the expected torque is sequentially compared with the preset torque and the reverse of the preset torque, so that it can also be determined whether the desired torque is greater than the preset torque or the opposite of the preset torque. It can also be located between the preset torque and the opposite of the preset torque, and it can also detect whether there is any manpower pushing the gimbal.
在某些实施方式中,转轴结构10的工作参数也可以包括转轴结构10的期望电流,期望电流可以根据对应的转轴结构10的期望姿态分量和实时姿态分量确定。在一个实施例中,可以通过比较期望电流和预设电流,其中,期望电流为矢量,预设电流为标量,在期望电流大于等于预设电流、或期望电流小于等于预设电流的相反数时判断人力推动转轴结构10,在期望电流大于预设电流的相反数且小于预设电流时判断不是人力推动转轴结构。In some embodiments, the operating parameters of the shaft structure 10 may also include a desired current of the shaft structure 10, and the desired current may be determined according to a desired attitude component and a real-time attitude component of the corresponding shaft structure 10. In one embodiment, the expected current and the preset current may be compared, where the desired current is a vector and the preset current is a scalar. When the desired current is greater than or equal to the preset current or the desired current is less than or equal to the inverse of the preset current It is judged that the shaft structure 10 is pushed by a human being, and when the expected current is larger than the preset current and smaller than the preset current, it is determined that the shaft structure is not pushed by a manpower.
在某些实施方式中,期望扭矩与期望电流呈正比关系,M=Ca×I;其中,M表示期望扭矩,Ca表示一常数,I表示电流。其中,通过期望电流判断是否人力推动转轴结构10的方式可以参考通过期望扭矩判断是否人力推动转轴结构10的方式。In some embodiments, the desired torque is proportional to the desired current, M = Ca × I; where M is the desired torque, Ca is a constant, and I is the current. Among them, for a manner of judging whether the shaft structure 10 is manually pushed by a desired current, refer to a manner of judging whether the shaft structure 10 is manually pushed by a desired torque.
请参阅图13,在某些实施方式中,方法还包括:Referring to FIG. 13, in some embodiments, the method further includes:
034:比较期望姿态分量与实时姿态分量;034: Compare the expected attitude component with the real-time attitude component;
036:根据比较结果,确定人力推动转轴结构10的方向。036: According to the comparison result, determine the direction in which the shaft structure 10 is pushed by human power.
以图2的手持云台为例,在某些实施方式中,处理器20还用于比较期望姿态分量与实时姿态分量、及根据比较结果,确定人力推动转轴结构10的方向。Taking the handheld gimbal of FIG. 2 as an example, in some implementations, the processor 20 is further configured to compare a desired posture component with a real-time posture component, and determine a direction in which the human body pushes the shaft structure 10 according to the comparison result.
也即是说,步骤034和步骤036可以由处理器20实现。That is, steps 034 and 036 can be implemented by the processor 20.
具体地,可以计算期望姿态分量与实时姿态分量的偏差,如欧拉角差,在该欧拉角差大于零时,说明人力推动转轴结构10的方向为其中一个方向,例如为第三方向,在该姿态差小于零时,说明人力推动转轴结构10的方向为另一个方向,例如为第四方向。在一个实施例中,在期望姿态分量对应的欧拉角大于实时姿态分量对应的欧拉角时,人力推动转轴结构10的方向例如为第三方向;在期望姿态分量对应的欧拉角小于实时姿态分量对应的欧拉角时,人力推动转轴结构10的方向例如为第四方向。如此,可以通过期望姿态分量和实时姿态分量快速地确定人力推动转轴结构10的方向。Specifically, the deviation between the desired attitude component and the real-time attitude component can be calculated, such as the Euler angle difference. When the Euler angle difference is greater than zero, it indicates that the direction in which the rotary shaft structure 10 is pushed by human power is one of the directions, for example, the third direction. When the attitude difference is less than zero, it indicates that the direction in which the rotary shaft structure 10 is pushed by human power is another direction, for example, the fourth direction. In one embodiment, when the Euler angle corresponding to the desired attitude component is greater than the Euler angle corresponding to the real-time attitude component, the direction in which the shaft structure 10 is manually pushed by the human is, for example, a third direction; the Euler angle corresponding to the desired attitude component is less than the real-time When the Euler angle corresponding to the posture component, the direction in which the rotary shaft structure 10 is pushed by human power is, for example, the fourth direction. In this way, it is possible to quickly determine the direction in which the human-powered shaft structure 10 is pushed by the desired posture component and the real-time posture component.
需要说明的是,本发明实施方式的第三方向可以是上述第一方向,也可以是上述第二方向,对应地,本发明实施方式的第四方向可以是第二方向,也可以是第一方向。It should be noted that the third direction of the embodiment of the present invention may be the first direction or the second direction. Correspondingly, the fourth direction of the embodiment of the present invention may be the second direction or the first direction. direction.
在某些实施方式中,预设转动速度的方向与人力推动转轴结构10的方向相同。如此,预设转动速度的方向符合人力推动转轴结构10的方向,即预设转动速度的方向准确,使得对预设转动速度进行积分的积分结果、累积积分结果获得的人力推动角度也更加准确。In some embodiments, the direction of the preset rotation speed is the same as the direction in which the shaft structure 10 is pushed by a human. In this way, the direction of the preset rotation speed is in accordance with the direction of the manual pushing shaft structure 10, that is, the direction of the preset rotation speed is accurate, so that the integration result of integrating the preset rotation speed and the human pushing angle obtained by accumulating the integration result are more accurate.
在某些实施方式中,在人力推动转轴结构10时,转轴电机12的扭矩值通常大于通过遥控器控制转轴结构10时的扭矩值。本实施例的预设扭矩是根据电机的温度保护策略预设的,该预设扭矩为用于判断人力推动转轴结构10时的扭矩值的下限值。具体地,不同的转轴电机12可以具有不同的温度保护策略,可以根据不同的转轴电机12的温度保护策略,设定一个恒定的预设扭矩。如此,可以便于期望扭矩和预设扭矩的比较和判断。In some embodiments, when the shaft structure 10 is pushed by a human force, the torque value of the shaft motor 12 is generally greater than the torque value when the shaft structure 10 is controlled by a remote control. The preset torque in this embodiment is preset according to a temperature protection strategy of the motor, and the preset torque is a lower limit value for determining a torque value when a human is pushing the shaft structure 10. Specifically, different shaft motors 12 may have different temperature protection strategies, and a constant preset torque may be set according to different temperature protection strategies of the shaft motors 12. In this way, comparison and judgment of the desired torque and the preset torque can be facilitated.
在某些实施方式中,预设扭矩是根据转轴电机12的温度保护策略实时调整的,即在人力推动云台100的过程中,预设扭矩是变化的,以满足不同的需求。具体地,预设扭矩可以与转轴电机12的温度呈负相关,即转轴电机12的温度越大,预设扭矩越小;转轴电机12的温度越小,预设扭矩越大,如此,预设扭矩的获取更加精确,从而使得通过期望扭矩和预设扭矩判断是否人力推动转轴结构10的判断结果更加精确。In some embodiments, the preset torque is adjusted in real time according to the temperature protection strategy of the rotating shaft motor 12, that is, during the process of pushing the PTZ 100 manually, the preset torque is changed to meet different requirements. Specifically, the preset torque may be negatively related to the temperature of the shaft motor 12, that is, the higher the temperature of the shaft motor 12, the smaller the preset torque; the lower the temperature of the shaft motor 12, the larger the preset torque, and thus, the preset The acquisition of the torque is more accurate, so that the determination result of judging whether the human body pushes the rotating shaft structure 10 by the desired torque and the preset torque is more accurate.
本发明实施方式的云台100可以应用于移动平台,也即是说,移动平台可以包括上述任意一种实施方式的云台100。另外,移动平台还可以包括本体,云台100设置在本体上。其中,当移动平台为手持云台时,移动平台的本体可以为手持云台的手持部。当然,移动平台可以例如包括小车、飞行器、机器人等,其本体上的云台100可以搭载有成像装置和/或射击装置和/或其它功能模块。The PTZ 100 of the embodiment of the present invention can be applied to a mobile platform, that is, the mobile platform can include the PTZ 100 of any one of the foregoing embodiments. In addition, the mobile platform may further include a main body, and the PTZ 100 is disposed on the main body. When the mobile platform is a handheld PTZ, the body of the mobile platform may be a handheld part of the handheld PTZ. Of course, the mobile platform may include, for example, a cart, an aircraft, a robot, and the like, and the gimbal 100 on the body may be equipped with an imaging device and / or a shooting device and / or other functional modules.
请参阅图14,本发明实施方式以移动平台为飞行器1000为例,飞行器1000包括云台100和本体200,本体200例如包括中心架、与所述中心架连接的机臂以及与所述机臂连接的动力单元等。可以理解,移动平台的本体与移动平台的类型相对应,例如移动平台为小车时,本体为小车。Please refer to FIG. 14. In the embodiment of the present invention, the mobile platform is an aircraft 1000. The aircraft 1000 includes a gimbal 100 and a main body 200. The main body 200 includes, for example, a center frame, an arm connected to the center frame, and the arm. Connected power unit, etc. It can be understood that the body of the mobile platform corresponds to the type of the mobile platform. For example, when the mobile platform is a cart, the body is a cart.
请参阅图15,本发明实施方式的计算机可读存储介质400包括计算机程序,所述计算 机程序可被处理器20执行以完成上述任意一种实施方式的控制方法。Referring to FIG. 15, a computer-readable storage medium 400 according to an embodiment of the present invention includes a computer program, and the computer program can be executed by the processor 20 to implement the control method of any one of the foregoing embodiments.
例如,请结合图1和图15,计算机程序可被处理器20执行以完成以下步骤所述的控制方法:For example, in conjunction with FIG. 1 and FIG. 15, the computer program may be executed by the processor 20 to complete the control method described in the following steps:
012:获取转轴结构10的工作参数;012: Obtain the working parameters of the shaft structure 10.
016:在检测工作参数符合人力推动转轴结构10的预设条件时,根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度;及016: determining the human-driven angle of the rotary shaft structure 10 relative to the initial position according to the preset rotation speed when detecting that the working parameters meet the preset conditions of the human-driven shaft structure 10; and
018:在检测工作参数从符合预设条件变成不符合预设条件时,沿着形成人力推动角度的相反方向,驱动转轴结构10回到初始位置。018: When detecting that the working parameter changes from meeting the preset conditions to not meeting the preset conditions, the rotary shaft structure 10 is driven back to the initial position along the opposite direction of the angle formed by the human push.
再例如,请结合图4和图15,计算机程序还可被处理器20执行以完成以下步骤所述的控制方法:For another example, in conjunction with FIG. 4 and FIG. 15, the computer program can also be executed by the processor 20 to complete the control method described in the following steps:
步骤0161:在工作参数符合预设条件且持续第一预定时长时,根据预设转动速度确定转轴结构10相对于初始位置的人力推动角度。Step 0161: When the working parameter meets the preset condition and lasts for the first predetermined period of time, the manual pushing angle of the rotating shaft structure 10 relative to the initial position is determined according to the preset rotation speed.
在本说明书的描述中,参考术语“一个实施方式”、“一些实施方式”、“示意性实施方式”、“示例”、“具体示例”、或“一些示例”等的描述意指结合所述实施方式或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施方式或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施方式或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施方式或示例中以合适的方式结合。In the description of this specification, the description with reference to the terms “one embodiment”, “some embodiments”, “exemplary embodiments”, “examples”, “specific examples”, or “some examples”, etc., means in combination with the Specific features, structures, materials, or characteristics described in the embodiments or examples are included in at least one embodiment or example of the present invention. In this specification, the schematic expressions of the above terms do not necessarily refer to the same implementation or example. Moreover, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more implementations or examples.
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更多个用于执行特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本发明的优选实施方式的范围包括另外的执行,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本发明的实施例所属技术领域的技术人员所理解。Any process or method description in a flowchart or otherwise described herein can be understood as representing a module, fragment, or portion of code that includes one or more executable instructions for performing a particular logical function or step of a process And, the scope of the preferred embodiments of the present invention includes additional implementations, in which the functions may be performed out of the order shown or discussed, including performing the functions in a substantially simultaneous manner or in the reverse order according to the functions involved, which should It is understood by those skilled in the art to which the embodiments of the present invention pertain.
在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于执行逻辑功能的可执行指令的定序列表,可以具体执行在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介 质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。Logic and / or steps represented in a flowchart or otherwise described herein, for example, a ordered list of executable instructions that may be considered to perform a logical function, may be embodied in any computer-readable medium, For use by, or in combination with, an instruction execution system, device, or device (such as a computer-based system, a system that includes a processor, or another system that can fetch and execute instructions from an instruction execution system, device, or device) Or equipment. For the purposes of this specification, a "computer-readable medium" may be any device that can contain, store, communicate, propagate, or transmit a program for use by or in connection with an instruction execution system, apparatus, or device. More specific examples (non-exhaustive list) of computer-readable media include the following: electrical connections (electronic devices) with one or more wirings, portable computer disk cartridges (magnetic devices), random access memory (RAM), Read-only memory (ROM), erasable and editable read-only memory (EPROM or flash memory), fiber optic devices, and portable optical disk read-only memory (CDROM). In addition, the computer-readable medium may even be paper or other suitable medium on which the program can be printed, because, for example, by optically scanning the paper or other medium, followed by editing, interpretation, or other suitable Processing to obtain the program electronically and then store it in computer memory.
应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来执行。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来执行。例如,如果用硬件来执行,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来执行:具有用于对数据信号执行逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。It should be understood that various parts of the present invention may be executed by hardware, software, firmware, or a combination thereof. In the above embodiments, multiple steps or methods may be performed by software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if executed by hardware, as in another embodiment, it may be executed by any one or a combination of the following techniques known in the art: a logic gate circuit having a logic function for performing a logic function on a data signal Discrete logic circuits, application-specific integrated circuits with suitable combinational logic gate circuits, programmable gate arrays (PGA), field programmable gate arrays (FPGA), etc.
本技术领域的普通技术人员可以理解执行上述实施方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。A person of ordinary skill in the art can understand that performing all or part of the steps carried by the foregoing implementation method can be completed by a program instructing related hardware. The program can be stored in a computer-readable storage medium, and the program is executing , Including one or a combination of the steps of the method embodiments.
此外,在本发明各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式执行,也可以采用软件功能模块的形式执行。所述集成的模块如果以软件功能模块的形式执行并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。In addition, each functional unit in each embodiment of the present invention may be integrated into one processing module, or each unit may exist separately physically, or two or more units may be integrated into one module. The above integrated modules can be executed in the form of hardware or software functional modules. When the integrated module is executed in the form of a software functional module and sold or used as an independent product, it may also be stored in a computer-readable storage medium.
上述提到的存储介质可以是只读存储器,磁盘或光盘等。尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。The aforementioned storage medium may be a read-only memory, a magnetic disk, or an optical disk. Although the embodiments of the present invention have been shown and described above, it can be understood that the above embodiments are exemplary and should not be construed as limitations on the present invention. Those skilled in the art can interpret the above within the scope of the present invention. Embodiments are subject to change, modification, substitution, and modification.

Claims (34)

  1. 一种云台的控制方法,所述云台包括至少一个转轴结构,其特征在于,所述控制方法包括:A control method for a pan / tilt head. The pan / tilt head includes at least one shaft structure. The control method includes:
    获取所述转轴结构的工作参数;Obtaining working parameters of the shaft structure;
    在检测到所述工作参数符合人力推动所述转轴结构的预设条件时,根据预设转动速度确定所述转轴结构相对于初始位置的人力推动角度;及When it is detected that the working parameter meets a preset condition for manually pushing the rotating shaft structure, determining a manual pushing angle of the rotating shaft structure relative to an initial position according to a preset rotation speed; and
    在检测到所述工作参数从符合所述预设条件变成不符合所述预设条件时,沿着形成所述人力推动角度的相反方向,驱动所述转轴结构回到所述初始位置。When it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition, the rotating shaft structure is driven back to the initial position along an opposite direction that forms the human pushing angle.
  2. 根据权利要求1所述的方法,其特征在于,所述根据预设转动速度确定所述转轴结构相对于初始位置的人力推动角度,包括:The method according to claim 1, wherein determining the human-driven angle of the rotating shaft structure relative to an initial position according to a preset rotation speed comprises:
    对所述预设转动速度进行积分至所述转轴结构的期望姿态分量为人力推动所述转轴结构时所述转轴结构的实时姿态分量;Integrating the preset rotational speed to a desired posture component of the shaft structure is a real-time posture component of the shaft structure when a human is pushing the shaft structure;
    根据所述积分结果,确定所述转轴结构相对于所述初始位置的所述人力推动角度;Determining the human pushing angle of the rotating shaft structure relative to the initial position according to the integration result;
    其中,所述期望姿态分量为根据所述转轴结构位于所述初始位置时的姿态以及所述积分结果更新。Wherein, the desired posture component is updated according to the posture when the shaft structure is located at the initial position and the integration result.
  3. 根据权利要求1所述的方法,其特征在于,所述方法还包括:The method according to claim 1, further comprising:
    若所述人力推动角度大于预设值,则确定形成所述人力推动角度的方向为第一方向;If the manual pushing angle is greater than a preset value, determining that a direction forming the manual pushing angle is a first direction;
    若所述人力推动角度小于预设值,则确定形成所述人力推动角度的方向为第二方向。If the manual pushing angle is smaller than a preset value, it is determined that a direction forming the manual pushing angle is a second direction.
  4. 根据权利要求1所述的方法,其特征在于,所述预设转动速度为所述转轴结构的预设欧拉角速度。The method according to claim 1, wherein the preset rotational speed is a preset Euler angular velocity of the shaft structure.
  5. 根据权利要求4所述的方法,其特征在于,所述预设欧拉角速度的确定过程包括:The method according to claim 4, wherein the process of determining the preset Euler angular velocity comprises:
    依据预设关节角速度、云台关节角坐标系和云台本体坐标系之间的转换关系、所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述预设关节角速度转换为所述预设欧拉角速度。Convert the preset joint angular velocity according to a preset joint angular velocity, a translation relationship between the gimbal joint angular coordinate system and a gimbal body coordinate system, and a conversion relation between the gimbal body coordinate system and an Euler coordinate system Is the preset Euler angular velocity.
  6. 根据权利要求1所述的方法,其特征在于,所述在检测到所述工作参数符合人力推动所述转轴结构的预设条件时,根据预设转动速度确定所述转轴结构相对于初始位置的人力推动角度,包括:The method according to claim 1, wherein when it is detected that the working parameter meets a preset condition for manually pushing the shaft structure, determining the relative position of the shaft structure relative to the initial position according to a preset rotation speed. Human-driven perspectives, including:
    在检测到所述工作参数符合人力推动所述转轴结构的预设条件且持续第一预定时长时,根据所述预设转动速度确定所述转轴结构相对于所述初始位置的所述人力推动角度。When it is detected that the working parameter meets a preset condition for manually pushing the rotating shaft structure for a first predetermined time period, the manual pushing angle of the rotating shaft structure relative to the initial position is determined according to the preset rotation speed .
  7. 根据权利要求1所述的方法,其特征在于,所述在检测到所述工作参数从符合所述预设条件变成不符合所述预设条件时,沿着形成所述人力推动角度的相反方向,驱动所述转轴结构回到所述初始位置,包括:The method according to claim 1, characterized in that, when it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition, the opposite direction along which the manpower pushing angle is formed is detected. Direction to drive the shaft structure back to the initial position, including:
    在检测到所述工作参数从符合所述预设条件变成不符合所述预设条件,且所述工作参数不符合所述预设条件持续第二预定时长时,沿着形成所述人力推动角度的相反方向,驱动所述转轴结构回到所述初始位置。When it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition, and the working parameter does not meet the preset condition for a second predetermined period of time, driving along the formation of the manpower The opposite direction of the angle drives the shaft structure back to the initial position.
  8. 根据权利要求1至7中任一项所述的方法,其特征在于,所述转轴结构包括转轴电机,所述工作参数包括所述转轴电机的期望扭矩。The method according to any one of claims 1 to 7, wherein the shaft structure includes a shaft motor, and the operating parameter includes a desired torque of the shaft motor.
  9. 根据权利要求8所述的方法,其特征在于,所述期望扭矩的获取过程包括:The method according to claim 8, wherein the obtaining process of the desired torque comprises:
    获取所述转轴结构的期望姿态分量以及人力推动所述转轴结构时所述转轴结构的实时姿态分量;及Acquiring a desired attitude component of the shaft structure and a real-time attitude component of the shaft structure when a human is pushing the shaft structure; and
    根据所述期望姿态分量与所述实时姿态分量确定所述期望扭矩。The desired torque is determined according to the desired attitude component and the real-time attitude component.
  10. 根据权利要求8所述的方法,其特征在于,所述方法还包括:The method according to claim 8, further comprising:
    判断所述期望扭矩的绝对值是否大于或等于预设扭矩;Determining whether the absolute value of the desired torque is greater than or equal to a preset torque;
    在所述期望扭矩的绝对值大于或等于所述预设扭矩时,确定所述工作参数符合所述预设条件;及When the absolute value of the desired torque is greater than or equal to the preset torque, determining that the operating parameter meets the preset condition; and
    在所述期望扭矩的绝对值小于所述预设扭矩时,确定所述工作参数不符合所述预设条件。When the absolute value of the desired torque is smaller than the preset torque, it is determined that the operating parameter does not meet the preset condition.
  11. 根据权利要求10所述的方法,其特征在于,所述判断所述期望扭矩的绝对值是否大于或等于预设扭矩,包括:The method according to claim 10, wherein the determining whether the absolute value of the desired torque is greater than or equal to a preset torque comprises:
    当人力推动所述转轴结构的方向为第三方向时,判断所述期望扭矩是否大于或等于所述预设扭矩;和/或When the direction in which the shaft structure is pushed by human power is the third direction, determine whether the desired torque is greater than or equal to the preset torque; and / or
    当人力推动所述转轴结构的方向为第四方向时,判断所述期望扭矩是否小于或等于所述预设扭矩的相反数。When the direction in which the shaft structure is pushed by human power is the fourth direction, it is determined whether the desired torque is less than or equal to an opposite number of the preset torque.
  12. 根据权利要求11所述的方法,其特征在于,所述方法还包括:The method according to claim 11, further comprising:
    比较所述期望姿态分量与所述实时姿态分量;Comparing the desired attitude component with the real-time attitude component;
    根据所述比较结果,确定人力推动所述转轴结构的方向。According to the comparison result, a direction in which a human body pushes the shaft structure is determined.
  13. 根据权利要求12所述的方法,其特征在于,所述预设转动速度的方向与所述人力推动所述转轴结构的方向相同。The method according to claim 12, wherein a direction of the preset rotation speed is the same as a direction in which the manual force pushes the rotating shaft structure.
  14. 根据权利要求10所述的方法,其特征在于,所述预设扭矩是根据所述转轴电机的温度保护策略预设的。The method according to claim 10, wherein the preset torque is preset according to a temperature protection strategy of the shaft motor.
  15. 根据权利要求14所述的方法,其特征在于,所述预设扭矩是根据所述转轴电机的温度保护策略实时调整的。The method according to claim 14, wherein the preset torque is adjusted in real time according to a temperature protection strategy of the shaft motor.
  16. 根据权利要求1所述的方法,其特征在于,至少一个所述转轴结构包括对应偏航轴的转轴结构、对应横滚轴的转轴结构和对应俯仰轴的转轴结构中的至少一个。The method according to claim 1, wherein at least one of the rotation shaft structures comprises at least one of a rotation shaft structure corresponding to a yaw axis, a rotation shaft structure corresponding to a roll axis, and a rotation shaft structure corresponding to a pitch axis.
  17. 一种云台,其特征在于,所述云台包括至少一个转轴结构和处理器,所述处理器用于:A gimbal, characterized in that the gimbal includes at least one shaft structure and a processor, and the processor is used for:
    获取所述转轴结构的工作参数;Obtaining working parameters of the shaft structure;
    在检测到所述工作参数符合人力推动所述转轴结构的预设条件时,根据预设转动速度确定所述转轴结构相对于初始位置的人力推动角度;及When it is detected that the working parameter meets a preset condition for manually pushing the rotating shaft structure, determining a manual pushing angle of the rotating shaft structure relative to an initial position according to a preset rotation speed; and
    在检测到所述工作参数从符合所述预设条件变成不符合所述预设条件时,沿着形成所述人力推动角度的相反方向,驱动所述转轴结构回到所述初始位置。When it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition, the rotating shaft structure is driven back to the initial position along an opposite direction that forms the human pushing angle.
  18. 根据权利要求17所述的云台,其特征在于,所述处理器用于:The gimbal of claim 17, wherein the processor is configured to:
    对所述预设转动速度进行积分至所述转轴结构的期望姿态分量为人力推动所述转轴结构时所述转轴结构的实时姿态分量;Integrating the preset rotational speed to a desired posture component of the shaft structure is a real-time posture component of the shaft structure when a human is pushing the shaft structure;
    根据所述积分结果,确定所述转轴结构相对于所述初始位置的所述人力推动角度;Determining the human pushing angle of the rotating shaft structure relative to the initial position according to the integration result;
    其中,所述期望姿态分量为根据所述转轴结构位于所述初始位置时的姿态以及所述积分结果更新。Wherein, the desired posture component is updated according to the posture when the shaft structure is located at the initial position and the integration result.
  19. 根据权利要求17所述的云台,其特征在于,所述处理器还用于:The PTZ according to claim 17, wherein the processor is further configured to:
    若所述人力推动角度大于预设值,则确定形成所述人力推动角度的方向为第一方向;If the manual pushing angle is greater than a preset value, determining that a direction forming the manual pushing angle is a first direction;
    若所述人力推动角度小于预设值,则确定形成所述人力推动角度的方向为第二方向。If the manual pushing angle is smaller than a preset value, it is determined that a direction forming the manual pushing angle is a second direction.
  20. 根据权利要求17所述的云台,其特征在于,所述预设转动速度为所述转轴结构的预设欧拉角速度。The gimbal of claim 17, wherein the preset rotational speed is a preset Euler angular velocity of the shaft structure.
  21. 根据权利要求20所述的云台,其特征在于,所述处理器用于:The gimbal of claim 20, wherein the processor is configured to:
    依据预设关节角速度、云台关节角坐标系和云台本体坐标系之间的转换关系、所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述预设关节角速度转换为所述预设欧拉角速度。Convert the preset joint angular velocity according to a preset joint angular velocity, a translation relationship between the gimbal joint angular coordinate system and a gimbal body coordinate system, and a conversion relation between the gimbal body coordinate system and an Euler coordinate system Is the preset Euler angular velocity.
  22. 根据权利要求17所述的云台,其特征在于,所述处理器用于:The gimbal of claim 17, wherein the processor is configured to:
    在检测到所述工作参数符合人力推动所述转轴结构的预设条件且持续第一预定时长时,根据所述预设转动速度确定所述转轴结构相对于所述初始位置的所述人力推动角度。When it is detected that the working parameter meets a preset condition for manually pushing the rotating shaft structure for a first predetermined time period, the manual pushing angle of the rotating shaft structure relative to the initial position is determined according to the preset rotation speed .
  23. 根据权利要求17所述的云台,其特征在于,所述处理器用于:The gimbal of claim 17, wherein the processor is configured to:
    在检测到所述工作参数从符合所述预设条件变成不符合所述预设条件,且所述工作参数不符合所述预设条件持续第二预定时长时,沿着形成所述人力推动角度的相反方向,驱动所述转轴结构回到所述初始位置。When it is detected that the working parameter changes from meeting the preset condition to not meeting the preset condition, and the working parameter does not meet the preset condition for a second predetermined period of time, driving along the formation of the manpower The opposite direction of the angle drives the shaft structure back to the initial position.
  24. 根据权利要求17至23中任一项所述的云台,其特征在于,所述转轴结构包括转轴电机,所述工作参数包括所述转轴电机的期望扭矩。The gimbal according to any one of claims 17 to 23, wherein the shaft structure includes a shaft motor, and the operating parameter includes a desired torque of the shaft motor.
  25. 根据权利要求24所述的云台,其特征在于,所述处理器用于:The gimbal of claim 24, wherein the processor is configured to:
    获取所述转轴结构的期望姿态分量以及人力推动所述转轴结构时所述转轴结构的实时姿态分量;及Acquiring a desired attitude component of the shaft structure and a real-time attitude component of the shaft structure when a human is pushing the shaft structure; and
    根据所述期望姿态分量与所述实时姿态分量确定所述期望扭矩。The desired torque is determined according to the desired attitude component and the real-time attitude component.
  26. 根据权利要求24所述的云台,其特征在于,所述处理器还用于:The PTZ according to claim 24, wherein the processor is further configured to:
    判断所述期望扭矩的绝对值是否大于或等于预设扭矩;Determining whether the absolute value of the desired torque is greater than or equal to a preset torque;
    在所述期望扭矩的绝对值大于或等于所述预设扭矩时,确定所述工作参数符合所述预设条件;及When the absolute value of the desired torque is greater than or equal to the preset torque, determining that the operating parameter meets the preset condition; and
    在所述期望扭矩的绝对值小于所述预设扭矩时,确定所述工作参数不符合所述预设条件。When the absolute value of the desired torque is smaller than the preset torque, it is determined that the operating parameter does not meet the preset condition.
  27. 根据权利要求26所述的云台,其特征在于,所述处理器用于:The gimbal according to claim 26, wherein the processor is configured to:
    当人力推动所述转轴结构的方向为第三方向时,判断所述期望扭矩是否大于或等于所述预设扭矩;和/或When the direction in which the shaft structure is pushed by human power is the third direction, determine whether the desired torque is greater than or equal to the preset torque; and / or
    当人力推动所述转轴结构的方向为第四方向时,判断所述期望扭矩是否小于或等于所述预设扭矩的相反数。When the direction in which the shaft structure is pushed by human power is the fourth direction, it is determined whether the desired torque is less than or equal to an opposite number of the preset torque.
  28. 根据权利要求27所述的云台,其特征在于,所述处理器还用于:The gimbal of claim 27, wherein the processor is further configured to:
    比较所述期望姿态分量与所述实时姿态分量;Comparing the desired attitude component with the real-time attitude component;
    根据所述比较结果,确定人力推动所述转轴结构的方向。According to the comparison result, a direction in which a human body pushes the shaft structure is determined.
  29. 根据权利要求28所述的云台,其特征在于,所述预设转动速度的方向与所述人力推动所述转轴结构的方向相同。The gimbal of claim 28, wherein a direction of the preset rotation speed is the same as a direction in which the manual force pushes the rotation shaft structure.
  30. 根据权利要求26所述的云台,其特征在于,所述预设扭矩是根据所述转轴电机的温度保护策略预设的。The gimbal of claim 26, wherein the preset torque is preset according to a temperature protection strategy of the shaft motor.
  31. 根据权利要求30所述的云台,其特征在于,所述预设扭矩是根据所述转轴电机的温度保护策略实时调整的。The gimbal of claim 30, wherein the preset torque is adjusted in real time according to a temperature protection strategy of the shaft motor.
  32. 根据权利要求17所述的云台,其特征在于,至少一个所述转轴结构包括对应偏航轴的转轴结构、对应横滚轴的转轴结构和对应俯仰轴的转轴结构中的至少一个。The gimbal according to claim 17, wherein at least one of the rotation shaft structures comprises at least one of a rotation shaft structure corresponding to a yaw axis, a rotation shaft structure corresponding to a roll axis, and a rotation shaft structure corresponding to a pitch axis.
  33. 一种移动平台,其特征在于,所述移动平台包括本体和权利要求17至32中任一项所述的云台,所述云台设置在所述本体上。A mobile platform, characterized in that the mobile platform comprises a main body and a pan / tilt head according to any one of claims 17 to 32, and the pan / tilt head is disposed on the main body.
  34. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序可被处理器执行以完成权利要求1至16中任一项所述的控制方法。A computer-readable storage medium having stored thereon a computer program, characterized in that the computer program is executable by a processor to complete the control method according to any one of claims 1 to 16.
PCT/CN2018/109184 2018-09-30 2018-09-30 Control method for gimbal, gimbal, mobile platform and computer readable storage medium WO2020062280A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2018/109184 WO2020062280A1 (en) 2018-09-30 2018-09-30 Control method for gimbal, gimbal, mobile platform and computer readable storage medium
CN201880013283.XA CN110352394A (en) 2018-09-30 2018-09-30 Control method, holder, mobile platform and the computer readable storage medium of holder

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2018/109184 WO2020062280A1 (en) 2018-09-30 2018-09-30 Control method for gimbal, gimbal, mobile platform and computer readable storage medium

Publications (1)

Publication Number Publication Date
WO2020062280A1 true WO2020062280A1 (en) 2020-04-02

Family

ID=68174562

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2018/109184 WO2020062280A1 (en) 2018-09-30 2018-09-30 Control method for gimbal, gimbal, mobile platform and computer readable storage medium

Country Status (2)

Country Link
CN (1) CN110352394A (en)
WO (1) WO2020062280A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210364895A1 (en) * 2016-12-30 2021-11-25 Sz Dji Osmo Technology Co., Ltd. Gimbal control method, device, and gimbal

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5963749A (en) * 1998-02-09 1999-10-05 Nicholson; Lynn Self-leveling invertible camera stabilizer
CN201750495U (en) * 2010-07-05 2011-02-16 杭州晨安机电技术有限公司 Posture self-correcting vehicle-mounted camera
CN202758245U (en) * 2012-06-29 2013-02-27 深圳一电科技有限公司 Pan-tilt camera controlling device and pan-tilt camera system
CN103901897A (en) * 2014-03-14 2014-07-02 深圳市大疆创新科技有限公司 Control method and system of tripod head

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104469227B (en) * 2013-09-22 2017-06-30 杭州海康威视系统技术有限公司 The kinescope method and device of vehicle behavior
JP6255117B2 (en) * 2014-06-30 2017-12-27 エスゼット ディージェイアイ オスモ テクノロジー カンパニー リミテッドSZ DJI Osmo Technology Co., Ltd. Imaging control method, apparatus, and pan head apparatus
CN206096954U (en) * 2016-08-30 2017-04-12 哈瓦国际航空技术(深圳)有限公司 Camera shooting pan -tilt zooms
EP3564574B1 (en) * 2016-12-30 2021-11-10 SZ DJI Osmo Technology Co., Ltd. Method and device for controlling cradle head, and cradle head

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5963749A (en) * 1998-02-09 1999-10-05 Nicholson; Lynn Self-leveling invertible camera stabilizer
CN201750495U (en) * 2010-07-05 2011-02-16 杭州晨安机电技术有限公司 Posture self-correcting vehicle-mounted camera
CN202758245U (en) * 2012-06-29 2013-02-27 深圳一电科技有限公司 Pan-tilt camera controlling device and pan-tilt camera system
CN103901897A (en) * 2014-03-14 2014-07-02 深圳市大疆创新科技有限公司 Control method and system of tripod head

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210364895A1 (en) * 2016-12-30 2021-11-25 Sz Dji Osmo Technology Co., Ltd. Gimbal control method, device, and gimbal
US11852958B2 (en) * 2016-12-30 2023-12-26 Sz Dji Osmo Technology Co., Ltd. Gimbal control method, device, and gimbal

Also Published As

Publication number Publication date
CN110352394A (en) 2019-10-18

Similar Documents

Publication Publication Date Title
US11852958B2 (en) Gimbal control method, device, and gimbal
WO2021026753A1 (en) Gimbal control method, gimbal, and computer readable storage medium
JP5211944B2 (en) Robot apparatus control method and robot apparatus
WO2020062298A1 (en) Gimbal and control method therefor, and movable platform
WO2019127344A1 (en) Pan-tilt head reset control method and device, pan-tilt head, and unmanned aerial vehicle
WO2019134154A1 (en) Control method for non-orthogonal tripod head, tripod head thereof, and storage device
WO2020107292A1 (en) Control method for gimbal, gimbal, mobile platform, and computer readable storage medium
WO2020190166A1 (en) Method and system for grasping an object by means of a robotic device
WO2016154996A1 (en) Stabilized platform, follow-up control system thereof and method therefor
WO2018209592A1 (en) Movement control method for robot, robot and controller
US20190035108A1 (en) Control Device for Robot, Robot, Robot System, and Method of Confirming Abnormality Of Robot
WO2020062281A1 (en) Cradle head control method, cradle head, movable platform and readable storage medium
WO2019119455A1 (en) Tripod head calibration method and tripod head device
JP2008183690A (en) Robot control device and system
WO2018191969A1 (en) Camera mount control method and device
WO2020000423A1 (en) Control method for gimbal, gimbal, aerial vehicle, and computer-readable storage medium
WO2018191971A1 (en) Cradle head control method and cradle head
WO2021134644A1 (en) Gimbal control method and gimbal
WO2020062280A1 (en) Control method for gimbal, gimbal, mobile platform and computer readable storage medium
JP2015186834A (en) Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program
JP2017077600A (en) Manipulator device
WO2020179416A1 (en) Robot control device, robot control method, and robot control program
WO2019148394A1 (en) Pan-tilt control method and apparatus, pan-tilt, photographing device and readable storage medium
WO2021243527A1 (en) Gimbal control method, handheld gimbal, and computer-readable storage medium
WO2021134645A1 (en) Gimbal control method and gimbal

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

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

Country of ref document: EP

Kind code of ref document: A1