WO2020181531A1 - Gimbal center of gravity trim method, gimbal, and client - Google Patents

Gimbal center of gravity trim method, gimbal, and client Download PDF

Info

Publication number
WO2020181531A1
WO2020181531A1 PCT/CN2019/078008 CN2019078008W WO2020181531A1 WO 2020181531 A1 WO2020181531 A1 WO 2020181531A1 CN 2019078008 W CN2019078008 W CN 2019078008W WO 2020181531 A1 WO2020181531 A1 WO 2020181531A1
Authority
WO
WIPO (PCT)
Prior art keywords
gravity
center
pan
preset
torque value
Prior art date
Application number
PCT/CN2019/078008
Other languages
French (fr)
Chinese (zh)
Inventor
刘力源
谢文麟
刘帅
Original Assignee
深圳市大疆创新科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to PCT/CN2019/078008 priority Critical patent/WO2020181531A1/en
Priority to CN201980005507.7A priority patent/CN111316029B/en
Publication of WO2020181531A1 publication Critical patent/WO2020181531A1/en

Links

Images

Classifications

    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/043Allowing translations
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/10Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting around a horizontal axis
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/10Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting around a horizontal axis
    • F16M11/105Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting around a horizontal axis the horizontal axis being the roll axis, e.g. for creating a landscape-portrait rotation
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/18Heads with mechanism for moving the apparatus relatively to the stand
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01MTESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
    • G01M1/00Testing static or dynamic balance of machines or structures
    • G01M1/12Static balancing; Determining position of centre of gravity
    • G01M1/122Determining position of centre of gravity

Definitions

  • the invention relates to the field of pan-tilt, in particular to a method for balancing the center of gravity of the pan-tilt, the pan-tilt and a client.
  • pan-tilts In related technologies, most pan-tilts only support loads with known types and ranges, such as cameras and mobile phones, and do not support users to install unknown custom load modules. With the development of pan-tilt technology, some pan-tilts have the function of supporting users to install some unknown custom load modules by themselves, such as educational robot pan-tilts. Many mounting holes are reserved on this type of pan-tilt to support users' freedom Mount a custom load module.
  • the custom load modules that DIY users install on the educational robot's pan/tilt may be water bomb guns, navigation modules, camera modules, searchlights, microphones, or even decorations, which are highly uncertain. If the layout of the custom load module is unreasonable, the center of gravity of the gimbal may be unstable, causing the gimbal to generate additional output in order to resist the gravity moment, which affects the use of the gimbal.
  • the invention provides a method for balancing the center of gravity of a pan/tilt, a pan/tilt and a client.
  • the present invention is implemented through the following technical solutions:
  • a method for balancing the center of gravity of a pan/tilt the pan/tilt is configured to rotate around a pitch axis and/or a roll axis, and the method includes:
  • a prompt signal for instructing to adjust the position of the center of gravity is output.
  • a pan/tilt configured to rotate around a pitch axis and/or a roll axis, and the pan/tilt includes:
  • a controller which is electrically connected to the pitch axis motor and/or the roll axis motor;
  • controller is used for:
  • a prompt signal for instructing to adjust the position of the center of gravity is output.
  • a method for balancing the center of gravity of a pan/tilt comprising:
  • the first trigger signal for center of gravity trim is generated
  • a client is provided, and the client includes:
  • Storage device for storing program instructions
  • the controller calls the program instructions, and when the program instructions are executed, it is used to:
  • the first trigger signal for center of gravity trim is generated
  • the pan/tilt can be triggered to perform center-of-gravity trim.
  • center-of-gravity trim if the center of gravity of the corresponding part of the pan/tilt deviates from the desired center of gravity Position, the center of gravity adjustment plan is given to guide the user to adjust the custom load module mounted on the corresponding part, so that the pan/tilt does not need to generate additional output to resist the gravitational moment when the normal output is maintained in a balanced state.
  • FIG. 1 is a flow chart of the method for balancing the center of gravity of the gimbal in an embodiment of the present invention on the gimbal side;
  • FIG. 2 is a flow chart of the method for balancing the center of gravity of the gimbal in a specific embodiment of the present invention on the gimbal side;
  • 3 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part that rotates around the pitch axis in the pan/tilt head in an embodiment of the present invention is offset from the expected position of the center of gravity in the front-to-rear direction;
  • FIG. 4 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part of the pan-tilt rotating around the roll axis in an embodiment of the present invention is offset from the expected position of the center of gravity in the left-right direction;
  • FIG. 5 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part of the pan/tilt that rotates around the pitch axis in an embodiment of the present invention is offset from the expected position of the center of gravity in the vertical direction;
  • FIG. 6 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part of the pan-tilt that rotates around the roll axis in an embodiment of the present invention is offset from the expected position of the center of gravity in the up and down direction;
  • FIG. 7 is a flow chart of the method for balancing the center of gravity of the gimbal on the gimbal side in another specific embodiment of the present invention.
  • Fig. 8 is a structural block diagram of a pan-tilt in an embodiment of the present invention.
  • FIG. 9 is a flow chart of the method for balancing the center of gravity of the gimbal in an embodiment of the present invention on the gimbal side;
  • Fig. 10 is a structural block diagram of a client in an embodiment of the present invention.
  • the educational robot PTZ can support users to install some unknown custom load modules by themselves. Due to the high uncertainty of the custom load modules, if the layout of the custom load modules mounted on the PTZ is not reasonable enough, it will cause the cloud The center of gravity of the platform is unstable, so that the gimbal needs to generate extra output in order to resist the gravity moment, which affects the use of the gimbal.
  • the present invention uses the user to trigger the pan/tilt to perform center-of-gravity trimming. After the center-of-gravity trim is performed, the pan/tilt can guide the user to the custom load modules mounted on the corresponding part.
  • the load module is adjusted so that the gimbal does not need to generate additional output to resist the gravitational moment when the normal output of the gimbal is kept in balance, reducing the power consumption of the gimbal and reducing the heat of the gimbal, which can protect the gimbal and greatly It reduces the risk of scalding users, and can also ensure that the gimbal has enough output for stabilization, greatly avoiding the degradation of disturbance suppression performance caused by output saturation; at the same time, the user experience is expanded, so that custom load modules can also be used in the cloud Normal use on stage.
  • the pan/tilt head of the embodiment of the present invention is configured to rotate around a pitch axis and/or a roll axis.
  • the gimbal is a single-axis gimbal, and the gimbal is configured to rotate around a pitch axis or a roll axis.
  • the gimbal is a two-axis gimbal, the gimbal is configured to rotate around the pitch axis and roll axis, or the gimbal is configured to rotate around the pitch axis and yaw axis, or the gimbal is configured to roll around The axis and the yaw axis rotate.
  • the gimbal is a three-axis gimbal, and the gimbal is configured to rotate around the pitch axis, roll axis, and yaw axis.
  • the pan/tilt can also be other multi-axis pan/tilt, which are not listed here.
  • the pan-tilt in the embodiment of the present invention may be a pan-tilt mounted on a mobile device, or a handheld pan-tilt.
  • the mobile device can be a mobile car, an unmanned aerial vehicle, or other devices with mobile functions.
  • FIG. 1 is a flow chart of the method for balancing the center of gravity of the gimbal in an embodiment of the present invention on the gimbal side. It should be noted that the method for balancing the center of gravity of the pan/tilt in the first embodiment of the present invention is executed by the pan/tilt. As shown in FIG. 1, the method for balancing the center of gravity of the pan/tilt in the first embodiment of the present invention may include the following steps:
  • S101 Upon receiving the first trigger signal for center of gravity trimming, detect whether the position of the center of gravity of the corresponding part of the pan/tilt head deviates from the expected position of the center of gravity;
  • the first trigger signal is used to instruct the pan/tilt head to perform center-of-gravity trim.
  • the pan/tilt in this embodiment will perform center-of-gravity trim after receiving the first trigger signal.
  • the first trigger signal is generated by the pan/tilt.
  • the pan/tilt may generate the first trigger signal by operating keys/buttons on the pan/tilt.
  • the first trigger signal is sent by an external device.
  • the external device can be a remote control device or a control terminal that controls the pan/tilt.
  • the control terminal can be a mobile terminal such as a mobile phone or a Pad, or other terminal devices.
  • the user can also trigger the pan-tilt to perform center-of-gravity trimming in other ways, such as touch, gestures, and voice.
  • the inner frame is a frame that rotates around the pitch axis
  • the middle frame is a frame that rotates around the roll axis
  • the outer frame is a frame around the yaw axis.
  • Rotating frame In an ideal state, the overall center of gravity of the gimbal (that is, the overall center of gravity composed of the outer frame, middle frame, inner frame and the load carried on the inner frame) is the position of the intersection of the pitch axis, roll axis and yaw axis.
  • the pitch axis and roll axis hardly need to resist the gravitational moment, the output value of the pitch axis and the roll axis is extremely small, and the average value is close to zero, that is, the gimbal does not need to generate additional output to resist the gravitational moment.
  • the gimbal is actually used, when the distance between the center of gravity of the gimbal and the intersection point is small, the extra output generated by the gimbal to resist the gravitational moment is also small, and the extra output will not affect the normal use of the gimbal.
  • the distance between the center of gravity of the gimbal and the intersection point can be set to be small enough to meet the normal use requirements of the gimbal. Therefore, the desired center of gravity position can be a certain distance from the intersection position.
  • the corresponding part when the pan/tilt is configured to rotate around the pitch axis, the corresponding part includes a part of the pan/tilt that rotates around the pitch axis, and it is desirable that the distance between the center of gravity position and the pitch axis is not greater than the first preset distance.
  • the part of the gimbal that rotates around the pitch axis includes the inner frame and the load mounted on the inner frame.
  • the distance between the desired center of gravity position and the pitch axis is the vertical distance from the desired center of gravity position to the pitch axis.
  • a preset distance can be set as required, such as 0.5cm, so that the extra output generated by the pan/tilt is small.
  • the corresponding part when the pan/tilt is configured to rotate around the roll axis, the corresponding part includes a part of the pan/tilt that rotates around the roll axis, and it is expected that the distance between the center of gravity position and the roll axis is not greater than the second preset distance.
  • the part of the pan/tilt that rotates around the roll axis includes the middle frame, the inner frame and the load carried on the inner frame.
  • the distance between the desired center of gravity and the roll axis is the distance from the desired center of gravity to the roll axis. vertical distance.
  • the second preset distance can be set as required, such as 0.5 cm, so that the extra output generated by the pan/tilt head is small.
  • the position of the center of gravity deviates from the desired center of gravity position including one or more of the following situations: the position of the center of gravity is deviated from the desired center of gravity position in the front and rear direction, the position of the center of gravity is deviated from the desired center of gravity position in the left-right direction, and the center of gravity position is up and down. The direction is offset from the desired center of gravity position.
  • the side of the pan/tilt facing the user is the front, and the side facing away from the user is the rear;
  • the side of the pan/tilt facing the left is the left, and the side of the pan/tilt facing the right is the right;
  • the direction of gravity of the gimbal is downward, and the opposite direction of the direction of gravity of the gimbal is upward.
  • the corresponding part is the part of the gimbal that rotates around the pitch axis
  • it can be detected whether the position of the center of gravity of the part of the gimbal that rotates around the pitch axis is offset from the expected center of gravity position in the front-to-back direction and/or up and down direction; when the corresponding part is in the gimbal
  • the part that rotates around the roll axis it can be detected whether the position of the center of gravity of the part that rotates around the roll axis in the pan/tilt head is offset from the desired center of gravity position in the left-right direction and/or up-down direction.
  • This embodiment detects whether the center of gravity position of the corresponding part of the pan/tilt platform deviates from the desired center of gravity position according to the type of the pan/tilt platform and actual requirements. For example, in some of the embodiments, it is only detected whether the center of gravity position of the corresponding part of the pan/tilt head is offset from the desired center of gravity position in the up and down direction, such as detecting the part of the pan/tilt head that rotates around the pitch axis and/or the pan/tilt head rotates around the roll axis. Whether the position of the center of gravity of the part in the vertical direction is offset from the desired position of the center of gravity.
  • the method of detecting whether the center of gravity position of the corresponding part of the pan/tilt head deviates from the desired center of gravity position can be selected according to needs, see Figure 2.
  • the process of detecting whether the center of gravity position of the corresponding part of the pan/tilt head deviates from the desired center of gravity position may include the following step:
  • S201 Control the pan/tilt to rotate so that the corresponding part of the pan/tilt is at at least one preset position
  • the preset position includes the target position and/or other positions.
  • the target position may be the position of the corresponding part when the center of gravity position of the historical record is at the desired center of gravity position, or the position of the pan/tilt when returning to the center (that is, the position of the corresponding portion when the pan/tilt is returning to the center).
  • the preset position may include one or more, for example, detecting whether the center of gravity position of the corresponding part of the pan/tilt head is offset from the expected center of gravity position in the front and rear direction and/or detecting whether the center of gravity position of the corresponding part of the pan/tilt head is in the left-right direction and the expected center of gravity When the position is offset, the preset position includes one.
  • the preset position when detecting whether the center of gravity position of the part that rotates around the pitch axis in the pan/tilt head is offset from the expected center of gravity position in the front and back direction, the preset position is the first preset position; when detecting whether the center of gravity position of the corresponding part of the pan/tilt head is on the left and right When the direction is offset from the desired center of gravity position, the preset position is the second preset position.
  • the first preset position and the second preset position may be the same position, for example, the first preset position and the second preset position are both target positions. Of course, the first preset position and the second preset position may also be different positions.
  • the preset positions include 3, such as detecting whether the center of gravity of the part that rotates around the pitch axis in the pan/tilt is in the vertical direction and the desired center of gravity.
  • the preset position includes the third preset position, the fourth preset position and the target position; whether the center of gravity position of the part that rotates around the roll axis in the detection platform is offset from the expected center of gravity position in the up and down direction
  • the preset position includes the fifth preset position, the sixth preset position and the target position.
  • S202 Detect whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position.
  • the corresponding part is the part of the gimbal that rotates around the pitch axis
  • the corresponding part is the part of the pan/tilt that rotates around the roll axis
  • Move and/or detect whether the center of gravity position when the part of the pan/tilt rotating around the roll axis is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction.
  • S202 may include the following steps:
  • the specific position is the first preset position. In this step, it is necessary to obtain the first torque value output by the pitch axis motor when the part of the gimbal that rotates around the pitch axis is at the first preset position.
  • the specific position is the second preset position. In this step, it is necessary to obtain the second torque value output by the roll axis motor when the part of the pan/tilt that rotates around the roll axis is at the second preset position.
  • the specific position includes the third preset position and the fourth preset position.
  • This step needs to obtain the third torque value output by the pitch axis motor when the part of the gimbal that rotates around the pitch axis is at the third preset position, and the pitch axis motor when the part of the gimbal that rotates around the pitch axis is at the fourth preset position The output fourth torque value.
  • the specific position includes the fifth preset position and the sixth preset position. Preset location. This step needs to obtain the fifth torque value output by the roll axis motor when the part of the pan/tilt rotating around the roll axis is at the fifth preset position, and when the part of the pan/tilt rotating around the roll axis is at the sixth preset position, The sixth torque value output by the roll axis motor.
  • the method further includes: determining the pitch axis motor and/or Or the torque value output by the roll axis motor converges to ensure the accuracy of the torque value obtained, thereby improving the accuracy of the center of gravity of the gimbal.
  • the process of determining the torque value output by the pitch axis motor and/or roll axis motor converges Including: determining the variance of multiple torque values output by the pitch axis motor and/or roll axis motor in a specific time period; and determining the convergence of the torque values output by the pitch axis motor and/or roll axis motor according to the variance.
  • the preset variance threshold can be set as required, such as 0.5, 0.6 or other values.
  • the process of determining the convergence of the torque value output by the pitch axis motor and/or the roll axis motor includes: determining the pitch axis when the duration of the corresponding part at at least one preset position is greater than or equal to the preset duration
  • the output torque value of the motor and/or roll axis motor converges.
  • the duration of the corresponding part being at the at least one preset position is greater than or equal to the preset time length to ensure that the corresponding part is stably at the at least one preset position, thereby ensuring the accuracy of the torque value.
  • the preset duration can be set as required, such as 5 seconds, 10 seconds or other durations.
  • the torque value output by the pitch axis motor and/or the roll axis motor is: a value obtained after smooth filtering of multiple torque values output by the pitch axis motor and/or roll axis motor in a specific period of time, In order to eliminate the influence of noise on the torque value, ensure the accuracy of the torque value, thereby improving the accuracy of the center of gravity of the gimbal.
  • the pitch axis and/or roll axis of the gimbal will output a continuous and constant torque value in order to resist the moment of gravity, so it can be based on the pitch axis and/or horizontal
  • the torque value output by the roller is used to calculate the current trim situation of the gimbal.
  • the pan/tilt is configured to rotate around the pitch axis, and the pan/tilt in this embodiment includes a pitch axis motor .
  • the corresponding part refers to the part of the pan/tilt that rotates around the pitch axis.
  • the specific position is the first preset position, and the aforementioned torque value may include: the first torque value output by the pitch axis motor when the corresponding part is at the first preset position.
  • the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position includes: according to the first torque value, detecting whether the center of gravity position when the corresponding part is at the first preset position There is an offset from the desired center of gravity in the front and rear direction.
  • the implementation of detecting whether the center of gravity position of the corresponding part is at the first preset position is offset from the expected center of gravity position in the front-to-rear direction may include the following two implementations:
  • the pitch axis to the center of gravity position that is, the part of the pan/tilt that rotates around the pitch axis is in the first preset position.
  • the line direction and the horizontal direction of the distance along the line form the first included angle ⁇ 1 .
  • the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: first determining the angle of the first included angle according to the first torque value Range and/or the cosine value of the first included angle; then according to the angle range of the first included angle and/or the cosine value of the first included angle, it is detected whether the position of the center of gravity when the corresponding part is at the first preset position is in the front and rear direction. It is expected that there is an offset in the position of the center of gravity.
  • the first strategy can be set according to the use requirements of the pan/tilt.
  • the cosine of the first included angle is positive, it is determined that the position of the center of gravity is forward relative to the desired center of gravity; when the cosine of the first included angle is When the value is negative, it is determined that the position of the center of gravity is behind the expected position of the center of gravity.
  • the angle range of the first included angle when the angle range of the first included angle is within the first preset angle range, it is determined that the position of the center of gravity is forward relative to the desired center of gravity position; when the angle range of the first included angle is within the second preset angle range , Make sure that the center of gravity is behind the desired center of gravity.
  • the first strategy is not limited to the manners listed in the foregoing embodiment, and may be set in other manners.
  • position 1 is the position of the center of gravity when the part of the gimbal that rotates around the pitch axis is at the first preset position
  • ⁇ 1 is the first angle formed between the line direction and the horizontal direction of the distance from the pitch axis to the center of gravity position
  • T 1 is When the corresponding part is in the first preset position, the first torque value output by the pitch axis motor
  • m is the mass of the corresponding part
  • g is the acceleration of gravity
  • d is the distance from the pitch axis to the center of gravity
  • the hour hand is positive.
  • Figure 3 taking the desired center of gravity position as the origin, and the horizontal and vertical planes as references, the pan/tilt section is divided into four quadrant blocks.
  • the first torque value T 1 and the first included angle ⁇ 1 satisfy the following formula (1):
  • T 1 mg ⁇ d ⁇ cos ⁇ 1 (1)
  • the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant I or quadrant IV shown in Figure 3, and the gimbal rotates around the pitch axis
  • the position of the center of gravity of the part is forward relative to the expected center of gravity; when 90 degrees ⁇ 1 ⁇ 270 degrees, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant II or quadrant III as shown in Figure 3.
  • the position of the center of gravity of the part rotating around the pitch axis is offset from the desired position of the center of gravity.
  • the center of gravity position when the corresponding part is at the first preset position is offset from the expected center of gravity position in the front-to-rear direction .
  • the first torque value T 1 is greater than the first preset torque value, it is determined that the position of the center of gravity is forward relative to the desired center of gravity position; when the first torque value T 1 is less than the opposite of the first preset torque value, Make sure that the center of gravity is behind the desired center of gravity.
  • the first preset torque value can be set according to needs, for example, the first preset torque value can be 5N ⁇ m 2 , when T 1 >5N ⁇ m 2 , it is determined that the center of gravity position is forward relative to the desired center of gravity position; When T 1 ⁇ -5N ⁇ m 2 , it is determined that the position of the center of gravity is behind the expected position of the center of gravity.
  • the pan/tilt is configured to rotate about the roll axis, and the pan/tilt in this embodiment includes a horizontal Roller motor.
  • the corresponding part refers to the part of the pan/tilt that rotates around the roll axis.
  • the specific position is the second preset position
  • the aforementioned torque value includes: the second torque value output by the roll axis motor when the corresponding part is at the second preset position.
  • the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: detecting that the corresponding part is at the second preset according to the second torque value Whether the position of the center of gravity is offset from the desired center of gravity in the left-right direction.
  • the implementation of detecting whether the center of gravity position of the corresponding part is at the second preset position is offset from the expected center of gravity position in the left-right direction may include the following two implementations:
  • the process of detecting whether the center of gravity position of the corresponding part is at the second preset position is offset from the expected center of gravity position in the left and right direction may include: first determining the second torque value according to the second torque value.
  • the angle range of the included angle and/or the cosine value of the second included angle is detected whether the center of gravity position when the corresponding part is at the second preset position There is an offset from the desired center of gravity in the left and right direction.
  • the second strategy can be set according to the use requirements of the pan/tilt.
  • the cosine of the second included angle is positive, it is determined that the position of the center of gravity is to the right of the desired center of gravity; when the cosine of the second included angle is When the value is negative, it is determined that the position of the center of gravity is to the left relative to the expected position of the center of gravity.
  • the angle range of the second included angle when the angle range of the second included angle is within the third preset angle range, it is determined that the position of the center of gravity is off to the right with respect to the desired center of gravity position; when the angle range of the second included angle is within the fourth preset angle range , Make sure that the center of gravity is to the left relative to the desired center of gravity.
  • the second strategy is not limited to the manners listed in the foregoing embodiment, and may be set in other manners.
  • position 2 is the position of the center of gravity when the part of the pan/tilt that rotates around the roll axis is in the second preset position
  • ⁇ 2 is the second included angle formed by the line direction and the horizontal direction of the distance from the roll axis to the center of gravity
  • T 2 is the second torque value output by the roll axis motor when the corresponding part is in the second preset position
  • m is the mass of the corresponding part
  • g is the acceleration of gravity
  • d is the distance from the roll axis to the center of gravity.
  • the direction of rotation is positive counterclockwise.
  • the second torque value T 2 and the second included angle ⁇ 2 satisfy the following formula (2):
  • the center of gravity of the part of the gimbal that rotates around the roll axis is located in the quadrant I or IV shown in Figure 4, and the gimbal rolls around The position of the center of gravity of the part of the axis rotation is offset to the right of the desired position of the center of gravity; when 90 degrees ⁇ 2 ⁇ 270 degrees, the center of gravity of the part of the gimbal that rotates around the roll axis is located in quadrant II or quadrant III as shown in Figure 4 , The center of gravity of the part of the pan/tilt that rotates around the roll axis is leftward relative to the desired center of gravity.
  • the second preset torque value can be set according to needs.
  • the second preset torque value can be 3N ⁇ m 2.
  • T 1 >3N ⁇ m 2 it is determined that the center of gravity position is to the right relative to the desired center of gravity position;
  • T 1 ⁇ -3N ⁇ m 2 it is determined that the center of gravity position is to the left relative to the desired center of gravity position.
  • the pan/tilt includes a pitch axis motor, and the corresponding part in this embodiment refers to the tilt axis in the pan/tilt.
  • the rotating part includes the third preset position and the fourth preset position
  • the torque value includes: when the corresponding part is at the third preset position, the third torque value output by the pitch axis motor, and the corresponding part is at the fourth preset position When, the fourth torque value output by the pitch axis motor.
  • the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: detecting the corresponding part according to the third torque value and the fourth torque value Whether the center of gravity position at the target position in at least one preset position is offset from the desired center of gravity position in the up and down direction.
  • the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the third preset position and the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the fourth preset position have a fixed size.
  • the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the third preset position, and the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the fourth preset position is greater than 0 degrees If it is less than 180 degrees, the included angle can be 20 degrees, 30 degrees, 40 degrees, or other angles greater than 0 degrees and less than 180 degrees.
  • the distance along the line from the pitch axis to the center of gravity position when the corresponding part is at the third preset position (that is, the center of gravity position when the part of the gimbal that rotates around the pitch axis is at the third preset position) It forms a third angle ⁇ 3 along the line with the distance from the pitch axis to the center of gravity when the corresponding part is at the target position; when the corresponding part is at the fourth preset position, the pitch axis to the center of gravity position (that is, the part of the gimbal that rotates around the pitch axis is at The distance along the line direction of the center of gravity position at the fourth preset position and the distance along the line direction of the pitch axis to the center of gravity position when the corresponding part is at the target position form a third included angle forming a fourth included angle ⁇ 4 .
  • the third included angle ⁇ 3 and the fourth included angle ⁇ 4 are equal in magnitude.
  • the third preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the first preset angle in the first direction; the fourth preset position is: when the corresponding part is in the first In the case of three preset positions, the position of the corresponding part is rotated around the second direction twice the size of the first preset included angle.
  • the third preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the first preset angle around the first direction; the fourth preset position is: when the corresponding part is at At the target position, the position of the corresponding part after rotating the first preset angle in the second direction.
  • the first direction and the second direction are two opposite directions. When the first direction is counterclockwise, the second direction is clockwise; when the first direction is clockwise, the second direction is Counterclockwise. Specifically, in the embodiment shown in FIG. 5, the first direction is a counterclockwise direction, and the second direction is a clockwise direction.
  • the size of the first preset included angle can be set as required.
  • the first preset included angle in this embodiment is greater than 0 degrees and less than 90 degrees.
  • the first preset included angle may be 10 degrees, 15 degrees, and 20 degrees. , 30 degrees or other angles greater than 0 degrees and less than 90 degrees.
  • the line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is in the third preset position may coincide with the line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the target position, or the corresponding part is in the first position.
  • the along-line direction of the distance from the pitch axis to the center of gravity position at the four preset positions may coincide with the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the target position.
  • detecting whether the center of gravity position of the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction may include the following two implementations:
  • the distance from the pitch axis to the center of gravity position forms a fifth included angle with the horizontal direction. ⁇ 5 .
  • the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction may include: The third torque value and the fourth torque value determine the angle range of the fifth included angle and/or the sine value of the fifth included angle; according to the angle range of the fifth included angle and/or the sine value of the fifth included angle, detect the corresponding Whether the center of gravity position when part of the target position is in at least one preset position is offset from the expected center of gravity position in the up and down direction.
  • the third strategy can be set according to the use requirements of the PTZ.
  • the sine of the fifth included angle is positive, it is determined that the position of the center of gravity is higher than the expected position of the center of gravity; when the sine of the fifth included angle is When the value is negative, it is determined that the position of the center of gravity is lower than the expected position of the center of gravity.
  • the angle range of the fifth included angle when the angle range of the fifth included angle is within the fifth preset angle range, it is determined that the position of the center of gravity is higher than the expected position of the center of gravity; when the angle range of the fifth included angle is within the sixth preset angle range , Make sure that the center of gravity position is lower than the desired center of gravity position.
  • the third strategy is not limited to the manners listed in the foregoing embodiment, and may be set in other manners.
  • position 3 is the center of gravity when the part of the gimbal that rotates around the pitch axis is at the third preset position
  • position 4 is the position of the center of gravity when the part of the gimbal that rotates around the pitch axis is at the fourth preset position
  • ⁇ 3 is the corresponding The third angle formed by the distance along the line from the pitch axis to the center of gravity when the part is in the third preset position and the distance along the line from the pitch axis to the center of gravity when the corresponding part is at the target position
  • ⁇ 4 is the fourth The fourth angle formed by the distance along the line from the pitch axis to the center of gravity at the preset position and the distance from the pitch axis to the center of gravity when the corresponding part is at the target position.
  • ⁇ 5 is the pitch axis when the corresponding part is at the target position.
  • T 3 is the third angle output by the pitch axis motor when the corresponding part is at the third preset position.
  • Torque value, T 4 is the fourth torque value output by the pitch axis motor when the corresponding part is in the fourth preset position
  • m is the mass of the corresponding part
  • g is the acceleration of gravity
  • d is the distance from the pitch axis to the center of gravity
  • set The direction of rotation of the gimbal is positive counterclockwise.
  • the pan/tilt section is divided into four quadrant blocks.
  • the third torque value T 3 and the fifth angle ⁇ 5 and the fourth torque value T 4 and the fifth angle ⁇ 5 satisfy the following formula (3):
  • T 4 -T 3 2mg ⁇ d ⁇ sin ⁇ 1 ⁇ sin ⁇ 5 (4)
  • T 3 , T 4 , m, g, d and ⁇ 1 are all known, it can be known from formula (4) that when sin ⁇ 5 > 0, the center of gravity of the part of the gimbal that rotates around the pitch axis is located as shown in Figure 5 In the quadrant I or quadrant II, the center of gravity is determined to be higher than the desired center of gravity; when sin ⁇ 5 ⁇ 0, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in the quadrant III or quadrant IV shown in Figure 5. Make sure that the center of gravity is lower than the desired center of gravity.
  • the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant I or quadrant II as shown in Figure 5. It is determined that the center of gravity position is higher than the expected center of gravity position; when 180 degrees ⁇ When ⁇ 5 ⁇ 360 degrees, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant III or quadrant IV shown in Figure 5, and the center of gravity is determined to be lower than the desired center of gravity.
  • the third preset torque value can be set according to needs, for example, the third preset torque value can be 8N ⁇ m 2 , when T 3 -T 4 >8N ⁇ m 2 , it is determined that the center of gravity position is deviated from the desired center of gravity position Down; When T 3 -T 4 ⁇ -8N ⁇ m 2 , it is determined that the center of gravity position is higher than the expected center of gravity position.
  • the pan/tilt head includes a roll axis motor, and the corresponding part in this embodiment refers to The part where the roll axis turns.
  • the specific position includes the fifth preset position and the sixth preset position
  • the torque value includes: when the corresponding part is at the fifth preset position, the fifth torque value output by the roll axis motor, and the corresponding part is at the sixth preset position Position, the sixth torque value output by the roll axis.
  • the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: detecting the corresponding part according to the fifth torque value and the sixth torque value Whether the center of gravity position at the target position in at least one preset position is offset from the desired center of gravity position in the up and down direction.
  • the distance along the line from the roll axis to the center of gravity position is fixed in size with the distance from the roll axis to the center of gravity position when the corresponding part is at the sixth preset position.
  • the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the fifth preset position and the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the sixth preset position is greater than 0 degrees and less than 180 degrees
  • the included angle can be 20 degrees, 30 degrees, 40 degrees, or other angles greater than 0 degrees and less than 180 degrees.
  • the distance from the roll axis to the center of gravity position (that is, the center of gravity position when the part of the pan/tilt that rotates around the roll axis is at the fifth preset position)
  • the distance along the line from the roll axis to the center of gravity forms a sixth included angle ⁇ 6
  • the roll axis to the center of gravity position ie The distance along the line direction of the distance of the part that the pitch axis rotates at the sixth preset position and the distance along the line from the roll axis to the center of gravity position when the corresponding part is at the target position forms a seventh included angle ⁇ 7 .
  • the sixth included angle ⁇ 6 and the seventh included angle ⁇ 7 are equal in magnitude.
  • the fifth preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the second preset angle around the third direction; the sixth preset position is: when the corresponding part is in the first When the preset position is five, the position of the corresponding part is rotated around the fourth direction by twice the second preset included angle.
  • the fifth preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the second preset angle around the third direction; the sixth preset position is: when the corresponding part is at At the target position, the position of the corresponding part after rotating the second preset angle in the fourth direction.
  • the third direction and the fourth direction are two opposite directions.
  • the fourth direction is clockwise; when the third direction is clockwise, the fourth direction is Counterclockwise.
  • the third direction is a counterclockwise direction, and the fourth direction is a clockwise direction.
  • the size of the second preset included angle can be set as required.
  • the second preset included angle of this embodiment is greater than 0 degrees and less than 90 degrees.
  • the first preset included angle may be 10 degrees, 15 degrees, and 20 degrees. , 30 degrees or other angles greater than 0 degrees and less than 90 degrees.
  • the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the fifth preset position may coincide with the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the target position, or the corresponding part
  • the line direction of the distance from the roll axis to the center of gravity position at the sixth preset position may coincide with the line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the target position.
  • the implementation of detecting whether the center of gravity position of the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the vertical direction may include the following two implementation methods:
  • the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction may include: The fifth torque value and the sixth torque value determine the angle range of the eighth included angle and/or the sine value of the eighth included angle; detect the corresponding angle range and/or the sine value of the eighth included angle Whether the center of gravity position when part of the target position is in at least one preset position is offset from the expected center of gravity position in the front-to-back direction.
  • the fourth strategy can be set according to the use requirements of the PTZ.
  • the sine of the eighth included angle is positive, it is determined that the position of the center of gravity is higher than the expected position of the center of gravity; when the sine of the eighth included angle is When the value is negative, it is determined that the position of the center of gravity is lower than the expected position of the center of gravity.
  • angle range of the eighth included angle when the angle range of the eighth included angle is within the seventh preset angle range, it is determined that the position of the center of gravity is offset relative to the desired center of gravity position; when the angle range of the eighth included angle is within the eighth preset angle range , Make sure that the center of gravity position is lower than the desired center of gravity position.
  • position 5 is the center of gravity position when the part of the pan/tilt rotating around the roll axis is at the fifth preset position
  • position 6 is the position of the center of gravity when the part rotating around the roll axis of the gimbal is at the sixth preset position
  • ⁇ 6 It is the sixth included angle formed along the line of the distance from the roll axis to the center of gravity when the corresponding part is at the fifth preset position and the distance from the roll axis to the center of gravity when the corresponding part is at the target position.
  • ⁇ 7 is the corresponding sixth predetermined cross-section when in the position to seventh roll to roll axis direction along an angle from the center of gravity of the respective portions formed when the target position in the direction of the line from the center of gravity position, ⁇ 8 is located in a respective portion when the target position, the position of the center of gravity to the roll axis (i.e., center of gravity position in a corresponding portion of the target position) and an eighth angle along the horizontal direction is formed from a, T 5 in a fifth predetermined position corresponding moiety,
  • the fifth torque value output by the roll axis motor, T 6 is the sixth torque value output by the roll axis motor when the corresponding part is at the sixth preset position, m is the mass of the corresponding part, g is the acceleration due to gravity, and d is the horizontal
  • the direction of rotation of the gimbal is positive counterclockwise.
  • the PTZ section is divided into four quadrant blocks with the
  • T 6 -T 5 2mg ⁇ d ⁇ sin ⁇ 2 ⁇ sin ⁇ 8 (6)
  • T 5 , T 6 , m, g, d, and ⁇ 2 are all known, it can be seen from formula (6) that when sin ⁇ 8 > 0, the center of gravity of the part of the pan/tilt that rotates around the roll axis is located in Figure 6 In the quadrant I or quadrant II shown, the center of gravity is determined to be higher than the expected center of gravity; when sin ⁇ 8 ⁇ 0, the center of gravity of the part of the pan/tilt that rotates around the roll axis is located in the quadrant III or quadrant IV shown in Figure 6 , Confirm that the center of gravity position is lower than the desired center of gravity position.
  • the center of gravity of the part of the gimbal that rotates around the roll axis is located in quadrant I or quadrant II as shown in Figure 6. It is determined that the center of gravity position is higher than the expected center of gravity position; when 180 degrees When ⁇ 8 ⁇ 360 degrees, the center of gravity of the part of the pan/tilt that rotates around the roll axis is located in quadrant III or quadrant IV shown in Figure 6, and the center of gravity is determined to be lower than the desired center of gravity.
  • the fourth preset torque value can be set according to needs.
  • the fourth preset torque value can be 6N ⁇ m 2 , when T 5 -T 6 >6N ⁇ m 2 , it is determined that the center of gravity position is deviated from the expected center of gravity position Down; When T 5 -T 6 ⁇ -6N ⁇ m 2 , it is determined that the position of the center of gravity is higher than the expected position of the center of gravity.
  • the prompt signal in S102 carries the offset information of the position of the center of gravity to guide the user to adjust the installation position of the load installed in the corresponding part.
  • the offset information may include: offset direction and/or offset amount.
  • the part of the pan/tilt that rotates around the roll axis reserves multiple mounting parts, such as mounting holes, for users to install custom loads.
  • the plurality of mounting parts includes a plurality of first mounting parts arranged at intervals in the front-rear direction, and a plurality of second mounting parts arranged at intervals in the up-down direction.
  • the offset information in the prompt signal is used to indicate that the center of gravity of the part of the gimbal that rotates around the roll axis is forward, the user can install the load on the first installation part behind the current installation position of the load; when the prompt signal The offset information is used to indicate that when the center of gravity of the part of the gimbal that rotates around the roll axis is lower, the user can install the load on the second installation part above the current installation position of the load, and finally make the gimbal around the roll axis The position of the center of gravity of the rotated part coincides with the position of the desired center of gravity.
  • the interval between adjacent first mounting parts is such as 0.1cm, 0.2cm, 0.3cm, 0.4cm, 0.5cm, 0.6cm, 0.7cm, 0.8cm, 0.9cm or 1cm, and the distance between adjacent second mounting parts Intervals such as 0.1 cm, 0.2 cm, 0.3 cm, 0.4 cm, 0.5 cm, 0.6 cm, 0.7 cm, 0.8 cm, 0.9 cm or 1 cm.
  • the offset information in the prompt signal is used to indicate that the center of gravity of the part of the gimbal that rotates around the roll axis is forward, such as 0.1cm
  • the user can install the load on the first installation part behind the current installation position of the load Up
  • the offset information in the prompt signal is used to indicate that the center of gravity of the part of the gimbal that rotates around the roll axis is lower than 0.2cm
  • the user can install the load on the second installation above the current installation position of the load
  • the center of gravity of the part of the pan/tilt that rotates around the roll axis will coincide with the desired center of gravity.
  • the pan-tilt may use different ways to output the prompt signal.
  • a prompt signal for indicating adjustment of the center of gravity position is sent to the client, and the client can communicate with the pan-tilt.
  • the client can be a mobile terminal such as a mobile phone, a Pad, or other terminal equipment.
  • the pan-tilt includes a prompt module.
  • the prompt module outputs a prompt signal for indicating adjustment of the center of gravity position.
  • the prompt module can be a display screen, a voice module or others.
  • the gimbal before the gimbal balances the center of gravity, it needs to detect whether the load currently carried by the gimbal exceeds the upper limit of the load. If the load exceeds the upper limit, the center of gravity balance is not allowed to prevent the gimbal from being damaged by the excessive load.
  • the first trigger signal is obtained by the pan/tilt after determining that the load currently carried by the pan/tilt is within the preset load range of the pan/tilt, the first trigger signal is considered to be a valid trigger signal; if the first trigger signal is If the pan/tilt is obtained when it is determined that the load size currently carried by the pan/tilt exceeds the preset load size range of the pan/tilt, the first trigger signal is considered to be an invalid trigger signal. In this embodiment, the pan/tilt will perform center of gravity trimming only after receiving a valid trigger signal.
  • the gimbal includes a motor.
  • the motors correspondingly include: pitch axis motor, roll axis motor, and yaw axis.
  • Pan axis motor when the gimbal is configured as a two-axis gimbal that rotates around the pitch axis and roll axis, the corresponding motors include: pitch axis motor and roll axis motor; when the gimbal is configured to rotate around the pitch axis and yaw
  • the corresponding motors include: pitch axis motor and yaw axis motor; when the gimbal is configured as a two-axis gimbal that rotates around the roll axis and yaw axis, the corresponding motors include: roll Axis motor and yaw axis motor; when the gimbal is configured as a single-axis gimbal that rotates around the pitch axis or roll axis, the corresponding motors include: pitch axis motor or roll axis motor; and so on.
  • the motor of this embodiment is used to drive the pan/tilt to rotate.
  • the corresponding motor of this embodiment is used to drive the corresponding part of the pan/tilt to rotate.
  • the motor corresponding to the inner frame is used to drive the inner frame and the load carried by the inner frame. Rotate.
  • the load carried on the pan/tilt may include common load on the pan/tilt, such as an imaging device, or a custom load module installed by the user, or both of the above, which are not specifically limited here.
  • J J 0 +m*d 2
  • d is the distance from the center of gravity of the load to the shaft of the motor
  • m is the load mass
  • J 0 is the moment of inertia of the motor when the center of gravity of the load is set on the shaft. Therefore, by setting the preset inertia threshold and comparing the rotational inertia of the gimbal motor with the preset inertia threshold, it can be determined that the load currently carried by the gimbal is within the preset load range of the gimbal.
  • the process of determining that the load size currently carried by the pan/tilt is within the preset load size range of the pan/tilt may include:
  • the second trigger signal is used to instruct the pan/tilt to perform load evaluation.
  • the pan/tilt in this embodiment performs load evaluation after receiving the second trigger signal.
  • the second trigger signal is generated by the pan-tilt.
  • the pan-tilt can generate the second trigger signal by operating keys/buttons on the pan-tilt.
  • the second trigger signal is sent by an external device.
  • the external device may be a remote control device or a control terminal that controls the pan/tilt.
  • the control terminal may be a mobile terminal such as a mobile phone or a Pad, or other terminal devices.
  • the user can also trigger the pan-tilt to perform center-of-gravity trimming in other ways, such as touch, gestures, and voice.
  • the output torque of the gimbal motor and the angular acceleration of the motor can be detected by corresponding sensors, and can also be determined according to the input signal that controls the rotation of the motor.
  • the method of determining the output torque of the gimbal motor and the angular acceleration of the motor is the prior art. More details.
  • the load is a user-defined load module installed by the user
  • only the user-defined load module can be acquired.
  • the output torque and angular acceleration of the motor that the load module rotates For example, when the pitch axis motor drives the inner frame of the gimbal to rotate, but the custom load module is installed on the middle frame of the gimbal driven by the roll axis motor, only the output torque and angular acceleration of the roll axis motor can be obtained.
  • This step is to determine the moment of inertia of the corresponding shaft motor according to the output torque of the corresponding shaft motor and the angular acceleration of the corresponding shaft motor. This step needs to determine the moment of inertia of the pitch axis motor and/or roll axis motor.
  • T is the output torque of the motor
  • is the angular acceleration of the motor
  • formula for calculating the moment of inertia J of the motor is not limited to formula (7), and may also be a modification based on formula (7).
  • the moment of inertia being less than or equal to the preset inertia threshold includes: the moment of inertia of the pitch axis motor and/or the roll axis motor determined in step (2) is less than or equal to the corresponding preset inertia threshold.
  • that the moment of inertia is less than or equal to the preset inertia threshold includes: the moment of inertia of the pitch axis motor is less than or equal to the first preset inertia threshold, and/or the moment of inertia of the roll axis motor is less than or equal to the second Preset inertia threshold.
  • the size of the first preset inertia threshold and the second preset inertia threshold may be equal or unequal, and the sizes of the first preset inertia threshold and the second preset inertia threshold may be set according to the specific structure.
  • the preset inertia threshold can be set according to the angular acceleration demand of the load.
  • the method for balancing the center of gravity of the gimbal in this embodiment may further include: when the moment of inertia is greater than the preset inertia threshold, it is determined that the load currently carried by the gimbal is too large, and the user needs to be prompted to reduce the load to protect the gimbal and prevent The gimbal is damaged.
  • the method for balancing the center of gravity of the gimbal may further include: outputting an evaluation result for the second trigger signal.
  • the evaluation results include: the current load of the pan/tilt is within the preset load range of the pan/tilt, or the load currently mounted on the pan/tilt is too large.
  • the evaluation result is that the current load of the gimbal is within the preset load range of the gimbal, remind the user that the gimbal can be triggered to perform center-of-gravity trim; when the evaluation result is that the current load of the gimbal is too large, remind the user Reduce the load to protect the gimbal.
  • the pan-tilt can use different methods to output the evaluation results.
  • the evaluation results are sent to the client.
  • the client can be a mobile terminal such as a mobile phone or a Pad, or other terminal equipment.
  • the first trigger signal is sent after the client terminal receives an evaluation result indicating that the load size currently carried by the pan/tilt is within a preset load size range of the pan/tilt.
  • the user can operate the client after the client receives the evaluation result indicating that the load size currently carried by the pan/tilt is within the preset load size range of the pan/tilt, so that the client sends the first trigger signal to PTZ, to trigger the PTZ for center of gravity trimming.
  • the first trigger signal is automatically generated after the pan/tilt detects that the current load of the pan/tilt is within the preset load range of the pan/tilt, or is output from the pan/tilt to indicate the current load of the pan/tilt.
  • the user After the evaluation result that the load size of is within the preset load size range of the pan/tilt, the user operates the keys/buttons on the pan/tilt to generate the first trigger signal.
  • the PTZ includes a prompt module.
  • the evaluation result is output through the prompt module.
  • the prompt module can be a display screen, a voice module or others.
  • the center of gravity of the pan/tilt will be adjusted again, that is, when the pan/tilt detects that the load carried by the pan/tilt generates When changing, re-check whether the center of gravity of the corresponding part of the PTZ deviates from the expected center of gravity.
  • the prompt signal for indicating the adjustment of the center of gravity position will be output again; if the center of gravity of the gimbal is re-balanced to determine that the center of gravity position does not deviate from the desired center of gravity position, then output A display signal used to indicate the successful balance of the center of gravity of the gimbal.
  • detecting a change in the load carried by the pan/tilt may include: detecting a change in the position and/or weight of the load carried by the pan/tilt on the pan/tilt.
  • this embodiment is suitable for a three-axis pan/tilt head (including pitch axis, roll axis and yaw axis) or a two-axis pan/tilt head without yaw axis (including pitch axis and roll axis) ), the embodiment shown in Figure 7 first performs the center of gravity balance on the pitch axis, and then performs the center of gravity balance on the roll axis. It can be understood that it can also be replaced by first performing the center of gravity balance on the roll axis, and then rebalance the pitch axis. The heart is balanced.
  • the method for balancing the center of gravity of the pan/tilt in the embodiment shown in FIG. 7 may include the following steps:
  • the user can operate the buttons/buttons on the pan/tilt to make the pan/tilt generate a second trigger signal for instructing the pan/tilt to perform load evaluation, or, by operating the client, the user can cause the client to send instructions for the pan/tilt
  • the second trigger signal for load evaluation is sent to the pan/tilt to trigger the pan/tilt to perform load evaluation.
  • step (3) is executed after step (2).
  • the user can operate the keys/buttons on the PTZ to make the PTZ generate the first trigger signal for instructing the PTZ to perform center-of-gravity trimming, or the user can operate the client terminal to cause the client to send instructions for the cloud
  • the first trigger signal for center-of-gravity trimming is sent to the gimbal to trigger the gimbal to perform center-of-gravity trim, or when the gimbal determines that the load currently carried by the gimbal is within the preset load range
  • the first trigger signal to instruct the pan/tilt to perform center of gravity trimming.
  • the target position is the position when the pan/tilt returns to the center.
  • the pitch axis rotates counterclockwise by ⁇ from the target position to reach the third preset position.
  • the pitch axis rotates counterclockwise by ⁇ from the third preset position to reach the fourth preset position.
  • step (10) and step (11) can be executed sequentially or simultaneously.
  • the pan-tilt may first perform step (10) and then step (11), or the pan-tilt may first perform step (11) and then step (10).
  • the output is used to indicate the position of the center of gravity of the part that deviates from the desired center of gravity in the adjustment platform that rotates around the pitch axis to guide the user to adjust the installation position of the pitch axis load;
  • the moment data during the trim of the pitch axis and the roll axis can be acquired in addition to the time sequence described above, but also other time sequences. For example, steps (13)-(14) can precede steps (4)-(9). ) Timing. At the same time, whether the position of the center of gravity of the corresponding part is offset from the expected position of the center of gravity in the up-and-down direction can be determined when the pitch axis is trimmed, or when the roll axis is trimmed, and there is no specific limitation here.
  • the output is used to instruct the adjustment of the center of gravity of the part of the pan/tilt that deviates from the desired center of gravity to rotate around the roll axis to guide the user to adjust the installation position of the roll axis load.
  • step (12) and step (16) can be executed at the same time, or can be executed sequentially according to the corresponding detection results, which is not specifically limited here.
  • the pan/tilt can be triggered to perform center-of-gravity trim.
  • center-of-gravity trim if the center of gravity of the corresponding part of the pan/tilt deviates from the desired center of gravity, the center of gravity is given
  • the adjustment plan is to guide the user to adjust the custom load module mounted in the corresponding part, so that the gimbal will not need to generate additional output to resist the gravity moment when the normal output of the gimbal is in a balanced state, reducing the power consumption of the gimbal, Reduce the gimbal heating, which can protect the gimbal and greatly reduce the risk of scalding users. It can also ensure that the gimbal has enough output for stabilization, greatly avoiding the degradation of disturbance suppression performance caused by output saturation; at the same time, The user experience is expanded, so that the custom load module can also be used normally on the PTZ.
  • the gimbal in the first embodiment of the present invention also provides a gimbal.
  • the gimbal 100 may include a pitch axis motor 110 and/or a roll axis motor 120 , And the first controller 130, wherein the first controller 130 is electrically connected to the pitch axis motor 110 and/or the roll axis motor 120.
  • the pan/tilt head 100 includes a pitch axis motor 110 and a roll axis motor 120.
  • the first controller 130 is configured to: upon receiving the first trigger signal for center of gravity trimming, detect whether the center of gravity position of the corresponding part of the pan/tilt head deviates from the expected center of gravity position; if the center of gravity position deviates from the expected center of gravity position, output Used to indicate the prompt signal to adjust the position of the center of gravity.
  • the first controller 130 in this embodiment may be a central processing unit (CPU).
  • the first controller 130 may further include a hardware chip.
  • the aforementioned hardware chip may be an application-specific integrated circuit (ASIC), a programmable logic device (PLD) or a combination thereof.
  • ASIC application-specific integrated circuit
  • PLD programmable logic device
  • the above-mentioned PLD may be a complex programmable logic device (CPLD), a field-programmable gate array (FPGA), a generic array logic (GAL), or any combination thereof.
  • CPLD complex programmable logic device
  • FPGA field-programmable gate array
  • GAL generic array logic
  • the first controller 130 may include a pan/tilt controller and/or an independent controller provided on the pan/tilt, and may also include other controllers.
  • Fig. 9 is a flow chart of the method for balancing the center of gravity of the pan/tilt in an embodiment of the present invention on the client side.
  • the execution subject of the method for balancing the center of gravity of the pan/tilt in the second embodiment of the present invention is a client, which can communicate with the pan/tilt, and the client may be a mobile terminal such as a mobile phone or a Pad, or other Terminal Equipment.
  • the method for balancing the center of gravity of the gimbal in the second embodiment of the present invention may include the following steps:
  • the method for balancing the center of gravity of the pan/tilt head further includes: before receiving the trimming instruction, receiving the evaluation result sent by the pan/tilt head.
  • the evaluation results include: the current load of the pan/tilt is within the preset load range of the pan/tilt, or the load currently mounted on the pan/tilt is too large.
  • the trim command is an evaluation result sent by the pan/tilt to indicate that the load currently carried by the pan/tilt is within a preset load range of the pan/tilt.
  • the trim command is generated by the user operating the client terminal.
  • the user operates a virtual key on the client terminal to generate a trim command, or the user operates a physical key/button on the client terminal to generate a trim command.
  • the client terminal may determine whether to generate the first trigger signal according to the trim instruction according to the evaluation result.
  • the client after the client receives the evaluation result indicating that the load size currently carried by the pan/tilt is within the preset load size range of the pan/tilt, if it receives a trimming instruction, it generates a first trigger signal; the client receives After the evaluation result indicating that the load currently carried by the pan/tilt head is too large, if a trim command is received, the first trigger signal will not be generated.
  • the method for balancing the center of gravity of the gimbal further includes: before receiving the evaluation result sent by the gimbal, if a load evaluation instruction is received, generating a second trigger signal for instructing the gimbal to perform load evaluation; Send the second trigger signal to the pan-tilt to trigger the pan-tilt to perform load evaluation.
  • the load evaluation instruction is generated by the user operating the client. For example, the user operates a virtual key on the client to generate a trim instruction, or the user operates a physical key/button of the client to generate a load evaluation instruction.
  • S902 Send the first trigger signal to the pan-tilt to trigger the pan-tilt to detect the position of the center of gravity;
  • the method for detecting the position of the center of gravity of the pan/tilt may refer to the first embodiment, which will not be repeated here.
  • the PTZ is triggered by the client to detect the center of gravity position, which is more flexible and meets the needs of users.
  • S903 Receive a prompt signal returned by the pan/tilt head for the first trigger signal, where the prompt signal is used to instruct to adjust the center of gravity position of the pan/tilt head that deviates from the expected center of gravity position.
  • the prompt signal carries the offset information of the center of gravity position to guide the user to adjust the installation position of the load on the corresponding part.
  • the offset information includes: an offset direction and/or an offset amount.
  • the client terminal outputs the prompt signal after receiving the prompt signal returned by the pan-tilt for the first trigger signal.
  • the prompt signal can be output based on at least one of graphics, text, and voice.
  • the client can also output the prompt signal in other ways.
  • the second embodiment of the present invention also provides a client.
  • the client 200 may include a storage device 210 and a second controller 220.
  • the storage device 210 is used to store program instructions, and the second controller 220 calls the program instructions.
  • the second controller 220 is used to execute the method for balancing the center of gravity of the pan/tilt head in the embodiment shown in 9.
  • the second controller 220 is configured to: if a trim command is received, generate a first trigger signal for center of gravity trim; send the first trigger signal to the pan/tilt to trigger the pan/tilt to perform the center of gravity position The detection; receiving the prompt signal returned by the pan/tilt head for the first trigger signal, the prompt signal is used to instruct the adjustment of the center of gravity position of the pan/tilt deviating from the desired center of gravity position.
  • the storage device 210 may include a volatile memory (volatile memory), such as random-access memory (RAM); the storage device 210 may also include a non-volatile memory (non-volatile memory), such as fast Flash memory (flash memory), hard disk drive (HDD) or solid-state drive (SSD); the storage device 210 may also include a combination of the foregoing types of memories.
  • volatile memory volatile memory
  • non-volatile memory non-volatile memory
  • flash memory fast Flash memory
  • HDD hard disk drive
  • SSD solid-state drive
  • the storage device 210 may also include a combination of the foregoing types of memories.
  • the second controller 220 in this embodiment may be a central processing unit (CPU).
  • the second controller 220 may further include a hardware chip.
  • the aforementioned hardware chip may be an application-specific integrated circuit (ASIC), a programmable logic device (PLD) or a combination thereof.
  • ASIC application-specific integrated circuit
  • PLD programmable logic device
  • the above-mentioned PLD may be a complex programmable logic device (CPLD), a field-programmable gate array (FPGA), a generic array logic (GAL), or any combination thereof.
  • an embodiment of the present invention also provides a computer-readable storage medium on which a computer program is stored. When the program is executed by the controller, the method for balancing the center of gravity of the pan/tilt head described in the first embodiment or the second embodiment is implemented. step.
  • the program can be stored in a computer readable storage medium. During execution, it may include the procedures of the above-mentioned method embodiments.
  • the storage medium may be a magnetic disk, an optical disc, a read-only memory (Read-Only Memory, ROM), or a random access memory (Random Access Memory, RAM), etc.

Abstract

A gimbal (100) center of gravity trim method, a gimbal (100), and a client (200). The method comprises: when a first trigger signal for center of gravity trim is received, detecting whether a center of gravity position of a respective portion of the gimbal (100) deviates from a desired center of gravity position (S101); and if the center of gravity position deviates from the desired center of gravity position, outputting a prompt signal for indicating adjustment of the center of gravity position (S102).

Description

云台重心配平的方法、云台及客户端Method for balancing the center of gravity of gimbal, gimbal and client 技术领域Technical field
本发明涉及云台领域,尤其涉及一种云台重心配平的方法、云台及客户端。The invention relates to the field of pan-tilt, in particular to a method for balancing the center of gravity of the pan-tilt, the pan-tilt and a client.
背景技术Background technique
相关技术中,大部分云台仅支持类型、范围已知的负载,如相机、手机等,而不支持用户加装一些未知自定义负载模块。随着云台技术的发展,一些云台具有支持用户自行加装一些未知自定义负载模块的功能,如教育机器人云台,此类型的云台上会预留诸多的安装孔,以支持用户自由挂载自定义负载模块。而DIY用户加装在教育机器人云台上的自定义负载模块,可能是水弹枪、导航模块、摄像模块、探照灯、话筒、甚至是装饰品等,具有极高的不确定性。若自定义负载模块布置的不合理性,可能导致云台重心不稳,使得云台需要为了抵抗重力矩而产生额外的输出,影响云台的使用。In related technologies, most pan-tilts only support loads with known types and ranges, such as cameras and mobile phones, and do not support users to install unknown custom load modules. With the development of pan-tilt technology, some pan-tilts have the function of supporting users to install some unknown custom load modules by themselves, such as educational robot pan-tilts. Many mounting holes are reserved on this type of pan-tilt to support users' freedom Mount a custom load module. The custom load modules that DIY users install on the educational robot's pan/tilt may be water bomb guns, navigation modules, camera modules, searchlights, microphones, or even decorations, which are highly uncertain. If the layout of the custom load module is unreasonable, the center of gravity of the gimbal may be unstable, causing the gimbal to generate additional output in order to resist the gravity moment, which affects the use of the gimbal.
发明内容Summary of the invention
本发明提供一种云台重心配平的方法、云台及客户端。The invention provides a method for balancing the center of gravity of a pan/tilt, a pan/tilt and a client.
具体地,本发明是通过如下技术方案实现的:Specifically, the present invention is implemented through the following technical solutions:
根据本发明的第一方面,提供一种云台重心配平的方法,所述云台被配置为绕俯仰轴和/或横滚轴转动,所述方法包括:According to a first aspect of the present invention, there is provided a method for balancing the center of gravity of a pan/tilt, the pan/tilt is configured to rotate around a pitch axis and/or a roll axis, and the method includes:
在接收到用于重心配平的第一触发信号时,检测所述云台中相应部分的重心位置是否偏离期望重心位置;When receiving the first trigger signal for center of gravity trimming, detect whether the position of the center of gravity of the corresponding part of the pan/tilt head deviates from the expected position of the center of gravity;
若所述重心位置偏离所述期望重心位置,则输出用于指示调整所述重心位置的提示信号。If the position of the center of gravity deviates from the position of the desired center of gravity, a prompt signal for instructing to adjust the position of the center of gravity is output.
根据本发明的第二方面,提供一种云台,所述云台被配置为绕俯仰轴和/或横滚轴转动,所述云台包括:According to a second aspect of the present invention, there is provided a pan/tilt, the pan/tilt is configured to rotate around a pitch axis and/or a roll axis, and the pan/tilt includes:
俯仰轴电机和/或横滚轴电机;以及Pitch axis motor and/or roll axis motor; and
控制器,所述控制器与所述俯仰轴电机和/或横滚轴电机电连接;A controller, which is electrically connected to the pitch axis motor and/or the roll axis motor;
其中,所述控制器用于:Wherein, the controller is used for:
在接收到用于重心配平的第一触发信号时,检测所述云台中相应部分的重心位置是否偏离期望重心位置;When receiving the first trigger signal for center of gravity trimming, detect whether the position of the center of gravity of the corresponding part of the pan/tilt head deviates from the expected position of the center of gravity;
若所述重心位置偏离所述期望重心位置,则输出用于指示调整所述重心位置的提示信号。If the position of the center of gravity deviates from the position of the desired center of gravity, a prompt signal for instructing to adjust the position of the center of gravity is output.
根据本发明的第三方面,提供一种云台重心配平的方法,所述方法包括:According to a third aspect of the present invention, there is provided a method for balancing the center of gravity of a pan/tilt, the method comprising:
若接收到配平指令,则产生用于重心配平的第一触发信号;If the trim command is received, the first trigger signal for center of gravity trim is generated;
发送所述第一触发信号至云台,以触发所述云台进行重心位置的检测;Sending the first trigger signal to the pan-tilt to trigger the pan-tilt to detect the position of the center of gravity;
接收所述云台针对所述第一触发信号返回的提示信号,所述提示信号用于指示调整所述云台中偏离期望重心位置的重心位置。Receiving a prompt signal returned by the pan/tilt head in response to the first trigger signal, where the prompt signal is used to instruct to adjust the center of gravity position of the pan/tilt head that deviates from the desired center of gravity position.
根据本发明的第四方面,提供一种客户端,所述客户端包括:According to a fourth aspect of the present invention, a client is provided, and the client includes:
存储装置,用于存储程序指令;和Storage device for storing program instructions; and
控制器,调用所述程序指令,当所述程序指令被执行时,用于:The controller calls the program instructions, and when the program instructions are executed, it is used to:
若接收到配平指令,则产生用于重心配平的第一触发信号;If the trim command is received, the first trigger signal for center of gravity trim is generated;
发送所述第一触发信号至云台,以触发所述云台进行重心位置的检测;Sending the first trigger signal to the pan-tilt to trigger the pan-tilt to detect the position of the center of gravity;
接收所述云台针对所述第一触发信号返回的提示信号,所述提示信号用于指示调整所述云台中偏离期望重心位置的重心位置。Receiving a prompt signal returned by the pan/tilt head in response to the first trigger signal, where the prompt signal is used to instruct to adjust the center of gravity position of the pan/tilt head that deviates from the desired center of gravity position.
由以上本发明实施例提供的技术方案可见,用户在云台上增加自定义负载模块后,可触发云台进行重心配平,在进行重心配平时,若云台中相应部分的重心位置偏离期望重心位置,则给出重心调节方案,以指导用户对搭载在相应部分的自定义负载模块进行调整,从而使得云台在正常出力保持平衡的状态下,不需要为了抵抗重力矩而产生额外的输出,降低云台功耗、减少云台发热,既能够保护云台,也极大地降低了烫伤用户的风险,还可以保证云台有足够的输出用于增稳,大大避免因输出饱和而造成的扰动抑制性能下降;同时,拓展了用户体验,使得自定义负载模块也可以在云台上正常使用。It can be seen from the technical solutions provided by the above embodiments of the present invention that after the user adds a custom load module to the pan/tilt, the pan/tilt can be triggered to perform center-of-gravity trim. When performing center-of-gravity trim, if the center of gravity of the corresponding part of the pan/tilt deviates from the desired center of gravity Position, the center of gravity adjustment plan is given to guide the user to adjust the custom load module mounted on the corresponding part, so that the pan/tilt does not need to generate additional output to resist the gravitational moment when the normal output is maintained in a balanced state. Reduce the power consumption of the gimbal and reduce the heat of the gimbal, which can protect the gimbal and greatly reduce the risk of scalding users. It can also ensure that the gimbal has enough output for stability and greatly avoid disturbance caused by output saturation. Suppress performance degradation; at the same time, it expands the user experience so that the custom load module can also be used normally on the PTZ.
附图说明Description of the drawings
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施 例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to more clearly describe the technical solutions in the embodiments of the present invention, the following will briefly introduce the accompanying drawings used in the description of the embodiments. Obviously, the accompanying drawings in the following description are only some embodiments of the present invention. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without creative labor.
图1是本发明一实施例中的云台重心配平的方法在云台侧的方法流程图;FIG. 1 is a flow chart of the method for balancing the center of gravity of the gimbal in an embodiment of the present invention on the gimbal side;
图2是本发明一具体实施例中的云台重心配平的方法在云台侧的方法流程图;2 is a flow chart of the method for balancing the center of gravity of the gimbal in a specific embodiment of the present invention on the gimbal side;
图3是本发明一实施例中检测云台中绕俯仰轴转动的部分的重心位置是否在前后方向与期望重心位置存在偏移的坐标示意图;3 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part that rotates around the pitch axis in the pan/tilt head in an embodiment of the present invention is offset from the expected position of the center of gravity in the front-to-rear direction;
图4是本发明一实施例中检测云台中绕横滚轴转动的部分的重心位置是否在左右方向与期望重心位置存在偏移的坐标示意图;4 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part of the pan-tilt rotating around the roll axis in an embodiment of the present invention is offset from the expected position of the center of gravity in the left-right direction;
图5是本发明一实施例中检测云台中绕俯仰轴转动的部分的重心位置是否在上下方向与期望重心位置存在偏移的坐标示意图;5 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part of the pan/tilt that rotates around the pitch axis in an embodiment of the present invention is offset from the expected position of the center of gravity in the vertical direction;
图6是本发明一实施例中检测云台中绕横滚轴转动的部分的重心位置是否在上下方向与期望重心位置存在偏移的坐标示意图;6 is a schematic diagram of coordinates for detecting whether the position of the center of gravity of the part of the pan-tilt that rotates around the roll axis in an embodiment of the present invention is offset from the expected position of the center of gravity in the up and down direction;
图7是本发明又一具体实施例中云台重心配平的方法在云台侧的方法流程图;FIG. 7 is a flow chart of the method for balancing the center of gravity of the gimbal on the gimbal side in another specific embodiment of the present invention;
图8是本发明一实施例中的云台的结构框图;Fig. 8 is a structural block diagram of a pan-tilt in an embodiment of the present invention;
图9是本发明一实施例中的云台重心配平的方法在云台侧的方法流程图;9 is a flow chart of the method for balancing the center of gravity of the gimbal in an embodiment of the present invention on the gimbal side;
图10是本发明一实施例中的客户端的结构框图。Fig. 10 is a structural block diagram of a client in an embodiment of the present invention.
具体实施方式detailed description
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only a part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of the present invention.
目前,教育机器人云台能够支持用户自行加装一些未知自定义负载模块,由于自定义负载模块的高度不确定性,若搭载在云台上的自定义负载模块的布置不够合理性,会导致云台重心不稳,使得云台需要为了抵抗重力矩而产生额外的输出,影响云台的使用。At present, the educational robot PTZ can support users to install some unknown custom load modules by themselves. Due to the high uncertainty of the custom load modules, if the layout of the custom load modules mounted on the PTZ is not reasonable enough, it will cause the cloud The center of gravity of the platform is unstable, so that the gimbal needs to generate extra output in order to resist the gravity moment, which affects the use of the gimbal.
故需要对自定义负载模块的布置合理与否进行判断,对于此,本发明通过用户触发云台进行重心配平,云台在进行重心配平后,能够指导用户对搭载在相应部分的 自定义负载模块进行调整,从而使得云台在正常出力保持平衡的状态下,不需要为了抵抗重力矩而产生额外的输出,降低云台功耗、减少云台发热,既能够保护云台,也极大地降低了烫伤用户的风险,还可以保证云台有足够的输出用于增稳,大大避免因输出饱和而造成的扰动抑制性能下降;同时,拓展了用户体验,使得自定义负载模块也可以在云台上正常使用。Therefore, it is necessary to judge whether the layout of the custom load module is reasonable or not. For this, the present invention uses the user to trigger the pan/tilt to perform center-of-gravity trimming. After the center-of-gravity trim is performed, the pan/tilt can guide the user to the custom load modules mounted on the corresponding part. The load module is adjusted so that the gimbal does not need to generate additional output to resist the gravitational moment when the normal output of the gimbal is kept in balance, reducing the power consumption of the gimbal and reducing the heat of the gimbal, which can protect the gimbal and greatly It reduces the risk of scalding users, and can also ensure that the gimbal has enough output for stabilization, greatly avoiding the degradation of disturbance suppression performance caused by output saturation; at the same time, the user experience is expanded, so that custom load modules can also be used in the cloud Normal use on stage.
本发明实施例的云台被配置为绕俯仰轴和/或横滚轴转动。可选的,云台为单轴云台,云台被配置为绕俯仰轴或横滚轴转动。可选的,云台为两轴云台,云台被配置为绕俯仰轴和横滚轴转动,或者云台被配置为绕俯仰轴和偏航轴转动,或者云台被配置为绕横滚轴和偏航轴转动。可选的,云台为三轴云台,云台被配置为绕俯仰轴、横滚轴和偏航轴转动。当然,云台也可为其他多轴云台,此处不一一列举。The pan/tilt head of the embodiment of the present invention is configured to rotate around a pitch axis and/or a roll axis. Optionally, the gimbal is a single-axis gimbal, and the gimbal is configured to rotate around a pitch axis or a roll axis. Optionally, the gimbal is a two-axis gimbal, the gimbal is configured to rotate around the pitch axis and roll axis, or the gimbal is configured to rotate around the pitch axis and yaw axis, or the gimbal is configured to roll around The axis and the yaw axis rotate. Optionally, the gimbal is a three-axis gimbal, and the gimbal is configured to rotate around the pitch axis, roll axis, and yaw axis. Of course, the pan/tilt can also be other multi-axis pan/tilt, which are not listed here.
此外,本发明实施例的云台可为搭载在移动设备上的云台,也可为手持云台。其中,移动设备可为移动小车,也可为无人飞行器,还可为其他具备移动功能的设备。In addition, the pan-tilt in the embodiment of the present invention may be a pan-tilt mounted on a mobile device, or a handheld pan-tilt. Among them, the mobile device can be a mobile car, an unmanned aerial vehicle, or other devices with mobile functions.
下面结合附图,对本发明的云台重心配平的方法、云台及客户端进行详细说明。在不冲突的情况下,下述的实施例及实施方式中的特征可以相互组合。The method for balancing the center of gravity of the pan-tilt, the pan-tilt, and the client of the present invention will be described in detail below in conjunction with the accompanying drawings. In the case of no conflict, the following embodiments and features in the implementation can be combined with each other.
实施例一Example one
图1是本发明一实施例中的云台重心配平的方法在云台侧的方法流程图。需要说明的是,本发明实施例一的云台重心配平的方法的执行主体为云台。如图1所示,本发明实施例一的云台重心配平的方法可包括如下步骤:FIG. 1 is a flow chart of the method for balancing the center of gravity of the gimbal in an embodiment of the present invention on the gimbal side. It should be noted that the method for balancing the center of gravity of the pan/tilt in the first embodiment of the present invention is executed by the pan/tilt. As shown in FIG. 1, the method for balancing the center of gravity of the pan/tilt in the first embodiment of the present invention may include the following steps:
S101:在接收到用于重心配平的第一触发信号时,检测云台中相应部分的重心位置是否偏离期望重心位置;S101: Upon receiving the first trigger signal for center of gravity trimming, detect whether the position of the center of gravity of the corresponding part of the pan/tilt head deviates from the expected position of the center of gravity;
其中,第一触发信号用于指示云台进行重心配平,本实施例的云台在接收到第一触发信号后,即进行重心配平。可选的,第一触发信号由云台产生,例如,可通过操作云台上的按键/按钮等使得云台产生第一触发信号。可选的,第一触发信号由外部设备发送,该外部设备可为控制云台的遥控设备或控制终端,该控制终端可为手机、Pad等移动终端,也可为其他终端设备。当然,用户也可通过其他方式触发云台进行重心配平,诸如触控、手势、语音等。The first trigger signal is used to instruct the pan/tilt head to perform center-of-gravity trim. The pan/tilt in this embodiment will perform center-of-gravity trim after receiving the first trigger signal. Optionally, the first trigger signal is generated by the pan/tilt. For example, the pan/tilt may generate the first trigger signal by operating keys/buttons on the pan/tilt. Optionally, the first trigger signal is sent by an external device. The external device can be a remote control device or a control terminal that controls the pan/tilt. The control terminal can be a mobile terminal such as a mobile phone or a Pad, or other terminal devices. Of course, the user can also trigger the pan-tilt to perform center-of-gravity trimming in other ways, such as touch, gestures, and voice.
以具有内框架、中框架和外框架的三轴云台为例,可选的,内框架为绕俯仰轴转动的框架、中框架为绕横滚轴转动的框架,外框架为绕偏航轴转动的框架。在理想状态下,云台整体的重心位置(即外框架、中框架、内框架和搭载在内框架上的负载 构成的整体的重心)为俯仰轴、横滚轴和偏航轴的交点位置,此时,俯仰轴和横滚轴几乎不需要抵抗重力矩,俯仰轴和横滚轴输出值极小,均值接近于零,即云台不需要为了抵抗重力矩而产生额外的输出。云台实际使用时,当云台整体的重心位置偏离交点位置的距离较小时,云台为了抵抗重力矩而产生的额外输出也较小,该额外输出也不会影响云台的正常使用,即可将云台整体的重心位置偏离交点位置的距离设置得足够小也能满足云台正常使用需求。因此,期望重心位置可为距离交点位置一定距离的区域范围。Take a three-axis gimbal with an inner frame, a middle frame and an outer frame as an example. Optionally, the inner frame is a frame that rotates around the pitch axis, the middle frame is a frame that rotates around the roll axis, and the outer frame is a frame around the yaw axis. Rotating frame. In an ideal state, the overall center of gravity of the gimbal (that is, the overall center of gravity composed of the outer frame, middle frame, inner frame and the load carried on the inner frame) is the position of the intersection of the pitch axis, roll axis and yaw axis. At this time, the pitch axis and roll axis hardly need to resist the gravitational moment, the output value of the pitch axis and the roll axis is extremely small, and the average value is close to zero, that is, the gimbal does not need to generate additional output to resist the gravitational moment. When the gimbal is actually used, when the distance between the center of gravity of the gimbal and the intersection point is small, the extra output generated by the gimbal to resist the gravitational moment is also small, and the extra output will not affect the normal use of the gimbal. The distance between the center of gravity of the gimbal and the intersection point can be set to be small enough to meet the normal use requirements of the gimbal. Therefore, the desired center of gravity position can be a certain distance from the intersection position.
例如,可选的,在云台被配置为绕俯仰轴转动时,相应部分包括云台中绕俯仰轴转动的部分,期望重心位置与俯仰轴之间的距离不大于第一预设距离。本实施例中,云台中绕俯仰轴转动的部分包括内框架和搭载在内框架上的负载,期望重心位置与俯仰轴之间的距离即为期望重心位置至俯仰轴的垂直距离,其中,第一预设距离可根据需要设置,如0.5cm,以使得云台产生的额外输出较小。For example, optionally, when the pan/tilt is configured to rotate around the pitch axis, the corresponding part includes a part of the pan/tilt that rotates around the pitch axis, and it is desirable that the distance between the center of gravity position and the pitch axis is not greater than the first preset distance. In this embodiment, the part of the gimbal that rotates around the pitch axis includes the inner frame and the load mounted on the inner frame. The distance between the desired center of gravity position and the pitch axis is the vertical distance from the desired center of gravity position to the pitch axis. A preset distance can be set as required, such as 0.5cm, so that the extra output generated by the pan/tilt is small.
可选的,在云台被配置为绕横滚轴转动时,相应部分包括云台中绕横滚轴转动的部分,期望重心位置与横滚轴之间的距离不大于第二预设距离。本实施例中,云台中绕横滚轴转动的部分包括中框架、内框架和搭载在内框架上的负载,期望重心位置与横滚轴之间的距离即为期望重心位置至横滚轴的垂直距离。其中,第二预设距离可根据需要设置,如0.5cm,以使得云台产生的额外输出较小。Optionally, when the pan/tilt is configured to rotate around the roll axis, the corresponding part includes a part of the pan/tilt that rotates around the roll axis, and it is expected that the distance between the center of gravity position and the roll axis is not greater than the second preset distance. In this embodiment, the part of the pan/tilt that rotates around the roll axis includes the middle frame, the inner frame and the load carried on the inner frame. The distance between the desired center of gravity and the roll axis is the distance from the desired center of gravity to the roll axis. vertical distance. Among them, the second preset distance can be set as required, such as 0.5 cm, so that the extra output generated by the pan/tilt head is small.
S102:若重心位置偏离期望重心位置,则输出用于指示调整重心位置的提示信号。S102: If the position of the center of gravity deviates from the expected position of the center of gravity, output a prompt signal for indicating adjustment of the position of the center of gravity.
本实施例中,重心位置偏离期望重心位置包括以下一种或多种情况:重心位置在前后方向与期望重心位置存在偏移、重心位置在左右方向与期望重心位置存在偏移、重心位置在上下方向与期望重心位置存在偏移。可选的,云台的正面朝向用户时,云台朝向用户的一侧为前,背离用户的一侧为后;云台朝左的一侧为左,云台朝右的一侧为右;云台的重力方向为下,云台重力方向的相反方向为上。In this embodiment, the position of the center of gravity deviates from the desired center of gravity position including one or more of the following situations: the position of the center of gravity is deviated from the desired center of gravity position in the front and rear direction, the position of the center of gravity is deviated from the desired center of gravity position in the left-right direction, and the center of gravity position is up and down. The direction is offset from the desired center of gravity position. Optionally, when the front of the pan/tilt faces the user, the side of the pan/tilt facing the user is the front, and the side facing away from the user is the rear; the side of the pan/tilt facing the left is the left, and the side of the pan/tilt facing the right is the right; The direction of gravity of the gimbal is downward, and the opposite direction of the direction of gravity of the gimbal is upward.
当相应部分为云台中绕俯仰轴转动的部分时,可检测云台中绕俯仰轴转动的部分的重心位置是否在前后方向和/或上下方向与期望重心位置存在偏移;当相应部分为云台中绕横滚轴转动的部分时,可检测云台中绕横滚轴转动的部分的重心位置是否在左右方向和/或上下方向与期望重心位置存在偏移。When the corresponding part is the part of the gimbal that rotates around the pitch axis, it can be detected whether the position of the center of gravity of the part of the gimbal that rotates around the pitch axis is offset from the expected center of gravity position in the front-to-back direction and/or up and down direction; when the corresponding part is in the gimbal When the part that rotates around the roll axis, it can be detected whether the position of the center of gravity of the part that rotates around the roll axis in the pan/tilt head is offset from the desired center of gravity position in the left-right direction and/or up-down direction.
本实施例根据云台的类型以及实际需求来检测云台中相应部分的重心位置是 否偏离期望重心位置。例如,在其中一些实施例中,仅检测云台中相应部分的重心位置在上下方向是否与期望重心位置存在偏移,如检测云台中绕俯仰轴转动的部分和/或云台中绕横滚轴转动的部分的重心位置在上下方向是否与期望重心位置存在偏移。在另一些实施例中,不仅检测云台中相应部分的重心位置在上下方向是否与期望重心位置存在偏移,还需检测云台中相应部分的重心位置在前后方向与期望重心位置存在偏移和/或检测云台中相应部分的重心位置在左右方向与期望重心位置存在偏移,如检测云台中绕俯仰轴转动的部分的重心位置在上下方向是否与期望重心位置存在偏移,并检测云台中绕俯仰轴转动的部分的重心位置在前后方向是否与期望重心位置存在偏移,和/或检测云台中绕横滚轴转动的部分的重心位置在上下方向是否与期望重心位置存在偏移,并检测云台中绕横滚轴转动的部分的重心位置在左右方向是否与期望重心位置存在偏移。This embodiment detects whether the center of gravity position of the corresponding part of the pan/tilt platform deviates from the desired center of gravity position according to the type of the pan/tilt platform and actual requirements. For example, in some of the embodiments, it is only detected whether the center of gravity position of the corresponding part of the pan/tilt head is offset from the desired center of gravity position in the up and down direction, such as detecting the part of the pan/tilt head that rotates around the pitch axis and/or the pan/tilt head rotates around the roll axis. Whether the position of the center of gravity of the part in the vertical direction is offset from the desired position of the center of gravity. In other embodiments, it is not only detected whether the center of gravity position of the corresponding part of the pan/tilt head is offset from the expected center of gravity position in the up and down direction, but also whether the center of gravity position of the corresponding part of the pan/tilt head is offset from the expected center of gravity position in the front-to-back direction and/ Or detect that the center of gravity of the corresponding part of the pan/tilt is deviated from the expected center of gravity in the left and right directions. For example, detect whether the center of gravity of the part that rotates around the pitch axis in the pan/tilt is deviated from the expected center of gravity in the vertical direction, and detect whether the center of gravity is deviated from the expected center of gravity. Whether the position of the center of gravity of the part rotated by the pitch axis deviates from the expected position of the center of gravity in the front and rear direction, and/or detects whether the position of the center of gravity of the part that rotates around the roll axis in the pan/tilt is deviated from the expected position of the center of gravity in the vertical direction, and detects Whether the position of the center of gravity of the part that rotates around the roll axis in the pan/tilt is deviated from the desired position of the center of gravity in the left-right direction.
可根据需要选择检测云台中相应部分的重心位置是否偏离期望重心位置的实现方式,参见图2,在一具体实现方式中,检测云台中相应部分的重心位置是否偏离期望重心位置的过程可包括如下步骤:The method of detecting whether the center of gravity position of the corresponding part of the pan/tilt head deviates from the desired center of gravity position can be selected according to needs, see Figure 2. In a specific implementation, the process of detecting whether the center of gravity position of the corresponding part of the pan/tilt head deviates from the desired center of gravity position may include the following step:
S201:控制云台转动,使得云台中的相应部分处于至少一个预设位置;S201: Control the pan/tilt to rotate so that the corresponding part of the pan/tilt is at at least one preset position;
该步骤中,预设位置包括目标位置和/或其他位置。其中,目标位置可为历史记录的重心位置处于期望重心位置时相应部分的位置,也可为云台回中时的位置(即云台回中时相应部分的位置)。In this step, the preset position includes the target position and/or other positions. Wherein, the target position may be the position of the corresponding part when the center of gravity position of the historical record is at the desired center of gravity position, or the position of the pan/tilt when returning to the center (that is, the position of the corresponding portion when the pan/tilt is returning to the center).
预设位置可包括一个或多个,例如,在检测云台中相应部分的重心位置是否在前后方向与期望重心位置存在偏移和/或检测云台中相应部分的重心位置是否在左右方向与期望重心位置存在偏移时,预设位置包括一个。如,在检测云台中绕俯仰轴转动的部分的重心位置是否在前后方向与期望重心位置存在偏移时,预设位置为第一预设位置;在检测云台中相应部分的重心位置是否在左右方向与期望重心位置存在偏移时,预设位置为第二预设位置。其中,第一预设位置和第二预设位置可为同一位置,如第一预设位置和第二预设位置均为目标位置。当然,第一预设位置和第二预设位置也可为不同的位置。The preset position may include one or more, for example, detecting whether the center of gravity position of the corresponding part of the pan/tilt head is offset from the expected center of gravity position in the front and rear direction and/or detecting whether the center of gravity position of the corresponding part of the pan/tilt head is in the left-right direction and the expected center of gravity When the position is offset, the preset position includes one. For example, when detecting whether the center of gravity position of the part that rotates around the pitch axis in the pan/tilt head is offset from the expected center of gravity position in the front and back direction, the preset position is the first preset position; when detecting whether the center of gravity position of the corresponding part of the pan/tilt head is on the left and right When the direction is offset from the desired center of gravity position, the preset position is the second preset position. Wherein, the first preset position and the second preset position may be the same position, for example, the first preset position and the second preset position are both target positions. Of course, the first preset position and the second preset position may also be different positions.
在检测云台中相应部分的重心位置是否在上下方向与期望重心位置存在偏移时,预设位置包括3个,如在检测云台中绕俯仰轴转动的部分的重心位置是否在上下方向与期望重心位置存在偏移时,预设位置包括第三预设位置、第四预设位置和目标位置;在检测云台中绕横滚轴转动的部分的重心位置是否在上下方向与期望重心位置 存在偏移时,预设位置包括第五预设位置、第六预设位置和目标位置。When detecting whether the center of gravity of the corresponding part of the pan/tilt is offset from the desired center of gravity in the vertical direction, the preset positions include 3, such as detecting whether the center of gravity of the part that rotates around the pitch axis in the pan/tilt is in the vertical direction and the desired center of gravity. When the position is offset, the preset position includes the third preset position, the fourth preset position and the target position; whether the center of gravity position of the part that rotates around the roll axis in the detection platform is offset from the expected center of gravity position in the up and down direction When the time, the preset position includes the fifth preset position, the sixth preset position and the target position.
S202:检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否偏离期望重心位置。S202: Detect whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position.
当相应部分为云台中绕俯仰轴转动的部分时,可检测云台中绕俯仰轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在前后方向与期望重心位置存在偏移和/或检测云台中绕俯仰轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移。When the corresponding part is the part of the gimbal that rotates around the pitch axis, it can be detected whether the center of gravity position when the part of the gimbal that rotates around the pitch axis is at the target position in at least one preset position is deviated from the expected center of gravity position in the front-rear direction and /Or detecting whether the center of gravity position when the part of the pan/tilt rotating around the pitch axis is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction.
当相应部分为云台中绕横滚轴转动的部分时,可检测云台中绕横滚轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在左右方向与期望重心位置存在偏移和/或检测云台中绕横滚轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移。When the corresponding part is the part of the pan/tilt that rotates around the roll axis, it can be detected whether the center of gravity position when the part of the pan/tilt that rotates around the roll axis is at the target position in at least one preset position is deviated from the desired center of gravity in the left-right direction. Move and/or detect whether the center of gravity position when the part of the pan/tilt rotating around the roll axis is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction.
以云台包括俯仰轴电机和/或横滚轴电机为例,S202可包括如下步骤:Taking the gimbal including the pitch axis motor and/or the roll axis motor as an example, S202 may include the following steps:
(1)在相应部分处于至少一个预设位置中的特定位置时,获取俯仰轴电机和/或横滚轴电机输出的力矩值;(1) Obtain the torque value output by the pitch axis motor and/or the roll axis motor when the corresponding part is in a specific position among at least one preset position;
其中,在检测云台中绕俯仰轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在前后方向与期望重心位置存在偏移时,该特定位置为第一预设位置。该步骤需获取云台中绕俯仰轴转动的部分处于第一预设位置时,俯仰轴电机输出的第一力矩值。Wherein, when detecting whether the center of gravity position when the part of the pan/tilt rotating around the pitch axis is at the target position in at least one preset position is offset from the expected center of gravity position in the front-to-rear direction, the specific position is the first preset position. In this step, it is necessary to obtain the first torque value output by the pitch axis motor when the part of the gimbal that rotates around the pitch axis is at the first preset position.
在检测云台中绕横滚轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在左右方向与期望重心位置存在偏移时,该特定位置为第二预设位置。该步骤需获取云台中绕横滚轴转动的部分处于第二预设位置时,横滚轴电机输出的第二力矩值。When detecting whether the center of gravity position when the part of the pan/tilt rotating around the roll axis is at the target position in at least one preset position, the specific position is the second preset position. In this step, it is necessary to obtain the second torque value output by the roll axis motor when the part of the pan/tilt that rotates around the roll axis is at the second preset position.
在检测云台中绕俯仰轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移,该特定位置包括第三预设位置和第四预设位置。该步骤需获取云台中绕俯仰轴转动的部分处于第三预设位置时,俯仰轴电机输出的第三力矩值,以及云台中绕俯仰轴转动的部分处于第四预设位置时,俯仰轴电机输出的第四力矩值。Whether the center of gravity position when the part of the pan/tilt rotating around the pitch axis is at the target position in at least one preset position is deviated from the expected center of gravity position in the up and down direction, the specific position includes the third preset position and the fourth preset position. This step needs to obtain the third torque value output by the pitch axis motor when the part of the gimbal that rotates around the pitch axis is at the third preset position, and the pitch axis motor when the part of the gimbal that rotates around the pitch axis is at the fourth preset position The output fourth torque value.
在检测云台中绕横滚轴转动的部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移时,该特定位置包括第五预设位置 和第六预设位置。该步骤需获取云台中绕横滚轴转动的部分处于第五预设位置时,横滚轴电机输出的第五力矩值,以及云台中绕横滚轴转动的部分处于第六预设位置时,横滚轴电机输出的第六力矩值。When detecting whether the center of gravity position when the part of the pan/tilt rotating around the roll axis is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction, the specific position includes the fifth preset position and the sixth preset position. Preset location. This step needs to obtain the fifth torque value output by the roll axis motor when the part of the pan/tilt rotating around the roll axis is at the fifth preset position, and when the part of the pan/tilt rotating around the roll axis is at the sixth preset position, The sixth torque value output by the roll axis motor.
在一些实施例中,在相应部分处于至少一个预设位置中的特定位置之后,获取俯仰轴电机和/或横滚轴电机输出的力矩值之前,所述方法还包括:确定俯仰轴电机和/或横滚轴电机输出的力矩值收敛,以确保获得的力矩值的准确性,从而提高云台重心配平的精度。In some embodiments, after the corresponding part is in a specific position among the at least one preset position, before obtaining the torque value output by the pitch axis motor and/or the roll axis motor, the method further includes: determining the pitch axis motor and/or Or the torque value output by the roll axis motor converges to ensure the accuracy of the torque value obtained, thereby improving the accuracy of the center of gravity of the gimbal.
可采用不同的方式来确定俯仰轴电机和/或横滚轴电机输出的力矩值是否收敛,例如,作为一种实现方式,确定俯仰轴电机和/或横滚轴电机输出的力矩值收敛的过程包括:确定特定时间段内俯仰轴电机和/或横滚轴电机输出的多个力矩值的方差;根据方差,确定俯仰轴电机和/或横滚轴电机输出的力矩值收敛。具体的,当方差小于或者等于预设方差阈值时,确定俯仰轴电机和/或横滚轴电机输出的力矩值收敛;当方差大于预设方差阈值时,确定俯仰轴电机和/或横滚轴电机输出的力矩值不收敛。其中,预设方差阈值可根据需要设定,如0.5、0.6或其他数值。作为另一种实现方式,确定俯仰轴电机和/或横滚轴电机输出的力矩值收敛的过程包括:在相应部分处于至少一个预设位置的持续时长大于或等于预设时长时,确定俯仰轴电机和/或横滚轴电机输出的力矩值收敛。相应部分处于至少一个预设位置的持续时长大于或等于预设时长能够保证相应部分稳定地处于至少一个预设位置,从而保证力矩值的准确性。其中,预设时长可根据需要设定,如5秒、10秒或其他时长大小。Different methods can be used to determine whether the torque value output by the pitch axis motor and/or roll axis motor converges. For example, as an implementation method, the process of determining the torque value output by the pitch axis motor and/or roll axis motor converges Including: determining the variance of multiple torque values output by the pitch axis motor and/or roll axis motor in a specific time period; and determining the convergence of the torque values output by the pitch axis motor and/or roll axis motor according to the variance. Specifically, when the variance is less than or equal to the preset variance threshold, it is determined that the torque values output by the pitch axis motor and/or roll axis motor converge; when the variance is greater than the preset variance threshold, the pitch axis motor and/or roll axis is determined The torque value output by the motor does not converge. Among them, the preset variance threshold can be set as required, such as 0.5, 0.6 or other values. As another implementation manner, the process of determining the convergence of the torque value output by the pitch axis motor and/or the roll axis motor includes: determining the pitch axis when the duration of the corresponding part at at least one preset position is greater than or equal to the preset duration The output torque value of the motor and/or roll axis motor converges. The duration of the corresponding part being at the at least one preset position is greater than or equal to the preset time length to ensure that the corresponding part is stably at the at least one preset position, thereby ensuring the accuracy of the torque value. Among them, the preset duration can be set as required, such as 5 seconds, 10 seconds or other durations.
在一些实施例中,俯仰轴电机和/或横滚轴电机输出的力矩值为:特定时间段内俯仰轴电机和/或横滚轴电机输出的多个力矩值进行平滑滤波后获得的数值,以消除噪声对力矩值的影响,确保力矩值的准确性,从而提高云台重心配平的精度。In some embodiments, the torque value output by the pitch axis motor and/or the roll axis motor is: a value obtained after smooth filtering of multiple torque values output by the pitch axis motor and/or roll axis motor in a specific period of time, In order to eliminate the influence of noise on the torque value, ensure the accuracy of the torque value, thereby improving the accuracy of the center of gravity of the gimbal.
(2)根据力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否偏离期望重心位置。(2) According to the torque value, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one preset position deviates from the expected position of the center of gravity.
若相应部分的重心位置偏离期望重心位置,那么,云台的俯仰轴和/或横滚轴会为了抵抗重力矩而输出一个持续的、恒定的力矩值,故就可以根据俯仰轴和/或横滚轴输出的力矩值对云台当前的配平情况进行推算。If the position of the center of gravity of the corresponding part deviates from the expected position of the center of gravity, then the pitch axis and/or roll axis of the gimbal will output a continuous and constant torque value in order to resist the moment of gravity, so it can be based on the pitch axis and/or horizontal The torque value output by the roller is used to calculate the current trim situation of the gimbal.
在检测云台中绕俯仰轴转动的部分的重心位置是否在前后方向与期望重心位置存在偏移的具体实施例中,云台被配置为绕俯仰轴转动,本实施例的云台包括俯仰 轴电机。需要说明的是,本实施例中,相应部分是指云台中绕俯仰轴转动的部分。其中,特定位置为第一预设位置,上述力矩值可包括:相应部分处于第一预设位置时,俯仰轴电机输出的第一力矩值。根据力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否偏离期望重心位置的过程包括:根据第一力矩值,检测相应部分处于第一预设位置时的重心位置是否在前后方向与期望重心位置存在偏移。In a specific embodiment for detecting whether the position of the center of gravity of the part that rotates around the pitch axis in the pan/tilt head is offset from the expected center of gravity position in the front-to-rear direction, the pan/tilt is configured to rotate around the pitch axis, and the pan/tilt in this embodiment includes a pitch axis motor . It should be noted that, in this embodiment, the corresponding part refers to the part of the pan/tilt that rotates around the pitch axis. The specific position is the first preset position, and the aforementioned torque value may include: the first torque value output by the pitch axis motor when the corresponding part is at the first preset position. According to the torque value, the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position includes: according to the first torque value, detecting whether the center of gravity position when the corresponding part is at the first preset position There is an offset from the desired center of gravity in the front and rear direction.
根据第一力矩值,检测相应部分处于第一预设位置时的重心位置是否在前后方向与期望重心位置存在偏移的实现方式可包括以下两种实现方式:According to the first moment value, the implementation of detecting whether the center of gravity position of the corresponding part is at the first preset position is offset from the expected center of gravity position in the front-to-rear direction may include the following two implementations:
在第一种实现方式中,参见图3,相应部分处于第一预设位置(如图3中的位置1)时,俯仰轴至重心位置(即云台中绕俯仰轴转动的部分处于第一预设位置时的重心位置)的距离的沿线方向与水平方向形成第一夹角θ 1。本实现方式中,根据力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否偏离期望重心位置的过程可包括:首先根据第一力矩值,确定第一夹角的角度范围和/或第一夹角的余弦值;再根据第一夹角的角度范围和/或第一夹角的余弦值,检测相应部分处于第一预设位置时的重心位置是否在前后方向与期望重心位置存在偏移。 In the first implementation, referring to Fig. 3, when the corresponding part is in the first preset position (position 1 in Fig. 3), the pitch axis to the center of gravity position (that is, the part of the pan/tilt that rotates around the pitch axis is in the first preset position). The line direction and the horizontal direction of the distance along the line form the first included angle θ 1 . In this implementation, according to the torque value, the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: first determining the angle of the first included angle according to the first torque value Range and/or the cosine value of the first included angle; then according to the angle range of the first included angle and/or the cosine value of the first included angle, it is detected whether the position of the center of gravity when the corresponding part is at the first preset position is in the front and rear direction. It is expected that there is an offset in the position of the center of gravity.
本实现方式中,当第一夹角的角度范围和/或第一夹角的余弦值满足第一策略时,确定重心位置在前后方向与期望重心位置存在偏移。其中,第一策略可根据云台的使用需求设定,可选的,当第一夹角的余弦值为正数时,确定重心位置相对于期望重心位置偏前;当第一夹角的余弦值为负数时,确定重心位置相对于期望重心位置偏后。可选的,当第一夹角的角度范围在第一预设角度范围内时,确定重心位置相对于期望重心位置偏前;当第一夹角的角度范围在第二预设角度范围内时,确定重心位置相对于期望重心位置偏后。可以理解,第一策略并不限于上述实施例所列举的方式,还可设置成其他方式。In this implementation manner, when the angle range of the first included angle and/or the cosine value of the first included angle meets the first strategy, it is determined that the position of the center of gravity is offset from the expected position of the center of gravity in the front-to-rear direction. Among them, the first strategy can be set according to the use requirements of the pan/tilt. Optionally, when the cosine of the first included angle is positive, it is determined that the position of the center of gravity is forward relative to the desired center of gravity; when the cosine of the first included angle is When the value is negative, it is determined that the position of the center of gravity is behind the expected position of the center of gravity. Optionally, when the angle range of the first included angle is within the first preset angle range, it is determined that the position of the center of gravity is forward relative to the desired center of gravity position; when the angle range of the first included angle is within the second preset angle range , Make sure that the center of gravity is behind the desired center of gravity. It can be understood that the first strategy is not limited to the manners listed in the foregoing embodiment, and may be set in other manners.
将云台三个轴拆解为三个独立的自由度,则可以选取横切俯仰轴(pitch)和横滚轴(roll)的剖面来评估云台中绕俯仰轴转动的部分的重心位置配平状态,如图3所示。其中,位置1为云台中绕俯仰轴转动的部分处于第一预设位置时的重心位置,θ 1为俯仰轴至重心位置的距离的沿线方向与水平方向形成的第一夹角,T 1为相应部分处于第一预设位置时,俯仰轴电机输出的第一力矩值,m为相应部分的质量,g为重力加速度,d为俯仰轴至重心位置的距离,设定云台旋转方向以逆时针为正。为了方便直观理解,图3中以期望重心位置为原点,以水平面和竖直面为参考,将云台剖面分割成了四个象限块。 Disassemble the three axes of the gimbal into three independent degrees of freedom, you can select the cross-section of the pitch axis (pitch) and the roll axis (roll) to evaluate the position of the center of gravity of the gimbal that rotates around the pitch axis. ,As shown in Figure 3. Among them, position 1 is the position of the center of gravity when the part of the gimbal that rotates around the pitch axis is at the first preset position, θ 1 is the first angle formed between the line direction and the horizontal direction of the distance from the pitch axis to the center of gravity position, and T 1 is When the corresponding part is in the first preset position, the first torque value output by the pitch axis motor, m is the mass of the corresponding part, g is the acceleration of gravity, d is the distance from the pitch axis to the center of gravity, set the direction of rotation of the gimbal to reverse The hour hand is positive. In order to facilitate intuitive understanding, in Figure 3, taking the desired center of gravity position as the origin, and the horizontal and vertical planes as references, the pan/tilt section is divided into four quadrant blocks.
其中,第一力矩值T 1和第一夹角θ 1满足如下公式(1): Among them, the first torque value T 1 and the first included angle θ 1 satisfy the following formula (1):
T 1=mg·d·cosθ 1  (1) T 1 =mg·d·cosθ 1 (1)
由公式(1)可知,当cosθ 1>0时,云台中绕俯仰轴转动的部分的重心位置位于图3所示的象限I或象限IV中,云台中绕俯仰轴转动的部分的重心位置相对于期望重心位置偏前;当cosθ 1<0时,云台中绕俯仰轴转动的部分的重心位置位于图3所示的象限II或象限III中,云台中绕俯仰轴转动的部分的重心位置相对于期望重心位置偏后。 It can be seen from formula (1) that when cosθ 1 > 0, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant I or IV shown in Figure 3, and the center of gravity of the part of the gimbal that rotates around the pitch axis is relatively Deviate from the desired center of gravity; when cosθ 1 <0, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in Quadrant II or Quadrant III shown in Figure 3, and the center of gravity of the part of the gimbal that rotates around the pitch axis is relatively Behind the desired center of gravity.
当0度<θ 1<90度或270度<θ 1<360度时,云台中绕俯仰轴转动的部分的重心位置位于图3所示的象限I或象限IV中,云台中绕俯仰轴转动的部分的重心位置相对于期望重心位置偏前;当90度<θ 1<270度时,云台中绕俯仰轴转动的部分的重心位置位于图3所示的象限II或象限III中,云台中绕俯仰轴转动的部分的重心位置相对于期望重心位置偏后。 When 0 degrees<θ 1 <90 degrees or 270 degrees<θ 1 <360 degrees, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant I or quadrant IV shown in Figure 3, and the gimbal rotates around the pitch axis The position of the center of gravity of the part is forward relative to the expected center of gravity; when 90 degrees<θ 1 <270 degrees, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant II or quadrant III as shown in Figure 3. The position of the center of gravity of the part rotating around the pitch axis is offset from the desired position of the center of gravity.
此外,当cosθ 1为0和/或θ 1=90度或270度时,确定重心位置在前后方向与期望重心位置不存在偏移。 In addition, when cos θ 1 is 0 and/or θ 1 =90 degrees or 270 degrees, it is determined that the center of gravity position does not deviate from the desired center of gravity position in the front-rear direction.
在第二种实现方式中,当第一力矩值T 1的绝对值大于第一预设力矩值时,确定相应部分处于第一预设位置时的重心位置在前后方向与期望重心位置存在偏移。可选的,当第一力矩值T 1大于第一预设力矩值时,确定重心位置相对于期望重心位置偏前;当第一力矩值T 1小于第一预设力矩值的相反数时,确定重心位置相对于期望重心位置偏后。其中,第一预设力矩值可根据需要设定,如第一预设力矩值可为5N·m 2,当T 1>5N·m 2时,确定重心位置相对于期望重心位置偏前;当T 1<-5N·m 2时,确定重心位置相对于期望重心位置偏后。 In the second implementation manner, when the absolute value of the first torque value T 1 is greater than the first preset torque value, it is determined that the center of gravity position when the corresponding part is at the first preset position is offset from the expected center of gravity position in the front-to-rear direction . Optionally, when the first torque value T 1 is greater than the first preset torque value, it is determined that the position of the center of gravity is forward relative to the desired center of gravity position; when the first torque value T 1 is less than the opposite of the first preset torque value, Make sure that the center of gravity is behind the desired center of gravity. Among them, the first preset torque value can be set according to needs, for example, the first preset torque value can be 5N·m 2 , when T 1 >5N·m 2 , it is determined that the center of gravity position is forward relative to the desired center of gravity position; When T 1 <-5N·m 2 , it is determined that the position of the center of gravity is behind the expected position of the center of gravity.
此外,可以理解,当第一力矩值T 1的绝对值小于或等于第一预设力矩值时,确定相应部分处于第一预设位置时的重心位置在前后方向与期望重心位置不存在偏移。 In addition, it can be understood that when the absolute value of the first torque value T 1 is less than or equal to the first preset torque value, it is determined that the center of gravity position when the corresponding part is at the first preset position does not deviate from the expected center of gravity position in the front-rear direction. .
在检测云台中绕横滚轴转动的部分的重心位置是否在左右方向与期望重心位置存在偏移的具体实施例中,云台被配置为绕横滚轴转动,本实施例的云台包括横滚轴电机。需要说明的是,本实施例中,相应部分是指云台中绕横滚轴转动的部分。其中,特定位置为第二预设位置,上述力矩值包括:相应部分处于第二预设位置时,横滚轴电机输出的第二力矩值。本实现方式中,根据力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否偏离期望重心位置的过程可包括:根据第 二力矩值,检测相应部分处于第二预设位置时的重心位置是否在左右方向与期望重心位置存在偏移。In a specific embodiment of detecting whether the center of gravity position of the part of the pan/tilt that rotates around the roll axis is offset from the desired center of gravity in the left and right direction, the pan/tilt is configured to rotate about the roll axis, and the pan/tilt in this embodiment includes a horizontal Roller motor. It should be noted that in this embodiment, the corresponding part refers to the part of the pan/tilt that rotates around the roll axis. Wherein, the specific position is the second preset position, and the aforementioned torque value includes: the second torque value output by the roll axis motor when the corresponding part is at the second preset position. In this implementation, according to the torque value, the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: detecting that the corresponding part is at the second preset according to the second torque value Whether the position of the center of gravity is offset from the desired center of gravity in the left-right direction.
根据第二力矩值,检测相应部分处于第二预设位置时的重心位置是否在左右方向与期望重心位置存在偏移的实现方式可包括以下两种实现方式:According to the second torque value, the implementation of detecting whether the center of gravity position of the corresponding part is at the second preset position is offset from the expected center of gravity position in the left-right direction may include the following two implementations:
在第一种实现方式中,参见图4,相应部分处于第二预设位置(如图4中的位置2)时,横滚轴至重心位置(即云台中绕横滚轴转动的部分处于第二预设位置时的重心位置)的距离的沿线方向与水平方向形成第二夹角θ 2。本实现方式中,根据第二力矩值,检测相应部分处于第二预设位置时的重心位置是否在左右方向与期望重心位置存在偏移的过程可包括:先根据第二力矩值,确定第二夹角的角度范围和/或第二夹角的余弦值;再根据第二夹角的角度范围和/或第二夹角的余弦值,检测相应部分处于第二预设位置时的重心位置是否在左右方向与期望重心位置存在偏移。 In the first implementation, referring to Fig. 4, when the corresponding part is in the second preset position (position 2 in Fig. 4), the roll axis to the center of gravity position (that is, the part of the pan/tilt that rotates around the roll axis is in the second preset position). The distance along the line direction and the horizontal direction form a second included angle θ 2 . In this implementation, according to the second torque value, the process of detecting whether the center of gravity position of the corresponding part is at the second preset position is offset from the expected center of gravity position in the left and right direction may include: first determining the second torque value according to the second torque value. The angle range of the included angle and/or the cosine value of the second included angle; then according to the angle range of the second included angle and/or the cosine value of the second included angle, it is detected whether the center of gravity position when the corresponding part is at the second preset position There is an offset from the desired center of gravity in the left and right direction.
本实现方式中,当第二夹角的角度范围和/或第二夹角的余弦值满足第二策略时,确定重心位置在左右方向与期望重心位置存在偏移。其中,第二策略可根据云台的使用需求设定,可选的,当第二夹角的余弦值为正数时,确定重心位置相对于期望重心位置偏右;当第二夹角的余弦值为负数时,确定重心位置相对于期望重心位置偏左。可选的,当第二夹角的角度范围在第三预设角度范围内时,确定重心位置相对于期望重心位置偏右;当第二夹角的角度范围在第四预设角度范围内时,确定重心位置相对于期望重心位置偏左。可以理解,第二策略并不限于上述实施例所列举的方式,还可设置成其他方式。In this implementation manner, when the angle range of the second included angle and/or the cosine value of the second included angle meets the second strategy, it is determined that the position of the center of gravity is deviated from the desired position of the center of gravity in the left-right direction. Among them, the second strategy can be set according to the use requirements of the pan/tilt. Optionally, when the cosine of the second included angle is positive, it is determined that the position of the center of gravity is to the right of the desired center of gravity; when the cosine of the second included angle is When the value is negative, it is determined that the position of the center of gravity is to the left relative to the expected position of the center of gravity. Optionally, when the angle range of the second included angle is within the third preset angle range, it is determined that the position of the center of gravity is off to the right with respect to the desired center of gravity position; when the angle range of the second included angle is within the fourth preset angle range , Make sure that the center of gravity is to the left relative to the desired center of gravity. It can be understood that the second strategy is not limited to the manners listed in the foregoing embodiment, and may be set in other manners.
将云台三个轴拆解为三个独立的自由度,则可以选取横切俯仰轴(pitch)和横滚轴(roll)的剖面来评估相应部分的重心位置配平状态,如图4所示。其中,位置2为云台中绕横滚轴转动的部分处于第二预设位置时的重心位置,θ 2为横滚轴至重心位置的距离的沿线方向与水平方向形成的第二夹角,T 2为相应部分处于第二预设位置时,横滚轴电机输出的第二力矩值,m为相应部分的质量,g为重力加速度,d为横滚轴至重心位置的距离,设定云台旋转方向以逆时针为正。为了方便直观理解,图4中以期望重心位置为原点,以水平面和竖直面为参考,将云台剖面分割成了四个象限块。 Disassemble the three axes of the gimbal into three independent degrees of freedom, you can select the cross-section of the pitch axis (pitch) and the roll axis (roll) to evaluate the position of the center of gravity of the corresponding part of the balance, as shown in Figure 4 . Wherein, position 2 is the position of the center of gravity when the part of the pan/tilt that rotates around the roll axis is in the second preset position, θ 2 is the second included angle formed by the line direction and the horizontal direction of the distance from the roll axis to the center of gravity, T 2 is the second torque value output by the roll axis motor when the corresponding part is in the second preset position, m is the mass of the corresponding part, g is the acceleration of gravity, and d is the distance from the roll axis to the center of gravity. The direction of rotation is positive counterclockwise. In order to facilitate intuitive understanding, in Figure 4, taking the desired center of gravity position as the origin, and the horizontal and vertical planes as references, the pan/tilt section is divided into four quadrant blocks.
其中,第二力矩值T 2和第二夹角θ 2满足如下公式(2): Among them, the second torque value T 2 and the second included angle θ 2 satisfy the following formula (2):
T 2=mg·d·cosθ 2   (2) T 2 =mg·d·cosθ 2 (2)
由公式(2)可知,当cosθ 2>0时,云台中绕横滚轴转动的部分的重心位置位于 图4所示的象限I或象限IV中,云台中绕横滚轴转动的部分的重心位置相对于期望重心位置偏右;当cosθ 2<0时,云台中绕横滚轴转动的部分的重心位置位于图4所示的象限II或象限III中,云台中绕横滚轴转动的部分的重心位置相对于期望重心位置偏左。 It can be seen from formula (2) that when cosθ 2 >0, the center of gravity of the part of the pan/tilt that rotates around the roll axis is located in quadrant I or IV shown in Figure 4, and the center of gravity of the part of the pan/tilt that rotates about the roll axis The position is to the right relative to the desired center of gravity; when cosθ 2 <0, the center of gravity of the part of the gimbal that rotates around the roll axis is in quadrant II or III as shown in Figure 4, and the part of the gimbal that rotates around the roll axis The position of the center of gravity is to the left of the desired center of gravity.
当0度<θ 2<90度或270度<θ 2<360度时,云台中绕横滚轴转动的部分的重心位置位于图4所示的象限I或象限IV中,云台中绕横滚轴转动的部分的重心位置相对于期望重心位置偏右;当90度<θ 2<270度时,云台中绕横滚轴转动的部分的重心位置位于图4所示的象限II或象限III中,云台中绕横滚轴转动的部分的重心位置相对于期望重心位置偏左。 When 0 degrees<θ 2 <90 degrees or 270 degrees<θ 2 <360 degrees, the center of gravity of the part of the gimbal that rotates around the roll axis is located in the quadrant I or IV shown in Figure 4, and the gimbal rolls around The position of the center of gravity of the part of the axis rotation is offset to the right of the desired position of the center of gravity; when 90 degrees<θ 2 <270 degrees, the center of gravity of the part of the gimbal that rotates around the roll axis is located in quadrant II or quadrant III as shown in Figure 4 , The center of gravity of the part of the pan/tilt that rotates around the roll axis is leftward relative to the desired center of gravity.
此外,当cosθ 2为0和/或θ 2=90度或270度时,确定重心位置在左右方向与期望重心位置不存在偏移。 In addition, when cosθ 2 is 0 and/or θ 2 =90 degrees or 270 degrees, it is determined that the center of gravity position does not deviate from the desired center of gravity position in the left-right direction.
在第二种实现方式中,当第二力矩值T 2的绝对值大于第二预设力矩值时,确定相应部分处于第二预设位置时的重心位置在左右方向与期望重心位置存在偏移。可选的,当第二力矩值大于第二预设力矩值时,确定重心位置相对于期望重心位置偏右;当第二力矩值小于第二预设力矩值的相反数时,确定重心位置相对于期望重心位置偏左。其中,第二预设力矩值可根据需要设定,如第二预设力矩值可为3N·m 2,当T 1>3N·m 2时,确定重心位置相对于期望重心位置偏右;当T 1<-3N·m 2时,确定重心位置相对于期望重心位置偏左。 In the second implementation manner, when the absolute value of the second torque value T 2 is greater than the second preset torque value, it is determined that the center of gravity position when the corresponding part is at the second preset position is offset from the desired center of gravity position in the left-right direction . Optionally, when the second torque value is greater than the second preset torque value, it is determined that the center of gravity position is to the right relative to the desired center of gravity position; when the second torque value is less than the opposite of the second preset torque value, it is determined that the center of gravity position is relatively To the left of the desired center of gravity. Among them, the second preset torque value can be set according to needs. For example, the second preset torque value can be 3N·m 2. When T 1 >3N·m 2 , it is determined that the center of gravity position is to the right relative to the desired center of gravity position; When T 1 <-3N·m 2 , it is determined that the center of gravity position is to the left relative to the desired center of gravity position.
此外,可以理解,当第二力矩值T 2的绝对值小于或等于第二预设力矩值时,确定相应部分处于第二预设位置时的重心位置在左右方向与期望重心位置不存在偏移。 In addition, it can be understood that when the absolute value of the second torque value T 2 is less than or equal to the second preset torque value, it is determined that the center of gravity position when the corresponding part is at the second preset position does not deviate from the desired center of gravity position in the left-right direction. .
在检测云台中绕俯仰轴转动的部分的重心位置是否在上下方向与期望重心位置存在偏移的具体实施例中,云台包括俯仰轴电机,本实施例的相应部分是指云台中绕俯仰轴转动的部分。其中,特定位置包括第三预设位置和第四预设位置,力矩值包括:相应部分处于第三预设位置时,俯仰轴电机输出的第三力矩值,以及相应部分处于第四预设位置时,俯仰轴电机输出的第四力矩值。本实施例中,根据力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否偏离期望重心位置的过程可包括:根据第三力矩值和第四力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移。In a specific embodiment for detecting whether the center of gravity position of the part of the pan/tilt rotating around the pitch axis is offset from the desired center of gravity position in the up and down direction, the pan/tilt includes a pitch axis motor, and the corresponding part in this embodiment refers to the tilt axis in the pan/tilt. The rotating part. Wherein, the specific position includes the third preset position and the fourth preset position, the torque value includes: when the corresponding part is at the third preset position, the third torque value output by the pitch axis motor, and the corresponding part is at the fourth preset position When, the fourth torque value output by the pitch axis motor. In this embodiment, according to the torque value, the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: detecting the corresponding part according to the third torque value and the fourth torque value Whether the center of gravity position at the target position in at least one preset position is offset from the desired center of gravity position in the up and down direction.
其中,相应部分处于第三预设位置时俯仰轴至重心位置的距离的沿线方向,与 相应部分位于第四预设位置时俯仰轴至重心位置的距离的沿线方向的夹角大小固定。可选的,相应部分处于第三预设位置时俯仰轴至重心位置的距离的沿线方向,与相应部分位于第四预设位置时俯仰轴至重心位置的距离的沿线方向的夹角大于0度并小于180度,该夹角可为20度、30度、40度或其他大于0度并小于180度的角度大小。Wherein, the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the third preset position and the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the fourth preset position have a fixed size. Optionally, the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the third preset position, and the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the fourth preset position is greater than 0 degrees If it is less than 180 degrees, the included angle can be 20 degrees, 30 degrees, 40 degrees, or other angles greater than 0 degrees and less than 180 degrees.
在一实施例中,参见图5,相应部分处于第三预设位置时俯仰轴至重心位置(即云台中绕俯仰轴转动的部分处于第三预设位置时的重心位置)的距离的沿线方向与相应部分处于目标位置时俯仰轴至重心位置的距离的沿线方向形成第三夹角θ 3;相应部分处于第四预设位置时俯仰轴至重心位置(即云台中绕俯仰轴转动的部分处于第四预设位置时的重心位置)的距离的沿线方向与相应部分处于目标位置时俯仰轴至重心位置的距离的沿线方向形成第三夹角形成第四夹角θ 4In one embodiment, referring to FIG. 5, the distance along the line from the pitch axis to the center of gravity position when the corresponding part is at the third preset position (that is, the center of gravity position when the part of the gimbal that rotates around the pitch axis is at the third preset position) It forms a third angle θ 3 along the line with the distance from the pitch axis to the center of gravity when the corresponding part is at the target position; when the corresponding part is at the fourth preset position, the pitch axis to the center of gravity position (that is, the part of the gimbal that rotates around the pitch axis is at The distance along the line direction of the center of gravity position at the fourth preset position and the distance along the line direction of the pitch axis to the center of gravity position when the corresponding part is at the target position form a third included angle forming a fourth included angle θ 4 .
可选的,第三夹角θ 3和第四夹角θ 4大小相等。在一些例子中,第三预设位置为:在相应部分处于目标位置时,绕第一方向旋转第一预设夹角大小后相应部分的位置;第四预设位置为:在相应部分处于第三预设位置时,绕第二方向旋转第一预设夹角的两倍大小后相应部分的位置。在另一些例子中,第三预设位置为:在相应部分处于目标位置时,绕第一方向旋转第一预设夹角大小后相应部分的位置;第四预设位置为:在相应部分处于目标位置时,绕第二方向旋转第一预设夹角大小后相应部分的位置。其中,第一方向与第二方向为相反的两个方向,当第一方向为逆时针方向时,第二方向则为顺时针方向;当第一方向为顺时针方向时,第二方向则为逆时针方向。具体到图5所示实施例中,第一方向为逆时针方向,第二方向为顺时针方向。进一步的,第一预设夹角大小可根据需要设置,本实施例的第一预设夹角大于0度并小于90度,如第一预设夹角可为10度、15度、20度、30度或其他大于0度并小于90度的角度大小。 Optionally, the third included angle θ 3 and the fourth included angle θ 4 are equal in magnitude. In some examples, the third preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the first preset angle in the first direction; the fourth preset position is: when the corresponding part is in the first In the case of three preset positions, the position of the corresponding part is rotated around the second direction twice the size of the first preset included angle. In other examples, the third preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the first preset angle around the first direction; the fourth preset position is: when the corresponding part is at At the target position, the position of the corresponding part after rotating the first preset angle in the second direction. Among them, the first direction and the second direction are two opposite directions. When the first direction is counterclockwise, the second direction is clockwise; when the first direction is clockwise, the second direction is Counterclockwise. Specifically, in the embodiment shown in FIG. 5, the first direction is a counterclockwise direction, and the second direction is a clockwise direction. Further, the size of the first preset included angle can be set as required. The first preset included angle in this embodiment is greater than 0 degrees and less than 90 degrees. For example, the first preset included angle may be 10 degrees, 15 degrees, and 20 degrees. , 30 degrees or other angles greater than 0 degrees and less than 90 degrees.
在其他实施例中,相应部分处于第三预设位置时俯仰轴至重心位置的距离的沿线方向可与相应部分处于目标位置时俯仰轴至重心位置的距离的沿线方向重合,或者相应部分处于第四预设位置时俯仰轴至重心位置的距离的沿线方向可与相应部分处于目标位置时俯仰轴至重心位置的距离的沿线方向重合。In other embodiments, the line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is in the third preset position may coincide with the line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the target position, or the corresponding part is in the first position. The along-line direction of the distance from the pitch axis to the center of gravity position at the four preset positions may coincide with the along-line direction of the distance from the pitch axis to the center of gravity position when the corresponding part is at the target position.
以下实施例中,以第三夹角θ 3和第四夹角θ 4大小相等(θ 3=θ 4=β 1)为例来说明如何根据第三力矩值和第四力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移。 In the following embodiments, the third angle θ 3 and the fourth angle θ 4 are equal (θ 341 ) as an example to illustrate how to detect the corresponding part according to the third torque value and the fourth torque value Whether the center of gravity position at the target position in at least one preset position is offset from the desired center of gravity position in the up and down direction.
根据第三力矩值和第四力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移的实现方式可包括如下两种:According to the third torque value and the fourth torque value, detecting whether the center of gravity position of the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction may include the following two implementations:
在第一种实现方式中,参见图5,在相应部分位于目标位置时,俯仰轴至重心位置(即相应部分处于目标位置时的重心位置)的距离的沿线方向与水平方向形成第五夹角θ 5。本实现方式中,根据第三力矩值和第四力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移的过程可包括:根据第三力矩值和第四力矩值,确定第五夹角的角度范围和/或第五夹角的正弦值;根据第五夹角的角度范围和/或第五夹角的正弦值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移。 In the first implementation, referring to Figure 5, when the corresponding part is located at the target position, the distance from the pitch axis to the center of gravity position (that is, the center of gravity position when the corresponding part is at the target position) forms a fifth included angle with the horizontal direction. θ 5 . In this implementation, according to the third torque value and the fourth torque value, the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction may include: The third torque value and the fourth torque value determine the angle range of the fifth included angle and/or the sine value of the fifth included angle; according to the angle range of the fifth included angle and/or the sine value of the fifth included angle, detect the corresponding Whether the center of gravity position when part of the target position is in at least one preset position is offset from the expected center of gravity position in the up and down direction.
本实现方式中,当第五夹角的角度范围和/或第五夹角的正弦值满足第三策略时,确定重心位置在上下方向与期望重心位置存在偏移。其中,第三策略可根据云台的使用需求设定,可选的,当第五夹角的正弦值为正数时,确定重心位置相对于期望重心位置偏上;当第五夹角的正弦值为负数时,确定重心位置相对于期望重心位置偏下。可选的,当第五夹角的角度范围在第五预设角度范围内时,确定重心位置相对于期望重心位置偏上;当第五夹角的角度范围在第六预设角度范围内时,确定重心位置相对于期望重心位置偏下。可以理解,第三策略并不限于上述实施例所列举的方式,还可设置成其他方式。In this implementation manner, when the angle range of the fifth included angle and/or the sine value of the fifth included angle meets the third strategy, it is determined that the position of the center of gravity is offset from the desired center of gravity position in the up and down direction. Among them, the third strategy can be set according to the use requirements of the PTZ. Optionally, when the sine of the fifth included angle is positive, it is determined that the position of the center of gravity is higher than the expected position of the center of gravity; when the sine of the fifth included angle is When the value is negative, it is determined that the position of the center of gravity is lower than the expected position of the center of gravity. Optionally, when the angle range of the fifth included angle is within the fifth preset angle range, it is determined that the position of the center of gravity is higher than the expected position of the center of gravity; when the angle range of the fifth included angle is within the sixth preset angle range , Make sure that the center of gravity position is lower than the desired center of gravity position. It can be understood that the third strategy is not limited to the manners listed in the foregoing embodiment, and may be set in other manners.
将云台三个轴拆解为三个独立的自由度,则可以选取横切俯仰轴(pitch)和横滚轴(roll)的剖面来评估相应部分的重心位置配平状态,如图5所示。其中,位置3为云台中绕俯仰轴转动的部分处于第三预设位置时的重心位置,位置4为云台中绕俯仰轴转动的部分处于第四预设位置时的重心位置,θ 3为相应部分处于第三预设位置时俯仰轴至重心位置的距离的沿线方向与相应部分处于目标位置时俯仰轴至重心位置的距离的沿线方向形成的第三夹角,θ 4为相应部分处于第四预设位置时俯仰轴至重心位置的距离的沿线方向与相应部分处于目标位置时俯仰轴至重心位置的距离的沿线方向形成的第四夹角,θ 5为相应部分位于目标位置时,俯仰轴至重心位置(即相应部分处于目标位置时的重心位置)的距离的沿线方向与水平方向形成的第五夹角,T 3为相应部分处于第三预设位置时,俯仰轴电机输出的第三力矩值,T 4为相应部分处于第四预设位置时,俯仰轴电机输出的第四力矩值,m为相应部分的质量,g为重力加速度,d为俯仰轴至重心位置的距离,设定云台旋转方向以逆时针为正。为了方便直观理解, 图5中以期望重心位置为原点,以水平面和竖直面为参考,将云台剖面分割成了四个象限块。 Disassemble the three axes of the gimbal into three independent degrees of freedom, you can select the cross-section of the pitch axis (pitch) and the roll axis (roll) to evaluate the center of gravity position and trim status of the corresponding part, as shown in Figure 5. . Among them, position 3 is the center of gravity when the part of the gimbal that rotates around the pitch axis is at the third preset position, position 4 is the position of the center of gravity when the part of the gimbal that rotates around the pitch axis is at the fourth preset position, and θ 3 is the corresponding The third angle formed by the distance along the line from the pitch axis to the center of gravity when the part is in the third preset position and the distance along the line from the pitch axis to the center of gravity when the corresponding part is at the target position, θ 4 is the fourth The fourth angle formed by the distance along the line from the pitch axis to the center of gravity at the preset position and the distance from the pitch axis to the center of gravity when the corresponding part is at the target position. θ 5 is the pitch axis when the corresponding part is at the target position. The fifth angle formed by the distance to the center of gravity (that is, the position of the center of gravity when the corresponding part is at the target position) and the horizontal direction. T 3 is the third angle output by the pitch axis motor when the corresponding part is at the third preset position. Torque value, T 4 is the fourth torque value output by the pitch axis motor when the corresponding part is in the fourth preset position, m is the mass of the corresponding part, g is the acceleration of gravity, d is the distance from the pitch axis to the center of gravity, set The direction of rotation of the gimbal is positive counterclockwise. In order to facilitate intuitive understanding, in Fig. 5, with the desired center of gravity position as the origin, and the horizontal and vertical planes as references, the pan/tilt section is divided into four quadrant blocks.
其中,第三力矩值T 3与第五夹角θ 5以及第四力矩值T 4与第五夹角θ 5满足如下公式(3): Among them, the third torque value T 3 and the fifth angle θ 5 and the fourth torque value T 4 and the fifth angle θ 5 satisfy the following formula (3):
Figure PCTCN2019078008-appb-000001
Figure PCTCN2019078008-appb-000001
由公式(3)推导获得:Derived from formula (3):
T 4-T 3=2mg·d·sinβ 1·sinθ 5  (4) T 4 -T 3 =2mg·d·sinβ 1 ·sinθ 5 (4)
由于T 3、T 4、m、g、d以及β 1均已知,故由公式(4)可知,当sinθ 5>0时,云台中绕俯仰轴转动的部分的重心位置位于图5所示的象限I或象限II中,确定重心位置相对于期望重心位置偏上;当sinθ 5<0时,云台中绕俯仰轴转动的部分的重心位置位于图5所示的象限III或象限IV中,确定重心位置相对于期望重心位置偏下。 Since T 3 , T 4 , m, g, d and β 1 are all known, it can be known from formula (4) that when sinθ 5 > 0, the center of gravity of the part of the gimbal that rotates around the pitch axis is located as shown in Figure 5 In the quadrant I or quadrant II, the center of gravity is determined to be higher than the desired center of gravity; when sinθ 5 <0, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in the quadrant III or quadrant IV shown in Figure 5. Make sure that the center of gravity is lower than the desired center of gravity.
当0度<θ 5<180度时,云台中绕俯仰轴转动的部分的重心位置位于图5所示的象限I或象限II中,确定重心位置相对于期望重心位置偏上;当180度<θ 5<360度时,云台中绕俯仰轴转动的部分的重心位置位于图5所示的象限III或象限IV中,确定重心位置相对于期望重心位置偏下。 When 0 degrees<θ 5 <180 degrees, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant I or quadrant II as shown in Figure 5. It is determined that the center of gravity position is higher than the expected center of gravity position; when 180 degrees< When θ 5 <360 degrees, the center of gravity of the part of the gimbal that rotates around the pitch axis is located in quadrant III or quadrant IV shown in Figure 5, and the center of gravity is determined to be lower than the desired center of gravity.
此外,当sinθ 5为0和/或θ 5=0度、180度时,确定重心位置在上下方向与期望重心位置不存在偏移。 In addition, when sin θ 5 is 0 and/or θ 5 =0 degrees, 180 degrees, it is determined that the center of gravity position does not deviate from the desired center of gravity position in the vertical direction.
在第二种实现方式中,当第三力矩值T 3和第四力矩值T 4的差值的绝对值|T 4-T 3|大于第三预设力矩值时,确定重心位置在上下方向与期望重心位置存在偏移。可选的,当第三力矩值和第四力矩值的差值大于第三预设力矩值时,确定重心位置相对于期望重心位置偏下;当第三力矩值和第四力矩值的差值小于第三预设力矩值的相反数时,确定重心位置相对于期望重心位置偏上。其中,第三预设力矩值可根据需要设定,如第三预设力矩值可为8N·m 2,当T 3-T 4>8N·m 2时,确定重心位置相对于期望重心位置偏下;当T 3-T 4<-8N·m 2时,确定重心位置相对于期望重心位置偏上。 In the second implementation manner, when the absolute value of the difference between the third torque value T 3 and the fourth torque value T 4 |T 4 -T 3 | is greater than the third preset torque value, it is determined that the center of gravity position is in the up and down direction There is an offset from the desired center of gravity. Optionally, when the difference between the third torque value and the fourth torque value is greater than the third preset torque value, it is determined that the center of gravity position is lower than the expected center of gravity position; when the difference between the third torque value and the fourth torque value When it is less than the inverse of the third preset torque value, it is determined that the position of the center of gravity is higher than the expected position of the center of gravity. Among them, the third preset torque value can be set according to needs, for example, the third preset torque value can be 8N·m 2 , when T 3 -T 4 >8N·m 2 , it is determined that the center of gravity position is deviated from the desired center of gravity position Down; When T 3 -T 4 <-8N·m 2 , it is determined that the center of gravity position is higher than the expected center of gravity position.
此外,可以理解,当第三力矩值T 3和第四力矩值T 4的差值的绝对值|T 4-T 3|小于或等于第三预设力矩值时,确定相应部分的重心位置在上下方向与期望重心位置不存 在偏移。 In addition, it can be understood that when the absolute value of the difference between the third torque value T 3 and the fourth torque value T 4 |T 4 -T 3 | is less than or equal to the third preset torque value, it is determined that the center of gravity position of the corresponding part is There is no deviation between the up and down direction and the desired center of gravity.
在检测云台中绕横滚轴转动的部分的重心位置是否在上下方向与期望重心位置存在偏移的具体实施例中,云台包括横滚轴电机,本实施例的相应部分是指云台中绕横滚轴转动的部分。其中,特定位置包括第五预设位置和第六预设位置,力矩值包括:相应部分处于第五预设位置时,横滚轴电机输出的第五力矩值,以及相应部分处于第六预设位置时,横滚轴输出的第六力矩值。本实施例中,根据力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否偏离期望重心位置的过程可包括:根据第五力矩值和第六力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移。In a specific embodiment for detecting whether the center of gravity position of the part that rotates around the roll axis in the pan/tilt head is offset from the desired center of gravity position in the up and down direction, the pan/tilt head includes a roll axis motor, and the corresponding part in this embodiment refers to The part where the roll axis turns. Among them, the specific position includes the fifth preset position and the sixth preset position, the torque value includes: when the corresponding part is at the fifth preset position, the fifth torque value output by the roll axis motor, and the corresponding part is at the sixth preset position Position, the sixth torque value output by the roll axis. In this embodiment, according to the torque value, the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position deviates from the expected center of gravity position may include: detecting the corresponding part according to the fifth torque value and the sixth torque value Whether the center of gravity position at the target position in at least one preset position is offset from the desired center of gravity position in the up and down direction.
其中,相应部分处于第五预设位置时横滚轴至重心位置的距离的沿线方向,与相应部分位于第六预设位置时横滚轴至重心位置的距离的沿线方向的夹角大小固定。可选的,相应部分处于第五预设位置时横滚轴至重心位置的距离的沿线方向,与相应部分位于第六预设位置时横滚轴至重心位置的距离的沿线方向的夹角大于0度并小于180度,该夹角可为20度、30度、40度或其他大于0度并小于180度的角度大小。Wherein, when the corresponding part is at the fifth preset position, the distance along the line from the roll axis to the center of gravity position is fixed in size with the distance from the roll axis to the center of gravity position when the corresponding part is at the sixth preset position. Optionally, the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the fifth preset position and the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the sixth preset position is greater than 0 degrees and less than 180 degrees, the included angle can be 20 degrees, 30 degrees, 40 degrees, or other angles greater than 0 degrees and less than 180 degrees.
在一实施例中,参见图6,相应部分处于第五预设位置时,横滚轴至重心位置(即云台中绕横滚轴转动的部分处于第五预设位置时的重心位置)的距离的沿线方向与相应部分处于目标位置时横滚轴至重心位置的距离的沿线方向形成第六夹角θ 6;相应部分处于第六预设位置时,横滚轴至重心位置(即云台中绕俯仰轴转动的部分处于第六预设位置时的重心位置)的距离的沿线方向与相应部分处于目标位置时横滚轴至重心位置的距离的沿线方向形成第七夹角θ 7In one embodiment, referring to FIG. 6, when the corresponding part is at the fifth preset position, the distance from the roll axis to the center of gravity position (that is, the center of gravity position when the part of the pan/tilt that rotates around the roll axis is at the fifth preset position) When the corresponding part is at the target position, the distance along the line from the roll axis to the center of gravity forms a sixth included angle θ 6 ; when the corresponding part is at the sixth preset position, the roll axis to the center of gravity position (ie The distance along the line direction of the distance of the part that the pitch axis rotates at the sixth preset position and the distance along the line from the roll axis to the center of gravity position when the corresponding part is at the target position forms a seventh included angle θ 7 .
可选的,第六夹角θ 6和第七夹角θ 7大小相等。在一些例子中,第五预设位置为:在相应部分处于目标位置时,绕第三方向旋转第二预设夹角大小后相应部分的位置;第六预设位置为:在相应部分处于第五预设位置时,绕第四方向旋转第二预设夹角的两倍大小后相应部分的位置。在另一些例子中,第五预设位置为:在相应部分处于目标位置时,绕第三方向旋转第二预设夹角大小后相应部分的位置;第六预设位置为:在相应部分处于目标位置时,绕第四方向旋转第二预设夹角大小后相应部分的位置。其中,第三方向与第四方向为相反的两个方向,当第三方向为逆时针方向时,第四方向则为顺时针方向;当第三方向为顺时针方向时,第四方向则为逆时针方向。具体到图6所示实施例中,第三方向为逆时针方向,第四方向为顺时针方向。进一步的,第二预设夹角大小可根据需要设置,本实施例的第二预设夹角大于0度并小于90度,如 第一预设夹角可为10度、15度、20度、30度或其他大于0度并小于90度的角度大小。 Optionally, the sixth included angle θ 6 and the seventh included angle θ 7 are equal in magnitude. In some examples, the fifth preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the second preset angle around the third direction; the sixth preset position is: when the corresponding part is in the first When the preset position is five, the position of the corresponding part is rotated around the fourth direction by twice the second preset included angle. In other examples, the fifth preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the second preset angle around the third direction; the sixth preset position is: when the corresponding part is at At the target position, the position of the corresponding part after rotating the second preset angle in the fourth direction. Among them, the third direction and the fourth direction are two opposite directions. When the third direction is counterclockwise, the fourth direction is clockwise; when the third direction is clockwise, the fourth direction is Counterclockwise. Specifically, in the embodiment shown in FIG. 6, the third direction is a counterclockwise direction, and the fourth direction is a clockwise direction. Further, the size of the second preset included angle can be set as required. The second preset included angle of this embodiment is greater than 0 degrees and less than 90 degrees. For example, the first preset included angle may be 10 degrees, 15 degrees, and 20 degrees. , 30 degrees or other angles greater than 0 degrees and less than 90 degrees.
在其他实施例中,相应部分处于第五预设位置时横滚轴至重心位置的距离的沿线方向可与相应部分处于目标位置时横滚轴至重心位置的距离的沿线方向重合,或者相应部分处于第六预设位置时横滚轴至重心位置的距离的沿线方向可与相应部分处于目标位置时横滚轴至重心位置的距离的沿线方向重合。In other embodiments, the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the fifth preset position may coincide with the along-line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the target position, or the corresponding part The line direction of the distance from the roll axis to the center of gravity position at the sixth preset position may coincide with the line direction of the distance from the roll axis to the center of gravity position when the corresponding part is at the target position.
以下实施例中,以第六夹角θ 6和第七夹角θ 7大小相等(θ 6=θ 7=β 2)为例来说明如何根据第五力矩值和第六力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移。 In the following embodiments, the sixth included angle θ 6 and the seventh included angle θ 7 are equal (θ 6 =θ 7 =β 2 ) as an example to illustrate how to detect the corresponding part according to the fifth torque value and the sixth torque value Whether the center of gravity position at the target position in at least one preset position is offset from the desired center of gravity position in the up and down direction.
根据第五力矩值和第六力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移的实现方式可包括如下两种实现方式:According to the fifth torque value and the sixth torque value, the implementation of detecting whether the center of gravity position of the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the vertical direction may include the following two implementation methods:
在第一种实现方式中,参见图6,在相应部分位于目标位置时,横滚轴至重心位置(即相应部分处于目标位置时的重心位置)的距离的沿线方向与水平方向形成第八夹角θ 8。本实现方式中,根据第五力矩值和第六力矩值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在上下方向与期望重心位置存在偏移的过程可包括:根据第五力矩值和第六力矩值,确定第八夹角的角度范围和/或第八夹角的正弦值;根据第八夹角的角度范围和/或第八夹角的正弦值,检测相应部分处于至少一个预设位置中的目标位置时的重心位置是否在前后方向与期望重心位置存在偏移。 In the first implementation, referring to Figure 6, when the corresponding part is at the target position, the distance between the roll axis and the center of gravity position (that is, the center of gravity position when the corresponding part is at the target position) forms an eighth clamp along the line and the horizontal direction. Angle θ 8 . In this implementation, according to the fifth torque value and the sixth torque value, the process of detecting whether the center of gravity position when the corresponding part is at the target position in at least one preset position is offset from the expected center of gravity position in the up and down direction may include: The fifth torque value and the sixth torque value determine the angle range of the eighth included angle and/or the sine value of the eighth included angle; detect the corresponding angle range and/or the sine value of the eighth included angle Whether the center of gravity position when part of the target position is in at least one preset position is offset from the expected center of gravity position in the front-to-back direction.
本实现方式中,当第八夹角的角度范围和/或第八夹角的正弦值满足第四策略时,确定重心位置在上下方向与期望重心位置存在偏移。其中,第四策略可根据云台的使用需求设定,可选的,当第八夹角的正弦值为正数时,确定重心位置相对于期望重心位置偏上;当第八夹角的正弦值为负数时,确定重心位置相对于期望重心位置偏下。可选的,当第八夹角的角度范围在第七预设角度范围内时,确定重心位置相对于期望重心位置偏上;当第八夹角的角度范围在第八预设角度范围内时,确定重心位置相对于期望重心位置偏下。In this implementation, when the angle range of the eighth included angle and/or the sine value of the eighth included angle meets the fourth strategy, it is determined that the position of the center of gravity is offset from the desired center of gravity position in the up and down direction. Among them, the fourth strategy can be set according to the use requirements of the PTZ. Optionally, when the sine of the eighth included angle is positive, it is determined that the position of the center of gravity is higher than the expected position of the center of gravity; when the sine of the eighth included angle is When the value is negative, it is determined that the position of the center of gravity is lower than the expected position of the center of gravity. Optionally, when the angle range of the eighth included angle is within the seventh preset angle range, it is determined that the position of the center of gravity is offset relative to the desired center of gravity position; when the angle range of the eighth included angle is within the eighth preset angle range , Make sure that the center of gravity position is lower than the desired center of gravity position.
将云台三个轴拆解为三个独立的自由度,则可以选取横切俯仰轴(pitch)和横滚轴(roll)的剖面来评估相应部分的重心位置配平状态,如图6所示。其中,位置5为云台中绕横滚轴转动的部分处于第五预设位置时的重心位置,位置6为云台中绕横 滚轴转动的部分处于第六预设位置时的重心位置,θ 6为相应部分处于第五预设位置时横滚轴至重心位置的距离的沿线方向与相应部分处于目标位置时横滚轴至重心位置的距离的沿线方向形成的第六夹角,θ 7为相应部分处于第六预设位置时横滚轴至重心位置的距离的沿线方向与相应部分处于目标位置时横滚轴至重心位置的距离的沿线方向形成的第七夹角,θ 8为相应部分位于目标位置时,横滚轴至重心位置(即相应部分处于目标位置时的重心位置)的距离的沿线方向与水平方向形成的第八夹角,T 5为相应部分处于第五预设位置时,横滚轴电机输出的第五力矩值,T 6为相应部分处于第六预设位置时,横滚轴电机输出的第六力矩值,m为相应部分的质量,g为重力加速度,d为横滚轴至重心位置的距离,设定云台旋转方向以逆时针为正。为了方便直观理解,图6中以期望重心位置为原点,以水平面和竖直面为参考,将云台剖面分割成了四个象限块。 Disassemble the three axes of the gimbal into three independent degrees of freedom, you can select the cross section of the pitch axis (pitch) and the roll axis (roll) to evaluate the position of the center of gravity of the corresponding part, as shown in Figure 6. . Among them, position 5 is the center of gravity position when the part of the pan/tilt rotating around the roll axis is at the fifth preset position, position 6 is the position of the center of gravity when the part rotating around the roll axis of the gimbal is at the sixth preset position, θ 6 It is the sixth included angle formed along the line of the distance from the roll axis to the center of gravity when the corresponding part is at the fifth preset position and the distance from the roll axis to the center of gravity when the corresponding part is at the target position. θ 7 is the corresponding sixth predetermined cross-section when in the position to seventh roll to roll axis direction along an angle from the center of gravity of the respective portions formed when the target position in the direction of the line from the center of gravity position, θ 8 is located in a respective portion when the target position, the position of the center of gravity to the roll axis (i.e., center of gravity position in a corresponding portion of the target position) and an eighth angle along the horizontal direction is formed from a, T 5 in a fifth predetermined position corresponding moiety, The fifth torque value output by the roll axis motor, T 6 is the sixth torque value output by the roll axis motor when the corresponding part is at the sixth preset position, m is the mass of the corresponding part, g is the acceleration due to gravity, and d is the horizontal For the distance from the roller to the center of gravity, set the direction of rotation of the gimbal to be positive counterclockwise. In order to facilitate intuitive understanding, in Fig. 6, the PTZ section is divided into four quadrant blocks with the desired center of gravity position as the origin and the horizontal and vertical planes as references.
其中,第五力矩值T 5与第八夹角θ 8以及第六力矩值T 6与第八夹角θ 8满足如下公式(5): Wherein, the fifth moment value T 5 and the eighth included angle θ 8 and the sixth moment value T 6 and the eighth included angle θ 8 satisfy the following formula (5):
Figure PCTCN2019078008-appb-000002
Figure PCTCN2019078008-appb-000002
由公式(5)推导获得:Derived from formula (5):
T 6-T 5=2mg·d·sinβ 2·sinθ 8  (6) T 6 -T 5 =2mg·d·sinβ 2 ·sinθ 8 (6)
由于T 5、T 6、m、g、d以及β 2均已知,故由公式(6)可知,当sinθ 8>0时,云台中绕横滚轴转动的部分的重心位置位于图6所示的象限I或象限II中,确定重心位置相对于期望重心位置偏上;当sinθ 8<0时,云台中绕横滚轴转动的部分的重心位置位于图6所示的象限III或象限IV中,确定重心位置相对于期望重心位置偏下。 Since T 5 , T 6 , m, g, d, and β 2 are all known, it can be seen from formula (6) that when sinθ 8 > 0, the center of gravity of the part of the pan/tilt that rotates around the roll axis is located in Figure 6 In the quadrant I or quadrant II shown, the center of gravity is determined to be higher than the expected center of gravity; when sinθ 8 <0, the center of gravity of the part of the pan/tilt that rotates around the roll axis is located in the quadrant III or quadrant IV shown in Figure 6 , Confirm that the center of gravity position is lower than the desired center of gravity position.
当0度<θ 8<180度时,云台中绕横滚轴转动的部分的重心位置位于图6所示的象限I或象限II中,确定重心位置相对于期望重心位置偏上;当180度<θ 8<360度时,云台中绕横滚轴转动的部分的重心位置位于图6所示的象限III或象限IV中,确定重心位置相对于期望重心位置偏下。 When 0 degrees<θ 8 <180 degrees, the center of gravity of the part of the gimbal that rotates around the roll axis is located in quadrant I or quadrant II as shown in Figure 6. It is determined that the center of gravity position is higher than the expected center of gravity position; when 180 degrees When <θ 8 <360 degrees, the center of gravity of the part of the pan/tilt that rotates around the roll axis is located in quadrant III or quadrant IV shown in Figure 6, and the center of gravity is determined to be lower than the desired center of gravity.
此外,当sinθ 8为0和/或θ 8=0度、180度时,确定重心位置在上下方向与期望重心位置不存在偏移。 In addition, when sin θ 8 is 0 and/or θ 8 =0 degrees, 180 degrees, it is determined that the center of gravity position does not deviate from the desired center of gravity position in the vertical direction.
在第二种实现方式中,当第五力矩值T 5和第六力矩值T 6的差值的绝对值|T 6-T 5| 大于第四预设力矩值时,确定重心在上下方向与期望重心位置存在偏移。可选的,当第五力矩值和第六力矩值的差值大于第四预设力矩值时,确定重心位置相对于期望重心位置偏下;当第五力矩值和第六力矩值的差值小于第四预设力矩值的负数时,确定重心位置相对于期望重心位置偏上。其中,第四预设力矩值可根据需要设定,如第四预设力矩值可为6N·m 2,当T 5-T 6>6N·m 2时,确定重心位置相对于期望重心位置偏下;当T 5-T 6<-6N·m 2时,确定重心位置相对于期望重心位置偏上。 In the second implementation manner, when the absolute value of the difference between the fifth torque value T 5 and the sixth torque value T 6 |T 6 -T 5 | is greater than the fourth preset torque value, it is determined that the center of gravity is in the up and down direction and It is expected that the position of the center of gravity is offset. Optionally, when the difference between the fifth torque value and the sixth torque value is greater than the fourth preset torque value, it is determined that the position of the center of gravity is lower than the expected position of the center of gravity; when the difference between the fifth torque value and the sixth torque value is When it is less than the negative number of the fourth preset torque value, it is determined that the position of the center of gravity is higher than the position of the desired center of gravity. Among them, the fourth preset torque value can be set according to needs. For example, the fourth preset torque value can be 6N·m 2 , when T 5 -T 6 >6N·m 2 , it is determined that the center of gravity position is deviated from the expected center of gravity position Down; When T 5 -T 6 <-6N·m 2 , it is determined that the position of the center of gravity is higher than the expected position of the center of gravity.
此外,可以理解,当第五力矩值T 5和第六力矩值T 6的差值的绝对值|T 6-T 5|小于或等于第四预设力矩值时,确定相应部分的重心位置在上下方向与期望重心位置不存在偏移。 In addition, it can be understood that when the absolute value of the difference between the fifth torque value T 5 and the sixth torque value T 6 |T 6 -T 5 | is less than or equal to the fourth preset torque value, it is determined that the center of gravity position of the corresponding part is There is no deviation between the up and down direction and the desired center of gravity.
可选的,S102中的提示信号携带有重心位置的偏移信息,以指导用户调节负载安装在相应部分的安装位置。其中,偏移信息可包括:偏移方向和/或偏移量。例如,云台中绕横滚轴转动的部分预留多个安装部,如安装孔,用以供用户安装自定义负载。多个安装部包括沿前后方向间隔排布的多个第一安装部,以及沿上下方向间隔排布的多个第二安装部。当提示信号中的偏移信息用于指示云台中绕横滚轴转动的部分的重心位置偏前时,用户可将负载安装在位于负载当前安装位置后方的第一安装部上;当提示信号中的偏移信息用于指示云台中绕横滚轴转动的部分的重心位置偏下时,用户可将负载安装在位于负载当前安装位置上方的第二安装部上,最终使得云台中绕横滚轴转动的部分的重心位置与期望重心位置重合。可选的,相邻第一安装部之间间隔诸如0.1cm、0.2cm、0.3cm、0.4cm、0.5cm、0.6cm、0.7cm、0.8cm、0.9cm或1cm,相邻第二安装部之间间隔诸如0.1cm、0.2cm、0.3cm、0.4cm、0.5cm、0.6cm、0.7cm、0.8cm、0.9cm或1cm。当提示信号中的偏移信息用于指示云台中绕横滚轴转动的部分的重心位置偏前诸如0.1cm时,用户可将负载安装在位于负载当前安装位置后方的第一个第一安装部上;当提示信号中的偏移信息用于指示云台中绕横滚轴转动的部分的重心位置偏下0.2cm时,用户可将负载安装在位于负载当前安装位置上方的第二个第二安装部上,最终使得云台中绕横滚轴转动的部分的重心位置与期望重心位置重合。Optionally, the prompt signal in S102 carries the offset information of the position of the center of gravity to guide the user to adjust the installation position of the load installed in the corresponding part. Wherein, the offset information may include: offset direction and/or offset amount. For example, the part of the pan/tilt that rotates around the roll axis reserves multiple mounting parts, such as mounting holes, for users to install custom loads. The plurality of mounting parts includes a plurality of first mounting parts arranged at intervals in the front-rear direction, and a plurality of second mounting parts arranged at intervals in the up-down direction. When the offset information in the prompt signal is used to indicate that the center of gravity of the part of the gimbal that rotates around the roll axis is forward, the user can install the load on the first installation part behind the current installation position of the load; when the prompt signal The offset information is used to indicate that when the center of gravity of the part of the gimbal that rotates around the roll axis is lower, the user can install the load on the second installation part above the current installation position of the load, and finally make the gimbal around the roll axis The position of the center of gravity of the rotated part coincides with the position of the desired center of gravity. Optionally, the interval between adjacent first mounting parts is such as 0.1cm, 0.2cm, 0.3cm, 0.4cm, 0.5cm, 0.6cm, 0.7cm, 0.8cm, 0.9cm or 1cm, and the distance between adjacent second mounting parts Intervals such as 0.1 cm, 0.2 cm, 0.3 cm, 0.4 cm, 0.5 cm, 0.6 cm, 0.7 cm, 0.8 cm, 0.9 cm or 1 cm. When the offset information in the prompt signal is used to indicate that the center of gravity of the part of the gimbal that rotates around the roll axis is forward, such as 0.1cm, the user can install the load on the first installation part behind the current installation position of the load Up; when the offset information in the prompt signal is used to indicate that the center of gravity of the part of the gimbal that rotates around the roll axis is lower than 0.2cm, the user can install the load on the second installation above the current installation position of the load Finally, the center of gravity of the part of the pan/tilt that rotates around the roll axis will coincide with the desired center of gravity.
本实施例中,云台可采用不同的方式输出提示信号,例如,作为一种可行的实现方式,发送用于指示调整重心位置的提示信号至客户端,该客户端可与云台进行通信,该客户端可为手机、Pad等移动终端,也可为其他终端设备。In this embodiment, the pan-tilt may use different ways to output the prompt signal. For example, as a feasible implementation, a prompt signal for indicating adjustment of the center of gravity position is sent to the client, and the client can communicate with the pan-tilt. The client can be a mobile terminal such as a mobile phone, a Pad, or other terminal equipment.
作为另一种可行的实现方式,云台包括提示模块。本实现方式中,通过提示模 块输出用于指示调整重心位置的提示信号。其中,提示模块可为显示屏、语音模块或其他。As another feasible implementation manner, the pan-tilt includes a prompt module. In this implementation, the prompt module outputs a prompt signal for indicating adjustment of the center of gravity position. Among them, the prompt module can be a display screen, a voice module or others.
本实施例中,云台在进行重心配平之前,还需检测云台当前搭载的负载是否超过负载上限,若超过负载上限,则不允许进行重心配平,防止负载过大损坏云台。具体的,若第一触发信号为云台在确定云台当前搭载的负载大小处于预设的云台负载大小范围内后获得的,则认为第一触发信号为有效触发信号;若第一触发信号为云台在确定云台当前搭载的负载大小超过预设的云台负载大小范围内获得的,则认为第一触发信号为无效触发信号。本实施例中,云台在接收到有效触发信号后,才会进行重心配平。In this embodiment, before the gimbal balances the center of gravity, it needs to detect whether the load currently carried by the gimbal exceeds the upper limit of the load. If the load exceeds the upper limit, the center of gravity balance is not allowed to prevent the gimbal from being damaged by the excessive load. Specifically, if the first trigger signal is obtained by the pan/tilt after determining that the load currently carried by the pan/tilt is within the preset load range of the pan/tilt, the first trigger signal is considered to be a valid trigger signal; if the first trigger signal is If the pan/tilt is obtained when it is determined that the load size currently carried by the pan/tilt exceeds the preset load size range of the pan/tilt, the first trigger signal is considered to be an invalid trigger signal. In this embodiment, the pan/tilt will perform center of gravity trimming only after receiving a valid trigger signal.
可选的,云台包括电机,例如当云台为被配置为绕俯仰轴、横滚轴和偏航轴转动的三轴云台时,电机对应包括:俯仰轴电机、横滚轴电机和偏航轴电机;当云台被配置为绕俯仰轴和横滚轴转动的两轴云台时,电机对应包括:俯仰轴电机和横滚轴电机;当云台被配置为绕俯仰轴和偏航轴转动的两轴云台时,电机对应包括:俯仰轴电机和偏航轴电机;当云台被配置为绕横滚轴和偏航轴转动的两轴云台时,电机对应包括:横滚轴电机和偏航轴电机;当云台被配置为绕俯仰轴或横滚轴转动的单轴云台时,电机对应包括:绕俯仰轴电机或横滚轴电机;以此类推。本实施例的电机用于驱动云台转动,或者说,本实施例的相应电机用于驱动云台中的相应部分转动,例如,内框架对应的电机用于驱动内框架以及内框架搭载的负载进行转动。其中,云台上搭载的负载可以包括云台上常见的搭载负载,如成像装置,也可以包括用户自行加装的自定义负载模块,或者包括上述两者,此处不做具体限定。Optionally, the gimbal includes a motor. For example, when the gimbal is a three-axis gimbal configured to rotate around the pitch axis, roll axis, and yaw axis, the motors correspondingly include: pitch axis motor, roll axis motor, and yaw axis. Pan axis motor; when the gimbal is configured as a two-axis gimbal that rotates around the pitch axis and roll axis, the corresponding motors include: pitch axis motor and roll axis motor; when the gimbal is configured to rotate around the pitch axis and yaw For a two-axis gimbal that rotates by axis, the corresponding motors include: pitch axis motor and yaw axis motor; when the gimbal is configured as a two-axis gimbal that rotates around the roll axis and yaw axis, the corresponding motors include: roll Axis motor and yaw axis motor; when the gimbal is configured as a single-axis gimbal that rotates around the pitch axis or roll axis, the corresponding motors include: pitch axis motor or roll axis motor; and so on. The motor of this embodiment is used to drive the pan/tilt to rotate. In other words, the corresponding motor of this embodiment is used to drive the corresponding part of the pan/tilt to rotate. For example, the motor corresponding to the inner frame is used to drive the inner frame and the load carried by the inner frame. Rotate. Among them, the load carried on the pan/tilt may include common load on the pan/tilt, such as an imaging device, or a custom load module installed by the user, or both of the above, which are not specifically limited here.
对于大转动惯量(J)、同时又有快速运动需求(要求较大的角加速度α)的负载,为了保证云台的电机的输出力矩能够尽可能满足较大的角加速度需求(最大输出力矩T max=J*α max,而T max可以由云台电机输出能力确定),故合理布置负载,可以尽可能降低电机的转动惯量,从而获得尽可能大的角加速度上限α max。其中,J=J 0+m*d 2,d为负载的重心至电机的转轴的距离,m为负载质量,J 0为负载的重心设于转轴时电机的转动惯量。故可通过设置预设惯量阈值,通过比较云台电机的转动惯量与预设惯量阈值来判断云台当前搭载的负载大小处于预设的云台负载大小范围内。 For loads with large moment of inertia (J) and fast motion requirements (large angular acceleration α), in order to ensure that the output torque of the gimbal motor can meet the large angular acceleration requirements as much as possible (the maximum output torque T max = J*α max , and T max can be determined by the output capacity of the pan/tilt motor). Therefore, a reasonable load arrangement can reduce the moment of inertia of the motor as much as possible, so as to obtain the largest possible upper limit of angular acceleration α max . Among them, J=J 0 +m*d 2 , d is the distance from the center of gravity of the load to the shaft of the motor, m is the load mass, and J 0 is the moment of inertia of the motor when the center of gravity of the load is set on the shaft. Therefore, by setting the preset inertia threshold and comparing the rotational inertia of the gimbal motor with the preset inertia threshold, it can be determined that the load currently carried by the gimbal is within the preset load range of the gimbal.
本实施例中,确定云台当前搭载的负载大小处于预设的云台负载大小范围内的过程可包括:In this embodiment, the process of determining that the load size currently carried by the pan/tilt is within the preset load size range of the pan/tilt may include:
(1)在接收到用于负载评估的第二触发信号时,获取云台的电机的输出力矩 和电机的角加速度;(1) When receiving the second trigger signal for load evaluation, obtain the output torque of the motor of the gimbal and the angular acceleration of the motor;
该步骤中,第二触发信号用于指示云台进行负载评估,本实施例的云台在接收到第二触发信号后,即进行负载评估。可选的,第二触发信号由云台产生,例如,可通过操作云台上的按键/按钮等使得云台产生第二触发信号。可选的,第二触发信号由外部设备发送,该外部设备可为控制云台的遥控设备或控制终端,该控制终端可为手机、Pad等移动终端,也可为其他终端设备。当然,用户也可通过其他方式触发云台进行重心配平,诸如触控、手势、语音等。In this step, the second trigger signal is used to instruct the pan/tilt to perform load evaluation. The pan/tilt in this embodiment performs load evaluation after receiving the second trigger signal. Optionally, the second trigger signal is generated by the pan-tilt. For example, the pan-tilt can generate the second trigger signal by operating keys/buttons on the pan-tilt. Optionally, the second trigger signal is sent by an external device. The external device may be a remote control device or a control terminal that controls the pan/tilt. The control terminal may be a mobile terminal such as a mobile phone or a Pad, or other terminal devices. Of course, the user can also trigger the pan-tilt to perform center-of-gravity trimming in other ways, such as touch, gestures, and voice.
云台电机的输出力矩和电机的角加速度可由相应传感器检测获得,也可根据控制电机转动的输入信号确定,云台电机的输出力矩和电机的角加速度的确定方式为现有技术,此处不再详细说明。The output torque of the gimbal motor and the angular acceleration of the motor can be detected by corresponding sensors, and can also be determined according to the input signal that controls the rotation of the motor. The method of determining the output torque of the gimbal motor and the angular acceleration of the motor is the prior art. More details.
此外,该步骤中,对于被配置为绕俯仰轴、横滚轴和偏航轴转动的三轴云台,需获取俯仰轴电机和/或横滚轴电机的输出力矩以及俯仰轴电机和/或横滚轴电机的角加速度;对于被配置为绕俯仰轴和横滚轴转动的两轴云台,需要获取俯仰轴电机和/或横滚轴电机的输出力矩以及俯仰轴电机和/或横滚轴电机的角加速度;对于被配置为绕俯仰轴和偏航轴转动的两轴云台,需要获取俯仰轴电机的输出力矩以及俯仰轴电机的角加速度;对于被配置为绕横滚轴和偏航轴转动的两轴云台,需要获取横滚轴电机的输出力矩以及横滚轴电机的角加速度;对于被配置为绕俯仰轴或横滚轴转动的单轴云台,需要获取俯仰轴电机的输出力矩以及俯仰轴电机的角加速度、或横滚轴电机的输出力矩以及横滚轴电机的角加速度。In addition, in this step, for a three-axis gimbal that is configured to rotate around the pitch axis, roll axis, and yaw axis, the output torque of the pitch axis motor and/or roll axis motor and the pitch axis motor and/or Angular acceleration of the roll axis motor; for a two-axis gimbal configured to rotate around the pitch axis and roll axis, the output torque of the pitch axis motor and/or roll axis motor and the pitch axis motor and/or roll need to be obtained Angular acceleration of the axis motor; for a two-axis gimbal configured to rotate around the pitch axis and yaw axis, the output torque of the pitch axis motor and the angular acceleration of the pitch axis motor need to be obtained; For a two-axis gimbal that rotates on the pan axis, it needs to obtain the output torque of the roll axis motor and the angular acceleration of the roll axis motor; for a single-axis gimbal that is configured to rotate around the pitch axis or roll axis, it needs to obtain the pitch axis motor The output torque and the angular acceleration of the pitch axis motor, or the output torque of the roll axis motor and the angular acceleration of the roll axis motor.
进一步的,该步骤中,对于被配置为绕俯仰轴、横滚轴和偏航轴转动的三轴云台,若负载为用户加装的自定义负载模块,则可以只获取有驱动该自定义负载模块转动的电机的输出力矩以及角加速度。例如,俯仰轴电机驱动云台的内框架转动,但自定义负载模块加装于由横滚轴电机驱动的云台的中框架上时,可以只获取横滚轴电机的输出力矩以及角加速度。Further, in this step, for a three-axis gimbal that is configured to rotate around the pitch axis, roll axis, and yaw axis, if the load is a user-defined load module installed by the user, only the user-defined load module can be acquired. The output torque and angular acceleration of the motor that the load module rotates. For example, when the pitch axis motor drives the inner frame of the gimbal to rotate, but the custom load module is installed on the middle frame of the gimbal driven by the roll axis motor, only the output torque and angular acceleration of the roll axis motor can be obtained.
(2)根据输出力矩和角加速度,确定电机的转动惯量;(2) Determine the moment of inertia of the motor according to the output torque and angular acceleration;
该步骤是根据对应轴电机的输出力矩和该对应轴电机的角加速度,确定该对应轴电机的转动惯量。该步骤需确定俯仰轴电机和/或横滚轴电机的转动惯量。This step is to determine the moment of inertia of the corresponding shaft motor according to the output torque of the corresponding shaft motor and the angular acceleration of the corresponding shaft motor. This step needs to determine the moment of inertia of the pitch axis motor and/or roll axis motor.
其中,电机的转动惯量J的计算公式可如下:Among them, the calculation formula for the moment of inertia J of the motor can be as follows:
J=T/α   (7)J=T/α (7)
公式(7)中,T为电机的输出力矩,α为电机的角加速度。In formula (7), T is the output torque of the motor, and α is the angular acceleration of the motor.
可以理解的是,电机的转动惯量J的计算公式不限于公式(7),也可为基于公式(7)的变形。It can be understood that the formula for calculating the moment of inertia J of the motor is not limited to formula (7), and may also be a modification based on formula (7).
(3)当转动惯量小于或等于预设惯量阈值时,确定云台当前搭载的负载大小处于预设的云台负载大小范围内。(3) When the moment of inertia is less than or equal to the preset inertia threshold, it is determined that the load currently carried by the pan/tilt is within the preset load range of the pan/tilt.
该步骤中,转动惯量小于或等于预设惯量阈值包括:步骤(2)中确定的俯仰轴电机和/或横滚轴电机的转动惯量小于或等于相应的预设惯量阈值。例如,在一实施例中,转动惯量小于或等于预设惯量阈值包括:俯仰轴电机的转动惯量小于或等于第一预设惯量阈值,和/或横滚轴电机的转动惯量小于或等于第二预设惯量阈值。其中,第一预设惯量阈值与第二预设惯量阈值的大小可相等,也可不相等,可根据具体结构设置第一预设惯量阈值和第二预设惯量阈值的大小。In this step, the moment of inertia being less than or equal to the preset inertia threshold includes: the moment of inertia of the pitch axis motor and/or the roll axis motor determined in step (2) is less than or equal to the corresponding preset inertia threshold. For example, in an embodiment, that the moment of inertia is less than or equal to the preset inertia threshold includes: the moment of inertia of the pitch axis motor is less than or equal to the first preset inertia threshold, and/or the moment of inertia of the roll axis motor is less than or equal to the second Preset inertia threshold. Wherein, the size of the first preset inertia threshold and the second preset inertia threshold may be equal or unequal, and the sizes of the first preset inertia threshold and the second preset inertia threshold may be set according to the specific structure.
该步骤中,预设惯量阈值可根据负载的角加速度需求设定。In this step, the preset inertia threshold can be set according to the angular acceleration demand of the load.
本实施例的云台重心配平的方法还可包括:当转动惯量大于预设惯量阈值时,确定云台当前搭载的负载过大,需要对用户进行提示,减少负载,以保护云台,防止云台损坏。The method for balancing the center of gravity of the gimbal in this embodiment may further include: when the moment of inertia is greater than the preset inertia threshold, it is determined that the load currently carried by the gimbal is too large, and the user needs to be prompted to reduce the load to protect the gimbal and prevent The gimbal is damaged.
进一步的,云台重心配平的方法还可包括:针对第二触发信号输出评估结果。其中,评估结果包括:云台当前搭载的负载大小处于预设的云台负载大小范围内,或云台当前搭载的负载过大。当评估结果为云台当前搭载的负载大小处于预设的云台负载大小范围内时,提醒用户可触发云台进行重心配平;当评估结果为云台当前搭载的负载过大时,提醒用户减少负载,以保护云台。Further, the method for balancing the center of gravity of the gimbal may further include: outputting an evaluation result for the second trigger signal. Among them, the evaluation results include: the current load of the pan/tilt is within the preset load range of the pan/tilt, or the load currently mounted on the pan/tilt is too large. When the evaluation result is that the current load of the gimbal is within the preset load range of the gimbal, remind the user that the gimbal can be triggered to perform center-of-gravity trim; when the evaluation result is that the current load of the gimbal is too large, remind the user Reduce the load to protect the gimbal.
云台可采用不同的方式输出评估结果,作为一种实现方式,发送评估结果至客户端,该客户端可为手机、Pad等移动终端,也可为其他终端设备。可选的,第一触发信号是客户端接收到用于指示云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果之后发送。在具体实现时,用户可在客户端接收到用于指示云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果之后,操作客户端,使得客户端发送第一触发信号至云台,以触发云台进行重心配平。The pan-tilt can use different methods to output the evaluation results. As an implementation method, the evaluation results are sent to the client. The client can be a mobile terminal such as a mobile phone or a Pad, or other terminal equipment. Optionally, the first trigger signal is sent after the client terminal receives an evaluation result indicating that the load size currently carried by the pan/tilt is within a preset load size range of the pan/tilt. In specific implementation, the user can operate the client after the client receives the evaluation result indicating that the load size currently carried by the pan/tilt is within the preset load size range of the pan/tilt, so that the client sends the first trigger signal to PTZ, to trigger the PTZ for center of gravity trimming.
可选的,第一触发信号是云台检测到云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果之后自动产生,或者,在云台输出用于指示云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果之后,由用户操作云台上的按 键/按钮产生第一触发信号。Optionally, the first trigger signal is automatically generated after the pan/tilt detects that the current load of the pan/tilt is within the preset load range of the pan/tilt, or is output from the pan/tilt to indicate the current load of the pan/tilt. After the evaluation result that the load size of is within the preset load size range of the pan/tilt, the user operates the keys/buttons on the pan/tilt to generate the first trigger signal.
作为另一种实现方式,云台包括提示模块。本实现方式中,通过提示模块输出评估结果。其中,提示模块可为显示屏、语音模块或其他。As another implementation manner, the PTZ includes a prompt module. In this implementation, the evaluation result is output through the prompt module. Among them, the prompt module can be a display screen, a voice module or others.
此外,在一些实施例中,云台在执行S102之后,若检测到云台所搭载的负载产生变化,则重新进行云台的重心配平,也即云台在检测到该云台所搭载的负载产生变化时,重新检测云台中相应部分的重心位置是否偏离期望重心位置。若重新进行云台的重心配平确定重心位置偏离期望重心位置,则再次输出用于指示调整重心位置的提示信号;若重新进行云台的重心配平确定重心位置未偏离期望重心位置,则输出用于指示云台重心配平成功的显示信号。In addition, in some embodiments, after the pan/tilt performs S102, if it detects that the load carried by the pan/tilt has changed, the center of gravity of the pan/tilt will be adjusted again, that is, when the pan/tilt detects that the load carried by the pan/tilt generates When changing, re-check whether the center of gravity of the corresponding part of the PTZ deviates from the expected center of gravity. If the center of gravity of the gimbal is re-balanced to determine that the center of gravity position deviates from the desired center of gravity position, the prompt signal for indicating the adjustment of the center of gravity position will be output again; if the center of gravity of the gimbal is re-balanced to determine that the center of gravity position does not deviate from the desired center of gravity position, then output A display signal used to indicate the successful balance of the center of gravity of the gimbal.
其中,检测到云台所搭载的负载产生变化可包括:检测到云台所搭载的负载在云台上的位置和/或重量产生变化。Wherein, detecting a change in the load carried by the pan/tilt may include: detecting a change in the position and/or weight of the load carried by the pan/tilt on the pan/tilt.
如图7所示的具体实施例,该实施例适用于三轴云台(包括俯仰轴、横滚轴和偏航轴)或无偏航轴的两轴云台(包括俯仰轴和横滚轴),图7所示实施例先对俯仰轴进行重心配平,再对横滚轴进行重心配平,可以理解,也可替换成先对横滚轴进行重心配平,再对俯仰轴进行重心配平。图7所示实施例的云台重心配平的方法可包括如下步骤:The specific embodiment shown in Figure 7, this embodiment is suitable for a three-axis pan/tilt head (including pitch axis, roll axis and yaw axis) or a two-axis pan/tilt head without yaw axis (including pitch axis and roll axis) ), the embodiment shown in Figure 7 first performs the center of gravity balance on the pitch axis, and then performs the center of gravity balance on the roll axis. It can be understood that it can also be replaced by first performing the center of gravity balance on the roll axis, and then rebalance the pitch axis. The heart is balanced. The method for balancing the center of gravity of the pan/tilt in the embodiment shown in FIG. 7 may include the following steps:
(1)触发云台进行负载评估;(1) Trigger the PTZ to perform load evaluation;
该步骤中,用户可通过操作云台上的按键/按钮使得云台产生用于指示云台进行负载评估的第二触发信号,或者,用户通过操作客户端,使得客户端发送用于指示云台进行负载评估的第二触发信号至云台,以触发云台进行负载评估。In this step, the user can operate the buttons/buttons on the pan/tilt to make the pan/tilt generate a second trigger signal for instructing the pan/tilt to perform load evaluation, or, by operating the client, the user can cause the client to send instructions for the pan/tilt The second trigger signal for load evaluation is sent to the pan/tilt to trigger the pan/tilt to perform load evaluation.
(2)负载评估通过,即云台确定该云台当前搭载的负载大小处于预设的云台负载大小范围内;(2) The load evaluation is passed, that is, the pan/tilt determines that the current load of the pan/tilt is within the preset load range of the pan/tilt;
(3)触发云台进行重心配平;(3) Trigger the gimbal to balance the center of gravity;
其中,步骤(3)在步骤(2)后执行。该步骤中,用户可通过操作云台上的按键/按钮使得云台产生用于指示云台进行重心配平的第一触发信号,或者,用户通过操作客户端,使得客户端发送用于指示云台进行重心配平的第一触发信号至云台,以触发云台进行重心配平,或者云台在确定该云台当前搭载的负载大小处于预设的云台负载大小范围内时,产生用于指示云台进行重心配平的第一触发信号。Among them, step (3) is executed after step (2). In this step, the user can operate the keys/buttons on the PTZ to make the PTZ generate the first trigger signal for instructing the PTZ to perform center-of-gravity trimming, or the user can operate the client terminal to cause the client to send instructions for the cloud The first trigger signal for center-of-gravity trimming is sent to the gimbal to trigger the gimbal to perform center-of-gravity trim, or when the gimbal determines that the load currently carried by the gimbal is within the preset load range The first trigger signal to instruct the pan/tilt to perform center of gravity trimming.
(4)控制云台转动至目标位置,即上述实施例的第一预设位置为目标位置;(4) Control the pan/tilt to rotate to the target position, that is, the first preset position in the above embodiment is the target position;
该步骤中,目标位置为云台回中时的位置。In this step, the target position is the position when the pan/tilt returns to the center.
(5)当云台转动至目标位置时,获得俯仰轴输出的力矩值T 1(5) When the gimbal rotates to the target position, obtain the torque value T 1 output by the pitch axis;
(6)控制俯仰轴逆时针转动β大小,俯仰轴转动至第三预设位置;(6) Control the pitch axis to rotate counterclockwise by β, and the pitch axis to rotate to the third preset position;
该步骤中,俯仰轴由目标位置逆时针旋转β大小,到达第三预设位置。In this step, the pitch axis rotates counterclockwise by β from the target position to reach the third preset position.
(7)当俯仰轴处于第三预设位置时,获得俯仰轴输出的力矩值T 3(7) When the pitch axis is at the third preset position, obtain the torque value T 3 output by the pitch axis;
(8)控制俯仰轴顺时针转动2β大小,俯仰轴转动至第四预设位置;(8) Control the pitch axis to rotate clockwise by 2β, and the pitch axis to rotate to the fourth preset position;
该步骤中,俯仰轴由第三预设位置逆时针旋转β大小,到达第四预设位置。In this step, the pitch axis rotates counterclockwise by β from the third preset position to reach the fourth preset position.
(9)当俯仰轴处于第四预设位置时,获得俯仰轴输出的力矩值T 4(9) When the pitch axis is at the fourth preset position, obtain the torque value T 4 output by the pitch axis;
(10)判断|T 1|是否小于第一预设力矩值a;若|T 1|<a,则确定云台中绕俯仰轴转动的部分的重心位置在前后方向与期望重心位置不存在偏移;若T 1>a,则确定云台中绕俯仰轴转动的部分的重心位置相对期望重心位置偏前;若T 1<-a,则定云台中绕俯仰轴转动的部分的重心位置相对期望重心位置偏后; (10) Determine whether |T 1 | is less than the first preset torque value a; if |T 1 |<a, it is determined that the center of gravity of the part of the gimbal that rotates around the pitch axis does not deviate from the expected center of gravity in the front and rear directions ; If T 1 >a, the center of gravity of the part of the gimbal that rotates around the pitch axis is determined to be forward relative to the expected center of gravity; if T 1 <-a, the center of gravity of the part of the gimbal that rotates around the pitch axis is determined to be relative to the expected center of gravity Position behind
(11)判断|T 4-T 3|是否小于第三预设力矩值b;若|T 4-T 3|<b,则确定云台中绕俯仰轴转动的部分的重心位置在上下方向与期望重心位置不存在偏移;若T 4-T 3>b,则确定云台中绕俯仰轴转动的部分的重心位置相对期望重心位置偏下;若T 4-T 3<-b,则定云台中绕俯仰轴转动的部分的重心位置相对期望重心位置偏上; (11) Determine whether |T 4 -T 3 | is less than the third preset torque value b; if |T 4 -T 3 |<b, determine that the center of gravity position of the part of the gimbal that rotates around the pitch axis is in the up and down direction and the expected There is no offset in the center of gravity position; if T 4 -T 3 >b, the center of gravity of the part of the gimbal that rotates around the pitch axis is determined to be lower than the expected center of gravity; if T 4 -T 3 <-b, the center of the gimbal is determined The position of the center of gravity of the part rotating around the pitch axis is higher than the expected position of the center of gravity;
其中,步骤(10)与步骤(11)可先后执行,也可同时执行。步骤(10)与步骤(11)先后执行时,云台可先执行步骤(10),再执行步骤(11),或者,云台可先执行步骤(11),再执行步骤(10)。Among them, step (10) and step (11) can be executed sequentially or simultaneously. When step (10) and step (11) are executed successively, the pan-tilt may first perform step (10) and then step (11), or the pan-tilt may first perform step (11) and then step (10).
(12)输出用于指示调整云台中偏离期望重心位置的绕俯仰轴转动的部分的重心位置,以指导用户调整俯仰轴负载的安装位置;(12) The output is used to indicate the position of the center of gravity of the part that deviates from the desired center of gravity in the adjustment platform that rotates around the pitch axis to guide the user to adjust the installation position of the pitch axis load;
(13)控制云台转动至目标位置,即上述实施例的第二预设位置为目标位置;(13) Control the pan/tilt head to rotate to the target position, that is, the second preset position in the foregoing embodiment is the target position;
(14)当云台转动至目标位置时,获得横滚轴输出的力矩值T 2(14) When the pan/tilt rotates to the target position, obtain the torque value T 2 output by the roll axis;
(15)判断|T 2|是否小于第二预设力矩值c;若|T 2|<c,则确定云台中绕横滚轴转动的部分的重心位置在左右方向与期望重心位置不存在偏移;若T 2>c,则确定云台中绕横滚轴转动的部分的重心位置相对期望重心位置偏右;若T 2<-c,则定云台中绕横 滚轴转动的部分的重心位置相对期望重心位置偏左。 (15) Determine whether |T 2 | is less than the second preset torque value c; if |T 2 |<c, it is determined that the center of gravity of the part that rotates around the roll axis in the pan/tilt does not deviate from the desired center of gravity in the left-right direction If T 2 >c, determine that the center of gravity of the part of the gimbal that rotates around the roll axis is to the right; if T 2 <-c, determine the position of the center of gravity of the part of the gimbal that rotates around the axis of gravity Relative to the desired center of gravity position to the left.
其中,俯仰轴的配平与横滚轴的配平时的力矩数据的获取除了上述说明的时序,也可以为其它时序,例如,步骤(13)-(14)可以先于步骤(4)-(9)的时序。同时,关于相应部分的重心位置是否在上下方向与期望重心位置存在偏移的情况,除了在对俯仰轴配平时确定,也可以在横滚轴配平时确定,此处均不做具体限定。Among them, the moment data during the trim of the pitch axis and the roll axis can be acquired in addition to the time sequence described above, but also other time sequences. For example, steps (13)-(14) can precede steps (4)-(9). ) Timing. At the same time, whether the position of the center of gravity of the corresponding part is offset from the expected position of the center of gravity in the up-and-down direction can be determined when the pitch axis is trimmed, or when the roll axis is trimmed, and there is no specific limitation here.
(16)输出用于指示调整云台中偏离期望重心位置的绕横滚轴转动的部分的重心位置,以指导用户调整横滚轴负载的安装位置。(16) The output is used to instruct the adjustment of the center of gravity of the part of the pan/tilt that deviates from the desired center of gravity to rotate around the roll axis to guide the user to adjust the installation position of the roll axis load.
其中,步骤(12)和步骤(16)可以同时执行,也可以按照相应的检测结果先后执行,此处不做具体限定。Among them, step (12) and step (16) can be executed at the same time, or can be executed sequentially according to the corresponding detection results, which is not specifically limited here.
本发明实施例中,用户在云台上增加自定义负载模块后,可触发云台进行重心配平,在进行重心配平时,若云台中相应部分的重心位置偏离期望重心位置,则给出重心调节方案,以指导用户对搭载在相应部分的自定义负载模块进行调整,从而使得云台在正常出力保持平衡的状态下,不需要为了抵抗重力矩而产生额外的输出,降低云台功耗、减少云台发热,既能够保护云台,也极大地降低了烫伤用户的风险,还可以保证云台有足够的输出用于增稳,大大避免因输出饱和而造成的扰动抑制性能下降;同时,拓展了用户体验,使得自定义负载模块也可以在云台上正常使用。In the embodiment of the present invention, after the user adds a custom load module to the pan/tilt, the pan/tilt can be triggered to perform center-of-gravity trim. During center-of-gravity trim, if the center of gravity of the corresponding part of the pan/tilt deviates from the desired center of gravity, the center of gravity is given The adjustment plan is to guide the user to adjust the custom load module mounted in the corresponding part, so that the gimbal will not need to generate additional output to resist the gravity moment when the normal output of the gimbal is in a balanced state, reducing the power consumption of the gimbal, Reduce the gimbal heating, which can protect the gimbal and greatly reduce the risk of scalding users. It can also ensure that the gimbal has enough output for stabilization, greatly avoiding the degradation of disturbance suppression performance caused by output saturation; at the same time, The user experience is expanded, so that the custom load module can also be used normally on the PTZ.
对应于上述实施例一的云台重心配平的方法,本发明实施例一还提供一种云台,参见图8,该云台100可包括:俯仰轴电机110和/或横滚轴电机120、以及第一控制器130,其中,第一控制器130与俯仰轴电机110和/或横滚轴电机120电连接。如图8所示实施例中,云台100包括俯仰轴电机110和横滚轴电机120。Corresponding to the method for balancing the center of gravity of the gimbal in the first embodiment, the gimbal in the first embodiment of the present invention also provides a gimbal. Referring to FIG. 8, the gimbal 100 may include a pitch axis motor 110 and/or a roll axis motor 120 , And the first controller 130, wherein the first controller 130 is electrically connected to the pitch axis motor 110 and/or the roll axis motor 120. In the embodiment shown in FIG. 8, the pan/tilt head 100 includes a pitch axis motor 110 and a roll axis motor 120.
具体的,第一控制器130用于:在接收到用于重心配平的第一触发信号时,检测云台中相应部分的重心位置是否偏离期望重心位置;若重心位置偏离期望重心位置,则输出用于指示调整重心位置的提示信号。Specifically, the first controller 130 is configured to: upon receiving the first trigger signal for center of gravity trimming, detect whether the center of gravity position of the corresponding part of the pan/tilt head deviates from the expected center of gravity position; if the center of gravity position deviates from the expected center of gravity position, output Used to indicate the prompt signal to adjust the position of the center of gravity.
第一控制器130的实现过程和工作原理可参见上述实施例一的云台重心配平的方法的描述,此处不再赘述。For the implementation process and working principle of the first controller 130, please refer to the description of the method for balancing the center of gravity of the pan/tilt head in the first embodiment, which will not be repeated here.
本实施例的第一控制器130可以是中央处理器(central processing unit,CPU)。第一控制器130还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(application-specific integrated circuit,ASIC),可编程逻辑器件(programmable logic device,PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(complex programmable  logic device,CPLD),现场可编程逻辑门阵列(field-programmable gate array,FPGA),通用阵列逻辑(generic array logic,GAL)或其任意组合。The first controller 130 in this embodiment may be a central processing unit (CPU). The first controller 130 may further include a hardware chip. The aforementioned hardware chip may be an application-specific integrated circuit (ASIC), a programmable logic device (PLD) or a combination thereof. The above-mentioned PLD may be a complex programmable logic device (CPLD), a field-programmable gate array (FPGA), a generic array logic (GAL), or any combination thereof.
此外,第一控制器130可包括云台控制器和/或设于云台的独立控制器,也可包括其他控制器。In addition, the first controller 130 may include a pan/tilt controller and/or an independent controller provided on the pan/tilt, and may also include other controllers.
实施例二Example two
图9是本发明一实施例中的云台重心配平的方法在客户端侧的方法流程图。需要说明的是,本发明实施例二的云台重心配平的方法的执行主体为客户端,该客户端可与云台进行通信,客户端可为手机、Pad等移动终端,也可为其他终端设备。Fig. 9 is a flow chart of the method for balancing the center of gravity of the pan/tilt in an embodiment of the present invention on the client side. It should be noted that the execution subject of the method for balancing the center of gravity of the pan/tilt in the second embodiment of the present invention is a client, which can communicate with the pan/tilt, and the client may be a mobile terminal such as a mobile phone or a Pad, or other Terminal Equipment.
如图9所示,本发明实施例二的云台重心配平的方法可包括如下步骤:As shown in FIG. 9, the method for balancing the center of gravity of the gimbal in the second embodiment of the present invention may include the following steps:
S901:若接收到配平指令,则产生用于重心配平的第一触发信号;S901: If a trim command is received, a first trigger signal for center of gravity trim is generated;
在本实施例中,所述云台重心配平的方法还包括:接收到配平指令之前,接收到云台发送的评估结果。其中,评估结果包括:云台当前搭载的负载大小处于预设的云台负载大小范围内,或云台当前搭载的负载过大。In this embodiment, the method for balancing the center of gravity of the pan/tilt head further includes: before receiving the trimming instruction, receiving the evaluation result sent by the pan/tilt head. Among them, the evaluation results include: the current load of the pan/tilt is within the preset load range of the pan/tilt, or the load currently mounted on the pan/tilt is too large.
可选的,配平指令为云台发送的用于指示云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果。Optionally, the trim command is an evaluation result sent by the pan/tilt to indicate that the load currently carried by the pan/tilt is within a preset load range of the pan/tilt.
可选的,配平指令由用户操作客户端产生,例如,用户操作客户端的虚拟按键产生配平指令,或者,用户操作客户端的实体按键/按钮产生配平指令。进一步可选的,客户端可根据评估结果来判断是否根据配平指令产生第一触发信号。本实施例中,客户端接收到用于指示云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果之后,若接收到配平指令,则产生第一触发信号;客户端接收到用于指示云台当前搭载的负载过大的评估结果之后,若接收到配平指令,则不会产生第一触发信号。Optionally, the trim command is generated by the user operating the client terminal. For example, the user operates a virtual key on the client terminal to generate a trim command, or the user operates a physical key/button on the client terminal to generate a trim command. Further optionally, the client terminal may determine whether to generate the first trigger signal according to the trim instruction according to the evaluation result. In this embodiment, after the client receives the evaluation result indicating that the load size currently carried by the pan/tilt is within the preset load size range of the pan/tilt, if it receives a trimming instruction, it generates a first trigger signal; the client receives After the evaluation result indicating that the load currently carried by the pan/tilt head is too large, if a trim command is received, the first trigger signal will not be generated.
在一些实施例中,云台重心配平的方法还包括:在接收到云台发送的评估结果之前,若接收到负载评估指令,则产生用于指示云台进行负载评估的第二触发信号;发送第二触发信号至云台,以触发云台进行负载评估。通过客户端触发云台进行负载评估,灵活性更强,满足用户使用需求。In some embodiments, the method for balancing the center of gravity of the gimbal further includes: before receiving the evaluation result sent by the gimbal, if a load evaluation instruction is received, generating a second trigger signal for instructing the gimbal to perform load evaluation; Send the second trigger signal to the pan-tilt to trigger the pan-tilt to perform load evaluation. Through the client to trigger the PTZ to perform load evaluation, it is more flexible and meets the needs of users.
其中,负载评估指令由用户操作客户端产生,例如,用户操作客户端的虚拟按键产生配平指令,或者,用户操作客户端的实体按键/按钮产生负载评估指令。The load evaluation instruction is generated by the user operating the client. For example, the user operates a virtual key on the client to generate a trim instruction, or the user operates a physical key/button of the client to generate a load evaluation instruction.
S902:发送第一触发信号至云台,以触发云台进行重心位置的检测;S902: Send the first trigger signal to the pan-tilt to trigger the pan-tilt to detect the position of the center of gravity;
其中,云台进行重心位置的检测方式可参见实施例一,此处不再赘述。Among them, the method for detecting the position of the center of gravity of the pan/tilt may refer to the first embodiment, which will not be repeated here.
通过客户端触发云台进行重心位置的检测,灵活性更强,满足用户使用需求。The PTZ is triggered by the client to detect the center of gravity position, which is more flexible and meets the needs of users.
S903:接收云台针对第一触发信号返回的提示信号,提示信号用于指示调整云台中偏离期望重心位置的重心位置。S903: Receive a prompt signal returned by the pan/tilt head for the first trigger signal, where the prompt signal is used to instruct to adjust the center of gravity position of the pan/tilt head that deviates from the expected center of gravity position.
该步骤中,提示信号携带有重心位置的偏移信息,以指导用户调节负载安装在相应部分的安装位置。其中,偏移信息包括:偏移方向和/或偏移量,具体可参见实施例一中对应部分内容的描述。In this step, the prompt signal carries the offset information of the center of gravity position to guide the user to adjust the installation position of the load on the corresponding part. Wherein, the offset information includes: an offset direction and/or an offset amount. For details, please refer to the description of the corresponding part in the first embodiment.
本实施例中,客户端在接收云台针对第一触发信号返回的提示信号之后,会输出提示信号。可基于图形、文字、语音中的至少一种输出提示信号。当然,客户端也可采用其他方式输出提示信号。In this embodiment, the client terminal outputs the prompt signal after receiving the prompt signal returned by the pan-tilt for the first trigger signal. The prompt signal can be output based on at least one of graphics, text, and voice. Of course, the client can also output the prompt signal in other ways.
对应于上述实施例二的云台重心配平的方法,本发明实施例二还提供一种客户端,参见图10,该客户端200可包括:存储装置210和第二控制器220。其中,存储装置210用于存储程序指令,第二控制器220调用程序指令,当程序指令被执行时,第二控制器220用于执行如9所示实施例的云台重心配平的方法。Corresponding to the method for balancing the center of gravity of the pan-tilt in the second embodiment, the second embodiment of the present invention also provides a client. Referring to FIG. 10, the client 200 may include a storage device 210 and a second controller 220. The storage device 210 is used to store program instructions, and the second controller 220 calls the program instructions. When the program instructions are executed, the second controller 220 is used to execute the method for balancing the center of gravity of the pan/tilt head in the embodiment shown in 9.
具体的,第二控制器220用于:若接收到配平指令,则产生用于重心配平的第一触发信号;发送所述第一触发信号至云台,以触发所述云台进行重心位置的检测;接收所述云台针对所述第一触发信号返回的提示信号,所述提示信号用于指示调整所述云台中偏离期望重心位置的重心位置。Specifically, the second controller 220 is configured to: if a trim command is received, generate a first trigger signal for center of gravity trim; send the first trigger signal to the pan/tilt to trigger the pan/tilt to perform the center of gravity position The detection; receiving the prompt signal returned by the pan/tilt head for the first trigger signal, the prompt signal is used to instruct the adjustment of the center of gravity position of the pan/tilt deviating from the desired center of gravity position.
第二控制器220的实现过程和工作原理可参见上述实施例二的云台重心配平的方法的描述,此处不再赘述。For the implementation process and working principle of the second controller 220, refer to the description of the method for balancing the center of gravity of the pan/tilt in the second embodiment above, which will not be repeated here.
其中,存储装置210可以包括易失性存储器(volatile memory),例如随机存取存储器(random-access memory,RAM);存储装置210也可以包括非易失性存储器(non-volatile memory),例如快闪存储器(flash memory),硬盘(hard disk drive,HDD)或固态硬盘(solid-state drive,SSD);存储装置210还可以包括上述种类的存储器的组合。The storage device 210 may include a volatile memory (volatile memory), such as random-access memory (RAM); the storage device 210 may also include a non-volatile memory (non-volatile memory), such as fast Flash memory (flash memory), hard disk drive (HDD) or solid-state drive (SSD); the storage device 210 may also include a combination of the foregoing types of memories.
本实施例的第二控制器220可以是中央处理器(central processing unit,CPU)。第二控制器220还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(application-specific integrated circuit,ASIC),可编程逻辑器件(programmable logic device,PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(complex programmable  logic device,CPLD),现场可编程逻辑门阵列(field-programmable gate array,FPGA),通用阵列逻辑(generic array logic,GAL)或其任意组合。此外,本发明实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被控制器执行时实现上述实施例一或实施例二所述的云台重心配平的方法的步骤。The second controller 220 in this embodiment may be a central processing unit (CPU). The second controller 220 may further include a hardware chip. The aforementioned hardware chip may be an application-specific integrated circuit (ASIC), a programmable logic device (PLD) or a combination thereof. The above-mentioned PLD may be a complex programmable logic device (CPLD), a field-programmable gate array (FPGA), a generic array logic (GAL), or any combination thereof. In addition, an embodiment of the present invention also provides a computer-readable storage medium on which a computer program is stored. When the program is executed by the controller, the method for balancing the center of gravity of the pan/tilt head described in the first embodiment or the second embodiment is implemented. step.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random Access Memory,RAM)等。A person of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be implemented by instructing relevant hardware through a computer program. The program can be stored in a computer readable storage medium. During execution, it may include the procedures of the above-mentioned method embodiments. Wherein, the storage medium may be a magnetic disk, an optical disc, a read-only memory (Read-Only Memory, ROM), or a random access memory (Random Access Memory, RAM), etc.
以上所揭露的仅为本发明部分实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。The above-disclosed are only some embodiments of the present invention, which of course cannot be used to limit the scope of rights of the present invention. Therefore, equivalent changes made according to the claims of the present invention still fall within the scope of the present invention.

Claims (132)

  1. 一种云台重心配平的方法,所述云台被配置为绕俯仰轴和/或横滚轴转动,其特征在于,所述方法包括:A method for balancing the center of gravity of a gimbal, the gimbal is configured to rotate about a pitch axis and/or a roll axis, characterized in that the method includes:
    在接收到用于重心配平的第一触发信号时,检测所述云台中相应部分的重心位置是否偏离期望重心位置;When receiving the first trigger signal for center of gravity trimming, detect whether the position of the center of gravity of the corresponding part of the pan/tilt head deviates from the expected position of the center of gravity;
    若所述重心位置偏离所述期望重心位置,则输出用于指示调整所述重心位置的提示信号。If the position of the center of gravity deviates from the position of the desired center of gravity, a prompt signal for instructing to adjust the position of the center of gravity is output.
  2. 根据权利要求1所述的方法,其特征在于,在所述云台被配置为绕所述俯仰轴转动时,所述相应部分包括所述云台中绕所述俯仰轴转动的部分,所述期望重心位置与所述俯仰轴之间的距离不大于第一预设距离。The method according to claim 1, wherein when the pan/tilt is configured to rotate around the pitch axis, the corresponding part includes a part of the pan/tilt that rotates around the pitch axis, and the desired The distance between the position of the center of gravity and the pitch axis is not greater than a first preset distance.
  3. 根据权利要求1所述的方法,其特征在于,在所述云台被配置为绕所述横滚轴转动时,所述相应部分包括所述云台中绕所述横滚轴转动的部分,所述期望重心位置与所述横滚轴之间的距离不大于第二预设距离。The method according to claim 1, wherein when the pan/tilt is configured to rotate around the roll axis, the corresponding part includes a part of the pan/tilt that rotates around the roll axis, so The distance between the desired center of gravity position and the roll axis is not greater than a second preset distance.
  4. 根据权利要求1所述的方法,其特征在于,所述重心位置偏离所述期望重心位置包括以下一种或多种情况:The method according to claim 1, wherein the deviation of the position of the center of gravity from the position of the desired center of gravity includes one or more of the following situations:
    所述重心位置在前后方向与所述期望重心位置存在偏移、所述重心位置在左右方向与所述期望重心位置存在偏移、所述重心位置在上下方向与所述期望重心位置存在偏移。The position of the center of gravity is deviated from the desired center of gravity in the front and rear direction, the position of the center of gravity is deviated from the desired center of gravity in the left and right direction, and the position of the center of gravity deviates from the desired center of gravity in the up and down direction .
  5. 根据权利要求4所述的方法,其特征在于,所述检测所述云台中相应部分的重心位置是否偏离期望重心位置,包括:The method according to claim 4, wherein the detecting whether the position of the center of gravity of the corresponding part of the PTZ deviates from the position of the expected center of gravity comprises:
    控制所述云台转动,使得所述云台中的相应部分处于至少一个预设位置;Controlling the rotation of the pan/tilt so that the corresponding part of the pan/tilt is at at least one preset position;
    检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置。It is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from the expected position of the center of gravity.
  6. 根据权利要求5所述的方法,其特征在于,所述云台包括俯仰轴电机和/或横滚轴电机,所述检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置,包括:The method according to claim 5, wherein the pan-tilt includes a pitch axis motor and/or a roll axis motor, and the detection of the corresponding part is at least one of the preset positions when the target position Whether the position of the center of gravity deviates from the expected position of the center of gravity, including:
    在所述相应部分处于至少一个所述预设位置中的特定位置时,获取所述俯仰轴电机和/或所述横滚轴电机输出的力矩值;Acquiring a torque value output by the pitch axis motor and/or the roll axis motor when the corresponding part is at a specific position among at least one of the preset positions;
    根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置。According to the torque value, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from the expected position of the center of gravity.
  7. 根据权利要求6所述的方法,其特征在于,所述云台被配置为绕所述俯仰轴转动,所述云台包括所述俯仰轴电机,所述力矩值包括:所述相应部分处于第一预设位置时,所述俯仰轴电机输出的第一力矩值;The method according to claim 6, wherein the pan/tilt is configured to rotate around the pitch axis, the pan/tilt includes the pitch axis motor, and the torque value includes: the corresponding part is in the second At a preset position, the first torque value output by the pitch axis motor;
    所述根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置,包括:The detecting, according to the torque value, whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from an expected position of the center of gravity includes:
    根据所述第一力矩值,检测所述相应部分处于所述第一预设位置时的重心位置是 否在前后方向与所述期望重心位置存在偏移。According to the first moment value, it is detected whether the position of the center of gravity when the corresponding part is at the first preset position is offset from the expected position of the center of gravity in the front-to-rear direction.
  8. 根据权利要求7所述的方法,其特征在于,所述相应部分处于所述第一预设位置时,所述俯仰轴至所述重心位置的距离的沿线方向与水平方向形成第一夹角;7. The method according to claim 7, wherein when the corresponding part is at the first preset position, the distance along the line from the pitch axis to the center of gravity position forms a first angle with the horizontal direction;
    所述根据所述第一力矩值,检测所述相应部分处于所述第一预设位置时的重心位置是否在前后方向与所述期望重心位置存在偏移,包括:The detecting, according to the first torque value, whether the position of the center of gravity when the corresponding part is at the first preset position is offset from the position of the desired center of gravity in the front-to-rear direction, includes:
    根据所述第一力矩值,确定所述第一夹角的角度范围和/或所述第一夹角的余弦值;Determine the angular range of the first included angle and/or the cosine value of the first included angle according to the first moment value;
    根据所述第一夹角的角度范围和/或所述第一夹角的余弦值,检测所述相应部分处于所述第一预设位置时的重心位置是否在前后方向与所述期望重心位置存在偏移。According to the angle range of the first included angle and/or the cosine value of the first included angle, it is detected whether the position of the center of gravity when the corresponding part is at the first preset position is in the front-to-rear direction and the expected center of gravity position There is an offset.
  9. 根据权利要求8所述的方法,其特征在于,所述方法还包括:The method according to claim 8, wherein the method further comprises:
    当所述第一夹角的角度范围和/或所述第一夹角的余弦值满足第一策略时,确定所述重心位置在前后方向与所述期望重心位置存在偏移。When the angle range of the first included angle and/or the cosine value of the first included angle meets the first strategy, it is determined that the position of the center of gravity is offset from the position of the desired center of gravity in the front-to-rear direction.
  10. 根据权利要求9所述的方法,其特征在于,所述当所述第一夹角的角度范围和/或所述第一夹角的余弦值满足第一策略时,确定所述重心位置在前后方向与所述期望重心位置存在偏移,包括:The method according to claim 9, wherein when the angle range of the first included angle and/or the cosine value of the first included angle meets the first strategy, it is determined that the position of the center of gravity is in front and rear The direction is offset from the expected center of gravity position, including:
    当所述第一夹角的余弦值为正数时,确定所述重心位置相对于所述期望重心位置偏前;When the cosine value of the first included angle is a positive number, it is determined that the position of the center of gravity is forward relative to the position of the desired center of gravity;
    当所述第一夹角的余弦值为负数时,确定所述重心位置相对于所述期望重心位置偏后。When the cosine value of the first included angle is a negative number, it is determined that the position of the center of gravity is behind the position of the desired center of gravity.
  11. 根据权利要求9所述的方法,其特征在于,所述当所述第一夹角的角度范围和/或所述第一夹角的余弦值满足第一策略时,确定所述重心位置在前后方向与所述期望重心位置存在偏移,包括:The method according to claim 9, wherein when the angle range of the first included angle and/or the cosine value of the first included angle meets the first strategy, it is determined that the position of the center of gravity is in front and rear The direction is offset from the expected center of gravity position, including:
    当所述第一夹角的角度范围在第一预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏前;When the angle range of the first included angle is within a first preset angle range, determining that the position of the center of gravity is forward relative to the position of the desired center of gravity;
    当所述第一夹角的角度范围在第二预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏后。When the angle range of the first included angle is within the second preset angle range, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity.
  12. 根据权利要求7所述的方法,其特征在于,所述方法还包括:The method according to claim 7, wherein the method further comprises:
    当所述第一力矩值的绝对值大于第一预设力矩值时,确定所述相应部分处于所述第一预设位置时的重心位置在前后方向与所述期望重心位置存在偏移。When the absolute value of the first moment value is greater than the first preset moment value, it is determined that the center of gravity position when the corresponding part is at the first preset position is offset from the expected center of gravity position in the front-to-rear direction.
  13. 根据权利要求12所述的方法,其特征在于,所述当所述第一力矩值的绝对值大于第一预设力矩值时,确定所述相应部分处于所述第一预设位置时的重心位置在前后方向与所述期望重心位置存在偏移,包括:The method according to claim 12, wherein when the absolute value of the first torque value is greater than the first preset torque value, determining the center of gravity when the corresponding part is at the first preset position The position is offset from the expected center of gravity position in the front and rear direction, including:
    当所述第一力矩值大于所述第一预设力矩值时,确定所述重心位置相对于所述期望重心位置偏前;When the first torque value is greater than the first preset torque value, determining that the center of gravity position is forward relative to the desired center of gravity position;
    当所述第一力矩值小于所述第一预设力矩值的相反数时,确定所述重心位置相对于所述期望重心位置偏后。When the first torque value is less than the inverse of the first preset torque value, it is determined that the position of the center of gravity is behind the expected position of the center of gravity.
  14. 根据权利要求6所述的方法,其特征在于,所述云台被配置为绕所述横滚轴转动,所述云台包括横滚轴电机,所述力矩值包括:所述相应部分处于第二预设位置时,所述横滚轴电机输出的第二力矩值;The method according to claim 6, wherein the pan/tilt is configured to rotate around the roll axis, the pan/tilt includes a roll axis motor, and the torque value includes: the corresponding part is in the second 2. At the preset position, the second torque value output by the roll axis motor;
    所述根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置,包括:The detecting, according to the torque value, whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from an expected position of the center of gravity includes:
    根据所述第二力矩值,检测所述相应部分处于所述第二预设位置时的重心位置是否在左右方向与所述期望重心位置存在偏移。According to the second torque value, it is detected whether the position of the center of gravity when the corresponding part is at the second preset position is deviated from the expected position of the center of gravity in the left-right direction.
  15. 根据权利要求14所述的方法,其特征在于,所述相应部分处于所述第二预设位置时,所述横滚轴至所述重心位置的距离的沿线方向与水平方向形成第二夹角;The method according to claim 14, wherein when the corresponding part is at the second preset position, the distance between the roll axis and the center of gravity position forms a second included angle with the horizontal direction ;
    所述根据所述第二力矩值,检测所述相应部分处于所述第二预设位置时的重心位置是否在左右方向与所述期望重心位置存在偏移,包括:The detecting, according to the second torque value, whether the position of the center of gravity when the corresponding part is at the second preset position is offset from the position of the desired center of gravity in the left-right direction, includes:
    根据所述第二力矩值,确定所述第二夹角的角度范围和/或所述第二夹角的余弦值;Determine the angular range of the second included angle and/or the cosine value of the second included angle according to the second torque value;
    根据所述第二夹角的角度范围和/或所述第二夹角的余弦值,检测所述相应部分处于所述第二预设位置时的重心位置是否在左右方向与所述期望重心位置存在偏移。According to the angle range of the second included angle and/or the cosine value of the second included angle, it is detected whether the center of gravity position when the corresponding part is at the second preset position is in the left-right direction and the expected center of gravity position There is an offset.
  16. 根据权利要求15所述的方法,其特征在于,所述方法还包括:The method according to claim 15, wherein the method further comprises:
    当所述第二夹角的角度范围和/或所述第二夹角的余弦值满足第二策略时,确定所述重心位置在左右方向与所述期望重心位置存在偏移。When the angle range of the second included angle and/or the cosine value of the second included angle meets the second strategy, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity in the left-right direction.
  17. 根据权利要求16所述的方法,其特征在于,所述当所述第二夹角的角度范围和/或所述第二夹角的余弦值满足第二策略时,确定所述重心位置在左右方向与所述期望重心位置存在偏移,包括:The method according to claim 16, characterized in that, when the angle range of the second included angle and/or the cosine value of the second included angle meets a second strategy, it is determined that the position of the center of gravity is on the left and right. The direction is offset from the expected center of gravity position, including:
    当所述第二夹角的余弦值为正数时,确定所述重心位置相对于所述期望重心位置偏右;When the cosine value of the second included angle is a positive number, it is determined that the position of the center of gravity is to the right relative to the position of the desired center of gravity;
    当所述第二夹角的余弦值为负数时,确定所述重心位置相对于所述期望重心位置偏左。When the cosine value of the second included angle is a negative number, it is determined that the position of the center of gravity is deviated to the left relative to the position of the desired center of gravity.
  18. 根据权利要求16所述的方法,其特征在于,所述当所述第二夹角的角度范围和/或所述第二夹角的余弦值满足第二策略时,确定所述重心位置在左右方向与所述期望重心位置存在偏移,包括:The method according to claim 16, characterized in that, when the angle range of the second included angle and/or the cosine value of the second included angle meets a second strategy, it is determined that the position of the center of gravity is on the left and right. The direction is offset from the expected center of gravity position, including:
    当所述第二夹角的角度范围在第三预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏右;When the angle range of the second included angle is within a third preset angle range, determining that the center of gravity position is off to the right with respect to the expected center of gravity position;
    当所述第二夹角的角度范围在第四预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏左。When the angle range of the second included angle is within the fourth preset angle range, it is determined that the position of the center of gravity is deviated to the left relative to the position of the desired center of gravity.
  19. 根据权利要求14所述的方法,其特征在于,所述方法还包括:The method of claim 14, wherein the method further comprises:
    当所述第二力矩值的绝对值大于第二预设力矩值时,确定所述相应部分处于所述第二预设位置时的重心位置在左右方向与所述期望重心位置存在偏移。When the absolute value of the second torque value is greater than the second preset torque value, it is determined that the center of gravity position when the corresponding part is at the second preset position is offset from the expected center of gravity position in the left-right direction.
  20. 根据权利要求19所述的方法,其特征在于,当所述第二力矩值的绝对值大于 第二预设力矩值时,确定所述相应部分处于所述第二预设位置时的重心位置在左右方向与所述期望重心位置存在偏移,包括:The method according to claim 19, wherein when the absolute value of the second torque value is greater than the second preset torque value, it is determined that the center of gravity position when the corresponding part is at the second preset position is at The deviation between the left and right directions and the expected center of gravity position includes:
    当所述第二力矩值大于所述第二预设力矩值时,确定所述重心位置相对于所述期望重心位置偏右;When the second torque value is greater than the second preset torque value, determining that the center of gravity position is to the right relative to the expected center of gravity position;
    当所述第二力矩值小于所述第二预设力矩值的相反数时,确定所述重心位置相对于所述期望重心位置偏左。When the second torque value is less than the inverse of the second preset torque value, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity.
  21. 根据权利要求6所述的方法,其特征在于,所述云台包括俯仰轴电机,所述力矩值包括:所述相应部分处于第三预设位置时,所述俯仰轴电机输出的第三力矩值,以及所述相应部分处于第四预设位置时,所述俯仰轴电机输出的第四力矩值;The method according to claim 6, wherein the pan/tilt head includes a pitch axis motor, and the torque value includes: a third torque output by the pitch axis motor when the corresponding part is at a third preset position Value, and the fourth torque value output by the pitch axis motor when the corresponding part is at the fourth preset position;
    所述根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置,包括:The detecting, according to the torque value, whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from an expected position of the center of gravity includes:
    根据所述第三力矩值和所述第四力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移。According to the third torque value and the fourth torque value, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is offset from the desired center of gravity position in the up and down direction.
  22. 根据权利要求21所述的方法,其特征在于,所述相应部分处于所述第三预设位置时所述俯仰轴至所述重心位置的距离的沿线方向,与所述相应部分位于所述第四预设位置时所述俯仰轴至所述重心位置的距离的沿线方向的夹角大小固定。22. The method according to claim 21, wherein when the corresponding part is at the third preset position, the distance along the line from the pitch axis to the center of gravity position is the same as that of the corresponding part located in the first In the four preset positions, the included angle of the distance from the pitch axis to the center of gravity position along the line direction is fixed.
  23. 根据权利要求22所述的方法,其特征在于,所述相应部分处于所述第三预设位置时所述俯仰轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标位置时所述俯仰轴至所述重心位置的距离的沿线方向形成第三夹角;The method according to claim 22, wherein when the corresponding part is at the third preset position, the distance along the line from the pitch axis to the center of gravity position and the corresponding part at the target position When the distance from the pitch axis to the center of gravity position forms a third included angle;
    所述相应部分处于所述第四预设位置时所述俯仰轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标位置时所述俯仰轴至所述重心位置的距离的沿线方向形成第三夹角形成第四夹角。The distance along the line of the distance from the pitch axis to the center of gravity position when the corresponding part is at the fourth preset position and the distance from the pitch axis to the center of gravity position when the corresponding part is at the target position A third included angle is formed along the line direction to form a fourth included angle.
  24. 根据权利要求23所述的方法,其特征在于,所述第三夹角和所述第四夹角大小相等;The method according to claim 23, wherein the third included angle and the fourth included angle are equal in magnitude;
    所述第三预设位置为:在所述相应部分处于所述目标位置时,绕第一方向旋转第一预设夹角大小后所述相应部分的位置;The third preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the first preset angle around the first direction;
    所述第四预设位置为:在所述相应部分处于所述第三预设位置时,绕第二方向旋转所述第一预设夹角的两倍大小后所述相应部分的位置;The fourth preset position is: when the corresponding part is at the third preset position, the position of the corresponding part after being rotated around the second direction by twice the first preset included angle;
    其中,所述第一方向与所述第二方向为相反的两个方向。Wherein, the first direction and the second direction are two opposite directions.
  25. 根据权利要求23所述的方法,其特征在于,在所述相应部分位于所述目标位置时,所述俯仰轴至所述重心位置的距离的沿线方向与水平方向形成第五夹角;22. The method according to claim 23, wherein when the corresponding part is located at the target position, the distance along the line from the pitch axis to the center of gravity position forms a fifth included angle with the horizontal direction;
    所述根据所述第三力矩值和所述第四力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移,包括:According to the third torque value and the fourth torque value, it is detected whether the center of gravity position when the corresponding part is at the target position in at least one of the preset positions is deviated from the desired center of gravity position in the up and down direction Move, including:
    根据所述第三力矩值和所述第四力矩值,确定所述第五夹角的角度范围和/或所述第五夹角的正弦值;Determining the angle range of the fifth included angle and/or the sine value of the fifth included angle according to the third torque value and the fourth torque value;
    根据所述第五夹角的角度范围和/或所述第五夹角的正弦值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移。According to the angle range of the fifth included angle and/or the sine value of the fifth included angle, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is in the up-down direction. The expected center of gravity position is offset.
  26. 根据权利要求25所述的方法,其特征在于,所述方法还包括:The method of claim 25, wherein the method further comprises:
    当所述第五夹角的角度范围和/或所述第五夹角的正弦值满足第三策略时,确定所述重心位置在上下方向与所述期望重心位置存在偏移。When the angle range of the fifth included angle and/or the sine value of the fifth included angle meets the third strategy, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity in the up and down direction.
  27. 根据权利要求26所述的方法,其特征在于,所述当所述第五夹角的范围和/或所述第五夹角的正弦值满足第三策略时,确定所述重心位置在上下方向存在偏移,包括:The method according to claim 26, wherein when the range of the fifth included angle and/or the sine of the fifth included angle meets a third strategy, it is determined that the position of the center of gravity is in the up and down direction There are offsets, including:
    当所述第五夹角的正弦值为正数时,确定所述重心位置相对于所述期望重心位置偏上;When the sine value of the fifth included angle is positive, it is determined that the position of the center of gravity is higher than the position of the expected center of gravity;
    当所述第五夹角的正弦值为负数时,确定所述重心位置相对于所述期望重心位置偏下。When the sine value of the fifth included angle is negative, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  28. 根据权利要求26所述的方法,其特征在于,所述当所述第五夹角的范围和/或所述第五夹角的正弦值满足第三策略时,确定所述重心位置在上下方向存在偏移,包括:The method according to claim 26, wherein when the range of the fifth included angle and/or the sine of the fifth included angle meets a third strategy, it is determined that the position of the center of gravity is in the up and down direction There are offsets, including:
    当所述第五夹角的角度范围在第五预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏上;When the angle range of the fifth included angle is within the fifth preset angle range, determining that the position of the center of gravity is higher than the position of the desired center of gravity;
    当所述第五夹角的角度范围在第六预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏下。When the angle range of the fifth included angle is within the sixth preset angle range, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  29. 根据权利要求21所述的方法,其特征在于,所述方法还包括:The method of claim 21, wherein the method further comprises:
    当所述第三力矩值和所述第四力矩值的差值的绝对值大于第三预设力矩值时,确定所述重心位置在上下方向与所述期望重心位置存在偏移。When the absolute value of the difference between the third torque value and the fourth torque value is greater than the third preset torque value, it is determined that the center of gravity position is offset from the expected center of gravity position in the up and down direction.
  30. 根据权利要求29所述的方法,其特征在于,当所述第三力矩值和所述第四力矩值的差值的绝对值大于第三预设力矩值时,确定所述重心位置在上下方向与所述期望重心位置存在偏移,包括:The method according to claim 29, wherein when the absolute value of the difference between the third torque value and the fourth torque value is greater than a third preset torque value, it is determined that the position of the center of gravity is in the up and down direction The deviation from the expected center of gravity position includes:
    当所述第三力矩值和所述第四力矩值的差值大于所述第三预设力矩值时,确定所述重心位置相对于所述期望重心位置偏下;When the difference between the third torque value and the fourth torque value is greater than the third preset torque value, determining that the position of the center of gravity is lower than the position of the desired center of gravity;
    当所述第三力矩值和所述第四力矩值的差值小于所述第三预设力矩值的相反数时,确定所述重心位置相对于所述期望重心位置偏上。When the difference between the third torque value and the fourth torque value is less than the inverse of the third preset torque value, it is determined that the position of the center of gravity is higher than the position of the desired center of gravity.
  31. 根据权利要求6所述的方法,其特征在于,所述云台包括横滚轴电机,所述力矩值包括:所述相应部分处于第五预设位置时,所述横滚轴电机输出的第五力矩值,以及所述相应部分处于第六预设位置时,所述横滚轴输出的第六力矩值,The method according to claim 6, wherein the pan/tilt includes a roll axis motor, and the torque value includes: when the corresponding part is at a fifth preset position, the first output of the roll axis motor is Five torque values, and the sixth torque value output by the roll axis when the corresponding part is at the sixth preset position,
    所述根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置,包括:The detecting, according to the torque value, whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from an expected position of the center of gravity includes:
    根据所述第五力矩值和所述第六力矩值,检测所述相应部分处于至少一个所述预 设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移。According to the fifth torque value and the sixth torque value, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is offset from the desired center of gravity position in the up and down direction.
  32. 根据权利要求31所述的方法,其特征在于,所述相应部分处于所述第五预设位置时所述横滚轴至所述重心位置的距离的沿线方向,与所述相应部分位于所述第六预设位置时所述横滚轴至所述重心位置的距离的沿线方向的夹角大小固定。The method according to claim 31, wherein when the corresponding part is at the fifth preset position, the distance along the line from the roll axis to the center of gravity is located in the same direction as the corresponding part. At the sixth preset position, the included angle of the distance from the roll axis to the center of gravity position along the line is fixed.
  33. 根据权利要求32所述的方法,其特征在于,所述相应部分处于所述第五预设位置时,所述横滚轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标位置时所述横滚轴至所述重心位置的距离的沿线方向形成第六夹角;The method according to claim 32, wherein when the corresponding part is at the fifth preset position, the distance along the line from the roll axis to the center of gravity position and the corresponding part are in the The distance along the line from the roll axis to the center of gravity position at the target position forms a sixth included angle;
    所述相应部分处于所述第六预设位置时,所述横滚轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标位置时所述横滚轴至所述重心位置的距离的沿线方向形成第七夹角。When the corresponding part is at the sixth preset position, the distance along the line from the roll axis to the center of gravity position is the same as when the corresponding part is at the target position, the roll axis to the center of gravity position The distance along the line forms the seventh angle.
  34. 根据权利要求33所述的方法,其特征在于,所述第六夹角和所述第七夹角大小相等;The method according to claim 33, wherein the sixth included angle and the seventh included angle are equal in magnitude;
    所述第五预设位置为:在所述相应部分处于所述目标位置时,绕第三方向旋转第二预设夹角大小后所述相应部分的位置;The fifth preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating a second preset angle in a third direction;
    所述第六预设位置为:在所述相应部分处于所述第五预设位置时,绕第四方向旋转所述第二预设夹角的两倍大小后所述相应部分的位置;The sixth preset position is: when the corresponding part is at the fifth preset position, the position of the corresponding part is rotated about a fourth direction by twice the second preset included angle;
    其中,所述第三方向与所述第四方向为相反的两个方向。Wherein, the third direction and the fourth direction are two opposite directions.
  35. 根据权利要求33所述的方法,其特征在于,在所述相应部分位于所述目标位置时,所述横滚轴至所述重心位置的距离的沿线方向与水平方向形成第八夹角;The method according to claim 33, wherein when the corresponding part is located at the target position, the distance between the roll axis and the center of gravity position forms an eighth included angle with the horizontal direction;
    所述根据所述第五力矩值和所述第六力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移,包括:According to the fifth torque value and the sixth torque value, it is detected whether the center of gravity position when the corresponding part is at the target position in at least one of the preset positions is deviated from the desired center of gravity position in the up and down direction. Move, including:
    根据所述第五力矩值和所述第六力矩值,确定所述第八夹角的角度范围和/或所述第八夹角的正弦值;Determining the angle range of the eighth included angle and/or the sine value of the eighth included angle according to the fifth torque value and the sixth torque value;
    根据所述第八夹角的角度范围和/或所述第八夹角的正弦值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在前后方向与所述期望重心位置存在偏移。According to the angle range of the eighth included angle and/or the sine value of the eighth included angle, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is in front and back direction and The expected center of gravity position is offset.
  36. 根据权利要求35所述的方法,其特征在于,所述方法还包括:The method of claim 35, wherein the method further comprises:
    当所述第八夹角的角度范围和/或所述第八夹角的正弦值满足第四策略时,确定所述重心位置在上下方向与所述期望重心位置存在偏移。When the angle range of the eighth included angle and/or the sine value of the eighth included angle meets the fourth strategy, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity in the up and down direction.
  37. 根据权利要求36所述的方法,其特征在于,所述当所述第八夹角的角度范围和/或所述第八夹角的正弦值满足第四策略时,确定所述重心位置在上下方向与所述期望重心位置存在偏移,包括:The method according to claim 36, characterized in that, when the angle range of the eighth included angle and/or the sine of the eighth included angle meets the fourth strategy, it is determined that the position of the center of gravity is up and down. The direction is offset from the expected center of gravity position, including:
    当所述第八夹角的正弦值为正数时,确定所述重心位置相对于所述期望重心位置偏上;When the sine value of the eighth included angle is positive, determining that the position of the center of gravity is higher than the position of the desired center of gravity;
    当所述第八夹角的正弦值为负数时,确定所述重心位置相对于所述期望重心位置 偏下。When the sine value of the eighth included angle is a negative number, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  38. 根据权利要求36所述的方法,其特征在于,所述当所述第八夹角的角度范围和/或所述第八夹角的正弦值满足第四策略时,确定所述重心位置在上下方向与所述期望重心位置存在偏移,包括:The method according to claim 36, characterized in that, when the angle range of the eighth included angle and/or the sine of the eighth included angle meets the fourth strategy, it is determined that the position of the center of gravity is up and down. The direction is offset from the expected center of gravity position, including:
    当所述第八夹角的角度范围在第七预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏上;When the angle range of the eighth included angle is within the seventh preset angle range, determining that the position of the center of gravity is higher than the position of the desired center of gravity;
    当所述第八夹角的角度范围在第八预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏下。When the angle range of the eighth included angle is within the eighth preset angle range, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  39. 根据权利要求31所述的方法,其特征在于,所述方法还包括:The method of claim 31, wherein the method further comprises:
    当所述第五力矩值和所述第六力矩值的差值的绝对值大于第四预设力矩值时,确定所述重心在上下方向与所述期望重心位置存在偏移。When the absolute value of the difference between the fifth torque value and the sixth torque value is greater than the fourth preset torque value, it is determined that the center of gravity is offset from the desired center of gravity position in the up and down direction.
  40. 根据权利要求39所述的方法,其特征在于,当所述第五力矩值和所述第六力矩值的差值的绝对值大于第四预设力矩值时,确定所述重心位置在上下方向与所述期望重心位置存在偏移,包括:The method according to claim 39, wherein when the absolute value of the difference between the fifth torque value and the sixth torque value is greater than a fourth preset torque value, it is determined that the position of the center of gravity is in the up and down direction. The deviation from the expected center of gravity position includes:
    当所述第五力矩值和所述第六力矩值的差值大于所述第四预设力矩值时,确定所述重心位置相对于所述期望重心位置偏下;When the difference between the fifth torque value and the sixth torque value is greater than the fourth preset torque value, determining that the position of the center of gravity is lower than the position of the desired center of gravity;
    当所述第五力矩值和所述第六力矩值的差值小于所述第四预设力矩值的负数时,确定所述重心位置相对于所述期望重心位置偏上。When the difference between the fifth torque value and the sixth torque value is less than the negative number of the fourth preset torque value, it is determined that the position of the center of gravity is higher than the position of the desired center of gravity.
  41. 根据权利要求6所述的方法,其特征在于,在所述相应部分处于至少一个所述预设位置中的特定位置之后,获取所述俯仰轴电机和/或所述横滚轴电机输出的力矩值之前,所述方法还包括:The method according to claim 6, characterized in that, after the corresponding part is at a specific position among at least one of the preset positions, obtaining the torque output by the pitch axis motor and/or the roll axis motor Before the value, the method also includes:
    确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。It is determined that the torque value output by the pitch axis motor and/or the roll axis motor converges.
  42. 根据权利要求41所述的方法,其特征在于,所述确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛,包括:The method according to claim 41, wherein the determining the convergence of the torque value output by the pitch axis motor and/or the roll axis motor comprises:
    确定特定时间段内所述俯仰轴电机和/或所述横滚轴电机输出的多个力矩值的方差;Determining the variance of the multiple torque values output by the pitch axis motor and/or the roll axis motor in a specific time period;
    根据所述方差,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。According to the variance, it is determined that the torque value output by the pitch axis motor and/or the roll axis motor converges.
  43. 根据权利要求42所述的方法,其特征在于,所述根据所述方差,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛,包括:The method according to claim 42, wherein the determining, based on the variance, that the torque value output by the pitch axis motor and/or the roll axis motor converges, comprises:
    当所述方差小于或者等于预设方差阈值时,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。When the variance is less than or equal to a preset variance threshold, it is determined that the torque values output by the pitch axis motor and/or the roll axis motor converge.
  44. 根据权利要求41所述的方法,其特征在于,所述确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛,包括:The method according to claim 41, wherein the determining the convergence of the torque value output by the pitch axis motor and/or the roll axis motor comprises:
    在所述相应部分处于所述至少一个所述预设位置的持续时长大于或等于预设时长时,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。When the duration of the corresponding part at the at least one preset position is greater than or equal to the preset duration, it is determined that the torque value output by the pitch axis motor and/or the roll axis motor converges.
  45. 根据权利要求6所述的方法,其特征在于,所述俯仰轴电机和/或所述横滚轴 电机输出的力矩值为:特定时间段内所述俯仰轴电机和/或所述横滚轴电机输出的多个力矩值进行平滑滤波后获得的数值。The method according to claim 6, wherein the torque value output by the pitch axis motor and/or the roll axis motor is: the pitch axis motor and/or the roll axis within a specific time period The multiple torque values output by the motor are obtained after smoothing and filtering.
  46. 根据权利要求5所述的方法,其特征在于,所述目标位置为:历史记录的所述重心位置处于所述期望重心位置时所述相应部分的位置或者所述云台回中时的位置。The method according to claim 5, wherein the target position is: the position of the corresponding part when the position of the center of gravity of the historical record is at the position of the desired center of gravity, or the position of the pan/tilt head when returning to the center.
  47. 根据权利要求1所述的方法,其特征在于,所述在接收到用于重心配平的第一触发信号之前,所述方法还包括:The method according to claim 1, characterized in that, before receiving the first trigger signal for center of gravity trimming, the method further comprises:
    确定所述云台当前搭载的负载大小处于预设的云台负载大小范围内。It is determined that the load currently carried by the pan/tilt is within a preset load range of the pan/tilt.
  48. 根据权利要求47所述的方法,其特征在于,所述确定所述云台当前搭载的负载大小处于预设的云台负载大小范围内,包括:The method according to claim 47, wherein the determining that the load size currently carried by the pan/tilt head is within a preset load size range of the pan/tilt head comprises:
    在接收到用于负载评估的第二触发信号时,获取所述云台的电机的输出力矩和所述电机的角加速度,所述电机用于驱动所述负载转动;When receiving the second trigger signal for load evaluation, acquiring the output torque of the motor of the pan/tilt head and the angular acceleration of the motor, and the motor is used to drive the load to rotate;
    根据所述输出力矩和所述角加速度,确定所述电机的转动惯量;Determine the moment of inertia of the motor according to the output torque and the angular acceleration;
    当所述转动惯量小于或等于预设惯量阈值时,确定所述云台当前搭载的负载大小处于预设的云台负载大小范围内。When the moment of inertia is less than or equal to the preset inertia threshold, it is determined that the load currently carried by the pan/tilt is within the preset load range of the pan/tilt.
  49. 根据权利要求48所述的方法,其特征在于,所述方法还包括:The method according to claim 48, wherein the method further comprises:
    当所述转动惯量大于所述预设惯量阈值时,确定所述云台当前搭载的负载过大。When the moment of inertia is greater than the preset inertia threshold, it is determined that the load currently carried by the pan/tilt head is too large.
  50. 根据权利要求48或49所述的方法,其特征在于,所述方法还包括:The method according to claim 48 or 49, wherein the method further comprises:
    针对所述第二触发信号输出评估结果;Outputting an evaluation result for the second trigger signal;
    其中,所述评估结果包括:所述云台当前搭载的负载大小处于预设的云台负载大小范围内,或所述云台当前搭载的负载过大。Wherein, the evaluation result includes: the load currently carried by the pan/tilt is within a preset load range of the pan/tilt, or the load currently carried by the pan/tilt is too large.
  51. 根据权利要求50所述的方法,其特征在于,所述针对所述第二触发信号输出评估结果,包括:The method of claim 50, wherein the outputting an evaluation result for the second trigger signal comprises:
    发送所述评估结果至客户端。Send the evaluation result to the client.
  52. 根据权利要求51所述的方法,其特征在于,所述第一触发信号是所述客户端接收到用于指示所述云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果之后发送。The method according to claim 51, wherein the first trigger signal is an evaluation received by the client to indicate that the load size currently carried by the pan/tilt is within a preset load size range of the pan/tilt. The result will be sent later.
  53. 根据权利要求50所述的方法,其特征在于,所述云台包括提示模块;The method of claim 50, wherein the PTZ includes a prompt module;
    所述针对所述第二触发信号输出评估结果,包括:The outputting an evaluation result for the second trigger signal includes:
    通过所述提示模块输出所述评估结果。The evaluation result is output through the prompt module.
  54. 根据权利要求1所述的方法,其特征在于,所述输出用于指示调整所述重心位置的提示信号,包括:The method according to claim 1, wherein the outputting a prompt signal for instructing to adjust the position of the center of gravity comprises:
    发送用于指示调整所述重心位置的提示信号至客户端。Send a prompt signal for instructing to adjust the position of the center of gravity to the client.
  55. 根据权利要求1所述的方法,其特征在于,所述云台包括提示模块;The method according to claim 1, wherein the pan-tilt includes a prompt module;
    所述输出用于指示调整所述重心位置的提示信号,包括:The output is used to indicate a prompt signal for adjusting the position of the center of gravity, including:
    通过所述提示模块输出用于指示调整所述重心位置的提示信号。The prompt module outputs a prompt signal for instructing to adjust the position of the center of gravity.
  56. 根据权利要求1所述的方法,其特征在于,所述提示信号携带有所述重心位置的偏移信息。The method according to claim 1, wherein the prompt signal carries offset information of the position of the center of gravity.
  57. 根据权利要求56所述的方法,其特征在于,所述偏移信息包括:偏移方向和/或偏移量。The method according to claim 56, wherein the offset information comprises: an offset direction and/or an offset amount.
  58. 根据权利要求1所述的方法,其特征在于,所述若所述重心位置偏离所述期望重心位置,则输出用于指示调整所述重心位置的提示信号之后,所述方法还包括:The method according to claim 1, wherein after the output of a prompt signal for indicating adjustment of the position of the center of gravity if the position of the center of gravity deviates from the desired position of the center of gravity, the method further comprises:
    若检测到所述云台所搭载的负载产生变化,则重新进行所述云台的重心配平。If a change in the load carried by the pan/tilt head is detected, the center of gravity trim of the pan/tilt head is performed again.
  59. 根据权利要求58所述的方法,其特征在于,所述检测到所述云台所搭载的负载产生变化,包括:The method according to claim 58, wherein the detecting a change in the load carried by the pan/tilt head comprises:
    检测到所述云台所搭载的负载在所述云台上的位置和/或重量产生变化。It is detected that the position and/or weight of the load carried by the pan/tilt head on the pan/tilt head changes.
  60. 一种云台,所述云台被配置为绕俯仰轴和/或横滚轴转动,其特征在于,所述云台包括:A pan/tilt, the pan/tilt is configured to rotate around a pitch axis and/or a roll axis, characterized in that the pan/tilt includes:
    俯仰轴电机和/或横滚轴电机;以及Pitch axis motor and/or roll axis motor; and
    控制器,所述控制器与所述俯仰轴电机和/或横滚轴电机电连接;A controller, which is electrically connected to the pitch axis motor and/or the roll axis motor;
    其中,所述控制器用于:Wherein, the controller is used for:
    在接收到用于重心配平的第一触发信号时,检测所述云台中相应部分的重心位置是否偏离期望重心位置;When receiving the first trigger signal for center of gravity trimming, detect whether the position of the center of gravity of the corresponding part of the pan/tilt head deviates from the expected position of the center of gravity;
    若所述重心位置偏离所述期望重心位置,则输出用于指示调整所述重心位置的提示信号。If the position of the center of gravity deviates from the position of the desired center of gravity, a prompt signal for instructing to adjust the position of the center of gravity is output.
  61. 根据权利要求60所述的云台,其特征在于,在所述云台被配置为绕所述俯仰轴转动时,所述相应部分包括所述云台中绕所述俯仰轴转动的部分,所述期望重心位置与所述俯仰轴之间的距离不大于第一预设距离。The pan/tilt head according to claim 60, wherein when the pan/tilt head is configured to rotate around the pitch axis, the corresponding part includes a part of the pan/tilt head that rotates around the pitch axis, and It is desirable that the distance between the position of the center of gravity and the pitch axis is not greater than the first preset distance.
  62. 根据权利要求60所述的云台,其特征在于,在所述云台被配置为绕所述横滚轴转动时,所述相应部分包括所述云台中绕所述横滚轴转动的部分,所述期望重心位置与所述横滚轴之间的距离不大于第二预设距离。The pan/tilt head according to claim 60, wherein when the pan/tilt head is configured to rotate around the roll axis, the corresponding part includes a part of the pan/tilt head that rotates around the roll axis, The distance between the desired center of gravity position and the roll axis is not greater than a second preset distance.
  63. 根据权利要求60所述的云台,其特征在于,所述重心位置偏离所述期望重心位置包括以下一种或多种情况:The pan/tilt head according to claim 60, wherein the deviation of the position of the center of gravity from the position of the desired center of gravity includes one or more of the following conditions:
    所述重心位置在前后方向与所述期望重心位置存在偏移、所述重心位置在左右方向与所述期望重心位置存在偏移、所述重心位置在上下方向与所述期望重心位置存在偏移。The position of the center of gravity is deviated from the desired center of gravity in the front and rear direction, the position of the center of gravity is deviated from the desired center of gravity in the left and right direction, and the position of the center of gravity deviates from the desired center of gravity in the up and down direction .
  64. 根据权利要求63所述的云台,其特征在于,所述控制器在检测所述云台中相应部分的重心位置是否偏离期望重心位置时,具体用于:The pan/tilt head according to claim 63, wherein when the controller detects whether the position of the center of gravity of the corresponding part of the pan/tilt head deviates from the expected position of the center of gravity, it is specifically configured to:
    控制所述云台转动,使得所述云台中的相应部分处于至少一个预设位置;Controlling the rotation of the pan/tilt so that the corresponding part of the pan/tilt is at at least one preset position;
    检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置。It is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from the expected position of the center of gravity.
  65. 根据权利要求64所述的云台,其特征在于,所述云台包括俯仰轴电机和/或 横滚轴电机,所述控制器在检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置时,具体用于:The pan/tilt head according to claim 64, wherein the pan/tilt head comprises a pitch axis motor and/or a roll axis motor, and the controller detects that the corresponding part is in at least one of the preset positions. When the position of the center of gravity at the target position deviates from the expected position of the center of gravity, it is specifically used for:
    在所述相应部分处于至少一个所述预设位置中的特定位置时,获取所述俯仰轴电机和/或所述横滚轴电机输出的力矩值;Acquiring a torque value output by the pitch axis motor and/or the roll axis motor when the corresponding part is at a specific position among at least one of the preset positions;
    根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置。According to the torque value, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions deviates from the expected position of the center of gravity.
  66. 根据权利要求65所述的云台,其特征在于,所述云台被配置为绕所述俯仰轴转动,所述云台包括所述俯仰轴电机,所述力矩值包括:所述相应部分处于第一预设位置时,所述俯仰轴电机输出的第一力矩值;The pan/tilt head of claim 65, wherein the pan/tilt head is configured to rotate around the pitch axis, the pan/tilt head includes the pitch axis motor, and the torque value includes: the corresponding part is At the first preset position, the first torque value output by the pitch axis motor;
    所述控制器在根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置时,具体用于:When the controller detects whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions according to the torque value, it is specifically used to:
    根据所述第一力矩值,检测所述相应部分处于所述第一预设位置时的重心位置是否在前后方向与所述期望重心位置存在偏移。According to the first moment value, it is detected whether the position of the center of gravity when the corresponding part is at the first preset position is offset from the expected position of the center of gravity in the front-to-rear direction.
  67. 根据权利要求66所述的云台,其特征在于,所述相应部分处于所述第一预设位置时,所述俯仰轴至所述重心位置的距离的沿线方向与水平方向形成第一夹角;The pan/tilt head according to claim 66, wherein when the corresponding part is at the first preset position, the distance along the line from the pitch axis to the center of gravity position forms a first angle with the horizontal direction ;
    所述控制器在根据所述第一力矩值,检测所述相应部分处于所述第一预设位置时的重心位置是否在前后方向与所述期望重心位置存在偏移时,具体用于:When the controller detects whether the position of the center of gravity when the corresponding part is at the first preset position is offset from the position of the expected center of gravity in the front-to-rear direction according to the first torque value, the controller is specifically configured to:
    根据所述第一力矩值,确定所述第一夹角的角度范围和/或所述第一夹角的余弦值;Determine the angular range of the first included angle and/or the cosine value of the first included angle according to the first moment value;
    根据所述第一夹角的角度范围和/或所述第一夹角的余弦值,检测所述相应部分处于所述第一预设位置时的重心位置是否在前后方向与所述期望重心位置存在偏移。According to the angle range of the first included angle and/or the cosine value of the first included angle, it is detected whether the position of the center of gravity when the corresponding part is at the first preset position is in the front-to-rear direction and the expected center of gravity position There is an offset.
  68. 根据权利要求67所述的云台,其特征在于,所述控制器还用于:The pan/tilt head according to claim 67, wherein the controller is further configured to:
    当所述第一夹角的角度范围和/或所述第一夹角的余弦值满足第一策略时,确定所述重心位置在前后方向与所述期望重心位置存在偏移。When the angle range of the first included angle and/or the cosine value of the first included angle meets the first strategy, it is determined that the position of the center of gravity is offset from the position of the desired center of gravity in the front-to-rear direction.
  69. 根据权利要求68所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 68, wherein the controller is specifically configured to:
    当所述第一夹角的余弦值为正数时,确定所述重心位置相对于所述期望重心位置偏前;When the cosine value of the first included angle is a positive number, it is determined that the position of the center of gravity is forward relative to the position of the desired center of gravity;
    当所述第一夹角的余弦值为负数时,确定所述重心位置相对于所述期望重心位置偏后。When the cosine value of the first included angle is a negative number, it is determined that the position of the center of gravity is behind the position of the desired center of gravity.
  70. 根据权利要求68所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 68, wherein the controller is specifically configured to:
    当所述第一夹角的角度范围在第一预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏前;When the angle range of the first included angle is within a first preset angle range, determining that the position of the center of gravity is forward relative to the position of the desired center of gravity;
    当所述第一夹角的角度范围在第二预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏后。When the angle range of the first included angle is within the second preset angle range, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity.
  71. 根据权利要求66所述的云台,其特征在于,所述控制器还用于:The pan/tilt head according to claim 66, wherein the controller is further configured to:
    当所述第一力矩值的绝对值大于第一预设力矩值时,确定所述相应部分处于所述 第一预设位置时的重心位置在前后方向与所述期望重心位置存在偏移。When the absolute value of the first torque value is greater than the first preset torque value, it is determined that the center of gravity position when the corresponding part is at the first preset position is offset from the expected center of gravity position in the front-to-rear direction.
  72. 根据权利要求71所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 71, wherein the controller is specifically configured to:
    当所述第一力矩值大于所述第一预设力矩值时,确定所述重心位置相对于所述期望重心位置偏前;When the first torque value is greater than the first preset torque value, determining that the center of gravity position is forward relative to the desired center of gravity position;
    当所述第一力矩值小于所述第一预设力矩值的相反数时,确定所述重心位置相对于所述期望重心位置偏后。When the first torque value is less than the inverse of the first preset torque value, it is determined that the position of the center of gravity is behind the expected position of the center of gravity.
  73. 根据权利要求65所述的云台,其特征在于,所述云台被配置为绕所述横滚轴转动,所述云台包括横滚轴电机,所述力矩值包括:所述相应部分处于第二预设位置时,所述横滚轴电机输出的第二力矩值;The pan/tilt head of claim 65, wherein the pan/tilt head is configured to rotate around the roll axis, the pan/tilt head includes a roll axis motor, and the torque value includes: the corresponding part is At the second preset position, the second torque value output by the roll axis motor;
    所述控制器在根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置时,具体用于:When the controller detects whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions according to the torque value, it is specifically used to:
    根据所述第二力矩值,检测所述相应部分处于所述第二预设位置时的重心位置是否在左右方向与所述期望重心位置存在偏移。According to the second torque value, it is detected whether the position of the center of gravity when the corresponding part is at the second preset position is deviated from the expected position of the center of gravity in the left-right direction.
  74. 根据权利要求73所述的云台,其特征在于,所述相应部分处于所述第二预设位置时,所述横滚轴至所述重心位置的距离的沿线方向与水平方向形成第二夹角;The pan/tilt head according to claim 73, wherein when the corresponding part is in the second preset position, the distance between the roll axis and the center of gravity position forms a second clamp between the horizontal direction and the horizontal direction. angle;
    所述控制器在根据所述第二力矩值,检测所述相应部分处于所述第二预设位置时的重心位置是否在左右方向与所述期望重心位置存在偏移时,具体用于:When the controller detects whether the position of the center of gravity when the corresponding part is at the second preset position is offset from the position of the desired center of gravity in the left-right direction according to the second torque value, it is specifically used to:
    根据所述第二力矩值,确定所述第二夹角的角度范围和/或所述第二夹角的余弦值;Determine the angular range of the second included angle and/or the cosine value of the second included angle according to the second torque value;
    根据所述第二夹角的角度范围和/或所述第二夹角的余弦值,检测所述相应部分处于所述第二预设位置时的重心位置是否在左右方向与所述期望重心位置存在偏移。According to the angle range of the second included angle and/or the cosine value of the second included angle, it is detected whether the center of gravity position when the corresponding part is at the second preset position is in the left-right direction and the expected center of gravity position There is an offset.
  75. 根据权利要求74所述的云台,其特征在于,所述控制器还用于:The pan-tilt according to claim 74, wherein the controller is further used for:
    当所述第二夹角的角度范围和/或所述第二夹角的余弦值满足第二策略时,确定所述重心位置在左右方向与所述期望重心位置存在偏移。When the angle range of the second included angle and/or the cosine value of the second included angle meets the second strategy, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity in the left-right direction.
  76. 根据权利要求75所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 75, wherein the controller is specifically configured to:
    当所述第二夹角的余弦值为正数时,确定所述重心位置相对于所述期望重心位置偏右;When the cosine value of the second included angle is a positive number, it is determined that the position of the center of gravity is to the right relative to the position of the desired center of gravity;
    当所述第二夹角的余弦值为负数时,确定所述重心位置相对于所述期望重心位置偏左。When the cosine value of the second included angle is a negative number, it is determined that the position of the center of gravity is deviated to the left relative to the position of the desired center of gravity.
  77. 根据权利要求75所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 75, wherein the controller is specifically configured to:
    当所述第二夹角的角度范围在第三预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏右;When the angle range of the second included angle is within a third preset angle range, determining that the center of gravity position is off to the right with respect to the expected center of gravity position;
    当所述第二夹角的角度范围在第四预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏左。When the angle range of the second included angle is within the fourth preset angle range, it is determined that the position of the center of gravity is deviated to the left relative to the position of the desired center of gravity.
  78. 根据权利要求73所述的云台,其特征在于,所述控制器还用于:The pan/tilt head according to claim 73, wherein the controller is further configured to:
    当所述第二力矩值的绝对值大于第二预设力矩值时,确定所述相应部分处于所述 第二预设位置时的重心位置在左右方向与所述期望重心位置存在偏移。When the absolute value of the second torque value is greater than the second preset torque value, it is determined that the center of gravity position when the corresponding part is at the second preset position is offset from the expected center of gravity position in the left-right direction.
  79. 根据权利要求78所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 78, wherein the controller is specifically configured to:
    当所述第二力矩值大于所述第二预设力矩值时,确定所述重心位置相对于所述期望重心位置偏右;When the second torque value is greater than the second preset torque value, determining that the center of gravity position is to the right relative to the expected center of gravity position;
    当所述第二力矩值小于所述第二预设力矩值的相反数时,确定所述重心位置相对于所述期望重心位置偏左。When the second torque value is less than the inverse of the second preset torque value, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity.
  80. 根据权利要求65所述的云台,其特征在于,所述云台包括俯仰轴电机,所述力矩值包括:所述相应部分处于第三预设位置时,所述俯仰轴电机输出的第三力矩值,以及所述相应部分处于第四预设位置时,所述俯仰轴电机输出的第四力矩值;The pan/tilt head according to claim 65, wherein the pan/tilt head includes a pitch axis motor, and the torque value includes: when the corresponding part is at a third preset position, the third pitch axis motor output A torque value, and a fourth torque value output by the pitch axis motor when the corresponding part is at the fourth preset position;
    所述控制器在根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置时,具体用于:When the controller detects whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions according to the torque value, it is specifically used to:
    根据所述第三力矩值和所述第四力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移。According to the third torque value and the fourth torque value, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is offset from the desired center of gravity position in the up and down direction.
  81. 根据权利要求80所述的云台,其特征在于,所述相应部分处于所述第三预设位置时所述俯仰轴至所述重心位置的距离的沿线方向,与所述相应部分位于所述第四预设位置时所述俯仰轴至所述重心位置的距离的沿线方向的夹角大小固定。The pan/tilt head according to claim 80, wherein when the corresponding part is in the third preset position, the distance along the line from the pitch axis to the center of gravity is located in the same direction as the corresponding part. In the fourth preset position, the included angle of the distance from the pitch axis to the center of gravity position along the line direction is fixed.
  82. 根据权利要求81所述的云台,其特征在于,所述相应部分处于所述第三预设位置时所述俯仰轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标位置时所述俯仰轴至所述重心位置的距离的沿线方向形成第三夹角;The pan/tilt head according to claim 81, wherein when the corresponding part is at the third preset position, the distance along the line from the pitch axis to the center of gravity position and the corresponding part are at the target The distance along the line from the pitch axis to the center of gravity position forms a third included angle;
    所述相应部分处于所述第四预设位置时所述俯仰轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标位置时所述俯仰轴至所述重心位置的距离的沿线方向形成第三夹角形成第四夹角。The distance along the line of the distance from the pitch axis to the center of gravity position when the corresponding part is at the fourth preset position and the distance from the pitch axis to the center of gravity position when the corresponding part is at the target position A third included angle is formed along the line direction to form a fourth included angle.
  83. 根据权利要求82所述的云台,其特征在于,所述第三夹角和所述第四夹角大小相等;The pan/tilt head according to claim 82, wherein the third included angle and the fourth included angle are equal in size;
    所述第三预设位置为:在所述相应部分处于所述目标位置时,绕第一方向旋转第一预设夹角大小后所述相应部分的位置;The third preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating the first preset angle around the first direction;
    所述第四预设位置为:在所述相应部分处于所述第三预设位置时,绕第二方向旋转所述第一预设夹角的两倍大小后所述相应部分的位置;The fourth preset position is: when the corresponding part is at the third preset position, the position of the corresponding part after being rotated around the second direction by twice the first preset included angle;
    其中,所述第一方向与所述第二方向为相反的两个方向。Wherein, the first direction and the second direction are two opposite directions.
  84. 根据权利要求82所述的云台,其特征在于,在所述相应部分位于所述目标位置时,所述俯仰轴至所述重心位置的距离的沿线方向与水平方向形成第五夹角;The pan/tilt head according to claim 82, wherein when the corresponding part is located at the target position, the distance along the line from the pitch axis to the center of gravity position forms a fifth included angle with the horizontal direction;
    所述控制器在根据所述第三力矩值和所述第四力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移时,具体用于:According to the third torque value and the fourth torque value, the controller detects whether the center of gravity position when the corresponding part is at the target position in at least one of the preset positions is in the up-down direction and the expected center of gravity When the position is offset, it is specifically used for:
    根据所述第三力矩值和所述第四力矩值,确定所述第五夹角的角度范围和/或所述第五夹角的正弦值;Determining the angle range of the fifth included angle and/or the sine value of the fifth included angle according to the third torque value and the fourth torque value;
    根据所述第五夹角的角度范围和/或所述第五夹角的正弦值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移。According to the angle range of the fifth included angle and/or the sine value of the fifth included angle, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is in the up-down direction. The expected center of gravity position is offset.
  85. 根据权利要求84所述的云台,其特征在于,所述控制器还用于:The pan/tilt head according to claim 84, wherein the controller is further configured to:
    当所述第五夹角的角度范围和/或所述第五夹角的正弦值满足第三策略时,确定所述重心位置在上下方向与所述期望重心位置存在偏移。When the angle range of the fifth included angle and/or the sine value of the fifth included angle meets the third strategy, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity in the up and down direction.
  86. 根据权利要求85所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 85, wherein the controller is specifically configured to:
    当所述第五夹角的正弦值为正数时,确定所述重心位置相对于所述期望重心位置偏上;When the sine value of the fifth included angle is positive, it is determined that the position of the center of gravity is higher than the position of the expected center of gravity;
    当所述第五夹角的正弦值为负数时,确定所述重心位置相对于所述期望重心位置偏下。When the sine value of the fifth included angle is negative, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  87. 根据权利要求85所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 85, wherein the controller is specifically configured to:
    当所述第五夹角的角度范围在第五预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏上;When the angle range of the fifth included angle is within the fifth preset angle range, determining that the position of the center of gravity is higher than the position of the desired center of gravity;
    当所述第五夹角的角度范围在第六预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏下。When the angle range of the fifth included angle is within the sixth preset angle range, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  88. 根据权利要求80所述的云台,其特征在于,所述控制器还用于:The pan/tilt head of claim 80, wherein the controller is further configured to:
    当所述第三力矩值和所述第四力矩值的差值的绝对值大于第三预设力矩值时,确定所述重心位置在上下方向与所述期望重心位置存在偏移。When the absolute value of the difference between the third torque value and the fourth torque value is greater than the third preset torque value, it is determined that the center of gravity position is offset from the expected center of gravity position in the up and down direction.
  89. 根据权利要求88所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 88, wherein the controller is specifically configured to:
    当所述第三力矩值和所述第四力矩值的差值大于所述第三预设力矩值时,确定所述重心位置相对于所述期望重心位置偏下;When the difference between the third torque value and the fourth torque value is greater than the third preset torque value, determining that the position of the center of gravity is lower than the position of the desired center of gravity;
    当所述第三力矩值和所述第四力矩值的差值小于所述第三预设力矩值的相反数时,确定所述重心位置相对于所述期望重心位置偏上。When the difference between the third torque value and the fourth torque value is less than the inverse of the third preset torque value, it is determined that the position of the center of gravity is higher than the position of the desired center of gravity.
  90. 根据权利要求65所述的云台,其特征在于,所述云台包括横滚轴电机,所述力矩值包括:所述相应部分处于第五预设位置时,所述横滚轴电机输出的第五力矩值,以及所述相应部分处于第六预设位置时,所述横滚轴输出的第六力矩值,The pan/tilt head according to claim 65, wherein the pan/tilt head includes a roll axis motor, and the torque value includes: when the corresponding part is at the fifth preset position, the output of the roll axis motor The fifth torque value, and the sixth torque value output by the roll shaft when the corresponding part is at the sixth preset position,
    所述控制器在根据所述力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否偏离期望重心位置时,具体用于:When the controller detects whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions according to the torque value, it is specifically used to:
    根据所述第五力矩值和所述第六力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移。According to the fifth moment value and the sixth moment value, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is offset from the desired center of gravity position in the up and down direction.
  91. 根据权利要求90所述的云台,其特征在于,所述相应部分处于所述第五预设位置时所述横滚轴至所述重心位置的距离的沿线方向,与所述相应部分位于所述第六预设位置时所述横滚轴至所述重心位置的距离的沿线方向的夹角大小固定。The pan/tilt head according to claim 90, wherein when the corresponding part is at the fifth preset position, the distance along the line from the roll axis to the center of gravity is located at the same position as the corresponding part. In the sixth preset position, the included angle of the distance from the roll axis to the center of gravity position along the line is fixed.
  92. 根据权利要求91所述的云台,其特征在于,所述相应部分处于所述第五预设位置时,所述横滚轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标 位置时所述横滚轴至所述重心位置的距离的沿线方向形成第六夹角;The pan/tilt head according to claim 91, wherein when the corresponding part is at the fifth preset position, the distance between the roll axis and the center of gravity is at the same position as the corresponding part. The distance along the line from the roll axis to the center of gravity position when the target position forms a sixth included angle;
    所述相应部分处于所述第六预设位置时,所述横滚轴至所述重心位置的距离的沿线方向与所述相应部分处于所述目标位置时所述横滚轴至所述重心位置的距离的沿线方向形成第七夹角。When the corresponding part is at the sixth preset position, the distance along the line from the roll axis to the center of gravity position is the same as when the corresponding part is at the target position, the roll axis to the center of gravity position The distance along the line forms the seventh angle.
  93. 根据权利要求92所述的云台,其特征在于,所述第六夹角和所述第七夹角大小相等;The pan/tilt head according to claim 92, wherein the sixth included angle and the seventh included angle are equal in magnitude;
    所述第五预设位置为:在所述相应部分处于所述目标位置时,绕第三方向旋转第二预设夹角大小后所述相应部分的位置;The fifth preset position is: when the corresponding part is at the target position, the position of the corresponding part after rotating a second preset angle in a third direction;
    所述第六预设位置为:在所述相应部分处于所述第五预设位置时,绕第四方向旋转所述第二预设夹角的两倍大小后所述相应部分的位置;The sixth preset position is: when the corresponding part is at the fifth preset position, the position of the corresponding part is rotated about a fourth direction by twice the second preset included angle;
    其中,所述第三方向与所述第四方向为相反的两个方向。Wherein, the third direction and the fourth direction are two opposite directions.
  94. 根据权利要求92所述的云台,其特征在于,在所述相应部分位于所述目标位置时,所述横滚轴至所述重心位置的距离的沿线方向与水平方向形成第八夹角;The pan/tilt head according to claim 92, wherein when the corresponding part is located at the target position, the distance along the line from the roll axis to the center of gravity position forms an eighth included angle with the horizontal direction;
    所述控制器在根据所述第五力矩值和所述第六力矩值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在上下方向与所述期望重心位置存在偏移时,具体用于:According to the fifth torque value and the sixth torque value, the controller detects whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is in the up-down direction and the expected center of gravity When the position is offset, it is specifically used for:
    根据所述第五力矩值和所述第六力矩值,确定所述第八夹角的角度范围和/或所述第八夹角的正弦值;Determining the angle range of the eighth included angle and/or the sine value of the eighth included angle according to the fifth torque value and the sixth torque value;
    根据所述第八夹角的角度范围和/或所述第八夹角的正弦值,检测所述相应部分处于至少一个所述预设位置中的目标位置时的重心位置是否在前后方向与所述期望重心位置存在偏移。According to the angle range of the eighth included angle and/or the sine value of the eighth included angle, it is detected whether the position of the center of gravity when the corresponding part is at the target position in at least one of the preset positions is in front and back direction and The expected center of gravity position is offset.
  95. 根据权利要求94所述的云台,其特征在于,所述控制器还用于:The pan/tilt head of claim 94, wherein the controller is further configured to:
    当所述第八夹角的角度范围和/或所述第八夹角的正弦值满足第四策略时,确定所述重心位置在上下方向与所述期望重心位置存在偏移。When the angle range of the eighth included angle and/or the sine value of the eighth included angle meets the fourth strategy, it is determined that the position of the center of gravity is deviated from the position of the desired center of gravity in the up and down direction.
  96. 根据权利要求95所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head of claim 95, wherein the controller is specifically configured to:
    当所述第八夹角的正弦值为正数时,确定所述重心位置相对于所述期望重心位置偏上;When the sine value of the eighth included angle is positive, determining that the position of the center of gravity is higher than the position of the desired center of gravity;
    当所述第八夹角的正弦值为负数时,确定所述重心位置相对于所述期望重心位置偏下。When the sine value of the eighth included angle is a negative number, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  97. 根据权利要求95所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head of claim 95, wherein the controller is specifically configured to:
    当所述第八夹角的角度范围在第七预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏上;When the angle range of the eighth included angle is within the seventh preset angle range, determining that the position of the center of gravity is higher than the position of the desired center of gravity;
    当所述第八夹角的角度范围在第八预设角度范围内时,确定所述重心位置相对于所述期望重心位置偏下。When the angle range of the eighth included angle is within the eighth preset angle range, it is determined that the position of the center of gravity is lower than the position of the desired center of gravity.
  98. 根据权利要求90所述的云台,其特征在于,所述控制器还用于:The pan/tilt head of claim 90, wherein the controller is further configured to:
    当所述第五力矩值和所述第六力矩值的差值的绝对值大于第四预设力矩值时,确 定所述重心在上下方向与所述期望重心位置存在偏移。When the absolute value of the difference between the fifth torque value and the sixth torque value is greater than the fourth preset torque value, it is determined that the center of gravity is offset from the desired center of gravity position in the up and down direction.
  99. 根据权利要求98所述的云台,其特征在于,所述控制器具体用于:The pan/tilt head according to claim 98, wherein the controller is specifically configured to:
    当所述第五力矩值和所述第六力矩值的差值大于所述第四预设力矩值时,确定所述重心位置相对于所述期望重心位置偏下;When the difference between the fifth torque value and the sixth torque value is greater than the fourth preset torque value, determining that the position of the center of gravity is lower than the position of the desired center of gravity;
    当所述第五力矩值和所述第六力矩值的差值小于所述第四预设力矩值的负数时,确定所述重心位置相对于所述期望重心位置偏上。When the difference between the fifth torque value and the sixth torque value is less than the negative number of the fourth preset torque value, it is determined that the position of the center of gravity is higher than the position of the desired center of gravity.
  100. 根据权利要求65所述的云台,其特征在于,所述控制器在在所述相应部分处于至少一个所述预设位置中的特定位置之后,获取所述俯仰轴电机和/或所述横滚轴电机输出的力矩值之前,还用于:The pan/tilt head according to claim 65, wherein the controller acquires the pitch axis motor and/or the horizontal axis after the corresponding part is at a specific position among at least one of the preset positions. Before the torque value output by the roller motor, it is also used for:
    确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。It is determined that the torque value output by the pitch axis motor and/or the roll axis motor converges.
  101. 根据权利要求100所述的云台,其特征在于,所述控制器在确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛时,具体用于:The pan/tilt head according to claim 100, wherein when determining that the torque value output by the pitch axis motor and/or the roll axis motor converges, the controller is specifically configured to:
    确定特定时间段内所述俯仰轴电机和/或所述横滚轴电机输出的多个力矩值的方差;Determining the variance of the multiple torque values output by the pitch axis motor and/or the roll axis motor in a specific time period;
    根据所述方差,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。According to the variance, it is determined that the torque value output by the pitch axis motor and/or the roll axis motor converges.
  102. 根据权利要求101所述的云台,其特征在于,所述控制器在根据所述方差,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛时,具体用于:The pan/tilt head according to claim 101, wherein the controller is specifically configured to: when determining, according to the variance, that the torque values output by the pitch axis motor and/or the roll axis motor converge:
    当所述方差小于或者等于预设方差阈值时,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。When the variance is less than or equal to a preset variance threshold, it is determined that the torque values output by the pitch axis motor and/or the roll axis motor converge.
  103. 根据权利要求100所述的云台,其特征在于,所述控制器在确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛时,具体用于:The pan/tilt head according to claim 100, wherein when determining that the torque value output by the pitch axis motor and/or the roll axis motor converges, the controller is specifically configured to:
    在所述相应部分处于所述至少一个所述预设位置的持续时长大于或等于预设时长时,确定所述俯仰轴电机和/或所述横滚轴电机输出的力矩值收敛。When the duration of the corresponding part at the at least one preset position is greater than or equal to the preset duration, it is determined that the torque value output by the pitch axis motor and/or the roll axis motor converges.
  104. 根据权利要求65所述的云台,其特征在于,所述俯仰轴电机和/或所述横滚轴电机输出的力矩值为:特定时间段内所述俯仰轴电机和/或所述横滚轴电机输出的多个力矩值进行平滑滤波后获得的数值。The pan/tilt head according to claim 65, wherein the torque value output by the pitch axis motor and/or the roll axis motor is: the pitch axis motor and/or the roll axis in a specific time period The multiple torque values output by the shaft motor are obtained after smoothing and filtering.
  105. 根据权利要求64所述的云台,其特征在于,所述目标位置为:历史记录的所述重心位置处于所述期望重心位置时所述相应部分的位置或者所述云台回中时的位置。The pan/tilt head according to claim 64, wherein the target position is: the position of the corresponding part when the center of gravity position of the historical record is at the desired center of gravity position or the position of the pan/tilt head when returning to the center .
  106. 根据权利要求60所述的云台,其特征在于,所述控制器在在接收到用于重心配平的第一触发信号之前,还用于:The pan/tilt head according to claim 60, wherein the controller is further used for: before receiving the first trigger signal for center of gravity trimming:
    确定所述云台当前搭载的负载大小处于预设的云台负载大小范围内。It is determined that the load currently carried by the pan/tilt is within a preset load range of the pan/tilt.
  107. 根据权利要求106所述的云台,其特征在于,所述控制器在确定所述云台当前搭载的负载大小处于预设的云台负载大小范围内时,具体用于:The pan/tilt head according to claim 106, wherein the controller is specifically configured to: when determining that the load currently carried by the pan/tilt head is within a preset load range of the pan/tilt head:
    在接收到用于负载评估的第二触发信号时,获取所述云台的电机的输出力矩和所述电机的角加速度,所述电机用于驱动所述负载转动;When receiving the second trigger signal for load evaluation, acquiring the output torque of the motor of the pan/tilt head and the angular acceleration of the motor, and the motor is used to drive the load to rotate;
    根据所述输出力矩和所述角加速度,确定所述电机的转动惯量;Determine the moment of inertia of the motor according to the output torque and the angular acceleration;
    当所述转动惯量小于或等于预设惯量阈值时,确定所述云台当前搭载的负载大小处于预设的云台负载大小范围内。When the moment of inertia is less than or equal to the preset inertia threshold, it is determined that the load currently carried by the pan/tilt is within the preset load range of the pan/tilt.
  108. 根据权利要求107所述的云台,其特征在于,所述控制器还用于:The pan/tilt head according to claim 107, wherein the controller is further configured to:
    当所述转动惯量大于所述预设惯量阈值时,确定所述云台当前搭载的负载过大。When the moment of inertia is greater than the preset inertia threshold, it is determined that the load currently carried by the pan/tilt head is too large.
  109. 根据权利要求107或108所述的云台,其特征在于,所述控制器还用于:The pan/tilt head according to claim 107 or 108, wherein the controller is further configured to:
    针对所述第二触发信号输出评估结果;Outputting an evaluation result for the second trigger signal;
    其中,所述评估结果包括:所述云台当前搭载的负载大小处于预设的云台负载大小范围内,或所述云台当前搭载的负载过大。Wherein, the evaluation result includes: the load currently carried by the pan/tilt is within a preset load range of the pan/tilt, or the load currently carried by the pan/tilt is too large.
  110. 根据权利要求109所述的云台,其特征在于,所述控制器在针对所述第二触发信号输出评估结果时,具体用于:The pan/tilt head according to claim 109, wherein when the controller outputs the evaluation result for the second trigger signal, it is specifically configured to:
    发送所述评估结果至客户端。Send the evaluation result to the client.
  111. 根据权利要求110所述的云台,其特征在于,所述第一触发信号是所述客户端接收到用于指示所述云台当前搭载的负载大小处于预设的云台负载大小范围内的评估结果之后发送。The pan/tilt head according to claim 110, wherein the first trigger signal is received by the client to indicate that the load size currently carried by the pan/tilt head is within a preset load size range of the pan/tilt head. Send after the evaluation result.
  112. 根据权利要求109所述的云台,其特征在于,所述云台包括提示模块;The pan/tilt according to claim 109, wherein the pan/tilt comprises a prompt module;
    所述控制器在针对所述第二触发信号输出评估结果时,具体用于:When the controller outputs the evaluation result for the second trigger signal, it is specifically configured to:
    通过所述提示模块输出所述评估结果。The evaluation result is output through the prompt module.
  113. 根据权利要求60所述的云台,其特征在于,所述控制器在输出用于指示调整所述重心位置的提示信号时,具体用于:The pan/tilt head according to claim 60, wherein when the controller outputs a prompt signal for instructing to adjust the position of the center of gravity, it is specifically configured to:
    发送用于指示调整所述重心位置的提示信号至客户端。Send a prompt signal for instructing to adjust the position of the center of gravity to the client.
  114. 根据权利要求60所述的云台,其特征在于,所述云台包括提示模块;The pan-tilt according to claim 60, wherein the pan-tilt comprises a prompt module;
    所述控制器在输出用于指示调整所述重心位置的提示信号时,具体用于:When the controller outputs a prompt signal for indicating adjustment of the position of the center of gravity, it is specifically used to:
    通过所述提示模块输出用于指示调整所述重心位置的提示信号。The prompt module outputs a prompt signal for instructing to adjust the position of the center of gravity.
  115. 根据权利要求60所述的云台,其特征在于,所述提示信号携带有所述重心位置的偏移信息。The pan/tilt head according to claim 60, wherein the prompt signal carries offset information of the position of the center of gravity.
  116. 根据权利要求115所述的云台,其特征在于,所述偏移信息包括:偏移方向和/或偏移量。The pan/tilt head according to claim 115, wherein the offset information comprises: an offset direction and/or an offset amount.
  117. 根据权利要求60所述的云台,其特征在于,所述控制器在所述重心位置偏离所述期望重心位置时,输出用于指示调整所述重心位置的提示信号之后,还用于:The pan/tilt head according to claim 60, wherein after the controller outputs a prompt signal for instructing to adjust the position of the center of gravity when the position of the center of gravity deviates from the desired position of the center of gravity, it is further used for:
    若检测到所述云台所搭载的负载产生变化,则重新进行所述云台的重心配平。If a change in the load carried by the pan/tilt head is detected, the center of gravity trim of the pan/tilt head is performed again.
  118. 根据权利要求117所述的云台,其特征在于,所述控制器在检测到所述云台所搭载的负载产生变化时,具体用于:The pan/tilt head according to claim 117, wherein when the controller detects that the load carried by the pan/tilt head changes, it is specifically configured to:
    检测到所述云台所搭载的负载在所述云台上的位置和/或重量产生变化。It is detected that the position and/or weight of the load carried by the pan/tilt head on the pan/tilt head changes.
  119. 一种云台重心配平的方法,其特征在于,所述方法包括:A method for balancing the center of gravity of a gimbal, characterized in that the method includes:
    若接收到配平指令,则产生用于重心配平的第一触发信号;If the trim command is received, the first trigger signal for center of gravity trim is generated;
    发送所述第一触发信号至云台,以触发所述云台进行重心位置的检测;Sending the first trigger signal to the pan-tilt to trigger the pan-tilt to detect the position of the center of gravity;
    接收所述云台针对所述第一触发信号返回的提示信号,所述提示信号用于指示调整所述云台中偏离期望重心位置的重心位置。Receiving a prompt signal returned by the pan/tilt head in response to the first trigger signal, where the prompt signal is used to instruct to adjust the center of gravity position of the pan/tilt head that deviates from the desired center of gravity position.
  120. 根据权利要求119所述的方法,其特征在于,所述提示信号携带有所述重心位置的偏移信息。The method according to claim 119, wherein the prompt signal carries offset information of the position of the center of gravity.
  121. 根据权利要求120所述的方法,其特征在于,所述偏移信息包括:偏移方向和/或偏移量。The method according to claim 120, wherein the offset information comprises: an offset direction and/or an offset amount.
  122. 根据权利要求119所述的方法,其特征在于,所述接收所述云台针对所述第一触发信号返回的提示信号之后,所述方法还包括:The method according to claim 119, wherein after the receiving the prompt signal returned by the pan-tilt for the first trigger signal, the method further comprises:
    输出所述提示信号。Output the prompt signal.
  123. 根据权利要求122所述的方法,其特征在于,所述输出所述提示信号,包括:The method according to claim 122, wherein said outputting said prompt signal comprises:
    基于图形、文字、语音中的至少一种输出所述提示信号。The prompt signal is output based on at least one of graphics, text, and voice.
  124. 根据权利要求119所述的方法,其特征在于,所述接收到配平指令之前,所述方法还包括:The method according to claim 119, characterized in that, before the receiving a trim instruction, the method further comprises:
    接收到所述云台发送的评估结果;Receiving the evaluation result sent by the PTZ;
    其中,所述评估结果包括:所述云台当前搭载的负载大小处于预设的云台负载大小范围内,或所述云台当前搭载的负载过大。Wherein, the evaluation result includes: the load currently carried by the pan/tilt is within a preset load range of the pan/tilt, or the load currently carried by the pan/tilt is too large.
  125. 根据权利要求124所述的方法,其特征在于,所述接收到所述云台发送的评估结果之前,还包括:The method according to claim 124, wherein before the receiving the evaluation result sent by the PTZ, the method further comprises:
    若接收到负载评估指令,则产生用于指示所述云台进行负载评估的第二触发信号;If a load evaluation instruction is received, generating a second trigger signal for instructing the pan/tilt to perform load evaluation;
    发送所述第二触发信号至所述云台,以触发所述云台进行负载评估。Send the second trigger signal to the pan/tilt to trigger the pan/tilt to perform load evaluation.
  126. 一种客户端,其特征在于,所述客户端包括:A client, characterized in that the client includes:
    存储装置,用于存储程序指令;和Storage device for storing program instructions; and
    控制器,调用所述程序指令,当所述程序指令被执行时,用于:The controller calls the program instructions, and when the program instructions are executed, it is used to:
    若接收到配平指令,则产生用于重心配平的第一触发信号;If the trim command is received, the first trigger signal for center of gravity trim is generated;
    发送所述第一触发信号至云台,以触发所述云台进行重心位置的检测;Sending the first trigger signal to the pan-tilt to trigger the pan-tilt to detect the position of the center of gravity;
    接收所述云台针对所述第一触发信号返回的提示信号,所述提示信号用于指示调整所述云台中偏离期望重心位置的重心位置。Receiving a prompt signal returned by the pan/tilt head in response to the first trigger signal, where the prompt signal is used to instruct to adjust the center of gravity position of the pan/tilt head that deviates from the desired center of gravity position.
  127. 根据权利要求126所述的客户端,其特征在于,所述提示信号携带有所述重心位置的偏移信息。The client according to claim 126, wherein the prompt signal carries offset information of the position of the center of gravity.
  128. 根据权利要求127所述的客户端,其特征在于,所述偏移信息包括:偏移方向和/或偏移量。The client according to claim 127, wherein the offset information comprises: an offset direction and/or an offset amount.
  129. 根据权利要求126所述的客户端,其特征在于,所述控制器在接收所述云台针对所述第一触发信号返回的提示信号之后,还用于:The client terminal according to claim 126, wherein the controller is further configured to: after receiving the prompt signal returned by the pan-tilt for the first trigger signal:
    输出所述提示信号。Output the prompt signal.
  130. 根据权利要求129所述的客户端,其特征在于,所述控制器在输出所述提示 信号时,具体用于:The client terminal according to claim 129, wherein the controller is specifically configured to:
    基于图形、文字、语音中的至少一种输出所述提示信号。The prompt signal is output based on at least one of graphics, text, and voice.
  131. 根据权利要求126所述的客户端,其特征在于,所述控制器在接收到配平指令之前,还用于:The client terminal according to claim 126, wherein the controller is further configured to:
    接收到所述云台发送的评估结果;Receiving the evaluation result sent by the PTZ;
    其中,所述评估结果包括:所述云台当前搭载的负载大小处于预设的云台负载大小范围内,或所述云台当前搭载的负载过大。Wherein, the evaluation result includes: the load currently carried by the pan/tilt is within a preset load range of the pan/tilt, or the load currently carried by the pan/tilt is too large.
  132. 根据权利要求131所述的客户端,其特征在于,所述控制器在接收到所述云台发送的评估结果之前,还用于:The client according to claim 131, wherein before receiving the evaluation result sent by the pan-tilt, the controller is further configured to:
    若接收到负载评估指令,则产生用于指示所述云台进行负载评估的第二触发信号;If a load evaluation instruction is received, generating a second trigger signal for instructing the pan/tilt to perform load evaluation;
    发送所述第二触发信号至所述云台,以触发所述云台进行负载评估。Send the second trigger signal to the pan/tilt to trigger the pan/tilt to perform load evaluation.
PCT/CN2019/078008 2019-03-13 2019-03-13 Gimbal center of gravity trim method, gimbal, and client WO2020181531A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2019/078008 WO2020181531A1 (en) 2019-03-13 2019-03-13 Gimbal center of gravity trim method, gimbal, and client
CN201980005507.7A CN111316029B (en) 2019-03-13 2019-03-13 Cloud deck gravity center balancing method, cloud deck and client

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/078008 WO2020181531A1 (en) 2019-03-13 2019-03-13 Gimbal center of gravity trim method, gimbal, and client

Publications (1)

Publication Number Publication Date
WO2020181531A1 true WO2020181531A1 (en) 2020-09-17

Family

ID=71159534

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/078008 WO2020181531A1 (en) 2019-03-13 2019-03-13 Gimbal center of gravity trim method, gimbal, and client

Country Status (2)

Country Link
CN (1) CN111316029B (en)
WO (1) WO2020181531A1 (en)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113906249A (en) * 2020-07-28 2022-01-07 深圳市大疆创新科技有限公司 Cloud platform, camera device and movable platform
CN113993748A (en) * 2020-09-22 2022-01-28 深圳市大疆创新科技有限公司 Method for adjusting balance of stabilizer and stabilizer
CN112684814B (en) * 2020-12-24 2024-04-12 杭州海康威视数字技术股份有限公司 Method and device for adjusting load center of cradle head, cradle head and storage medium
CN114556005A (en) * 2020-12-31 2022-05-27 深圳市大疆创新科技有限公司 Cloud deck and leveling method and control method thereof, leveling motor and cloud deck assembly
WO2023065183A1 (en) * 2021-10-20 2023-04-27 深圳市大疆创新科技有限公司 Balance degree adjustment method and balance degree adjustment apparatus for stability enhancement device, and stability augmentation device
CN114819426B (en) * 2022-07-01 2022-12-09 深圳市海清数字技术有限公司 Cargo loading scheme determining method, device, equipment and storage medium

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100238345A1 (en) * 2009-03-20 2010-09-23 Camera Motion Research, Llc Adjustable Control for an Inertial Stabilizer
CN107002941A (en) * 2016-05-31 2017-08-01 深圳市大疆灵眸科技有限公司 Head method of adjustment, system, device and head
CN108459622A (en) * 2017-02-21 2018-08-28 昊翔电能运动科技(昆山)有限公司 From load centre of gravity adjustment system, the method for steady holder
CN109308074A (en) * 2017-07-28 2019-02-05 深圳禾苗通信科技有限公司 A kind of compensation method and system of drone center of unmanned aerial vehicle offset

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107883123B (en) * 2015-09-29 2019-11-01 深圳市大疆灵眸科技有限公司 Handle holder and its control method
CN105912028A (en) * 2015-12-30 2016-08-31 东莞市青麦田数码科技有限公司 Holder control system and control method
CN106681369B (en) * 2016-12-01 2019-10-08 广州亿航智能技术有限公司 A kind of holder attitude control method and system
CN107111322B (en) * 2016-12-12 2019-02-22 深圳市大疆创新科技有限公司 Holder and its operating method, control method, and the movable equipment using it
EP3339714A1 (en) * 2016-12-20 2018-06-27 Nokia Technologies Oy An apparatus and associated methods for virtual reality image capture

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100238345A1 (en) * 2009-03-20 2010-09-23 Camera Motion Research, Llc Adjustable Control for an Inertial Stabilizer
CN107002941A (en) * 2016-05-31 2017-08-01 深圳市大疆灵眸科技有限公司 Head method of adjustment, system, device and head
CN108459622A (en) * 2017-02-21 2018-08-28 昊翔电能运动科技(昆山)有限公司 From load centre of gravity adjustment system, the method for steady holder
CN109308074A (en) * 2017-07-28 2019-02-05 深圳禾苗通信科技有限公司 A kind of compensation method and system of drone center of unmanned aerial vehicle offset

Also Published As

Publication number Publication date
CN111316029A (en) 2020-06-19
CN111316029B (en) 2022-01-11

Similar Documents

Publication Publication Date Title
WO2020181531A1 (en) Gimbal center of gravity trim method, gimbal, and client
US20190064637A1 (en) Gimbal control method, gimbal control apparatus, and gimbal
CN108184061B (en) Tracking control method and device for handheld cloud deck, handheld cloud deck and storage medium
WO2016000194A1 (en) Photographing control method, device and pan-tilt device
WO2019100249A1 (en) Method of controlling gimbal, gimbal, and unmanned aerial vehicle
WO2020042152A1 (en) Control method for handheld gimbal, handheld gimbal, and image acquisition device
WO2019056381A1 (en) Method for controlling gimbal head, gimbal head controller, and gimbal head
WO2020140295A1 (en) Handheld gimbal control method and handheld gimbal
EP3839691A1 (en) Gimbal control method and device, gimbal, system and storage medium
WO2019051640A1 (en) Control method for pan-tilt, controller, and pan-tilt
CN110337560B (en) Control method of holder, shooting device and readable storage medium
CN108696674A (en) Gravity center adjusting mechanism and related photographing device
EP3683488A1 (en) Control method for pan tilt and control system of pan tilt
WO2020019106A1 (en) Gimbal and unmanned aerial vehicle control method, gimbal, and unmanned aerial vehicle
CN110869283A (en) Control method and device of cloud deck, cloud deck system and unmanned aerial vehicle
WO2019210467A1 (en) Pan-tilt control method and apparatus, pan-tilt system, unmanned aerial vehicle and computer-readable storage medium
EP4012245A1 (en) Handheld gimbal, gimbal control method, and computer readable storage medium
WO2018191971A1 (en) Cradle head control method and cradle head
JP5773616B2 (en) Method and system for imposing a momentum boundary when changing the direction of an agile vehicle using a control moment gyroscope
WO2021134644A1 (en) Gimbal control method and gimbal
WO2020181530A1 (en) Gimbal vibration adjustment method, gimbal and client
WO2020000423A1 (en) Control method for gimbal, gimbal, aerial vehicle, and computer-readable storage medium
WO2019148348A1 (en) Tripod head control method and apparatus
WO2020062163A1 (en) Method for controlling pan-tilt, and handheld pan-tilt and handheld device
WO2020087354A1 (en) Vertical stability augmentation mechanism and control method therefor, as well as movable device

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

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

Country of ref document: EP

Kind code of ref document: A1