WO2022027579A1 - Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium - Google Patents

Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium Download PDF

Info

Publication number
WO2022027579A1
WO2022027579A1 PCT/CN2020/107791 CN2020107791W WO2022027579A1 WO 2022027579 A1 WO2022027579 A1 WO 2022027579A1 CN 2020107791 W CN2020107791 W CN 2020107791W WO 2022027579 A1 WO2022027579 A1 WO 2022027579A1
Authority
WO
WIPO (PCT)
Prior art keywords
pan
tilt
state
component
angular velocity
Prior art date
Application number
PCT/CN2020/107791
Other languages
French (fr)
Chinese (zh)
Inventor
王文杰
Original Assignee
深圳市大疆创新科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to PCT/CN2020/107791 priority Critical patent/WO2022027579A1/en
Priority to CN202080006194.XA priority patent/CN113168192A/en
Publication of WO2022027579A1 publication Critical patent/WO2022027579A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback
    • 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
    • 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/16Details concerning attachment of head-supporting legs, with or without actuation of locking members thereof
    • 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
    • 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
    • F16M13/00Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles
    • F16M13/02Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles for supporting on, or attaching to, an object, e.g. tree, gate, window-frame, cycle
    • 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
    • F16M13/00Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles
    • F16M13/04Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles for supporting on, or holding steady relative to, a person, e.g. by chains, e.g. rifle butt or pistol grip supports, supports attached to the chest or head

Definitions

  • Embodiments of the present invention relate to the technical field of PTZ, and in particular, to a PTZ detection method, a stabilization PTZ, a movable platform and a storage medium.
  • the stabilizer When the stabilizer is working, the stabilizer can be adjusted between the mechanical axis locked state and the mechanical axis unlocked state through manual operation. There is no free rotation between the arms; when the mechanical axis is in the unlocked state, the stabilizer and the axis arm of the mechanical axis where it is located can freely rotate.
  • the mechanical axis or stabilizer When the mechanical axis is in the locked state, the stabilizer and the axis arm of the mechanical axis cannot rotate freely. At this time, if the control parameters of the controlled object, which is the combination of the stabilizer and the camera, are auto-tuned, the The following problems occur: the mechanical axis or stabilizer will hit the axis lock back and forth under the action of the excitation signal, which will reduce the service life of the gimbal and affect the safety of the user's load; , the mechanical shaft cannot be rotated to the preset position, so it is easy to make errors in the identification of the moment of inertia of the load such as the camera, resulting in the mismatch between the calculated control parameters and the load, which will affect the stabilization performance of the stabilizer.
  • Embodiments of the present invention provide a pan/tilt detection method, a stabilization pan/tilt, a movable platform, and a storage medium, which are used to solve the problem in the prior art that the service life of the pan/tilt will be reduced due to the mechanical axis being in a locked state. , and it is easy to cause the mismatch between the control parameters and the load, which will affect the stabilization performance of the stabilizer.
  • a first aspect of the present invention is to provide a method for detecting a pan/tilt, the pan/tilt includes a pan/tilt component, a motor for driving the pan/tilt component to rotate, and a locking mechanism for locking the pan/tilt component,
  • the method includes:
  • the attitude sensor is used for sensing the attitude information of the gimbal component
  • the detection state includes a locked state and an unlocked state.
  • a second aspect of the present invention is to provide a stabilization platform, comprising:
  • the pan/tilt part is used to mechanically couple and connect the photographing device
  • a motor used to drive the pan/tilt component to rotate, so as to adjust the posture of the photographing device, so as to enhance the stability of the photographing device;
  • a controller electrically connected to the motor, for controlling the motor
  • an attitude sensor connected in communication with the controller, for sensing the attitude information of the pan/tilt component
  • the controller acquires a state detection signal corresponding to the attitude sensor, and determines a detection state of the pan/tilt component according to the state detection signal, and the detection state includes a locked state and an unlocked state.
  • a third aspect of the present invention is to provide a computer-readable storage medium, the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used in the first aspect.
  • a fourth aspect of the present invention is to provide a movable platform comprising:
  • the support piece is mechanically coupled and connected with the stabilization gimbal, and is used for supporting the stabilization gimbal.
  • a fifth aspect of the present invention is to provide a method for detecting a pan/tilt, the pan/tilt comprising a pan/tilt component, a motor for driving the pan/tilt component to rotate, and a locking mechanism for locking the pan/tilt component,
  • the method includes:
  • a sixth aspect of the present invention is to provide a stabilization pan/tilt head, comprising:
  • the pan/tilt part is used to mechanically couple and connect the photographing device
  • a motor used to drive the pan/tilt component to rotate, so as to adjust the posture of the photographing device, so as to enhance the stability of the photographing device;
  • a controller electrically connected to the motor, for controlling the motor
  • an attitude sensor connected in communication with the controller, for sensing the attitude information of the pan/tilt component
  • the controller obtains a self-tuning request for implementing the self-tuning operation on the pan/tilt; determines whether to perform the self-tuning operation on the pan/tilt based on the state of the pan/tilt components; When the pan/tilt component is in a locked state, the self-tuning operation on the pan/tilt is stopped.
  • a seventh aspect of the present invention is to provide a computer-readable storage medium, the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used in the fifth aspect.
  • An eighth aspect of the present invention is to provide a movable platform, comprising:
  • the support piece is mechanically coupled and connected with the stabilization gimbal, and is used for supporting the stabilization gimbal.
  • the detection state of the pan-tilt component is determined by the acquired state detection signal, wherein the detection state of the pan-tilt may include: Locked state and unlocked state, so that it is convenient to use different control strategies to control the gimbal based on different detection states of the gimbal components. Specifically, when the gimbal components are in the locked state, the self-tuning operation of the gimbal can be prohibited.
  • the stable and reliable operation of the PTZ improves the practicability of the method and is beneficial to the promotion and application of the market.
  • FIG. 1 is a schematic diagram of the principle of a stabilizer provided by an embodiment of the present invention
  • FIG. 2 is a schematic flowchart of a method for detecting a pan/tilt according to an embodiment of the present invention
  • FIG. 3 is a schematic flowchart of obtaining a state detection signal corresponding to an attitude sensor according to an embodiment of the present invention
  • FIG. 4 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention.
  • FIG. 5 is a schematic flowchart of determining the detection state of the pan/tilt component based on the state detection signal according to an embodiment of the present invention
  • FIG. 6 is a schematic flowchart of determining the detection state of the pan/tilt component according to the angular velocity of the motor provided by an embodiment of the present invention
  • FIG. 7 is a schematic flowchart of determining the quantity of the angular velocity provided by an embodiment of the present invention.
  • FIG. 9 is a schematic flow chart 1 of determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component according to an embodiment of the present invention
  • FIG. 10 is a second schematic flowchart of determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component according to an embodiment of the present invention
  • FIG. 11 is a schematic flowchart of determining the detection state of the gimbal component according to the angular velocity of the motor according to an embodiment of the present invention
  • FIG. 12 is a schematic waveform diagram of the angular velocity of the motor when the motor component is in an unlocked state according to an application embodiment of the present invention
  • FIG. 13 is a schematic waveform diagram of the angular velocity of the motor when the motor component is in a locked state according to an application embodiment of the present invention
  • FIG. 14 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention.
  • FIG. 15 is a schematic structural diagram of a stabilization gimbal according to an embodiment of the present invention.
  • 16 is a schematic structural diagram of another stabilization gimbal provided by an embodiment of the present invention.
  • FIG. 17 is a schematic structural diagram of a movable platform according to an embodiment of the present invention.
  • FIG. 18 is a schematic structural diagram of another movable platform provided by an embodiment of the present invention.
  • the working principle of the stabilizer is described with reference to FIG. 1 .
  • the actual posture of the camera device is detected first, and the actual posture is compared with the target posture to obtain Control deviation; then perform negative feedback control according to the control deviation, determine the motor torque in the stabilizer based on the control deviation, and then send the motor torque to the motor in the stabilizer to reduce the control deviation and ensure the actual posture and target of the camera equipment
  • the attitude deviation is as small as possible, so that the image captured by the camera device is as stable as possible, or the actual attitude of the camera device is as close to the target attitude as possible to shoot in the target attitude.
  • the stabilizer can be adapted to different loads, such as: various combinations of cameras and lenses, etc., and their differences in size and quality, as well as different installation positions and structural forces.
  • the states result in different dynamics model parameters and frequency response characteristics.
  • Control parameter self-tuning refers to the identification of the model parameters of the controlled object, which is the combination of the stabilizer and the camera, by the method of system identification, and the stabilizer is controlled according to the identified control parameters, so that the stabilizer can be adapted to different loads. Can achieve good control performance.
  • the stabilizer when the stabilizer is working, the stabilizer can be adjusted between the mechanical axis locked state and the mechanical axis unlocked state through manual operation.
  • the mechanical axis when the mechanical axis is in the locked state, the The rotor of the motor corresponding to the mechanical shaft is in a locked state, so that the above-mentioned mechanical shaft cannot rotate freely;
  • the mechanical shaft is in an unlocked state, that is, the rotor of the motor corresponding to the mechanical shaft used to control the stabilizer is in an unlocked state, so that the above-mentioned mechanical shaft is in an unlocked state.
  • the shaft arm of the mechanical shaft can rotate freely.
  • the rotor of the motor can be controlled to be in a locked state through manual operation, thereby controlling the mechanical axis of the stabilizer to be in a locked state, that is, The mechanical axis is stably in the preset target posture and cannot be changed.
  • the stabilizer can be folded and stored. At this time, by manually controlling the mechanical shaft of the stabilizer to lock in the folded state, the stabilizer can be prevented from changing from the folded state to the unfolded state, which is not conducive to the stability of the stabilizer. to carry out the storage operation.
  • the mechanical axis of the stabilizer can be controlled by manual operation to be locked in the current posture, so that the mechanical axis cannot be used. Perform free rotation, and when the switching conditions of the next scene are met, unlock the mechanical axis again, so that the mechanical axis can be rotated freely.
  • the present embodiment provides a detection method, device, movable platform and storage medium for a pan/tilt, wherein the detection method can detect a detection state of a pan/tilt component located on the pan/tilt, and the detection state may include: Locked state or unlocked state, specifically, the detection state of the pan-tilt component is determined by the acquired state detection signal, wherein the detection state of the pan-tilt can include a locked state and an unlocked state, so as to facilitate the realization of a pan-tilt-based component based
  • different control strategies are used to control the gimbal.
  • the self-tuning operation of the gimbal can be prohibited when the gimbal parts are in a locked state, thereby avoiding the possibility of interfering with other gimbal components due to the locked state.
  • the collision of components will reduce the service life of the stabilizer, and easily lead to the mismatch between the control parameters and the load, which will affect the stabilization performance of the stabilizer, which further ensures the stability and reliability of the gimbal and improves the practicality of the method. It is conducive to the promotion and application of the market.
  • FIG. 2 is a schematic flowchart of a method for detecting a pan/tilt according to an embodiment of the present invention; with reference to FIG. 2 , the present embodiment provides a detection method for a pan/tilt.
  • the pan/tilt may include pan/tilt components, a A motor for driving the rotation of the pan-tilt part and a locking mechanism for locking the pan-tilt part.
  • the gimbal it is divided by the number of gimbal components, and the gimbal may refer to at least one of the following: a single-axis gimbal (the number of gimbal parts is 1), a dual-axis gimbal (a gimbal The number of table parts is 2), the three-axis pan/tilt (the number of pan/tilt components is 3), and the multi-axis pan/tilt (the number of pan/tilt components is multiple), etc.; divided by the carrier of the locking mechanism, the pan/tilt It can include at least one of the following: a handheld gimbal, a vehicle-mounted gimbal, an airborne gimbal, and the like.
  • the gimbal parts can be used to represent different structures on the gimbal.
  • the gimbal parts can include at least the following: One: a first bracket located between two motors, a second bracket movably connected to the first bracket, a third bracket movably connected to the second bracket (for supporting the load), and so on.
  • the pan/tilt components included on the pan/tilt may be any one or more of the above-mentioned first bracket, second bracket, and third bracket, and the detection method in this embodiment may acquire any one or more pan/tilt components detection status.
  • the execution body of the method may be the detection device of the pan/tilt.
  • the detection device of the pan/tilt may be implemented as software or a combination of software and hardware.
  • the detection device of the pan/tilt may be implemented For a stabilization gimbal.
  • the detection method of the PTZ may include:
  • Step S201 Acquire a state detection signal corresponding to the attitude sensor, and the attitude sensor is used to sense the attitude information of the pan/tilt component.
  • the attitude sensor is used to sense the attitude information of the gimbal component.
  • the attitude sensor can be an inertial measurement unit IMU;
  • the state detection signal refers to a request signal used to determine the state detection of the gimbal component.
  • the state detection signal The corresponding waveform may include at least one of the following: sine wave, cosine wave, square wave, and triangle wave. Since cosine wave, square wave, and triangle wave can be obtained by fusion of sine waves, in order to improve the quality and efficiency of data processing, it is relatively
  • the waveform corresponding to the state detection signal may be a sine wave.
  • the state detection signal corresponding to the attitude sensor may refer to a drive signal used to drive the attitude sensor to perform a detection operation. At this time, after acquiring the state detection signal, the attitude sensor may detect based on the acquired state detection signal.
  • the state detection signal corresponding to the attitude sensor may refer to a signal output by the attitude sensor, and in this case, the state detection signal may include attitude information of the pan/tilt component sensed by the attitude sensor.
  • this embodiment does not limit the specific acquisition method of the state detection signal, and those skilled in the art can set it according to specific application requirements and design requirements.
  • the signal is executed, so that the detection device of the PTZ can directly acquire the state detection signal generated by executing the operation.
  • the state detection signal may be sent by other devices to the detection device of the gimbal, so that the detection device of the gimbal can obtain the state detection signal from the stabilizer.
  • acquiring the state detection signal corresponding to the attitude sensor may include:
  • Step S2011 Acquire a self-tuning request for implementing the self-tuning operation on the PTZ.
  • Step S2012 Determine the state detection signal according to the self-tuning request.
  • the self-tuning request is used to realize the self-tuning operation of the control parameters of the gimbal (including at least one of the following: the force information of the motor on the gimbal, the response speed to the load pose, and the configuration parameters of the filter on the gimbal).
  • the step disturbance experiment is performed with the control parameters of the gimbal, and the operation of setting the parameter value is calculated according to the running state of the gimbal.
  • the self-tuning request may be generated according to an operation performed by the user on the input of the stabilization gimbal. After the self-tuning request is obtained, the self-tuning request may be analyzed and processed to determine the state detection signal, among which one may be The implementation method is to directly determine the self-tuning request as the status detection signal; or, another feasible method is to generate a status detection signal according to the self-tuning request.
  • the detection duration of the detection state is less than the set duration of the auto-tuning operation.
  • this embodiment does not limit the detection duration of the detection state and the setting duration of the self-tuning operation, and those skilled in the art can set it according to specific application scenarios and application requirements. It can be carried out synchronously, and in order to ensure the stability and reliability of the self-tuning operation, the detection time of the detection state can be controlled to be shorter than the set time of the self-tuning operation. Specifically, the detection time of the detection state can be the set time of the self-tuning operation.
  • the detection time required to detect the state can be less than or equal to 0.4s, so as to achieve Therefore, it is possible to quickly and accurately detect the state of the gimbal in the early stage of the self-tuning operation, which greatly avoids damage to the stabilizer and load, and also facilitates the detection of the state of the gimbal based on the obtained parts.
  • the specific manner of obtaining the state detection signal corresponding to the attitude sensor in this embodiment is not limited to the above-defined manner, and those skilled in the art may also use other methods to obtain the state detection signal corresponding to the attitude sensor. , as long as the accuracy and reliability of acquiring the state detection signal can be ensured, and details are not repeated here.
  • Step S202 Determine the detection state of the pan/tilt component based on the state detection signal.
  • the status detection signal can be analyzed and processed to determine the detection status of the pan/tilt status, where the detection status may include a locked status and an unlocked status. Specifically, when the detection status of the pan/tilt component is In the locked state, the relative position between the gimbal part and other parts remains unchanged; when the detection state of the gimbal is unlocked, the relative position between the gimbal part and other parts can be changed.
  • this embodiment does not limit the specific implementation manner of determining the detection state of the pan/tilt components, and those skilled in the art can make settings according to specific application requirements and design requirements.
  • a detection state for identifying the pan/tilt components is preset. After obtaining the state detection signal, the state identification information for identifying the detection state of the pan-tilt component can be obtained, and the detection state of the pan-tilt component can be determined through the state identification information. For example: when the status identification information is "1", it is determined that the detection state of the pan-tilt component is a locked state; when the status identification information is "0", it is determined that the detection state of the pan-tilt component is an unlocked state.
  • those skilled in the art can also use other implementation manners to obtain the detection state of the pan/tilt component, as long as the detection state of the pan/tilt component can be accurately and effectively determined, which will not be repeated here.
  • the method in this embodiment further includes: when it is determined that the gimbal component is in an unlocked state, continuing to perform self-tuning on the gimbal based on the self-tuning request operation; or, when it is determined that the gimbal part is in a locked state, the self-tuning operation of the gimbal based on the self-tuning request is stopped.
  • the gimbal part When it is determined that the gimbal part is in an unlocked state, it means that the gimbal part on the gimbal can freely move with other parts at this time, and then the parameters of the gimbal can be self-tuned based on the pre-obtained self-tuning request. operation, so that the control parameters of the PTZ match the load set on the PTZ, which is beneficial to improve the stability and reliability of the control of the PTZ.
  • the gimbal parts When it is determined that the gimbal parts are in the locked state, it means that the positions of the gimbal parts on the gimbal and other parts remain relatively unchanged at this time, so that the gimbal parts cannot be controlled accurately and effectively. In order to avoid the gimbal parts If it collides with other parts, the self-tuning operation of the gimbal based on the self-tuning request can be stopped, thereby ensuring and improving the service life of the gimbal.
  • the method in this embodiment may further include: acquiring an execution operation for switching the detection state of the gimbal , switch the gimbal from the locked state to the unlocked state according to the execution operation, and then obtain the self-tuning request for realizing the self-tuning operation of the gimbal again, and perform the self-tuning operation on the gimbal based on the self-tuning request, so that the cloud
  • the control parameters of the platform match the load set on the gimbal, which is beneficial to improve the stability and reliability of the control of the gimbal.
  • the method in this embodiment may further include: when it is determined that the pan/tilt component is in a locked state, outputting a message for prompting that the pan/tilt component is in a locked state information.
  • a device for outputting information may be configured on the pan/tilt, and the device may include a voice module, a display module, an information sending module, etc.
  • the pan/tilt component when the pan/tilt component is in a locked state, it may be based on the fact that the pan/tilt component is locked.
  • the state generates corresponding prompt information, and the prompt information may include at least one of the following: voice information, text information, image information, identification information, and the like.
  • the voice prompt information 1 corresponding to "The PTZ part A is in the locked state" can be generated, and the voice prompt information 1 can be output through the voice module ;
  • text prompt information 2 and/or image information 3 can be generated, and the text prompt information 2 and/or image information 3 can be output through the display module;
  • the identification prompt information 4 can be generated, and the identification prompt information 4 can be displayed through the display module (for example: the green indicator light flashes to indicate that the gimbal part is not in the locked state, the red indicator light Blinking is used to indicate that the gimbal part is in a locked state) for output.
  • those skilled in the art can also output the information for prompting that the pan/tilt component is in the locked state in other ways, as long as the user can quickly learn from the output prompt information when it is determined that the pan/tilt component is in the locked state It suffices that the gimbal component is in a locked state, thereby facilitating timely and accurate control of the gimbal based on the locked state of the gimbal component, which will not be repeated here.
  • the locking mechanism is an intelligent (automatic or semi-automatic) locking mechanism, it can also be automatically unlocked, and then continue to perform the self-tuning operation, and the user can be unlocked while unlocking. Prompt unlocked; unlocking can also be triggered by the user.
  • the locking mechanism is an intelligent locking mechanism, the locking is used for locking or unlocking between the pan/tilt components and the motor, which can be triggered by the user non-contacting the pan/tilt, or by the user touching the buttons on the pan/tilt or touching the pan/tilt. Control screen, dial, etc. to achieve trigger operation.
  • the pan/tilt in this embodiment may be a pan/tilt in a folded state (that is, in a stowed state) or in a centered state (that is, a position where the joint angle is such as 0) ), that is, in these two states, there may be situations where the gimbal parts are locked.
  • the gimbal when the gimbal is in the folded state, there is overlap between the positions corresponding to at least two gimbal components of the gimbal; when the gimbal is in the centering state, the gimbal components of the gimbal are in an orthogonal position. .
  • the positional relationship between the gimbal components is not limited to the above description.
  • the state of the pan/tilt is not limited to the state described above, and those skilled in the art can also flexibly adjust according to specific application requirements and application scenarios, for example: cloud The platform is in a use state, or the PTZ is in a dormant state, etc., which will not be repeated here.
  • Application Scenario 1 for a certain PTZ, it can have a folded state and an unfolded state. After the shooting operation using the above-mentioned pan/tilt is completed, the pan/tilt can be stored. At this time, in order to reduce the space occupied by the gimbal, the gimbal can be adjusted from the unfolded state to the folded state, that is, the positions corresponding to at least two gimbal brackets on the gimbal overlap. In order to prevent the gimbal from changing from the folded state to the unfolded state and other situations that are not conducive to the storage operation of the gimbal, at this time, the gimbal bracket on the gimbal can be controlled to be in a locked state.
  • the detection state of the pan/tilt components on the pan/tilt may be in a locked state or an unlocked state. Therefore, in order to avoid the situation of reducing the service life of the gimbal and affecting the stabilization performance of the gimbal when the gimbal components are in the locked state, the gimbal can be checked for the state.
  • the received state detection signal is used to determine the detection state of the pan-tilt bracket, so that it is convenient to use different control strategies to control the pan-tilt bracket when the pan-tilt bracket is in different detection states.
  • Application Scenario 2 when the gimbal completes the task, the gimbal can be shut down or hibernated, so that the gimbal is in a shutdown or hibernation state.
  • the motor on the gimbal does not provide any driving force to the gimbal components, and can The gimbal bracket on the control gimbal is locked.
  • the detection state of the pan/tilt components on the pan/tilt may be in a locked state or an unlocked state. Therefore, in order to avoid the situation of reducing the service life of the gimbal and affecting the stabilization performance of the gimbal when the gimbal parts are in the locked state, you can control the gimbal first after the gimbal exits the shutdown state or hibernation state. It is in the middle state, and then the state detection of the gimbal is carried out. Specifically, the detection state of the gimbal bracket can be determined by the obtained state detection signal, so as to facilitate the realization of the gimbal bracket when it is in different detection states. Use different control strategies to control the PTZ.
  • the application scenario A is to shoot a still object through the gimbal
  • the application scenario B is to shoot a video image through the gimbal.
  • the gimbal components on the gimbal can be in the first preset posture.
  • the above-mentioned first preset posture can effectively realize the shooting of stationary objects.
  • you can The gimbal component on the control gimbal is in a locked state, that is, the gimbal component on the gimbal is locked in the first preset posture.
  • the change of the application scenario may affect the matching degree between the control parameters of the gimbal and the load set on the gimbal, and in order to ensure the video image To achieve the best shooting effect and quality, the gimbal component on the gimbal needs to be in the second preset attitude.
  • the gimbal can be self-tuning. Before performing the self-tuning operation, it is necessary to judge whether the gimbal can perform normal self-tuning based on the detection status of the gimbal components. Tuning operation, and then need to check the status of the gimbal components. Specifically, the detection status of the pan-tilt components is determined by the acquired status detection signals, so that it is convenient to implement different control strategies to control the self-tuning operation of the pan-tilt when the pan-tilt components are in different detection states. This further ensures the safety and reliability of the self-tuning operation of the PTZ.
  • the detection method of the pan/tilt determines the detection state of the pan/tilt components by using the acquired state detection signal, wherein the detection state of the pan/tilt may include a locked state and an unlocked state, so as to facilitate the realization of a pan/tilt based detection state.
  • Different detection states of the components use different control strategies to control the PTZ. Specifically, when the PTZ components are in the locked state, the self-tuning operation of the PTZ can be prohibited, thereby avoiding the possibility of conflicting with the PTZ due to the locked state of the PTZ components.
  • Fig. 4 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention; on the basis of the above-mentioned embodiment, with continued reference to Fig. 4, after it is determined that the pan/tilt components are in a locked state, the present embodiment
  • the methods in can also include:
  • Step S401 Acquire control parameters corresponding to the pan/tilt components.
  • Step S402 Control the pan/tilt component based on the control parameters, so that the pan/tilt component rotates within a preset range, where the preset range is used to avoid the pan/tilt component from colliding with the locking mechanism in a locked state.
  • control parameters corresponding to the pan/tilt components may be obtained, and the control parameters may include the control parameters corresponding to the pan/tilt components.
  • the control parameters may be stored in a preset area, and after it is determined that the pan/tilt components are in a locked state, the control parameters corresponding to the pan/tilt components may be obtained by accessing the preset area.
  • the gimbal components can be controlled based on the control parameters.
  • the gimbal components can be controlled based on the angle range and angular velocity of the rotating joints, so that the gimbal components can be preset at the
  • the preset range is related to the control parameter.
  • the preset range is the rotation joint angle range; when the control parameter includes the angular velocity, the preset range can be the angular velocity.
  • the range corresponding to when the current value is adjusted to 0.
  • the pan-tilt component after it is determined that the pan-tilt component is in a locked state, by acquiring control parameters corresponding to the pan-tilt component, and then controlling the pan-tilt component based on the control parameters, the pan-tilt component can be effectively controlled within a preset range. It rotates, thereby avoiding the collision between the pan/tilt components and the locking mechanism in the locked state, thereby ensuring the service life of the pan/tilt and improving the safety and reliability of the pan/tilt use.
  • FIG. 5 is a schematic flowchart of determining the detection state of a pan/tilt component based on a state detection signal according to an embodiment of the present invention; on the basis of the above embodiment, with continued reference to FIG.
  • the specific implementation of the detection state is not limited, and those skilled in the art can set it according to specific application requirements and design requirements. Determine whether the gimbal part is locked.
  • determining the detection state of the pan/tilt component based on the state detection signal may include:
  • Step S501 Obtain the angular velocity of the motor based on the state detection signal.
  • Step S502 Determine the detection state of the pan/tilt component according to the angular velocity of the motor.
  • the gimbal is provided with an attitude sensor for detecting the angular velocity of the motor.
  • the attitude sensor may include an angular velocity sensor, a gyroscope, or an inertial measurement unit IMU, etc.
  • the embodiment of the present invention takes the attitude sensor as an IMU as an example for description.
  • the angular velocity of the motor obtained by the stabilization gimbal can be read based on the state detection signal, so as to determine the detection state of the gimbal component based on the angular velocity of the motor.
  • the number of angular velocities of the motor obtained can be one or more. In order to improve the accuracy of the gimbal detection, the number of angular velocities can be multiple. Multiple angular velocities within a period.
  • determining the detection state of the pan/tilt component according to the angular velocity of the motor may include:
  • Step S601 Determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal according to the angular velocity of the motor, and the total energy of the signal includes the energy of the first harmonic component.
  • Step S602 Determine the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component.
  • the input signal input by the controller to the motor and the measurement signal of the motor should be signals of the same frequency.
  • signals such as measurement error, noise, and other additional interference, so that there are signals in other frequency bands in the measurement signal of the motor.
  • the excitation frequency included in the obtained measurement signal should account for most of the excitation frequency, for example: the input signal is 10HZ
  • the input signal is 10HZ
  • the signal energy is 100% of the transmission signal, then, under normal circumstances, the obtained output signal can be a 10HZ signal energy of 90% of the transmission signal.
  • the movement range of the gimbal component will not be restricted.
  • the input signal to the motor is a sine wave signal
  • the measurement signal obtained by the motor will also be a sine wave signal, that is, the corresponding component of the excitation frequency in the measurement signal is relatively high.
  • the gimbal part is in the locked state, the movement range of the gimbal part is limited by the locking mechanism.
  • the input signal to the motor is a sine wave signal
  • the measurement signal obtained by the motor is no longer a sine wave signal. , the corresponding component of the excitation frequency in the measurement signal drops.
  • the detection state of the pan/tilt component can be judged by the above-mentioned characteristics of signal transmission.
  • the angular velocity of the motor can be analyzed and processed to determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal.
  • the total energy of the signal may include the energy of the first harmonic component
  • the energy of the first harmonic component The harmonic component energy may refer to the signal energy corresponding to the signal of the preset frequency of interest.
  • the total energy of the signal can include the energy of harmonic components of 10HZ, the energy of harmonic components of 20HZ, the energy of harmonic components of 30HZ, etc.
  • the energy of harmonic components of 20HZ That is, the energy of the first harmonic component
  • the energy of the harmonic component of 30HZ is the energy of the first harmonic component
  • the total signal energy is negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity.
  • the discrete-time Fourier series formula in Perseval's theorem (the total energy of the signal in the time domain is equal to the total energy of the signal in the frequency domain) can be used to determine the total energy of the signal and the first harmonic component. Energy formula. Specifically, after obtaining the angular velocity of the motor, the following formula can be used to obtain the total energy of the signal:
  • J total is the total energy of the signal
  • x[n] is the angular velocity of the motor
  • N is the number of the angular velocity of the motor.
  • the method in this embodiment may also include a specific implementation process for determining the number of angular velocities.
  • this implementation Examples of methods can also include:
  • Step S701 Obtain the set frequency and sampling frequency corresponding to the angular velocity.
  • Step S702 Determine the number of angular velocities according to the set frequency and the sampling frequency.
  • the preset frequency and sampling frequency corresponding to the angular velocity can be obtained.
  • the set frequency refers to the frequency of the motor output signal
  • the sampling frequency refers to the acquisition of the motor output signal. the corresponding operating frequency.
  • the set frequency and the sampling frequency can be analyzed and processed to determine the number of angular velocities.
  • determining the number of angular velocities may include: The ratio to the set frequency is determined as the amount of angular velocity.
  • the accuracy and reliability of determining the number of angular velocities are effectively ensured, and the further improved How accurately the total energy of the signal can be determined based on the amount of angular velocity and the angular velocity.
  • the energy of the first harmonic component is negatively correlated with the amount of the angular velocity, positively correlated with the magnitude of the angular velocity, and negatively correlated with the fundamental frequency corresponding to the angular velocity.
  • the energy of the first harmonic component can be obtained by using the following formula:
  • J 1st is the energy of the first harmonic component
  • x[n] is the angular velocity of the motor
  • N is the number of the angular velocity of the motor
  • w 0 is the fundamental frequency corresponding to the angular velocity.
  • the method in this embodiment may further include:
  • Step S801 Acquire a set frequency and a sampling frequency corresponding to the angular velocity.
  • Step S802 Determine the fundamental frequency according to the set frequency and the sampling frequency.
  • the set frequency and the adopted frequency corresponding to the angular velocity can be determined by using the mapping relationship between the angular velocity, the set frequency and the sampling frequency.
  • the set frequency and the sampling frequency corresponding to the angular velocity can be analyzed and processed to determine the fundamental frequency.
  • the fundamental frequency can be determined by the following formula:
  • w 0 is the fundamental frequency corresponding to the angular velocity
  • f is the set frequency corresponding to the motor
  • f s is the sampling frequency corresponding to the motor.
  • the accuracy and reliability of determining the base frequency can be effectively ensured, and the further improved To determine the energy of the first harmonic component based on the fundamental frequency and angular velocity.
  • a method that can determine the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component may include:
  • Step S901 Acquire first ratio information of the energy of the first harmonic component relative to the total energy of the signal.
  • Step S902 Determine the detection state of the pan/tilt component according to the first scale information.
  • determining the detection state of the pan-tilt component according to the first scale information may include: when the first scale information is greater than or equal to a first preset threshold, determining that the detection state of the pan-tilt component is an unlocked state; or , when the first ratio information is smaller than the first preset threshold, it is determined that the detection state of the pan/tilt component is a locked state.
  • a first preset threshold corresponding to the detection state of the gimbal component is preset, and the first preset threshold may be a minimum proportional limit value corresponding to the gimbal component in a locked state.
  • the first preset threshold is obtained After the ratio information, the first ratio information can be analyzed and compared with the first preset threshold. When the first ratio information is greater than or equal to the first preset threshold, it means that in the total energy of the signal at this time, the first harmonic component The proportion of energy is large, and the detection state of the gimbal component is determined to be unlocked.
  • the first proportion information is less than the first preset threshold, it means that in the total energy of the signal at this time, the proportion of the energy of the first harmonic component is small, and then it is determined that the detection state of the pan/tilt component is a locked state.
  • the energy of the first harmonic component and the total energy of the signal are determined by the angular velocity of the motor, and then the ratio between the energy of the first harmonic component and the total energy of the signal is used to determine the
  • the detection state effectively realizes the determination of the detection state of the pan/tilt components based on the angular velocity of the motor, further ensures the accuracy and reliability of determining the detection state of the pan/tilt components, and effectively improves the stability and reliability of the method.
  • Step 1001 Determine the DC component energy corresponding to the angular velocity of the motor, and the total energy of the signal includes the DC component energy.
  • the DC component energy corresponding to the angular velocity of the motor can be determined.
  • the DC component energy may be negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity.
  • the DC component energy corresponding to the angular velocity of the motor can be determined by the following formula:
  • J dc is the DC component energy corresponding to the angular velocity of the motor
  • x[n] is the angular velocity of the motor
  • N is the number of the angular velocity of the motor.
  • this embodiment provides another implementation of determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component.
  • methods which may include:
  • Step S1002 Determine the difference between the total energy of the signal and the energy of the DC component as the total non-DC energy.
  • Step S1003 Determine the detection state of the pan/tilt component according to the energy of the first harmonic component and the total non-DC energy.
  • the total non-DC energy can be determined according to the total energy of the signal and the energy of the DC component. Specifically, the total non-DC energy can be the difference between the total energy of the signal and the energy of the DC component. .
  • the detection state of the pan/tilt component can be determined according to the first harmonic component energy and the non-DC total energy. In some instances, determining the detection state of the pan/tilt component based on the first harmonic component energy and the non-DC total energy may include:
  • Step S10031 Acquire second ratio information of the energy of the first harmonic component relative to the total non-DC energy.
  • Step S10032 Determine the detection state of the pan/tilt component according to the second scale information.
  • determining the detection state of the pan-tilt component according to the second scale information may include: when the second scale information is greater than or equal to a second preset threshold, determining that the detection state of the pan-tilt component is an unlocked state; or , when the second ratio information is smaller than the second preset threshold, it is determined that the detection state of the pan/tilt component is a locked state.
  • a second preset threshold corresponding to the detection state of the gimbal component is preset, and the second preset threshold may be a minimum proportional limit value corresponding to the gimbal component in a locked state.
  • the second preset threshold is obtained After the ratio information, the second ratio information can be analyzed and compared with the second preset threshold. When the second ratio information is greater than or equal to the second preset threshold, it means that in the non-DC total energy at this time, the first harmonic The proportion of wave component energy is relatively large, and the detection state of the gimbal component is determined to be an unlocked state.
  • the second ratio information is less than the second preset threshold, it means that in the non-DC total energy at this time, the proportion of the energy of the first harmonic component is small, and then it is determined that the detection state of the pan/tilt component is a locked state.
  • the total energy of the signal corresponding to the first ratio information includes the DC component energy, and the DC component energy is easy to change with the change of the application scene or application conditions. , therefore, when analyzing and judging by using the first ratio information, the corresponding first preset threshold may change with the change of the application scenario or the application condition.
  • the total energy of the signal corresponding to the second ratio information does not include the DC component energy, so as to avoid the influence of the size of the second ratio information due to changes in application scenarios or application conditions.
  • the second preset threshold for analyzing and processing the second ratio information may be a preset configured fixed value.
  • the energy of the first harmonic component, the total energy of the signal, and the energy of the DC component corresponding to the angular velocity of the motor are determined by the angular velocity of the motor, and then the energy of the first harmonic component is compared with the energy of the non-DC component.
  • the ratio of the total energy to determine the detection state of the pan/tilt components effectively realizes the determination of the detection state of the pan/tilt components based on the angular velocity of the motor, and further ensures the accuracy and reliability of determining the detection state of the pan/tilt components.
  • the stability and reliability of the method are greatly improved.
  • FIG. 11 is a schematic flowchart of determining the detection state of the pan/tilt component according to the angular velocity of the motor according to an embodiment of the present invention; on the basis of the above embodiment, with continued reference to FIG. 11 , this embodiment provides another implementation of determining The way of detecting the state of the pan-tilt component, specifically, in this embodiment, determining the detection state of the pan-tilt component according to the angular velocity of the motor may include:
  • Step S1101 perform fitting processing on the angular velocity of the motor according to the waveform corresponding to the state detection signal to obtain a fitting waveform corresponding to the angular velocity of the motor.
  • Step S1102 Determine the detection state of the pan/tilt component according to the fitted waveform and the angular velocity of the motor.
  • the angular velocity of the motor can be fitted according to the waveform corresponding to the state detection signal, so that the fitted waveform corresponding to the angular velocity of the motor can be obtained.
  • the fitting waveform corresponding to the angular velocity is consistent with or approximate to the waveform corresponding to the state detection signal.
  • the waveform corresponding to the state detection signal is a sine wave
  • a fitting waveform of the sine wave corresponding to the angular velocity of the motor can be obtained.
  • the waveform corresponding to the state detection signal is a cosine wave
  • a fitting waveform of the cosine wave corresponding to the angular velocity of the motor can be obtained.
  • determining the detection state of the gimbal component may include:
  • Step S11021 In the fitting waveform, obtain the fitting angular velocity corresponding to the angular velocity.
  • Step S11022 Determine the angular velocity error between the angular velocity and the fitted angular velocity.
  • Step S11023 Determine the detection state of the pan/tilt component according to the angular velocity error.
  • the fitted waveform includes the fitted angular velocity corresponding to the angular velocity of the motor, that is, the angular velocity of a motor can correspond to a fitted angular velocity, and the fitted angular velocity can be the same as or different from the angular velocity of the motor. .
  • the angular velocity error between the angular velocity and the fitted angular velocity can be obtained. It can be understood that when the number of angular velocities of the motor is multiple, the number of angular velocity errors can also be Multiple; when the number of angular velocity of the motor is one, the number of angular velocity errors can be one.
  • determining the detection state of the gimbal component according to the angular velocity error may include: when a preset number of angular velocity errors is less than a preset error threshold, determining that the gimbal component is in an unlocked state; or, when a preset number of angular velocity errors are in an unlocked state; When it is greater than or equal to the preset error threshold, it is determined that the gimbal is in a locked state.
  • the number of angular velocity of the motor can be one or more.
  • the number of angular velocity errors can also be one; when the angular velocity of the motor is multiple, the number of angular velocity errors can also be multiple.
  • the multiple angular velocity errors can be analyzed and processed to determine that the gimbal is in a locked state.
  • the preset number may be a preset minimum number limit used to determine the detection state of the pan/tilt components.
  • This embodiment does not limit the specific numerical range of the preset number, and those skilled in the art can use it according to specific applications. Requirements and design requirements to set, for example: the preset number can be 3, 4, 5 or 8 and so on.
  • all angular velocity errors can be analyzed and compared with the preset error threshold. When there are angular velocity errors that meet the preset number and are smaller than the preset error threshold, it means that the output signal of the motor is passed through the motor at this time.
  • the waveform obtained by the fitting has a high similarity with the waveform corresponding to the state detection signal, so that it can be determined that the gimbal component is in an unlocked state; when there is a preset number of angular velocity errors greater than or equal to the preset error threshold, then It means that the waveform obtained by fitting the output signal of the motor has a low similarity with the waveform corresponding to the state detection signal, and it is determined that the gimbal is in an unlocked state.
  • the implementation of determining the detection state of the gimbal component according to the angular velocity error is not limited to the above-mentioned implementation.
  • Those skilled in the art can also adjust according to specific application requirements and design requirements, for example: the number of angular velocity errors When there are more than one, the average angular velocity error corresponding to the multiple angular velocity errors can be obtained, and then based on the average angular velocity error and the preset error threshold for analysis and comparison, when the average angular velocity error is greater than or equal to the preset error threshold, the cloud can be determined.
  • the detection state of the gimbal is an unlocked state; when the average angular velocity error is less than the preset error threshold, the detection state of the gimbal can be determined to be a locked state, which also achieves the accuracy and reliability of determining the detection state of the gimbal components, and further The flexibility and reliability of the method are improved.
  • this application embodiment provides a method for detecting a pan/tilt head.
  • the pan/tilt head includes a pan/tilt shaft arm, a stabilizer arranged on the pan/tilt shaft arm, and a motor for driving the pan/tilt shaft arm to rotate.
  • the number of the gimbal shaft arms may be one or more, and correspondingly, the number of stabilizers and motors may also be one or more.
  • an excitation signal can be generated according to the self-tuning request, and then the motor can output torque according to the excitation signal, where the excitation signal can be a certain A sine wave with a preset frequency, then the output signal of the motor measured by the inertial measurement unit should also be a sine wave corresponding to the preset frequency. Even considering the influence of measurement noise, errors, etc., in the measured output signal , the excitation frequency should account for the vast majority of the entire signal.
  • the gimbal shaft arm can have different states, when the gimbal shaft arm is in the locked state, the movement range of the gimbal shaft arm and the stabilizer is limited by the locking mechanism. At this time, the signal measured by the IMU is no longer sinusoidal Wave, in the measurement signal, the proportion of the component corresponding to the excitation frequency decreases. When the gimbal shaft arm is in an unlocked state, the movement range of the gimbal shaft arm and the stabilizer will not be restricted by the locking mechanism. At this time, the signal measured by the IMU is a sine wave. In the measurement signal, the excitation frequency corresponds to The proportion of ingredients accounts for the vast majority. Based on the relationship between the above signal characteristics and the state of the gimbal shaft arm, it can be determined whether the gimbal shaft arm is in the locked state according to the proportion of the component corresponding to the excitation frequency. Specifically, the method may include:
  • Step 1 Obtain the self-tuning request for realizing the self-tuning operation of the gimbal
  • Step 2 Generate a status detection signal according to the self-tuning request
  • Step 3 Obtain the angular velocity of the motor through the IMU set on the gimbal according to the state detection signal;
  • Step 4 Obtain the set frequency and sampling frequency corresponding to the angular velocity, and determine the fundamental frequency and the number of angular velocities according to the set frequency and sampling frequency.
  • the fundamental frequency can be determined by the following formula:
  • w 0 is the fundamental frequency corresponding to the angular velocity
  • f is the set frequency corresponding to the motor
  • f s is the sampling frequency corresponding to the motor.
  • Step 5 Obtain the total energy of the signal and the energy of the DC component according to the angular velocity and the quantity of the angular velocity. Specifically, the total energy of the signal can be obtained by the following formula:
  • J total is the total energy of the signal
  • x[n] is the angular velocity of the motor
  • N is the number of the angular velocity of the motor.
  • the DC component energy is obtained by the following formula:
  • J dc is the DC component energy corresponding to the angular velocity of the motor
  • x[n] is the angular velocity of the motor
  • N is the number of the angular velocity of the motor.
  • Step 6 Obtain the energy of the first harmonic component according to the angular velocity, the quantity of the angular velocity and the fundamental frequency. Specifically, it can be obtained by the following formula:
  • J 1st is the energy of the first harmonic component
  • x[n] is the angular velocity of the motor
  • N is the number of the angular velocity of the motor
  • w 0 is the fundamental frequency corresponding to the angular velocity.
  • Step 7 Determine the proportion of the energy of the first harmonic component to the total non-DC energy according to the energy of the first harmonic component, the total energy of the signal and the energy of the DC component: namely
  • Step 8 According to the proportion of the energy of the first harmonic component to the total non-DC energy, determine whether the pivot arm of the gimbal is in a locked state.
  • the proportion of the energy of the first harmonic component in the total non-DC energy is greater than the preset threshold, as shown in FIG. 12 , it is assumed that the energy of the first harmonic component accounts for 78% of the total non-DC energy, and the preset threshold is 60% , then it is determined that the gimbal shaft arm is in the locked state; when the proportion of the energy of the first harmonic component to the total non-DC energy is less than or equal to the preset threshold, as shown in Figure 13, it is assumed that the energy of the first harmonic component of the non-DC total energy station 47% of the energy, and the preset threshold is 60%, then it is determined that the gimbal arm is in an unlocked state.
  • Step 9 Determine whether to perform self-tuning operation on the gimbal according to the detection state of the gimbal shaft arm.
  • the self-tuning operation of the gimbal is stopped; when the pivot arm of the gimbal is in an unlocked state, the self-tuning operation of the gimbal is performed based on the self-tuning request.
  • the gimbal detection method provided in this application example can effectively realize that during the self-tuning operation of the control parameters of the gimbal, it can be judged that the shaft arm of the gimbal is excited by the change of the angular velocity of the motor measured by the IMU. Whether it is in a locked state under the excitation of the signal to avoid damage to the stabilizer and the load, after determining the state of the gimbal shaft arm, the self-tuning operation can be controlled based on different detection states, thus avoiding the problem of the gimbal shaft arm.
  • FIG. 14 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention.
  • the present embodiment provides another pan/tilt detection method, and the pan/tilt may include pan/tilt components , a motor for driving the rotation of the pan-tilt parts and a locking mechanism for locking the pan-tilt parts.
  • the pan/tilt components can be used to represent different structures on the pan/tilt.
  • the pan/tilt components may include at least one of the following: A first bracket, a second bracket movably connected to the first bracket, a third bracket movably connected to the second bracket (for supporting a load), a base or a handle, and the like.
  • the number of pan/tilt components included on the pan/tilt may be one or more, and the detection method in this embodiment may acquire the detection status of any one or more pan/tilt components.
  • the execution body of the method may be the detection device of the pan/tilt.
  • the detection device of the pan/tilt may be implemented as software or a combination of software and hardware.
  • the detection device of the pan/tilt may be implemented as One to stabilize the gimbal.
  • the detection method of the PTZ may include:
  • Step S1401 Obtain a self-tuning request for implementing the self-tuning operation on the PTZ.
  • Step S1402 Based on the state of the pan/tilt components, determine whether to perform a self-tuning operation on the pan/tilt.
  • Step S1403 When the pan/tilt component is in a locked state, stop the self-tuning operation on the pan/tilt.
  • the self-tuning request is used to realize the self-tuning operation of the control parameters of the gimbal (including at least one of the following: the force information of the motor on the gimbal, the response speed to the load pose, and the configuration parameters of the filter on the gimbal).
  • the step disturbance experiment is performed with the control parameters of the gimbal, and the operation of setting the parameter value is calculated according to the running state of the gimbal.
  • the self-tuning request can be generated according to the user's operation on the stabilization gimbal. After the self-tuning request is obtained, the gimbal can be self-tuned based on the self-tuning request. After the self-tuning operation is performed on the gimbal During the process or before performing the self-tuning operation on the PTZ, it can be determined whether to perform the self-tuning operation on the PTZ based on the status of the PTZ components.
  • the state of the gimbal part may include a locked state and an unlocked state.
  • the specific implementation manner of detecting the state of the pan/tilt component in this embodiment is similar to the specific implementation manner of acquiring the detection state of the pan/tilt component in the above-mentioned embodiment. For details, reference may be made to the above statement, which will not be repeated here.
  • the method for detecting a pan/tilt determines whether to perform the self-tuning operation on the pan/tilt based on the state of the pan/tilt components by acquiring a self-tuning request for performing the self-tuning operation on the pan/tilt. ; Specifically, when the pan/tilt components are in a locked state, the self-tuning operation on the pan/tilt is stopped, which can effectively avoid the situation that normal self-tuning operations cannot be performed when the pan/tilt components are in a locked state. At the same time, it also avoids the collision between the pan/tilt parts and other components, thereby ensuring and improving the service life of the pan/tilt, further improving the stability and reliability of the method, which is beneficial to market promotion and application.
  • FIG. 15 is a schematic flowchart of a stabilization pan/tilt provided by an embodiment of the present invention.
  • the present embodiment provides a stabilization pan/tilt, wherein the stabilization pan/tilt includes pan/tilt components, a Due to the motor for driving the rotation of the pan/tilt components and the locking mechanism for locking the pan/tilt components, the stabilization pan/tilt in this embodiment can perform the detection method of the pan/tilt shown in FIG. 2 above.
  • the stabilization pan/tilt include:
  • the pan/tilt part 12 is used for mechanically coupling and connecting the photographing device 13;
  • the motor 14 is used to drive the pan/tilt component 12 to rotate to adjust the posture of the photographing device 13, thereby enhancing the stability of the photographing device 13;
  • the controller 11 is electrically connected to the motor 14 for controlling the motor 14;
  • the attitude sensor 15 is connected in communication with the controller, and is used for sensing the attitude information of the PTZ component 12,
  • the controller acquires the state detection signal corresponding to the attitude sensor 15, and determines the detection state of the pan/tilt component 12 according to the state detection signal, and the detection state includes a locked state and an unlocked state.
  • the controller 11 when acquiring the state detection signal corresponding to the attitude sensor 15 , the controller 11 is configured to: acquire a self-tuning request for implementing the self-tuning operation on the gimbal; and determine the state detection signal according to the self-tuning request.
  • the waveform corresponding to the state detection signal includes at least one of the following: sine wave, cosine wave, square wave, and triangle wave.
  • the controller 11 is further configured to: when it is determined that the gimbal component 12 is in an unlocked state, continue to perform the self-tuning operation on the gimbal based on the self-tuning request or, when it is determined that the pan/tilt component 12 is in a locked state, the self-tuning operation of the pan/tilt based on the self-tuning request is stopped.
  • the controller 11 is further configured to: acquire control parameters corresponding to the pan-tilt part 12; control the pan-tilt part 12 based on the control parameters, so that the pan-tilt The part 12 rotates within a preset range, wherein the preset range is used to avoid collision between the pan/tilt part 12 and the locking mechanism in a locked state.
  • the controller 11 is further configured to: when it is determined that the pan/tilt component 12 is in the locked state, output information for prompting the pan/tilt component 12 to be in the locked state.
  • the detection duration of the detection state is less than the set duration of the auto-tuning operation.
  • the controller 11 when determining the detection state of the pan/tilt unit 12 based on the state detection signal, is configured to: obtain the angular velocity of the motor 14 based on the state detection signal; determine the detection state of the pan/tilt unit 12 according to the angular velocity of the motor 14 state.
  • the controller 11 when determining the detection state of the pan/tilt head component 12 according to the angular velocity of the motor 14, the controller 11 is configured to: determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal according to the angular velocity of the motor 14, and the total energy of the signal The energy includes the energy of the first harmonic component; according to the total energy of the signal and the energy of the first harmonic component, the detection state of the pan/tilt component 12 is determined.
  • the total signal energy is negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity.
  • the energy of the first harmonic component is negatively correlated with the amount of angular velocity, positively correlated with the magnitude of the angular velocity, and negatively correlated with the fundamental frequency corresponding to the angular velocity.
  • the controller 11 is further configured to: acquire the set frequency and the sampling frequency corresponding to the angular velocity; and determine the fundamental frequency according to the set frequency and the sampling frequency.
  • the number of angular velocities is multiple.
  • the controller 11 is further configured to: acquire the set frequency and the sampling frequency corresponding to the angular velocity; and determine the quantity of the angular velocity according to the set frequency and the sampling frequency.
  • the controller 11 when determining the number of angular velocities according to the set frequency and the sampling frequency, the controller 11 is further configured to: determine the ratio of the sampling frequency to the set frequency as the number of angular velocities.
  • the controller 11 when determining the detection state of the pan/tilt component 12 according to the total energy of the signal and the energy of the first harmonic component, the controller 11 is further configured to: obtain first proportional information of the energy of the first harmonic component relative to the total energy of the signal ; According to the first scale information, the detection state of the pan/tilt component 12 is determined.
  • the controller 11 when determining the detection state of the pan/tilt unit 12 according to the first scale information, is further configured to: when the first scale information is greater than or equal to a first preset threshold, determine the pan/tilt unit 12 The detection state of the PTZ is an unlocked state; or, when the first ratio information is less than the first preset threshold, it is determined that the detection state of the pan/tilt component 12 is a locked state.
  • the controller 11 is further configured to: determine the DC component energy corresponding to the angular velocity of the motor 14, and the total signal energy includes the DC component energy;
  • the detection state includes: determining the difference between the signal total energy and the DC component energy as the non-DC total energy; determining the detection state of the pan/tilt component 12 according to the first harmonic component energy and the non-DC total energy.
  • the DC component energy is negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity.
  • the controller 11 when determining the detection state of the pan/tilt component 12 according to the energy of the first harmonic component and the total non-DC energy, is further configured to: obtain a second value of the energy of the first harmonic component relative to the total non-DC energy. Scale information; according to the second scale information, determine the detection state of the pan/tilt component 12 .
  • the controller 11 when determining the detection state of the pan-tilt component 12 according to the second scale information, is further configured to: when the second scale information is greater than or equal to the second preset threshold, determine the pan-tilt component 12 The detection state of 12 is an unlocked state; or, when the second ratio information is less than the second preset threshold, it is determined that the detection state of the pan/tilt component 12 is a locked state.
  • the controller 11 when determining the detection state of the gimbal component 12 according to the angular velocity of the motor 14, the controller 11 is further configured to: perform a fitting process on the angular velocity of the motor 14 according to the waveform corresponding to the state detection signal, and obtain a correlation with the motor 14.
  • the fitting waveform corresponding to the angular velocity of ; according to the fitting waveform and the angular velocity of the motor 14 , the detection state of the pan/tilt component 12 is determined.
  • the controller 11 when determining the detection state of the gimbal component 12 according to the fitting waveform and the angular velocity of the motor 14, is further configured to: obtain a fitting angular velocity corresponding to the angular velocity in the fitting waveform; determine the angular velocity The angular velocity error between the fitting angular velocity and the fitting angular velocity; according to the angular velocity error, the detection state of the gimbal component 12 is determined.
  • the controller 11 when determining the detection state of the pan-tilt unit 12 according to the angular velocity error, is further configured to: when a preset number of angular velocity errors are smaller than a preset error threshold, determine that the pan-tilt unit 12 is unlocked state; or, when the preset number of angular velocity errors is greater than or equal to a preset error threshold, it is determined that the gimbal is in a locked state.
  • the gimbal is a gimbal in a folded state or a gimbal in a centered state.
  • the gimbal when the gimbal is in the folded state, there is overlap between the positions corresponding to at least two gimbal parts 12 of the gimbal; in an orthogonal position.
  • the apparatus shown in FIG. 15 may execute the method of the embodiment shown in FIG. 1 to FIG. 13 .
  • the apparatus shown in FIG. 15 may execute the method of the embodiment shown in FIG. 1 to FIG. 13 .
  • FIG. 16 is a schematic flowchart of another stabilization pan/tilt provided by an embodiment of the present invention.
  • the present embodiment provides another stabilization pan/tilt, wherein the pan/tilt includes pan/tilt components, a Due to the motor for driving the rotation of the pan/tilt components and the locking mechanism for locking the pan/tilt components, the stabilization pan/tilt in this embodiment can perform the detection method of the pan/tilt shown in FIG. 14 above.
  • the stabilization pan/tilt include:
  • the pan/tilt part 22 is used for mechanically coupling and connecting the photographing device 23;
  • the motor 24 is used to drive the rotation of the pan/tilt part 22 to adjust the posture of the photographing device 23, thereby enhancing the stability of the photographing device 23;
  • the controller 21 is electrically connected to the motor 24 for controlling the motor 24;
  • the controller 21 obtains a self-tuning request for realizing the self-tuning operation on the pan/tilt; based on the state of the pan/tilt component 22, determines whether to perform the auto-tuning operation on the pan/tilt; when the pan/tilt component 22 is in a locked state, stops Perform self-tuning operation on the PTZ.
  • the apparatus shown in FIG. 15 may execute the method of the embodiment shown in FIG. 14 .
  • the apparatus shown in FIG. 15 may execute the method of the embodiment shown in FIG. 14 .
  • the parts not described in detail in this embodiment reference may be made to the related description of the embodiment shown in FIG. 14 .
  • Fig. 17 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention; with reference to Fig. 17, this embodiment provides a movable platform, wherein the movable platform may include but not limited to unmanned aerial vehicles, Unmanned ships, unmanned vehicles, mobile robots, etc. Specifically, the movable platform may include:
  • the support member 31 is mechanically coupled and connected to the stabilization gimbal 32 for supporting the stabilization gimbal 32 .
  • the support 31 may be any one of the following: the body of the unmanned aerial vehicle, the hand-held part of the hand-held gimbal, the body of the remote control ground robot, the body of the vehicle, and the like.
  • FIG. 18 is a schematic structural diagram of another movable platform provided by an embodiment of the present invention. with reference to FIG. 18 , this embodiment provides another movable platform, wherein the movable platform may include but not limited to unmanned aerial vehicles. drones, unmanned ships, unmanned vehicles, mobile robots, etc. Specifically, the movable platform may include:
  • the support member 41 is mechanically coupled and connected to the stabilization gimbal 42 for supporting the stabilization gimbal 42 .
  • the support 41 may be any one of the following: the body of the unmanned aerial vehicle, the hand-held part of the hand-held gimbal, the body of the remote control ground robot, the body of the vehicle, and the like.
  • an embodiment of the present invention provides a computer-readable storage medium, where the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement the above-mentioned cloud in FIG. 2 to FIG. 13 . method of detection.
  • an embodiment of the present invention provides a computer-readable storage medium, where the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement the detection of the pan/tilt in the above-mentioned FIG. 14 . method.
  • the disclosed related remote control devices and methods may be implemented in other manners.
  • the embodiments of the remote control device described above are only illustrative.
  • the division of the modules or units is only a logical function division.
  • the shown or discussed mutual coupling or direct coupling or communication connection may be through some interfaces, and the indirect coupling or communication connection of the remote control device or unit may be in electrical, mechanical or other forms.
  • the units described as separate components may or may not be physically separated, and components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution in this embodiment.
  • each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically alone, or two or more units may be integrated into one unit.
  • the above-mentioned integrated units may be implemented in the form of hardware, or may be implemented in the form of software functional units.
  • the integrated unit if implemented in the form of a software functional unit and sold or used as an independent product, may be stored in a computer-readable storage medium.
  • the technical solution of the present invention is essentially or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium , including several instructions for causing a computer processor (processor) to execute all or part of the steps of the methods described in the various embodiments of the present invention.
  • the aforementioned storage medium includes: U disk, mobile hard disk, Read-Only Memory (ROM, Read-Only Memory), Random Access Memory (RAM, Random Access Memory), magnetic disk or optical disk and other media that can store program codes.

Abstract

A detection method for a gimbal, a stability-enhanced gimbal, a mobile platform, and a storage medium. The gimbal comprises a gimbal part (12), an electric motor (14) used for driving the gimbal part (12) to rotate, and a locking mechanism used for locking the gimbal part (12). The detection method comprises: acquiring a state detection signal corresponding to a posture sensor (15) (S201); and determining a detected state of the gimbal part (12) on the basis of the detection signal (S202); the detected state comprising a locked state and an unlocked state. The detected state of the gimbal part (12) is determined via the state detection signal, the detected state of the gimbal may comprise the locked state and the unlocked state, this facilitates the implementation of the employment, on the basis of the different detected states of the gimbal part (12), of different control policies to control a stabilizer arranged on the gimbal, and favors the prevention of a collision due to the gimbal part (12) being in the locked state that in turn reduces the service life of the stabilizer, and of the problem of impacting the safety of a user load, causing a mismatch between a control parameter and the load, and impacting the stability enhancement performance of the stabilizer.

Description

云台的检测方法、增稳云台、可移动平台和存储介质PTZ detection method, stabilization PTZ, removable platform and storage medium 技术领域technical field
本发明实施例涉及云台技术领域,尤其涉及一种云台的检测方法、增稳云台、可移动平台和存储介质。Embodiments of the present invention relate to the technical field of PTZ, and in particular, to a PTZ detection method, a stabilization PTZ, a movable platform and a storage medium.
背景技术Background technique
在稳定器进行工作时,可以通过人为操作将稳定器在机械轴锁定状态和机械轴解锁状态之间进行调整,具体的,在稳定器处于机械轴锁定状态时,稳定器与所在机械轴的轴臂之间无法进行自由转动;在机械轴处于解锁状态时,稳定器与所在机械轴的轴臂之间可以进行自由转动。When the stabilizer is working, the stabilizer can be adjusted between the mechanical axis locked state and the mechanical axis unlocked state through manual operation. There is no free rotation between the arms; when the mechanical axis is in the unlocked state, the stabilizer and the axis arm of the mechanical axis where it is located can freely rotate.
在机械轴处于锁定状态时,稳定器与所在机械轴的轴臂之间无法进行自由转动,此时,若对稳定器和相机组合这一被控对象的控制参数进行自整定操作时,则会出现以下问题:机械轴或者稳定器在激励信号的作用下会来回撞击轴锁,从而会降低了云台的使用寿命,并对用户载荷的安全造成影响;此外,由于在机械轴处于锁定状态时,机械轴不能转动到预设位置,从而容易对相机等负载的转动惯量的辨识出现错误,导致所计算的控制参数与载荷不匹配,进而会影响稳定器的增稳性能。When the mechanical axis is in the locked state, the stabilizer and the axis arm of the mechanical axis cannot rotate freely. At this time, if the control parameters of the controlled object, which is the combination of the stabilizer and the camera, are auto-tuned, the The following problems occur: the mechanical axis or stabilizer will hit the axis lock back and forth under the action of the excitation signal, which will reduce the service life of the gimbal and affect the safety of the user's load; , the mechanical shaft cannot be rotated to the preset position, so it is easy to make errors in the identification of the moment of inertia of the load such as the camera, resulting in the mismatch between the calculated control parameters and the load, which will affect the stabilization performance of the stabilizer.
发明内容SUMMARY OF THE INVENTION
本发明实施例提供了一种云台的检测方法、增稳云台、可移动平台和存储介质,用于解决现有技术中存在的因机械轴处于机械轴锁定状态会降低云台的使用寿命,并容易导致控制参数与载荷不匹配,进而会影响稳定器的增稳性能的问题。Embodiments of the present invention provide a pan/tilt detection method, a stabilization pan/tilt, a movable platform, and a storage medium, which are used to solve the problem in the prior art that the service life of the pan/tilt will be reduced due to the mechanical axis being in a locked state. , and it is easy to cause the mismatch between the control parameters and the load, which will affect the stabilization performance of the stabilizer.
本发明的第一方面是为了提供一种云台的检测方法,所述云台包括云台部件、用于驱动所述云台部件转动的电机以及用于锁定所述云台部件的锁定机构,所述方法包括:A first aspect of the present invention is to provide a method for detecting a pan/tilt, the pan/tilt includes a pan/tilt component, a motor for driving the pan/tilt component to rotate, and a locking mechanism for locking the pan/tilt component, The method includes:
获取姿态传感器相对应的状态检测信号,所述姿态传感器用于感测所述 云台部件的姿态信息;Obtain the state detection signal corresponding to the attitude sensor, and the attitude sensor is used for sensing the attitude information of the gimbal component;
基于所述状态检测信号,确定所述云台部件的检测状态;Based on the state detection signal, determine the detection state of the pan/tilt component;
其中,所述检测状态包括锁定状态和未锁定状态。Wherein, the detection state includes a locked state and an unlocked state.
本发明的第二方面是为了提供一种增稳云台,包括:A second aspect of the present invention is to provide a stabilization platform, comprising:
云台部件,用于机械耦合连接拍摄装置;The pan/tilt part is used to mechanically couple and connect the photographing device;
电机,用于驱动所述云台部件转动,以调整所述拍摄装置的姿态,从而对所述拍摄装置进行增稳;a motor, used to drive the pan/tilt component to rotate, so as to adjust the posture of the photographing device, so as to enhance the stability of the photographing device;
控制器,与所述电机电连接,用于控制所述电机;a controller, electrically connected to the motor, for controlling the motor;
姿态传感器,与所述控制器通信连接,用于感测所述云台部件的姿态信息,an attitude sensor, connected in communication with the controller, for sensing the attitude information of the pan/tilt component,
其中,所述控制器获取与所述姿态传感器相对应的状态检测信号,并根据所述状态检测信号确定所述云台部件的检测状态,所述检测状态包括锁定状态和未锁定状态。Wherein, the controller acquires a state detection signal corresponding to the attitude sensor, and determines a detection state of the pan/tilt component according to the state detection signal, and the detection state includes a locked state and an unlocked state.
本发明的第三方面是为了提供一种计算机可读存储介质,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于第一方面所述的云台的检测方法。A third aspect of the present invention is to provide a computer-readable storage medium, the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used in the first aspect. The detection method of the PTZ mentioned above.
本发明的第四方面是为了提供一种可移动平台,包括:A fourth aspect of the present invention is to provide a movable platform comprising:
上述第二方面所述的增稳云台;The stabilization gimbal described in the second aspect above;
支撑件,与所述增稳云台机械耦合连接,用于支撑所述增稳云台。The support piece is mechanically coupled and connected with the stabilization gimbal, and is used for supporting the stabilization gimbal.
本发明的第五方面是为了提供一种云台的检测方法,所述云台包括云台部件、用于驱动所述云台部件转动的电机以及用于锁定所述云台部件的锁定机构,所述方法包括:A fifth aspect of the present invention is to provide a method for detecting a pan/tilt, the pan/tilt comprising a pan/tilt component, a motor for driving the pan/tilt component to rotate, and a locking mechanism for locking the pan/tilt component, The method includes:
获取用于实现对所述云台进行自整定操作的自整定请求;obtaining a self-tuning request for implementing the self-tuning operation on the PTZ;
基于所述云台部件的状态,确定是否对所述云台进行所述自整定操作;determining whether to perform the self-tuning operation on the gimbal based on the state of the gimbal component;
在所述云台部件处于锁定状态时,停止对所述云台进行所述自整定操作。When the pan/tilt component is in a locked state, the self-tuning operation on the pan/tilt is stopped.
本发明的第六方面是为了提供一种增稳云台,包括:A sixth aspect of the present invention is to provide a stabilization pan/tilt head, comprising:
云台部件,用于机械耦合连接拍摄装置;The pan/tilt part is used to mechanically couple and connect the photographing device;
电机,用于驱动所述云台部件转动,以调整所述拍摄装置的姿态,从而对所述拍摄装置进行增稳;a motor, used to drive the pan/tilt component to rotate, so as to adjust the posture of the photographing device, so as to enhance the stability of the photographing device;
控制器,与所述电机电连接,用于控制所述电机;a controller, electrically connected to the motor, for controlling the motor;
姿态传感器,与所述控制器通信连接,用于感测所述云台部件的姿态信 息,an attitude sensor, connected in communication with the controller, for sensing the attitude information of the pan/tilt component,
其中,所述控制器获取用于实现对所述云台进行自整定操作的自整定请求;基于所述云台部件的状态,确定是否对所述云台进行所述自整定操作;在所述云台部件处于锁定状态时,停止对所述云台进行所述自整定操作。Wherein, the controller obtains a self-tuning request for implementing the self-tuning operation on the pan/tilt; determines whether to perform the self-tuning operation on the pan/tilt based on the state of the pan/tilt components; When the pan/tilt component is in a locked state, the self-tuning operation on the pan/tilt is stopped.
本发明的第七方面是为了提供一种计算机可读存储介质,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于第五方面所述的云台的检测方法。A seventh aspect of the present invention is to provide a computer-readable storage medium, the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used in the fifth aspect. The detection method of the PTZ mentioned above.
本发明的第八方面是为了提供一种可移动平台,包括:An eighth aspect of the present invention is to provide a movable platform, comprising:
上述第六方面所述的增稳云台;The stabilization gimbal described in the sixth aspect;
支撑件,与所述增稳云台机械耦合连接,用于支撑所述增稳云台。The support piece is mechanically coupled and connected with the stabilization gimbal, and is used for supporting the stabilization gimbal.
本发明实施例提供的云台的检测方法、增稳云台、可移动平台和存储介质,通过所获取到的状态检测信号来确定云台部件的检测状态,其中,云台的检测状态可以包括锁定状态和未锁定状态,从而便于实现基于云台部件的不同检测状态采用不同的控制策略对云台进行控制,具体的,可以在云台部件处于锁定状态时,禁止对云台进行自整定操作,从而避免了因云台部件处于锁定状态而与其他部件发生碰撞,进而会降低稳定器的使用寿命,并容易导致控制参数与载荷不匹配,影响稳定器的增稳性能的问题,进一步保证了云台工作的稳定可靠性,提高了该方法的实用性,有利于市场的推广与应用。In the pan-tilt detection method, stabilization pan-tilt, movable platform, and storage medium provided by the embodiments of the present invention, the detection state of the pan-tilt component is determined by the acquired state detection signal, wherein the detection state of the pan-tilt may include: Locked state and unlocked state, so that it is convenient to use different control strategies to control the gimbal based on different detection states of the gimbal components. Specifically, when the gimbal components are in the locked state, the self-tuning operation of the gimbal can be prohibited. , so as to avoid collision with other components due to the locked state of the gimbal components, which will reduce the service life of the stabilizer, and easily lead to the mismatch between the control parameters and the load, which will affect the stabilization performance of the stabilizer. The stable and reliable operation of the PTZ improves the practicability of the method and is beneficial to the promotion and application of the market.
附图说明Description of drawings
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:The drawings described herein are used to provide further understanding of the present application and constitute a part of the present application. The schematic embodiments and descriptions of the present application are used to explain the present application and do not constitute an improper limitation of the present application. In the attached image:
图1为本发明实施例提供的稳定器的原理示意图;FIG. 1 is a schematic diagram of the principle of a stabilizer provided by an embodiment of the present invention;
图2为本发明实施例提供的一种云台的检测方法的流程示意图;2 is a schematic flowchart of a method for detecting a pan/tilt according to an embodiment of the present invention;
图3为本发明实施例提供的获取姿态传感器相对应的状态检测信号的流程示意图;3 is a schematic flowchart of obtaining a state detection signal corresponding to an attitude sensor according to an embodiment of the present invention;
图4为本发明实施例提供的又一种云台的检测方法的流程示意图;FIG. 4 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention;
图5为本发明实施例提供的基于所述状态检测信号,确定所述云台部件的检测状态的流程示意图;5 is a schematic flowchart of determining the detection state of the pan/tilt component based on the state detection signal according to an embodiment of the present invention;
图6为本发明实施例提供的根据所述电机的角速度确定所述云台部件的 检测状态的流程示意图;6 is a schematic flowchart of determining the detection state of the pan/tilt component according to the angular velocity of the motor provided by an embodiment of the present invention;
图7为本发明实施例提供的确定所述角速度的数量的流程示意图;7 is a schematic flowchart of determining the quantity of the angular velocity provided by an embodiment of the present invention;
图8为本发明实施例提供的确定所述基倍频率的流程示意图;8 is a schematic flowchart of determining the fundamental frequency provided by an embodiment of the present invention;
图9为本发明实施例提供的根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态的流程示意图一;9 is a schematic flow chart 1 of determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component according to an embodiment of the present invention;
图10为本发明实施例提供的根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态的流程示意图二;10 is a second schematic flowchart of determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component according to an embodiment of the present invention;
图11为本发明实施例提供的根据所述电机的角速度确定所述云台部件的检测状态的流程示意图;11 is a schematic flowchart of determining the detection state of the gimbal component according to the angular velocity of the motor according to an embodiment of the present invention;
图12为本发明应用实施例提供的电机部件处于未锁定状态时电机的角速度的波形示意图;12 is a schematic waveform diagram of the angular velocity of the motor when the motor component is in an unlocked state according to an application embodiment of the present invention;
图13为本发明应用实施例提供的电机部件处于锁定状态时电机的角速度的波形示意图;13 is a schematic waveform diagram of the angular velocity of the motor when the motor component is in a locked state according to an application embodiment of the present invention;
图14为本发明实施例提供的另一种云台的检测方法的流程示意图;14 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention;
图15为本发明实施例提供的一种增稳云台的结构示意图;15 is a schematic structural diagram of a stabilization gimbal according to an embodiment of the present invention;
图16为本发明实施例提供的另一种增稳云台的结构示意图;16 is a schematic structural diagram of another stabilization gimbal provided by an embodiment of the present invention;
图17为本发明实施例提供的一种可移动平台的结构示意图;17 is a schematic structural diagram of a movable platform according to an embodiment of the present invention;
图18为本发明实施例提供的另一种可移动平台的结构示意图。FIG. 18 is a schematic structural diagram of another movable platform provided by an embodiment of the present invention.
具体实施方式detailed description
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the purposes, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments These are some embodiments of the present invention, but not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention.
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs. The terms used herein in the description of the present invention are for the purpose of describing specific embodiments only, and are not intended to limit the present invention.
为了能够理解本实施例中技术方案的具体实现过程,首先,结合附图1对稳定器的工作原理进行说明,具体的,先检测摄像设备的实际姿态,将实际姿态与目标姿态进行比较,获得控制偏差;而后根据控制偏差进行负反馈控 制,基于控制偏差确定稳定器中的电机力矩,之后,将电机力矩发送至稳定器中的电机,以减小控制偏差,保证摄像设备的实际姿态和目标姿态偏差尽量小,从而使得摄像设备拍摄的图像尽量稳定,或使得摄像设备的实际姿态尽量趋近目标姿态而以目标姿态进行拍摄。In order to understand the specific implementation process of the technical solution in this embodiment, first, the working principle of the stabilizer is described with reference to FIG. 1 . Specifically, the actual posture of the camera device is detected first, and the actual posture is compared with the target posture to obtain Control deviation; then perform negative feedback control according to the control deviation, determine the motor torque in the stabilizer based on the control deviation, and then send the motor torque to the motor in the stabilizer to reduce the control deviation and ensure the actual posture and target of the camera equipment The attitude deviation is as small as possible, so that the image captured by the camera device is as stable as possible, or the actual attitude of the camera device is as close to the target attitude as possible to shoot in the target attitude.
可以理解的是,在不同的应用场景中,稳定器可以适配不同的载荷,例如:各种相机和镜头的组合等,其在尺寸、质量上的差异,以及不同的安装位置和结构受力状态会导致不同的动力学模型参数和频率响应特性。在负载发生更换之后,若稳定器仍然采用统一的控制参数对稳定器进行控制时,无法很好地适配负载的变化,将会对稳定器的控制性能带来影响。控制参数自整定是指通过系统辨识的方法对稳定器和相机组合这一被控对象的模型参数进行辨识,根据辨识得到的控制参数对稳定器进行控制,从而使得稳定器适配不同载荷时都能达到很好的控制性能。It can be understood that in different application scenarios, the stabilizer can be adapted to different loads, such as: various combinations of cameras and lenses, etc., and their differences in size and quality, as well as different installation positions and structural forces. The states result in different dynamics model parameters and frequency response characteristics. After the load is replaced, if the stabilizer still uses uniform control parameters to control the stabilizer, it cannot well adapt to the change of the load, which will affect the control performance of the stabilizer. Control parameter self-tuning refers to the identification of the model parameters of the controlled object, which is the combination of the stabilizer and the camera, by the method of system identification, and the stabilizer is controlled according to the identified control parameters, so that the stabilizer can be adapted to different loads. Can achieve good control performance.
具体的,在稳定器进行工作时,可以通过人为操作将稳定器在机械轴锁定状态和机械轴解锁状态之间进行调整,具体的,在机械轴处于锁定状态时,即用于控制稳定器的机械轴对应的电机的转子处于锁定状态,从而使得上述机械轴无法进行自由转动;在机械轴处于解锁状态时,即用于控制稳定器的机械轴对应的电机的转子处于解锁状态,从而使得上述机械轴的轴臂可以进行自由转动。Specifically, when the stabilizer is working, the stabilizer can be adjusted between the mechanical axis locked state and the mechanical axis unlocked state through manual operation. Specifically, when the mechanical axis is in the locked state, the The rotor of the motor corresponding to the mechanical shaft is in a locked state, so that the above-mentioned mechanical shaft cannot rotate freely; when the mechanical shaft is in an unlocked state, that is, the rotor of the motor corresponding to the mechanical shaft used to control the stabilizer is in an unlocked state, so that the above-mentioned mechanical shaft is in an unlocked state. The shaft arm of the mechanical shaft can rotate freely.
一般情况下,在机械轴的姿态满足应用需求(即机械轴处于预设的目标姿态)时,则可以通过人为操作控制电机的转子处于锁定状态,从而控制稳定器的机械轴处于锁定状态,即机械轴稳定地处于预设的目标姿态而无法发生变动。Under normal circumstances, when the posture of the mechanical axis meets the application requirements (that is, the mechanical axis is in the preset target posture), the rotor of the motor can be controlled to be in a locked state through manual operation, thereby controlling the mechanical axis of the stabilizer to be in a locked state, that is, The mechanical axis is stably in the preset target posture and cannot be changed.
例如:在对稳定器进行应用完毕后,可以将稳定器进行折叠收纳,此时通过人为控制稳定器的机械轴锁定在折叠状态,可以避免稳定器由折叠状态变化为展开状态,不利于对稳定器进行收纳操作。For example, after the stabilizer is applied, the stabilizer can be folded and stored. At this time, by manually controlling the mechanical shaft of the stabilizer to lock in the folded state, the stabilizer can be prevented from changing from the folded state to the unfolded state, which is not conducive to the stability of the stabilizer. to carry out the storage operation.
而在对稳定器的应用场景进行切换时,为了避免折叠的繁琐操作,并在下一个场景快速使用,可以通过人为操作控制稳定器的机械轴在当前的姿态下处于锁定状态,以使得机械轴无法进行自由转动,并在满足下一个场景的切换条件时,重新解锁机械轴,使得达到机械轴可以进行自由转动。When switching the application scene of the stabilizer, in order to avoid the cumbersome operation of folding and use it quickly in the next scene, the mechanical axis of the stabilizer can be controlled by manual operation to be locked in the current posture, so that the mechanical axis cannot be used. Perform free rotation, and when the switching conditions of the next scene are met, unlock the mechanical axis again, so that the mechanical axis can be rotated freely.
需要注意的是,控制稳定器的机械轴处于锁定状态和解锁状态的具体操作和应用场景并不限于上述描述内容,本领域技术人员还可以根据具体的应 用需求和应用场景进行灵活调整,在此不再赘述。It should be noted that the specific operations and application scenarios for controlling the mechanical axis of the stabilizer to be in a locked state and an unlocked state are not limited to the above description. Those skilled in the art can also flexibly adjust according to specific application requirements and application scenarios. Here No longer.
其中,在稳定器处于机械轴锁定状态时,稳定器的所在机械轴的轴臂无法进行自由转动,此时,若对稳定器和相机组合这一被控对象的控制参数进行自整定操作时,则会出现以下问题:Among them, when the stabilizer is in the locked state of the mechanical axis, the shaft arm of the mechanical axis where the stabilizer is located cannot rotate freely. The following problems will occur:
(1)机械轴所在的轴臂在激励信号的作用下会来回撞击轴锁,从而会降低了云台的使用寿命,并对用户载荷的安全造成影响。(1) The shaft arm where the mechanical shaft is located will hit the shaft lock back and forth under the action of the excitation signal, which will reduce the service life of the gimbal and affect the safety of the user's load.
(2)在机械轴处于锁定状态时,机械轴所在的轴臂不能转动到预设位置,从而容易对相机等负载的转动惯量的辨识出现错误,导致所计算的控制参数与载荷不匹配,进而会影响稳定器的增稳性能。(2) When the mechanical axis is in the locked state, the shaft arm where the mechanical axis is located cannot rotate to the preset position, so that it is easy to make errors in the identification of the moment of inertia of the load such as the camera, resulting in the calculated control parameters and the load do not match, and then It will affect the stabilization performance of the stabilizer.
为了解决上述技术问题,本实施例提供了一种云台的检测方法、装置、可移动平台和存储介质,其中,检测方法可以检测位于云台上云台部件的检测状态,该检测状态可以包括锁定状态或者未锁定状态,具体的,通过所获取到的状态检测信号来确定云台部件的检测状态,其中,云台的检测状态可以包括锁定状态和未锁定状态,从而便于实现基于云台部件的不同检测状态采用不同的控制策略对云台进行控制,具体的,可以在云台部件处于锁定状态时,禁止对云台进行自整定操作,从而避免了因云台部件处于锁定状态而与其他部件发生碰撞,进而会降低稳定器的使用寿命,并容易导致控制参数与载荷不匹配,影响稳定器的增稳性能的问题,进一步保证了云台工作的稳定可靠性,提高了该方法的实用性,有利于市场的推广与应用。In order to solve the above technical problems, the present embodiment provides a detection method, device, movable platform and storage medium for a pan/tilt, wherein the detection method can detect a detection state of a pan/tilt component located on the pan/tilt, and the detection state may include: Locked state or unlocked state, specifically, the detection state of the pan-tilt component is determined by the acquired state detection signal, wherein the detection state of the pan-tilt can include a locked state and an unlocked state, so as to facilitate the realization of a pan-tilt-based component based In different detection states, different control strategies are used to control the gimbal. Specifically, the self-tuning operation of the gimbal can be prohibited when the gimbal parts are in a locked state, thereby avoiding the possibility of interfering with other gimbal components due to the locked state. The collision of components will reduce the service life of the stabilizer, and easily lead to the mismatch between the control parameters and the load, which will affect the stabilization performance of the stabilizer, which further ensures the stability and reliability of the gimbal and improves the practicality of the method. It is conducive to the promotion and application of the market.
下面结合附图,对本发明中一种云台的检测方法、装置、可移动平台和存储介质的一些实施方式作详细说明。在各实施例之间不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。Some embodiments of a pan/tilt detection method, device, movable platform and storage medium of the present invention will be described in detail below with reference to the accompanying drawings. The following embodiments and features in the embodiments may be combined with each other without conflict between the embodiments.
图2为本发明实施例提供的一种云台的检测方法的流程示意图;参考附图2所示,本实施例提供了一种云台的检测方法,该云台可以包括云台部件、用于驱动云台部件转动的电机以及用于锁定云台部件的锁定机构。其中,对于云台而言,以云台部件所包括的数量进行划分,云台可以是指以下至少之一:单轴云台(云台部件的数量为1个)、双轴云台(云台部件的数量为2个)、三轴云台(云台部件的数量为3个)以及多轴云台(云台部件的数量为多个)等等;以锁定机构的载体划分,云台可以包括以下至少之一:手持云台、车载云台、机载云台等等。FIG. 2 is a schematic flowchart of a method for detecting a pan/tilt according to an embodiment of the present invention; with reference to FIG. 2 , the present embodiment provides a detection method for a pan/tilt. The pan/tilt may include pan/tilt components, a A motor for driving the rotation of the pan-tilt part and a locking mechanism for locking the pan-tilt part. Among them, for the gimbal, it is divided by the number of gimbal components, and the gimbal may refer to at least one of the following: a single-axis gimbal (the number of gimbal parts is 1), a dual-axis gimbal (a gimbal The number of table parts is 2), the three-axis pan/tilt (the number of pan/tilt components is 3), and the multi-axis pan/tilt (the number of pan/tilt components is multiple), etc.; divided by the carrier of the locking mechanism, the pan/tilt It can include at least one of the following: a handheld gimbal, a vehicle-mounted gimbal, an airborne gimbal, and the like.
以云台轴臂作为云台部件为例,在不同的应用场景中,云台部件可以用 于表征云台上的不同结构,例如:对于三轴云台而言,云台部件可以包括以下至少之一:位于两个电机之间的第一支架、与第一支架活动连接的第二支架、与第二支架活动连接的第三支架(用于支撑负载)等等。具体的,云台上包括的云台部件可以为上述第一支架、第二支架和第三支架中的任意一个或多个,本实施例中的检测方法可以获取任意一个或多个云台部件的检测状态。Taking the pivot arm of the gimbal as an example, in different application scenarios, the gimbal parts can be used to represent different structures on the gimbal. For example, for a three-axis gimbal, the gimbal parts can include at least the following: One: a first bracket located between two motors, a second bracket movably connected to the first bracket, a third bracket movably connected to the second bracket (for supporting the load), and so on. Specifically, the pan/tilt components included on the pan/tilt may be any one or more of the above-mentioned first bracket, second bracket, and third bracket, and the detection method in this embodiment may acquire any one or more pan/tilt components detection status.
另外,该方法的执行主体可以为云台的检测装置,可以理解的是,该云台的检测装置可以实现为软件、或者软件和硬件的组合,具体应用时,该云台的检测装置可以实现为一增稳云台。具体的,该云台的检测方法可以包括:In addition, the execution body of the method may be the detection device of the pan/tilt. It can be understood that the detection device of the pan/tilt may be implemented as software or a combination of software and hardware. In specific applications, the detection device of the pan/tilt may be implemented For a stabilization gimbal. Specifically, the detection method of the PTZ may include:
步骤S201:获取姿态传感器相对应的状态检测信号,姿态传感器用于感测云台部件的姿态信息。Step S201: Acquire a state detection signal corresponding to the attitude sensor, and the attitude sensor is used to sense the attitude information of the pan/tilt component.
其中,姿态传感器用于感测云台部件的姿态信息,具体实现时,姿态传感器可以为惯性测量单元IMU;状态检测信号是指用于确定云台部件进行状态检测的请求信号,该状态检测信号所对应的波形可以包括以下至少之一:正弦波、余弦波、方波、三角波,由于余弦波、方波、三角波可以通过正弦波进行融合获得,因此,为了提高数据处理的质量和效率,较为优选的,状态检测信号所对应的波形可以为正弦波。Among them, the attitude sensor is used to sense the attitude information of the gimbal component. In the specific implementation, the attitude sensor can be an inertial measurement unit IMU; the state detection signal refers to a request signal used to determine the state detection of the gimbal component. The state detection signal The corresponding waveform may include at least one of the following: sine wave, cosine wave, square wave, and triangle wave. Since cosine wave, square wave, and triangle wave can be obtained by fusion of sine waves, in order to improve the quality and efficiency of data processing, it is relatively Preferably, the waveform corresponding to the state detection signal may be a sine wave.
具体的,与姿态传感器相对应的状态检测信号可以是指用于驱动姿态传感器进行检测操作的驱动信号,此时,在获取到状态检测信号之后,姿态传感器可以基于所获取到的状态检测信号检测云台部件的姿态信息。或者,与姿态传感器相对应的状态检测信号可以是指通过姿态传感器所输出的信号,此时,状态检测信号可以包括通过姿态传感器感测到的云台部件的姿态信息。Specifically, the state detection signal corresponding to the attitude sensor may refer to a drive signal used to drive the attitude sensor to perform a detection operation. At this time, after acquiring the state detection signal, the attitude sensor may detect based on the acquired state detection signal. The attitude information of the gimbal part. Alternatively, the state detection signal corresponding to the attitude sensor may refer to a signal output by the attitude sensor, and in this case, the state detection signal may include attitude information of the pan/tilt component sensed by the attitude sensor.
另外,本实施例对于状态检测信号的具体获取方式不做限定,本领域技术人员可以根据具体的应用需求和设计需求进行设置,例如:用户可以直接向云台的检测装置输入用于生成状态检测信号的执行操作,以使得云台的检测装置可以直接获取到通过执行操作所生成的状态检测信号。或者,状态检测信号可以是其他装置发送至云台的检测装置,从而使得云台的检测装置可以稳定器获取到状态检测信号。In addition, this embodiment does not limit the specific acquisition method of the state detection signal, and those skilled in the art can set it according to specific application requirements and design requirements. The signal is executed, so that the detection device of the PTZ can directly acquire the state detection signal generated by executing the operation. Alternatively, the state detection signal may be sent by other devices to the detection device of the gimbal, so that the detection device of the gimbal can obtain the state detection signal from the stabilizer.
在一些实例中,参考附图3所示,获取姿态传感器相对应的状态检测信号可以包括:In some instances, referring to FIG. 3 , acquiring the state detection signal corresponding to the attitude sensor may include:
步骤S2011:获取用于实现对云台进行自整定操作的自整定请求。Step S2011: Acquire a self-tuning request for implementing the self-tuning operation on the PTZ.
步骤S2012:根据自整定请求确定状态检测信号。Step S2012: Determine the state detection signal according to the self-tuning request.
其中,自整定请求用于实现对云台的控制参数(包括以下至少之一:云台上电机的力度信息、对负载位姿的响应速度、云台上滤波器的配置参数)进行自整定操作,即以云台的控制参数进行阶跃扰动实验,根据云台的运行状态计算出整定参数值的操作。Among them, the self-tuning request is used to realize the self-tuning operation of the control parameters of the gimbal (including at least one of the following: the force information of the motor on the gimbal, the response speed to the load pose, and the configuration parameters of the filter on the gimbal). , that is, the step disturbance experiment is performed with the control parameters of the gimbal, and the operation of setting the parameter value is calculated according to the running state of the gimbal.
具体的,自整定请求可以是根据用户对增稳云台输入执行操作所生成的,在获取到自整定请求之后,可以对自整定请求进行分析处理,以确定状态检测信号,其中,一种可实现的方式为将自整定请求直接确定为状态检测信号;或者,另一种可实现的方式为根据自整定请求生成一状态检测信号。Specifically, the self-tuning request may be generated according to an operation performed by the user on the input of the stabilization gimbal. After the self-tuning request is obtained, the self-tuning request may be analyzed and processed to determine the state detection signal, among which one may be The implementation method is to directly determine the self-tuning request as the status detection signal; or, another feasible method is to generate a status detection signal according to the self-tuning request.
在一些实例中,检测状态的检测时长小于自整定操作的整定时长。In some instances, the detection duration of the detection state is less than the set duration of the auto-tuning operation.
其中,本实施例对于检测状态的检测时长和自整定操作的整定时长不做限定,本领域技术人员可以根据具体的应用场景和应用需求进行设置,一般情况下,自整定操作和检测状态的操作可以是同步进行的,而为了能够保证自整定操作进行的稳定可靠性,可以控制检测状态的检测时长小于自整定操作的整定时长,具体的,检测状态的检测时长可以是自整定操作的整定时长的三分之一、四分之一或者五分之一等等,例如:在进行自整定操作的整定时长为2s时,那么,检测状态所需要的检测时长可以小于或者等于0.4s,从而实现了可以在进行自整定操作的前期即可完成对云台的状态进行快速、准确地检测操作,极大地避免了对稳定器和载荷的损害,并且也便于基于所获取到云台部件的检测状态对云台的自整定操作进行控制,这样可以有效地避免在云台部件处于锁定状态时,无法进行正常的自整定操作的情况,同时也避免了云台部件与其他部件发生碰撞,从而保证并提高了云台的使用寿命。Among them, this embodiment does not limit the detection duration of the detection state and the setting duration of the self-tuning operation, and those skilled in the art can set it according to specific application scenarios and application requirements. It can be carried out synchronously, and in order to ensure the stability and reliability of the self-tuning operation, the detection time of the detection state can be controlled to be shorter than the set time of the self-tuning operation. Specifically, the detection time of the detection state can be the set time of the self-tuning operation. 1/3, 1/4 or 1/5, etc., for example, when the self-tuning operation is set to be 2s, the detection time required to detect the state can be less than or equal to 0.4s, so as to achieve Therefore, it is possible to quickly and accurately detect the state of the gimbal in the early stage of the self-tuning operation, which greatly avoids damage to the stabilizer and load, and also facilitates the detection of the state of the gimbal based on the obtained parts. Control the self-tuning operation of the gimbal, which can effectively avoid the situation that normal self-tuning operation cannot be performed when the gimbal parts are in a locked state, and also avoid the collision between the gimbal parts and other parts, so as to ensure and Improves the service life of the gimbal.
可以理解的是,本实施例中获取姿态传感器相对应的状态检测信号的具体方式并不限于上述所限定的方式,本领域技术人员也可以采用其他的方式来获取姿态传感器相对应的状态检测信号,只要能够保证对状态检测信号进行获取的准确可靠性即可,在此不再赘述。It can be understood that the specific manner of obtaining the state detection signal corresponding to the attitude sensor in this embodiment is not limited to the above-defined manner, and those skilled in the art may also use other methods to obtain the state detection signal corresponding to the attitude sensor. , as long as the accuracy and reliability of acquiring the state detection signal can be ensured, and details are not repeated here.
步骤S202:基于状态检测信号,确定云台部件的检测状态。Step S202: Determine the detection state of the pan/tilt component based on the state detection signal.
在获取到状态检测信号之后,可以对状态检测信号进行分析处理,以确定云台状态的检测状态,其中,检测状态可以包括锁定状态和未锁定状态,具体的,当云台部件的检测状态为锁定状态时,云台部件与其他部件之间的相对位置保持不变;在云台的检测状态为未锁定状态时,云台部件与其他部 件之间的相对位置可以进行改变。After the status detection signal is acquired, the status detection signal can be analyzed and processed to determine the detection status of the pan/tilt status, where the detection status may include a locked status and an unlocked status. Specifically, when the detection status of the pan/tilt component is In the locked state, the relative position between the gimbal part and other parts remains unchanged; when the detection state of the gimbal is unlocked, the relative position between the gimbal part and other parts can be changed.
其中,本实施例对于确定云台部件的检测状态的具体实现方式不做限定,本领域技术人员可以根据具体的应用需求和设计需求进行设置,例如:预先设置有用于标识云台部件的检测状态的状态标识信息,在获取到状态检测信号之后,可以获取用于标识云台部件的检测状态的状态标识信息,通过状态标识信息即可确定云台部件的检测状态。例如:在状态标识信息为“1”时,则确定云台部件的检测状态为锁定状态;在状态标识信息为“0”时,则确定云台部件的检测状态为未锁定状态。当然的,本领域技术人员也可以采用其他的实现方式来获取云台部件的检测状态,只要能够保证对云台部件的检测状态进行准确有效地确定即可,在此不再赘述。Wherein, this embodiment does not limit the specific implementation manner of determining the detection state of the pan/tilt components, and those skilled in the art can make settings according to specific application requirements and design requirements. For example, a detection state for identifying the pan/tilt components is preset. After obtaining the state detection signal, the state identification information for identifying the detection state of the pan-tilt component can be obtained, and the detection state of the pan-tilt component can be determined through the state identification information. For example: when the status identification information is "1", it is determined that the detection state of the pan-tilt component is a locked state; when the status identification information is "0", it is determined that the detection state of the pan-tilt component is an unlocked state. Of course, those skilled in the art can also use other implementation manners to obtain the detection state of the pan/tilt component, as long as the detection state of the pan/tilt component can be accurately and effectively determined, which will not be repeated here.
在一些实例中,在基于状态检测信号确定云台的检测状态之后,本实施例中的方法还包括:在确定云台部件处于未锁定状态时,则继续基于自整定请求对云台进行自整定操作;或者,在确定云台部件处于锁定状态时,则停止基于自整定请求对云台进行自整定操作。In some instances, after determining the detection state of the gimbal based on the state detection signal, the method in this embodiment further includes: when it is determined that the gimbal component is in an unlocked state, continuing to perform self-tuning on the gimbal based on the self-tuning request operation; or, when it is determined that the gimbal part is in a locked state, the self-tuning operation of the gimbal based on the self-tuning request is stopped.
在确定云台部件处于未锁定状态时,则说明此时云台上的云台部件与其他部件之间可以进行自由活动,进而则可以基于预先获取到的自整定请求对云台进行参数自整定操作,以使得云台的控制参数与设置于云台上的负载相匹配,有利于提高对云台进行控制的稳定可靠性。在确定云台部件处于锁定状态时,则说明此时云台上的云台部件与其他部件之间的位置相对保持不变,进而无法对云台部件进行准确有效地控制,为了避免云台部件与其他部件发生碰撞,则可以停止基于自整定请求对云台进行自整定操作,从而可以保证并提高云台的使用寿命。When it is determined that the gimbal part is in an unlocked state, it means that the gimbal part on the gimbal can freely move with other parts at this time, and then the parameters of the gimbal can be self-tuned based on the pre-obtained self-tuning request. operation, so that the control parameters of the PTZ match the load set on the PTZ, which is beneficial to improve the stability and reliability of the control of the PTZ. When it is determined that the gimbal parts are in the locked state, it means that the positions of the gimbal parts on the gimbal and other parts remain relatively unchanged at this time, so that the gimbal parts cannot be controlled accurately and effectively. In order to avoid the gimbal parts If it collides with other parts, the self-tuning operation of the gimbal based on the self-tuning request can be stopped, thereby ensuring and improving the service life of the gimbal.
需要注意的是,在另一些实例中,在停止基于自整定请求对云台进行自整定操作之后,本实施例中的方法还可以包括:获取用于对云台的检测状态进行切换的执行操作,根据执行操作将云台由锁定状态切换为未锁定状态,而后再次获取用于实现对云台进行自整定操作的自整定请求,并基于自整定请求对云台进行自整定操作,以使得云台的控制参数与设置于云台上的负载相匹配,有利于提高对云台进行控制的稳定可靠性。It should be noted that, in other instances, after stopping the self-tuning operation on the gimbal based on the self-tuning request, the method in this embodiment may further include: acquiring an execution operation for switching the detection state of the gimbal , switch the gimbal from the locked state to the unlocked state according to the execution operation, and then obtain the self-tuning request for realizing the self-tuning operation of the gimbal again, and perform the self-tuning operation on the gimbal based on the self-tuning request, so that the cloud The control parameters of the platform match the load set on the gimbal, which is beneficial to improve the stability and reliability of the control of the gimbal.
在又一些实例中,在基于状态检测信号确定云台的检测状态之后,本实施例中的方法还可以包括:在确定云台部件处于锁定状态时,输出用于提示云台部件处于锁定状态的信息。In still other instances, after determining the detection state of the pan/tilt based on the state detection signal, the method in this embodiment may further include: when it is determined that the pan/tilt component is in a locked state, outputting a message for prompting that the pan/tilt component is in a locked state information.
其中,云台上可以配置有用于输出信息的装置,该装置可以包括语音模块、显示模块、信息发送模块等等,具体的,在云台部件处于锁定状态时,则可以基于云台部件处于锁定状态生成相对应的提示信息,该提示信息可以包括以下至少之一:语音信息、文本信息、图像信息、标识信息等等。举例来说,在云台上的云台部件A处于锁定状态时,则可以生成与“云台部件A处于锁定状态”相对应的语音提示信息1,该语音提示信息1可以通过语音模块进行输出;在云台上的云台部件B处于锁定状态时,则可以生成文本提示信息2和/或图像信息3,该文本提示信息2和/或图像信息3可以通过显示模块进行输出;在云台上的云台部件C处于锁定状态时,则可以生成标识提示信息4,该标识提示信息4可以通过显示模块(例如:绿色显示灯闪亮用于标识云台部件未处于锁定状态、红色显示灯闪亮用于标识云台部件处于锁定状态)进行输出。Wherein, a device for outputting information may be configured on the pan/tilt, and the device may include a voice module, a display module, an information sending module, etc. Specifically, when the pan/tilt component is in a locked state, it may be based on the fact that the pan/tilt component is locked. The state generates corresponding prompt information, and the prompt information may include at least one of the following: voice information, text information, image information, identification information, and the like. For example, when the PTZ part A on the PTZ is in the locked state, the voice prompt information 1 corresponding to "The PTZ part A is in the locked state" can be generated, and the voice prompt information 1 can be output through the voice module ; When the PTZ component B on the PTZ is in a locked state, then text prompt information 2 and/or image information 3 can be generated, and the text prompt information 2 and/or image information 3 can be output through the display module; When the gimbal part C on the device is in the locked state, the identification prompt information 4 can be generated, and the identification prompt information 4 can be displayed through the display module (for example: the green indicator light flashes to indicate that the gimbal part is not in the locked state, the red indicator light Blinking is used to indicate that the gimbal part is in a locked state) for output.
当然的,本领域技术人员也可以通过其他的方式来输出用于提示云台部件处于锁定状态的信息,只要能够使得在确定云台部件处于锁定状态时,用户通过所输出的提示信息可以快速获知到云台部件处于锁定状态,进而便于基于云台部件所处于的锁定状态对云台进行及时、准确的控制即可,在此不再赘述。Of course, those skilled in the art can also output the information for prompting that the pan/tilt component is in the locked state in other ways, as long as the user can quickly learn from the output prompt information when it is determined that the pan/tilt component is in the locked state It suffices that the gimbal component is in a locked state, thereby facilitating timely and accurate control of the gimbal based on the locked state of the gimbal component, which will not be repeated here.
进一步的,在检测到云台处于锁定状态后,若锁定机构为智能(自动或半自动)的锁定机构,也可以是进行自动解锁,而后继续进行自整定操作,且可以在解锁的同时对用户进行提示已解锁;还可以是由用户触发解锁。可以理解,在锁定机构为智能的锁定机构时,锁定用于云台部件与电机之间的锁定或解锁,可以由用户非接触云台而触发,也可以由用户接触云台上的按键、触控屏、拨轮等来实现触发操作。Further, after it is detected that the PTZ is in a locked state, if the locking mechanism is an intelligent (automatic or semi-automatic) locking mechanism, it can also be automatically unlocked, and then continue to perform the self-tuning operation, and the user can be unlocked while unlocking. Prompt unlocked; unlocking can also be triggered by the user. It can be understood that when the locking mechanism is an intelligent locking mechanism, the locking is used for locking or unlocking between the pan/tilt components and the motor, which can be triggered by the user non-contacting the pan/tilt, or by the user touching the buttons on the pan/tilt or touching the pan/tilt. Control screen, dial, etc. to achieve trigger operation.
另外,在对云台上的云台部件进行检测时,本实施中的云台可以为处于折叠状态(即便于收纳的状态)的云台或者处于回中状态(即关节角为诸如0的位置)的云台,也即在这两个状态下,可能会存在云台部件处于锁定状态的情况。具体的,在云台处于折叠状态时,云台的至少两个云台部件所对应的位置之间存在重叠;在云台处于回中状态时,云台的云台部件之间处于正交位置。需要注意的是,云台处于折叠状态或回中状态时,云台部件之间的位置关系不限于上述的说明,例如,在云台处于回中状态时,云台的云台部件之间处于非正交位置;同时,在对云台部件进行检测时,云台的状态并不 限于上述所描述的状态,本领域技术人员还可以根据具体的应用需求和应用场景进行灵活调整,例如:云台处于使用中状态,或者,云台处于休眠状态等等,在此不再赘述。In addition, when detecting the pan/tilt parts on the pan/tilt, the pan/tilt in this embodiment may be a pan/tilt in a folded state (that is, in a stowed state) or in a centered state (that is, a position where the joint angle is such as 0) ), that is, in these two states, there may be situations where the gimbal parts are locked. Specifically, when the gimbal is in the folded state, there is overlap between the positions corresponding to at least two gimbal components of the gimbal; when the gimbal is in the centering state, the gimbal components of the gimbal are in an orthogonal position. . It should be noted that when the gimbal is in the folded state or the centering state, the positional relationship between the gimbal components is not limited to the above description. For example, when the gimbal is in the centering state, Non-orthogonal position; at the same time, when the pan/tilt components are detected, the state of the pan/tilt is not limited to the state described above, and those skilled in the art can also flexibly adjust according to specific application requirements and application scenarios, for example: cloud The platform is in a use state, or the PTZ is in a dormant state, etc., which will not be repeated here.
下面结合具体的应用场景对云台的检测方法进行说明:The detection method of the PTZ is described below in combination with specific application scenarios:
应用场景1,对于某一云台而言,其可以具有折叠状态和展开状态。在利用上述云台执行拍摄操作完毕后,可以对云台进行收纳操作。此时,为了减少云台所占用的空间大小,可以将云台由展开状态调整为折叠状态,即使得云台上的至少两个云台支架所对应的位置之间存在重叠。为了避免云台由折叠状态变化为展开状态等其他不利于对云台进行收纳操作的情况出现,此时,则可以控制云台上的云台支架处于锁定状态。 Application Scenario 1, for a certain PTZ, it can have a folded state and an unfolded state. After the shooting operation using the above-mentioned pan/tilt is completed, the pan/tilt can be stored. At this time, in order to reduce the space occupied by the gimbal, the gimbal can be adjusted from the unfolded state to the folded state, that is, the positions corresponding to at least two gimbal brackets on the gimbal overlap. In order to prevent the gimbal from changing from the folded state to the unfolded state and other situations that are not conducive to the storage operation of the gimbal, at this time, the gimbal bracket on the gimbal can be controlled to be in a locked state.
当使用人员再次对上述云台进行应用时,由于云台上的云台部件的检测状态可以处于锁定状态或者未锁定状态。因此,为了避免在云台部件处于锁定状态时所造成的降低稳定器的使用寿命、影响稳定器的增稳性能的情况出现,则可以对云台进行状态检测,具体的,则可以通过所获取到的状态检测信号来确定云台支架的检测状态,从而便于实现在云台支架处于不同的检测状态时,可以采用不同的控制策略对云台进行控制。When the user applies the above-mentioned pan/tilt again, the detection state of the pan/tilt components on the pan/tilt may be in a locked state or an unlocked state. Therefore, in order to avoid the situation of reducing the service life of the gimbal and affecting the stabilization performance of the gimbal when the gimbal components are in the locked state, the gimbal can be checked for the state. The received state detection signal is used to determine the detection state of the pan-tilt bracket, so that it is convenient to use different control strategies to control the pan-tilt bracket when the pan-tilt bracket is in different detection states.
应用场景2,当云台执行任务完毕后,则可以对云台进行关机或者休眠操作,使得云台处于关机状态或者休眠状态,云台上的电机未对云台部件提供任何驱动力,并且可以控制云台上的云台支架处于锁定状态。Application Scenario 2, when the gimbal completes the task, the gimbal can be shut down or hibernated, so that the gimbal is in a shutdown or hibernation state. The motor on the gimbal does not provide any driving force to the gimbal components, and can The gimbal bracket on the control gimbal is locked.
当使用人员再次对上述云台进行应用时,由于云台上的云台部件的检测状态可以处于锁定状态或者未锁定状态。因此,为了避免在云台部件处于锁定状态时所造成的降低稳定器的使用寿命、影响稳定器的增稳性能的情况出现,则可以在云台退出关机状态或者休眠状态之后,先控制云台处于回中状态,而后对云台进行状态检测,具体的,则可以通过所获取到的状态检测信号来确定云台支架的检测状态,从而便于实现在云台支架处于不同的检测状态时,可以采用不同的控制策略对云台进行控制。When the user applies the above-mentioned pan/tilt again, the detection state of the pan/tilt components on the pan/tilt may be in a locked state or an unlocked state. Therefore, in order to avoid the situation of reducing the service life of the gimbal and affecting the stabilization performance of the gimbal when the gimbal parts are in the locked state, you can control the gimbal first after the gimbal exits the shutdown state or hibernation state. It is in the middle state, and then the state detection of the gimbal is carried out. Specifically, the detection state of the gimbal bracket can be determined by the obtained state detection signal, so as to facilitate the realization of the gimbal bracket when it is in different detection states. Use different control strategies to control the PTZ.
应用场景3,以应用场景A为通过云台拍摄静止物体、应用场景B为通过云台拍摄视频影像。当云台当前处于应用场景A中,云台上的云台部件可以处于第一预设姿态,上述的第一预设姿态可以有效地实现对静止物体进行拍摄,为了能够保证拍摄的质量,可以控制云台上的云台部件处于锁定状态,即使得云台上的云台部件锁定在第一预设姿态。In the application scenario 3, the application scenario A is to shoot a still object through the gimbal, and the application scenario B is to shoot a video image through the gimbal. When the gimbal is currently in the application scenario A, the gimbal components on the gimbal can be in the first preset posture. The above-mentioned first preset posture can effectively realize the shooting of stationary objects. In order to ensure the quality of shooting, you can The gimbal component on the control gimbal is in a locked state, that is, the gimbal component on the gimbal is locked in the first preset posture.
在云台由上述的应用场景A切换到应用场景B时,由于应用场景的改变可能会影响云台的控制参数与设置于云台上的负载之间的匹配程度,并且,为了能够保证视频影像的拍摄效果和质量,需要将云台上的云台部件处于第二预设姿态。When the gimbal is switched from the above application scenario A to the application scenario B, the change of the application scenario may affect the matching degree between the control parameters of the gimbal and the load set on the gimbal, and in order to ensure the video image To achieve the best shooting effect and quality, the gimbal component on the gimbal needs to be in the second preset attitude.
为了能够满足应用场景B所对应的使用需求或者拍摄需求,可以对云台进行自整定操作,在进行自整定操作之前,需要基于云台部件的检测状态来判断是否云台能否进行正常的自整定操作,进而需要对云台部件进行状态检测。具体的,通过所获取到的状态检测信号来确定云台部件的检测状态,从而便于实现在云台部件处于不同的检测状态时,可以采用不同的控制策略对云台的自整定操作进行控制,进一步保证了对云台进行自整定操作的安全可靠性。In order to meet the usage requirements or shooting requirements corresponding to application scenario B, the gimbal can be self-tuning. Before performing the self-tuning operation, it is necessary to judge whether the gimbal can perform normal self-tuning based on the detection status of the gimbal components. Tuning operation, and then need to check the status of the gimbal components. Specifically, the detection status of the pan-tilt components is determined by the acquired status detection signals, so that it is convenient to implement different control strategies to control the self-tuning operation of the pan-tilt when the pan-tilt components are in different detection states. This further ensures the safety and reliability of the self-tuning operation of the PTZ.
本实施例提供的云台的检测方法,通过所获取到的状态检测信号来确定云台部件的检测状态,其中,云台的检测状态可以包括锁定状态和未锁定状态,从而便于实现基于云台部件的不同检测状态采用不同的控制策略对云台进行控制,具体的,可以在云台部件处于锁定状态时,禁止对云台进行自整定操作,从而避免了因云台部件处于锁定状态而与其他部件发生碰撞,进而会降低稳定器的使用寿命,并容易导致控制参数与载荷不匹配,影响稳定器的增稳性能的问题,进一步保证了云台工作的稳定可靠性,提高了该方法的实用性,有利于市场的推广与应用。The detection method of the pan/tilt provided in this embodiment determines the detection state of the pan/tilt components by using the acquired state detection signal, wherein the detection state of the pan/tilt may include a locked state and an unlocked state, so as to facilitate the realization of a pan/tilt based detection state. Different detection states of the components use different control strategies to control the PTZ. Specifically, when the PTZ components are in the locked state, the self-tuning operation of the PTZ can be prohibited, thereby avoiding the possibility of conflicting with the PTZ due to the locked state of the PTZ components. Other parts collide, which will reduce the service life of the stabilizer, and easily lead to the mismatch between the control parameters and the load, which will affect the stabilization performance of the stabilizer, which further ensures the stability and reliability of the gimbal and improves the stability of the method. Practical, conducive to market promotion and application.
图4为本发明实施例提供的又一种云台的检测方法的流程示意图;在上述实施例的基础上,继续参考附图4所示,在确定云台部件处于锁定状态之后,本实施例中的方法还可以包括:Fig. 4 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention; on the basis of the above-mentioned embodiment, with continued reference to Fig. 4, after it is determined that the pan/tilt components are in a locked state, the present embodiment The methods in can also include:
步骤S401:获取与云台部件相对应的控制参数。Step S401: Acquire control parameters corresponding to the pan/tilt components.
步骤S402:基于控制参数对云台部件进行控制,以使云台部件在预设范围内进行转动,其中,预设范围用于避免云台部件在锁定状态下与锁定机构发生碰撞。Step S402: Control the pan/tilt component based on the control parameters, so that the pan/tilt component rotates within a preset range, where the preset range is used to avoid the pan/tilt component from colliding with the locking mechanism in a locked state.
其中,在确定云台部件处于锁定状态之后,为了避免云台部件与其他部件之间发生碰撞,则可以获取与云台部件相对应的控制参数,该控制参数可以包括与云台部件相对应的转动关节角度范围、角速度等等。具体的,控制参数可以存储在预设区域中,在确定云台部件处于锁定状态之后,通过访问预设区域即可获取到与云台部件相对应的控制参数。Wherein, after it is determined that the pan/tilt parts are in a locked state, in order to avoid collisions between the pan/tilt components and other components, control parameters corresponding to the pan/tilt components may be obtained, and the control parameters may include the control parameters corresponding to the pan/tilt components. Rotate the joint angle range, angular velocity, etc. Specifically, the control parameters may be stored in a preset area, and after it is determined that the pan/tilt components are in a locked state, the control parameters corresponding to the pan/tilt components may be obtained by accessing the preset area.
在获取到与云台部件相对应的控制参数之后,则可以基于控制参数对云 台部件进行控制,例如:可以基于转动关节角度范围、角速度来控制云台部件,使得云台部件可以在预设范围内进行转动,其中,预设范围与控制参数有关,例如:在控制参数包括转动关节角度范围时,预设范围即为转动关节角度范围;在控制参数包括角速度时,预设范围可以是角速度由当前值调整为0时所对应的范围。After the control parameters corresponding to the gimbal components are obtained, the gimbal components can be controlled based on the control parameters. For example, the gimbal components can be controlled based on the angle range and angular velocity of the rotating joints, so that the gimbal components can be preset at the The preset range is related to the control parameter. For example, when the control parameter includes the rotation joint angle range, the preset range is the rotation joint angle range; when the control parameter includes the angular velocity, the preset range can be the angular velocity. The range corresponding to when the current value is adjusted to 0.
本实施例中,在确定云台部件处于锁定状态之后,通过获取与云台部件相对应的控制参数,而后基于控制参数对云台部件进行控制,可以有效地控制云台部件在预设范围内进行转动,从而避免了云台部件在锁定状态下与锁定机构发生碰撞,进而保证了云台的使用寿命,提高了云台使用的安全可靠性。In this embodiment, after it is determined that the pan-tilt component is in a locked state, by acquiring control parameters corresponding to the pan-tilt component, and then controlling the pan-tilt component based on the control parameters, the pan-tilt component can be effectively controlled within a preset range. It rotates, thereby avoiding the collision between the pan/tilt components and the locking mechanism in the locked state, thereby ensuring the service life of the pan/tilt and improving the safety and reliability of the pan/tilt use.
图5为本发明实施例提供的基于状态检测信号,确定云台部件的检测状态的流程示意图;在上述实施例的基础上,继续参考附图5所示,本实施例对于确定云台部件的检测状态的具体实现方式不做限定,本领域技术人员可以根据具体的应用需求和设计需求进行设置,较为优选的,可以通过判断在激励信号的激励作用下,通过测量电机的角速度的变化情况来判断云台部件是否处于锁定状态。具体的,本实施例中的基于状态检测信号,确定云台部件的检测状态可以包括:FIG. 5 is a schematic flowchart of determining the detection state of a pan/tilt component based on a state detection signal according to an embodiment of the present invention; on the basis of the above embodiment, with continued reference to FIG. The specific implementation of the detection state is not limited, and those skilled in the art can set it according to specific application requirements and design requirements. Determine whether the gimbal part is locked. Specifically, in this embodiment, determining the detection state of the pan/tilt component based on the state detection signal may include:
步骤S501:基于状态检测信号,获得电机的角速度。Step S501: Obtain the angular velocity of the motor based on the state detection signal.
步骤S502:根据电机的角速度确定云台部件的检测状态。Step S502: Determine the detection state of the pan/tilt component according to the angular velocity of the motor.
其中,云台上设置有用于检测电机的角速度的姿态传感器,该姿态传感器可以包括角速度传感器、陀螺仪或者惯性测量单元IMU等等,本发明实施例以姿态传感器为IMU为例进行说明。在获取姿态传感器相对应的状态检测信号之后,可以基于状态检测信号读取增稳云台所获得的电机的角速度,以便基于电机的角速度来确定云台部件的检测状态。需要注意的是,所获得的电机的角速度的个数可以为一个或多个,为了能够提高对云台进行检测的准确性,角速度的数量可以为多个,例如:可以获取到位于一个信号采集周期内的多个角速度。The gimbal is provided with an attitude sensor for detecting the angular velocity of the motor. The attitude sensor may include an angular velocity sensor, a gyroscope, or an inertial measurement unit IMU, etc. The embodiment of the present invention takes the attitude sensor as an IMU as an example for description. After acquiring the state detection signal corresponding to the attitude sensor, the angular velocity of the motor obtained by the stabilization gimbal can be read based on the state detection signal, so as to determine the detection state of the gimbal component based on the angular velocity of the motor. It should be noted that the number of angular velocities of the motor obtained can be one or more. In order to improve the accuracy of the gimbal detection, the number of angular velocities can be multiple. Multiple angular velocities within a period.
另外,参考附图6所示,本实施例中的根据电机的角速度确定云台部件的检测状态可以包括:In addition, as shown in FIG. 6 , in this embodiment, determining the detection state of the pan/tilt component according to the angular velocity of the motor may include:
步骤S601:根据电机的角速度确定状态检测信号对应的信号总能量和一次谐波分量能量,信号总能量包括一次谐波分量能量。Step S601: Determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal according to the angular velocity of the motor, and the total energy of the signal includes the energy of the first harmonic component.
步骤S602:根据信号总能量和一次谐波分量能量,确定云台部件的检测状态。Step S602: Determine the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component.
其中,对于由控制器和电机所形成的线性系统而言,在理想情况下,控制器输入至电机的输入信号与电机的测量信号应为相同频率的信号。然而,在进行测量信号的过程中,往往伴有测量误差、噪声、其他额外干扰等信号,从而使得电机的测量信号中会存在其他频段的信号。Among them, for the linear system formed by the controller and the motor, ideally, the input signal input by the controller to the motor and the measurement signal of the motor should be signals of the same frequency. However, in the process of measuring the signal, there are often signals such as measurement error, noise, and other additional interference, so that there are signals in other frequency bands in the measurement signal of the motor.
通过对测量信号和输入信号进行比较可知:即使考虑到测量噪声、其他额外干扰等信号的影响,所获取到的测量信号中包括的激励频率应占绝大部分,举例来说:输入信号为10HZ的信号能量为100%的传输信号,那么,在正常情况下,获得的输出信号可以为10HZ的信号能量为90%的传输信号。By comparing the measurement signal and the input signal, it can be known that even considering the influence of measurement noise, other additional interference and other signals, the excitation frequency included in the obtained measurement signal should account for most of the excitation frequency, for example: the input signal is 10HZ The signal energy is 100% of the transmission signal, then, under normal circumstances, the obtained output signal can be a 10HZ signal energy of 90% of the transmission signal.
在云台的应用场景中可以发现:在云台部件处于未锁定状态时,由于云台部件的运动范围不会受到任何限制,此时,若针对电机的输入信号为正弦波信号,那么,针对电机所获得的测量信号也会是正弦波信号,即测量信号中的激励频率对应成分较高。在云台部件处于锁定状态时,云台部件的运动范围受到锁定机构的限制,在针对电机的输入信号为正弦波信号时,那么通过电机所获得的测量信号不再是正弦波信号,此时,在测量信号中的激励频率的对应成分下降。In the application scenario of the gimbal, it can be found that when the gimbal component is in an unlocked state, the movement range of the gimbal component will not be restricted. At this time, if the input signal to the motor is a sine wave signal, then The measurement signal obtained by the motor will also be a sine wave signal, that is, the corresponding component of the excitation frequency in the measurement signal is relatively high. When the gimbal part is in the locked state, the movement range of the gimbal part is limited by the locking mechanism. When the input signal to the motor is a sine wave signal, the measurement signal obtained by the motor is no longer a sine wave signal. , the corresponding component of the excitation frequency in the measurement signal drops.
因此,在获取到电机的角速度之后,则可以信号传输所具有的上述特征来判断云台部件的检测状态。具体的,可以对电机的角速度进行分析处理,以确定与状态检测信号相对应的信号总能量和一次谐波分量能量,可以理解的是,信号总能量中可以包括一次谐波分量能量,而一次谐波分量能量可以是指预设关注频率的信号所对应的信号能量。举例来说:信号总能量中可以包括10HZ的谐波分量能量、20HZ的谐波分量能量、30HZ的谐波分量能量等等,在预设关注频率为20HZ时,那么,20HZ的谐波分量能量即为一次谐波分量能量;在预设关注频率为30HZ时,那么,30HZ的谐波分量能量即为一次谐波分量能量。Therefore, after the angular velocity of the motor is acquired, the detection state of the pan/tilt component can be judged by the above-mentioned characteristics of signal transmission. Specifically, the angular velocity of the motor can be analyzed and processed to determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal. It can be understood that the total energy of the signal may include the energy of the first harmonic component, and the energy of the first harmonic component The harmonic component energy may refer to the signal energy corresponding to the signal of the preset frequency of interest. For example: the total energy of the signal can include the energy of harmonic components of 10HZ, the energy of harmonic components of 20HZ, the energy of harmonic components of 30HZ, etc. When the preset frequency of interest is 20HZ, then the energy of harmonic components of 20HZ That is, the energy of the first harmonic component; when the preset frequency of interest is 30HZ, then the energy of the harmonic component of 30HZ is the energy of the first harmonic component.
在一些实例中,信号总能量与角速度的数量呈负相关、与角速度的大小呈正相关。具体实现时,可以根据帕塞瓦尔定理(信号在时域的总能量等于信号在频域的总能量)中的离散时间傅里叶级数公式来确定用于计算信号总能量和一次谐波分量能量的公式。具体的,在获取到电机的角速度之后,则可以利用以下公式来获取到信号总能量:In some instances, the total signal energy is negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity. In specific implementation, the discrete-time Fourier series formula in Perseval's theorem (the total energy of the signal in the time domain is equal to the total energy of the signal in the frequency domain) can be used to determine the total energy of the signal and the first harmonic component. Energy formula. Specifically, after obtaining the angular velocity of the motor, the following formula can be used to obtain the total energy of the signal:
Figure PCTCN2020107791-appb-000001
Figure PCTCN2020107791-appb-000001
其中,J total为信号总能量,x[n]为电机的角速度,N为电机的角速度的数量。 Among them, J total is the total energy of the signal, x[n] is the angular velocity of the motor, and N is the number of the angular velocity of the motor.
为了能够通过上述公式来获得信号总能量,需要获取电机的角速度的数量N,参考附图7所示,本实施例中的方法还可以包括确定角速度的数量的具体实现过程,具体的,本实施例中的方法还可以包括:In order to obtain the total energy of the signal through the above formula, it is necessary to obtain the number N of angular velocities of the motor. Referring to FIG. 7 , the method in this embodiment may also include a specific implementation process for determining the number of angular velocities. Specifically, this implementation Examples of methods can also include:
步骤S701:获取与角速度相对应的设定频率和采样频率。Step S701: Obtain the set frequency and sampling frequency corresponding to the angular velocity.
步骤S702:根据设定频率和采样频率,确定角速度的数量。Step S702: Determine the number of angular velocities according to the set frequency and the sampling frequency.
为了能够实现对电机的角速度的采集,可以获取预先设置的与角速度相对应的设定频率和采样频率,其中,设定频率是指电机输出信号的频率,采样频率是指对电机输出信号进行采集时所对应的工作频率。在获取到设定频率和采用频率之后,可以对设定频率和采样频率进行分析处理,以确定角速度的数量,具体的,根据设定频率和采样频率,确定角速度的数量可以包括:将采样频率与设定频率的比值,确定为角速度的数量。In order to realize the acquisition of the angular velocity of the motor, the preset frequency and sampling frequency corresponding to the angular velocity can be obtained. The set frequency refers to the frequency of the motor output signal, and the sampling frequency refers to the acquisition of the motor output signal. the corresponding operating frequency. After the set frequency and the adoption frequency are obtained, the set frequency and the sampling frequency can be analyzed and processed to determine the number of angular velocities. Specifically, according to the set frequency and the sampling frequency, determining the number of angular velocities may include: The ratio to the set frequency is determined as the amount of angular velocity.
举例来说,在与电机相对应的设定频率为f为2Hz,即电机可以在每2s的时间范围内输出1个激励信号;在与电机相对应的采样频率f s为10Hz时,那么,角速度的数量即为N=f s/f=10/2=5,即需要采集电机的5个角速度信号。 For example, when the set frequency f corresponding to the motor is 2Hz, that is, the motor can output 1 excitation signal in the time range of every 2s; when the sampling frequency f s corresponding to the motor is 10Hz, then, The number of angular velocity is N=f s /f=10/2=5, that is, 5 angular velocity signals of the motor need to be collected.
本实施例中,通过获取与角速度相对应的设定频率和采样频率,而后根据设定频率和采样频率来确定角速度的数量,有效地保证了对角速度的数量进行确定的准确可靠性,进一步提高了基于角速度的数量和角速度来确定信号总能量的精确程度。In this embodiment, by obtaining the set frequency and sampling frequency corresponding to the angular velocity, and then determining the number of angular velocities according to the set frequency and sampling frequency, the accuracy and reliability of determining the number of angular velocities are effectively ensured, and the further improved How accurately the total energy of the signal can be determined based on the amount of angular velocity and the angular velocity.
在另一些实例中,一次谐波分量能量与角速度的数量呈负相关、与角速度的大小呈正相关、与角速度对应的基倍频率呈负相关。具体实现时,在获取到电机的角速度之后,则可以利用以下公式来获取到一次谐波分量能量:In other examples, the energy of the first harmonic component is negatively correlated with the amount of the angular velocity, positively correlated with the magnitude of the angular velocity, and negatively correlated with the fundamental frequency corresponding to the angular velocity. In the specific implementation, after the angular velocity of the motor is obtained, the energy of the first harmonic component can be obtained by using the following formula:
Figure PCTCN2020107791-appb-000002
Figure PCTCN2020107791-appb-000002
其中,J 1st为一次谐波分量能量,x[n]为电机的角速度,N为电机的角速度的数量,w 0为与角速度相对应的基倍频率。 Among them, J 1st is the energy of the first harmonic component, x[n] is the angular velocity of the motor, N is the number of the angular velocity of the motor, and w 0 is the fundamental frequency corresponding to the angular velocity.
为了能够通过上述公式来获得一次谐波分量能量,需要获取与角速度相对应的基倍频率w 0,参考附图8所示,本实施例中的方法还可以包括: In order to obtain the energy of the first harmonic component through the above formula, it is necessary to obtain the fundamental frequency w 0 corresponding to the angular velocity. Referring to FIG. 8 , the method in this embodiment may further include:
步骤S801:获取与角速度相对应的设定频率和采样频率。Step S801: Acquire a set frequency and a sampling frequency corresponding to the angular velocity.
步骤S802:根据设定频率和采样频率,确定基倍频率。Step S802: Determine the fundamental frequency according to the set frequency and the sampling frequency.
在获取到角速度之后,可以利用角速度与设定频率、采样频率之间的映射关系来确定与角速度相对应的设定频率和采用频率。在获取到与角速度相对应的设定频率和采样频率之后,可以对设定频率和采样频率进行分析处理,以确定基倍频率。具体的,可以利用以下公式来确定基倍频率:After the angular velocity is acquired, the set frequency and the adopted frequency corresponding to the angular velocity can be determined by using the mapping relationship between the angular velocity, the set frequency and the sampling frequency. After the set frequency and the sampling frequency corresponding to the angular velocity are obtained, the set frequency and the sampling frequency can be analyzed and processed to determine the fundamental frequency. Specifically, the fundamental frequency can be determined by the following formula:
Figure PCTCN2020107791-appb-000003
Figure PCTCN2020107791-appb-000003
其中,w 0为与角速度相对应的基倍频率,f为与电机相对应的设定频率,f s为与电机相对应的采样频率。 Among them, w 0 is the fundamental frequency corresponding to the angular velocity, f is the set frequency corresponding to the motor, and f s is the sampling frequency corresponding to the motor.
本实施例中,通过获取与角速度相对应的设定频率和采样频率,而后根据设定频率和采样频率来确定基倍频率,有效地保证了对基倍频率进行确定的准确可靠性,进一步提高了基于基倍频率和角速度来确定一次谐波分量能量。In this embodiment, by acquiring the set frequency and the sampling frequency corresponding to the angular velocity, and then determining the base frequency according to the set frequency and the sampling frequency, the accuracy and reliability of determining the base frequency can be effectively ensured, and the further improved To determine the energy of the first harmonic component based on the fundamental frequency and angular velocity.
承接上述陈述内容,在获取到信号总能量和一次谐波分量能量之后,则可以对信号总能量和一次谐波分量能量进行分析处理,以确定云台部件的检测状态。其中,参考附图9所示,一种可实现根据信号总能量和一次谐波分量能量,确定云台部件的检测状态的方式可以包括:Following the above statement, after the total energy of the signal and the energy of the first harmonic component are obtained, the total energy of the signal and the energy of the first harmonic component can be analyzed and processed to determine the detection state of the pan/tilt components. Wherein, as shown in FIG. 9 , a method that can determine the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component may include:
步骤S901:获取一次谐波分量能量相对于信号总能量的第一比例信息。Step S901: Acquire first ratio information of the energy of the first harmonic component relative to the total energy of the signal.
步骤S902:根据第一比例信息,确定云台部件的检测状态。Step S902: Determine the detection state of the pan/tilt component according to the first scale information.
在获取到一次谐波分量能量和信号总能量之后,则可以确定一次谐波分量能量相对于信号总能量的第一比例信息,而后可以对第一比例信息进行分析处理,以确定云台部件的检测状态。在一些实例中,根据第一比例信息,确定云台部件的检测状态可以包括:在第一比例信息大于或等于第一预设阈值时,则确定云台部件的检测状态为未锁定状态;或者,在第一比例信息小于第一预设阈值时,则确定云台部件的检测状态为锁定状态。After obtaining the energy of the first harmonic component and the total energy of the signal, the first proportional information of the energy of the first harmonic component relative to the total energy of the signal can be determined, and then the first proportional information can be analyzed and processed to determine the Detection status. In some instances, determining the detection state of the pan-tilt component according to the first scale information may include: when the first scale information is greater than or equal to a first preset threshold, determining that the detection state of the pan-tilt component is an unlocked state; or , when the first ratio information is smaller than the first preset threshold, it is determined that the detection state of the pan/tilt component is a locked state.
具体的,预先设置有与云台部件的检测状态相对应的第一预设阈值,该第一预设阈值可以是云台部件为锁定状态时所对应的最小比例限值,在获取到第一比例信息之后,则可以将第一比例信息与第一预设阈值进行分析比较,在第一比例信息大于或等于第一预设阈值时,则说明此时的信号总能量中,一次谐波分量能量的占比较大,进而确定云台部件的检测状态为未锁定状态。在第一比例信息小于第一预设阈值时,则说明在此时的信号总能量中,一次 谐波分量能量的占比较小,进而确定云台部件的检测状态为锁定状态。Specifically, a first preset threshold corresponding to the detection state of the gimbal component is preset, and the first preset threshold may be a minimum proportional limit value corresponding to the gimbal component in a locked state. After the first preset threshold is obtained After the ratio information, the first ratio information can be analyzed and compared with the first preset threshold. When the first ratio information is greater than or equal to the first preset threshold, it means that in the total energy of the signal at this time, the first harmonic component The proportion of energy is large, and the detection state of the gimbal component is determined to be unlocked. When the first proportion information is less than the first preset threshold, it means that in the total energy of the signal at this time, the proportion of the energy of the first harmonic component is small, and then it is determined that the detection state of the pan/tilt component is a locked state.
本实施例中,在获取到电机的角速度之后,通过电机的角速度来确定一次谐波分量能量和信号总能量,而后将一次谐波分量能量与信号总能量之间的比值来确定云台部件的检测状态,有效地实现了基于电机的角速度来确定云台部件的检测状态,进一步保证了对云台部件的检测状态进行确定的准确可靠性,有效地提高了该方法使用的稳定可靠性。In this embodiment, after the angular velocity of the motor is obtained, the energy of the first harmonic component and the total energy of the signal are determined by the angular velocity of the motor, and then the ratio between the energy of the first harmonic component and the total energy of the signal is used to determine the The detection state effectively realizes the determination of the detection state of the pan/tilt components based on the angular velocity of the motor, further ensures the accuracy and reliability of determining the detection state of the pan/tilt components, and effectively improves the stability and reliability of the method.
在上述实施例的基础上,本实施例中提供了另一种确定云台部件的检测状态的实现方式,本实施例中的方法还可以包括:On the basis of the foregoing embodiment, another implementation manner of determining the detection state of the pan/tilt component is provided in this embodiment, and the method in this embodiment may further include:
步骤1001:确定与电机的角速度相对应的直流分量能量,信号总能量包括直流分量能量。Step 1001: Determine the DC component energy corresponding to the angular velocity of the motor, and the total energy of the signal includes the DC component energy.
其中,由于信号总能量中包括直流分量能量,而直流分量能量与电机的角速度有关,因此,在获取到电机的角速度之后,可以确定与电机的角速度相对应的直流分量能量。在一些实例中,直流分量能量可以与角速度的数量呈负相关、与角速度的大小呈正相关。具体实现时,可以通过以下公式来确定与电机的角速度相对应的直流分量能量:Among them, since the total energy of the signal includes the DC component energy, and the DC component energy is related to the angular velocity of the motor, after the angular velocity of the motor is obtained, the DC component energy corresponding to the angular velocity of the motor can be determined. In some instances, the DC component energy may be negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity. In specific implementation, the DC component energy corresponding to the angular velocity of the motor can be determined by the following formula:
Figure PCTCN2020107791-appb-000004
Figure PCTCN2020107791-appb-000004
其中,J dc为与电机的角速度相对应的直流分量能量,x[n]为电机的角速度,N为电机的角速度的数量。 Among them, J dc is the DC component energy corresponding to the angular velocity of the motor, x[n] is the angular velocity of the motor, and N is the number of the angular velocity of the motor.
在获取到与电机的角速度相对应的直流分量能量之后,参考附图10所示,本实施例提供了另一种根据信号总能量和一次谐波分量能量,确定云台部件的检测状态的实现方式,具体可以包括:After the DC component energy corresponding to the angular velocity of the motor is obtained, referring to FIG. 10 , this embodiment provides another implementation of determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component. methods, which may include:
步骤S1002:将信号总能量与直流分量能量之间的差值确定为非直流总能量。Step S1002: Determine the difference between the total energy of the signal and the energy of the DC component as the total non-DC energy.
步骤S1003:根据一次谐波分量能量和非直流总能量,确定云台部件的检测状态。Step S1003: Determine the detection state of the pan/tilt component according to the energy of the first harmonic component and the total non-DC energy.
在获取到信号总能量和直流分量能量之后,则可以根据信号总能量和直流分量能量来确定非直流总能量,具体的,非直流总能量可以为信号总能量与直流分量能量之间的差值。在获取到一次谐波分量能量和非直流总能量之后,则可以根据一次谐波分量能量和非直流总能量来确定云台部件的检测状态。在一些实例中,根据一次谐波分量能量和非直流总能量,确定云台部件 的检测状态可以包括:After the total energy of the signal and the energy of the DC component are obtained, the total non-DC energy can be determined according to the total energy of the signal and the energy of the DC component. Specifically, the total non-DC energy can be the difference between the total energy of the signal and the energy of the DC component. . After the first harmonic component energy and the non-DC total energy are obtained, the detection state of the pan/tilt component can be determined according to the first harmonic component energy and the non-DC total energy. In some instances, determining the detection state of the pan/tilt component based on the first harmonic component energy and the non-DC total energy may include:
步骤S10031:获取一次谐波分量能量相对于非直流总能量的第二比例信息。Step S10031: Acquire second ratio information of the energy of the first harmonic component relative to the total non-DC energy.
步骤S10032:根据第二比例信息,确定云台部件的检测状态。Step S10032: Determine the detection state of the pan/tilt component according to the second scale information.
在获取到非直流总能量和一次谐波分量能量之后,可以获取一次谐波分量能量相对于非直流总能量的第二比例信息,而后可以对第二比例信息进行分析处理,以确定云台部件的检测状态。在一些实例中,根据第二比例信息,确定云台部件的检测状态可以包括:在第二比例信息大于或等于第二预设阈值时,则确定云台部件的检测状态为未锁定状态;或者,在第二比例信息小于第二预设阈值时,则确定云台部件的检测状态为锁定状态。After the non-DC total energy and the first harmonic component energy are obtained, the second proportional information of the first harmonic component energy relative to the non-DC total energy can be obtained, and then the second proportional information can be analyzed and processed to determine the pan/tilt components detection status. In some instances, determining the detection state of the pan-tilt component according to the second scale information may include: when the second scale information is greater than or equal to a second preset threshold, determining that the detection state of the pan-tilt component is an unlocked state; or , when the second ratio information is smaller than the second preset threshold, it is determined that the detection state of the pan/tilt component is a locked state.
具体的,预先设置有与云台部件的检测状态相对应的第二预设阈值,该第二预设阈值可以是云台部件为锁定状态时所对应的最小比例限值,在获取到第二比例信息之后,则可以将第二比例信息与第二预设阈值进行分析比较,在第二比例信息大于或等于第二预设阈值时,则说明在此时的非直流总能量中,一次谐波分量能量的占比较大,进而确定云台部件的检测状态为未锁定状态。在第二比例信息小于第二预设阈值时,则说明在此时的非直流总能量中,一次谐波分量能量的占比较小,进而确定云台部件的检测状态为锁定状态。Specifically, a second preset threshold corresponding to the detection state of the gimbal component is preset, and the second preset threshold may be a minimum proportional limit value corresponding to the gimbal component in a locked state. After the second preset threshold is obtained After the ratio information, the second ratio information can be analyzed and compared with the second preset threshold. When the second ratio information is greater than or equal to the second preset threshold, it means that in the non-DC total energy at this time, the first harmonic The proportion of wave component energy is relatively large, and the detection state of the gimbal component is determined to be an unlocked state. When the second ratio information is less than the second preset threshold, it means that in the non-DC total energy at this time, the proportion of the energy of the first harmonic component is small, and then it is determined that the detection state of the pan/tilt component is a locked state.
需要注意的是,与上述实现方式相比,与第一比例信息相对应的信号总能量中包括有直流分量能量,而由于直流分量能量是容易随着应用场景或者应用条件的变化而发生变化的,因此,在利用第一比例信息进行分析判断时,所对应的第一预设阈值可以是随着应用场景或者应用条件的变化而发生变化的。而本实施例中,与第二比例信息相对应的信号总能量中不包括直流分量能量,从而避免了因应用场景或者应用条件的变化而影响第二比例信息的大小,因此,与用于对第二比例信息进行分析处理的第二预设阈值可以是预设配置的固定值。It should be noted that, compared with the above-mentioned implementation manner, the total energy of the signal corresponding to the first ratio information includes the DC component energy, and the DC component energy is easy to change with the change of the application scene or application conditions. , therefore, when analyzing and judging by using the first ratio information, the corresponding first preset threshold may change with the change of the application scenario or the application condition. However, in this embodiment, the total energy of the signal corresponding to the second ratio information does not include the DC component energy, so as to avoid the influence of the size of the second ratio information due to changes in application scenarios or application conditions. The second preset threshold for analyzing and processing the second ratio information may be a preset configured fixed value.
本实施例中,在获取到电机的角速度之后,通过电机的角速度来确定一次谐波分量能量、信号总能量以及与电机的角速度相对应的直流分量能量,而后将一次谐波分量能量与非直流总能量之间的比值来确定云台部件的检测状态,有效地实现了基于电机的角速度来确定云台部件的检测状态,进一步保证了对云台部件的检测状态进行确定的准确可靠性,有效地提高了该方法 使用的稳定可靠性。In this embodiment, after the angular velocity of the motor is obtained, the energy of the first harmonic component, the total energy of the signal, and the energy of the DC component corresponding to the angular velocity of the motor are determined by the angular velocity of the motor, and then the energy of the first harmonic component is compared with the energy of the non-DC component. The ratio of the total energy to determine the detection state of the pan/tilt components, effectively realizes the determination of the detection state of the pan/tilt components based on the angular velocity of the motor, and further ensures the accuracy and reliability of determining the detection state of the pan/tilt components. The stability and reliability of the method are greatly improved.
图11为本发明实施例提供的根据电机的角速度确定云台部件的检测状态的流程示意图;在上述实施例的基础上,继续参考附图11所示,本实施例提供了另一种实现确定云台部件的检测状态的方式,具体的,本实施例中的根据电机的角速度确定云台部件的检测状态可以包括:FIG. 11 is a schematic flowchart of determining the detection state of the pan/tilt component according to the angular velocity of the motor according to an embodiment of the present invention; on the basis of the above embodiment, with continued reference to FIG. 11 , this embodiment provides another implementation of determining The way of detecting the state of the pan-tilt component, specifically, in this embodiment, determining the detection state of the pan-tilt component according to the angular velocity of the motor may include:
步骤S1101:根据状态检测信号所对应的波形对电机的角速度进行拟合处理,获得与电机的角速度相对应的拟合波形。Step S1101 : perform fitting processing on the angular velocity of the motor according to the waveform corresponding to the state detection signal to obtain a fitting waveform corresponding to the angular velocity of the motor.
步骤S1102:根据拟合波形和电机的角速度,确定云台部件的检测状态。Step S1102: Determine the detection state of the pan/tilt component according to the fitted waveform and the angular velocity of the motor.
其中,在获取到与电机的角速度之后,则可以根据状态检测信号所对应的波形对电机的角速度进行拟合处理,从而可以获得与电机的角速度相对应的拟合波形,一般情况下,与电机的角速度相对应的拟合波形与状态检测信号所对应的波形相一致或者近似。举例来说:在状态检测信号所对应的波形为正弦波时,在基于上述正弦波对电机的角速度进行拟合处理时,则可以获得与电机的角速度相对应的正弦波的拟合波形。在状态检测信号所对应的波形为余弦波时,在基于上述余弦波对电机的角速度进行拟合处理时,则可以获得与电机的角速度相对应的余弦波的拟合波形。Among them, after the angular velocity of the motor is obtained, the angular velocity of the motor can be fitted according to the waveform corresponding to the state detection signal, so that the fitted waveform corresponding to the angular velocity of the motor can be obtained. The fitting waveform corresponding to the angular velocity is consistent with or approximate to the waveform corresponding to the state detection signal. For example, when the waveform corresponding to the state detection signal is a sine wave, when fitting the angular velocity of the motor based on the sine wave, a fitting waveform of the sine wave corresponding to the angular velocity of the motor can be obtained. When the waveform corresponding to the state detection signal is a cosine wave, when fitting the angular velocity of the motor based on the cosine wave, a fitting waveform of the cosine wave corresponding to the angular velocity of the motor can be obtained.
在获取到拟合波形之后,则可以对拟合波形和电机的角速度进行分析处理,以确定云台部件的检测状态。具体的,根据拟合波形和电机角速度,确定云台部件的检测状态可以包括:After the fitting waveform is acquired, the fitting waveform and the angular velocity of the motor can be analyzed and processed to determine the detection state of the gimbal component. Specifically, according to the fitted waveform and the motor angular velocity, determining the detection state of the gimbal component may include:
步骤S11021:在拟合波形中,获取与角速度相对应的拟合角速度。Step S11021: In the fitting waveform, obtain the fitting angular velocity corresponding to the angular velocity.
步骤S11022:确定角速度与拟合角速度之间的角速度误差。Step S11022: Determine the angular velocity error between the angular velocity and the fitted angular velocity.
步骤S11023:根据角速度误差,确定云台部件的检测状态。Step S11023: Determine the detection state of the pan/tilt component according to the angular velocity error.
其中,对于电机的角速度而言,拟合波形中包括与电机的角速度相对应的拟合角速度,即一个电机的角速度可以对应有一个拟合角速度,而拟合角速度可以与电机的角速度相同或者不同。为了能够准确地对云台部件的状态进行检测,则可以获取角速度与拟合角速度之间的角速度误差,可以理解的是,在电机的角速度的数量为多个时,角速度误差的数量也可以为多个;在电机的角速度的数量为一个时,角速度误差的数量可以为一个。Among them, for the angular velocity of the motor, the fitted waveform includes the fitted angular velocity corresponding to the angular velocity of the motor, that is, the angular velocity of a motor can correspond to a fitted angular velocity, and the fitted angular velocity can be the same as or different from the angular velocity of the motor. . In order to accurately detect the state of the pan/tilt components, the angular velocity error between the angular velocity and the fitted angular velocity can be obtained. It can be understood that when the number of angular velocities of the motor is multiple, the number of angular velocity errors can also be Multiple; when the number of angular velocity of the motor is one, the number of angular velocity errors can be one.
在获取到角速度误差之后,则可以对角速度误差进行分析处理,以确定云台部件的检测状态。具体的,根据角速度误差,确定云台部件的检测状态可以包括:在预设数量的角速度误差小于预设误差阈值时,则确定云台部件 处于未锁定状态;或者,在预设数量的角速度误差大于或等于预设误差阈值时,则确定云台处于锁定状态。After the angular velocity error is acquired, the angular velocity error can be analyzed and processed to determine the detection state of the gimbal component. Specifically, determining the detection state of the gimbal component according to the angular velocity error may include: when a preset number of angular velocity errors is less than a preset error threshold, determining that the gimbal component is in an unlocked state; or, when a preset number of angular velocity errors are in an unlocked state; When it is greater than or equal to the preset error threshold, it is determined that the gimbal is in a locked state.
需要注意的是,电机的角速度的数量可以为一个或多个,在电机的角速度为一个时,角速度误差的数量也可以为一个;在电机的角速度为多个时,角速度误差的数量也可以为多个。在角速度误差为多个时,可以对多个角速度误差进行分析处理,以确定云台处于锁定状态。It should be noted that the number of angular velocity of the motor can be one or more. When the angular velocity of the motor is one, the number of angular velocity errors can also be one; when the angular velocity of the motor is multiple, the number of angular velocity errors can also be multiple. When there are multiple angular velocity errors, the multiple angular velocity errors can be analyzed and processed to determine that the gimbal is in a locked state.
具体的,预设数量可以是预先设置的用于确定云台部件的检测状态的最少数量限值,本实施例对于预设数量的具体数值范围不做限定,本领域技术人员可以根据具体的应用需求和设计需求进行设置,例如:预设数量可以为3个、4个、5个或者8个等等。在获取到多个角速度误差之后,可以将所有的角速度误差与预设误差阈值进行分析比较,在存在满足预设数量的角速度误差小于预设误差阈值时,则说明此时通过对电机的输出信号进行拟合所获得的波形与状态检测信号所对应的波形相似度较高,进而可以确定云台部件处于未锁定状态;在存在满足预设数量的角速度误差大于或等于预设误差阈值时,则说明此时通过对电机的输出信号进行拟合所获得的波形与状态检测信号所对应的波形相似度较低,进而确定云台处于未锁定状态。Specifically, the preset number may be a preset minimum number limit used to determine the detection state of the pan/tilt components. This embodiment does not limit the specific numerical range of the preset number, and those skilled in the art can use it according to specific applications. Requirements and design requirements to set, for example: the preset number can be 3, 4, 5 or 8 and so on. After obtaining multiple angular velocity errors, all angular velocity errors can be analyzed and compared with the preset error threshold. When there are angular velocity errors that meet the preset number and are smaller than the preset error threshold, it means that the output signal of the motor is passed through the motor at this time. The waveform obtained by the fitting has a high similarity with the waveform corresponding to the state detection signal, so that it can be determined that the gimbal component is in an unlocked state; when there is a preset number of angular velocity errors greater than or equal to the preset error threshold, then It means that the waveform obtained by fitting the output signal of the motor has a low similarity with the waveform corresponding to the state detection signal, and it is determined that the gimbal is in an unlocked state.
需要注意的是,根据角速度误差确定云台部件的检测状态的实现方式并不限于上述的实现方式,本领域技术人员还可以根据具体的应用需求和设计需求进行调整,例如:在角速度误差的数量为多个时,则可以获取多个角速度误差所对应的平均角速度误差,而后基于平均角速度误差与预设误差阈值进行分析比较,在平均角速度误差大于或等于预设误差阈值时,则可以确定云台的检测状态为未锁定状态;在平均角速度误差小于预设误差阈值时,则可以确定云台的检测状态为锁定状态,同样实现了对云台部件的检测状态进行确定的准确可靠性,进一步提高了该方法使用的灵活可靠性。It should be noted that the implementation of determining the detection state of the gimbal component according to the angular velocity error is not limited to the above-mentioned implementation. Those skilled in the art can also adjust according to specific application requirements and design requirements, for example: the number of angular velocity errors When there are more than one, the average angular velocity error corresponding to the multiple angular velocity errors can be obtained, and then based on the average angular velocity error and the preset error threshold for analysis and comparison, when the average angular velocity error is greater than or equal to the preset error threshold, the cloud can be determined. The detection state of the gimbal is an unlocked state; when the average angular velocity error is less than the preset error threshold, the detection state of the gimbal can be determined to be a locked state, which also achieves the accuracy and reliability of determining the detection state of the gimbal components, and further The flexibility and reliability of the method are improved.
具体应用时,本应用实施例提供了一种云台的检测方法,该云台包括云台轴臂、设置于云台轴臂上的稳定器、用于驱动云台轴臂进行转动的电机,其中,云台轴臂的数量可以为一个或多个,相对应的,稳定器和电机的数量也可以为一个或多个。为了便于理解本实施例中方法的实现过程,首先对该方法的实现原理进行说明:In a specific application, this application embodiment provides a method for detecting a pan/tilt head. The pan/tilt head includes a pan/tilt shaft arm, a stabilizer arranged on the pan/tilt shaft arm, and a motor for driving the pan/tilt shaft arm to rotate. Wherein, the number of the gimbal shaft arms may be one or more, and correspondingly, the number of stabilizers and motors may also be one or more. In order to facilitate the understanding of the implementation process of the method in this embodiment, the implementation principle of the method is first described:
对于稳定器所在的任意一个云台轴臂而言,在对云台进行参数自整定操作时,可以根据自整定请求生成激励信号,而后使得电机根据激励信号输出 力矩,其中,激励信号可以为某一预设频率的正弦波,那么,通过惯性测量单元所测量的电机的输出信号也应该是对应预设频率的正弦波,即使考虑到测量噪声、误差等的影响,在所测量的输出信号中,激励频率应占全部信号的绝大部分。For any gimbal shaft arm where the stabilizer is located, when performing parameter self-tuning operation on the gimbal, an excitation signal can be generated according to the self-tuning request, and then the motor can output torque according to the excitation signal, where the excitation signal can be a certain A sine wave with a preset frequency, then the output signal of the motor measured by the inertial measurement unit should also be a sine wave corresponding to the preset frequency. Even considering the influence of measurement noise, errors, etc., in the measured output signal , the excitation frequency should account for the vast majority of the entire signal.
而由于云台轴臂可以具有不同的状态,在云台轴臂处于锁定状态时,云台轴臂和稳定器的运动范围受到锁定机构的限制,此时,IMU所测量的信号不再是正弦波,在测量信号中,激励频率对应的成分比重下降。在云台轴臂处于未锁定状态时,云台轴臂和稳定器的运动范围不会受到锁定机构的限制,此时,IMU所测量的信号是正弦波,在测量信号中,激励频率对应的成分比重占绝大部分。基于上述信号特征与云台轴臂的状态之间的关系,可以根据激励频率对应成分的比重来判断云台轴臂是否处于锁定状态。具体的,该方法可以包括:Since the gimbal shaft arm can have different states, when the gimbal shaft arm is in the locked state, the movement range of the gimbal shaft arm and the stabilizer is limited by the locking mechanism. At this time, the signal measured by the IMU is no longer sinusoidal Wave, in the measurement signal, the proportion of the component corresponding to the excitation frequency decreases. When the gimbal shaft arm is in an unlocked state, the movement range of the gimbal shaft arm and the stabilizer will not be restricted by the locking mechanism. At this time, the signal measured by the IMU is a sine wave. In the measurement signal, the excitation frequency corresponds to The proportion of ingredients accounts for the vast majority. Based on the relationship between the above signal characteristics and the state of the gimbal shaft arm, it can be determined whether the gimbal shaft arm is in the locked state according to the proportion of the component corresponding to the excitation frequency. Specifically, the method may include:
步骤1:获取用于实现对云台进行自整定操作的自整定请求;Step 1: Obtain the self-tuning request for realizing the self-tuning operation of the gimbal;
步骤2:根据自整定请求生成状态检测信号;Step 2: Generate a status detection signal according to the self-tuning request;
步骤3:根据状态检测信号、通过设置于云台上的IMU获取电机的角速度;Step 3: Obtain the angular velocity of the motor through the IMU set on the gimbal according to the state detection signal;
步骤4:获取与角速度相对应的设定频率和采样频率,根据设定频率和采样频率确定基倍频率和角速度的数量。Step 4: Obtain the set frequency and sampling frequency corresponding to the angular velocity, and determine the fundamental frequency and the number of angular velocities according to the set frequency and sampling frequency.
具体的,可以利用以下公式来确定基倍频率:Specifically, the fundamental frequency can be determined by the following formula:
Figure PCTCN2020107791-appb-000005
Figure PCTCN2020107791-appb-000005
其中,w 0为与角速度相对应的基倍频率,f为与电机相对应的设定频率,f s为与电机相对应的采样频率。 Among them, w 0 is the fundamental frequency corresponding to the angular velocity, f is the set frequency corresponding to the motor, and f s is the sampling frequency corresponding to the motor.
而角速度的数量可以为N=f s/f,其中,N为角速度的数量,f为与电机相对应的设定频率,f s为与电机相对应的采样频率。 The number of angular velocities may be N=f s /f, where N is the number of angular velocities, f is the set frequency corresponding to the motor, and f s is the sampling frequency corresponding to the motor.
步骤5:根据角速度和角速度的数量获取信号总能量和直流分量能量,具体的,可以通过以下公式获得信号总能量:Step 5: Obtain the total energy of the signal and the energy of the DC component according to the angular velocity and the quantity of the angular velocity. Specifically, the total energy of the signal can be obtained by the following formula:
Figure PCTCN2020107791-appb-000006
Figure PCTCN2020107791-appb-000006
其中,J total为信号总能量,x[n]为电机的角速度,N为电机的角速度的数量。 Among them, J total is the total energy of the signal, x[n] is the angular velocity of the motor, and N is the number of the angular velocity of the motor.
通过以下公式获得直流分量能量:The DC component energy is obtained by the following formula:
Figure PCTCN2020107791-appb-000007
Figure PCTCN2020107791-appb-000007
其中,J dc为与电机的角速度相对应的直流分量能量,x[n]为电机的角速度,N为电机的角速度的数量。 Among them, J dc is the DC component energy corresponding to the angular velocity of the motor, x[n] is the angular velocity of the motor, and N is the number of the angular velocity of the motor.
步骤6:根据角速度、角速度的数量以及基倍频率获取一次谐波分量能量,具体的,可以通过以下公式获得:Step 6: Obtain the energy of the first harmonic component according to the angular velocity, the quantity of the angular velocity and the fundamental frequency. Specifically, it can be obtained by the following formula:
Figure PCTCN2020107791-appb-000008
Figure PCTCN2020107791-appb-000008
其中,J 1st为一次谐波分量能量,x[n]为电机的角速度,N为电机的角速度的数量,w 0为与角速度相对应的基倍频率。 Among them, J 1st is the energy of the first harmonic component, x[n] is the angular velocity of the motor, N is the number of the angular velocity of the motor, and w 0 is the fundamental frequency corresponding to the angular velocity.
步骤7:根据一次谐波分量能量、信号总能量和直流分量能量确定一次谐波分量能量占非直流总能量的比重:即Step 7: Determine the proportion of the energy of the first harmonic component to the total non-DC energy according to the energy of the first harmonic component, the total energy of the signal and the energy of the DC component: namely
Figure PCTCN2020107791-appb-000009
Figure PCTCN2020107791-appb-000009
步骤8:根据一次谐波分量能量占非直流总能量的比重判断云台轴臂是否处于锁定状态。Step 8: According to the proportion of the energy of the first harmonic component to the total non-DC energy, determine whether the pivot arm of the gimbal is in a locked state.
具体的,在一次谐波分量能量占非直流总能量的比重大于预设阈值时,如图12所示,假设一次谐波分量能量站非直流总能量的78%,而预设阈值为60%,那么,则确定云台轴臂处于锁定状态;在一次谐波分量能量占非直流总能量的比重小于或等于预设阈值时,如图13所示,假设一次谐波分量能量站非直流总能量的47%,而预设阈值为60%,那么,则确定云台轴臂处于未锁定状态。Specifically, when the proportion of the energy of the first harmonic component in the total non-DC energy is greater than the preset threshold, as shown in FIG. 12 , it is assumed that the energy of the first harmonic component accounts for 78% of the total non-DC energy, and the preset threshold is 60% , then it is determined that the gimbal shaft arm is in the locked state; when the proportion of the energy of the first harmonic component to the total non-DC energy is less than or equal to the preset threshold, as shown in Figure 13, it is assumed that the energy of the first harmonic component of the non-DC total energy station 47% of the energy, and the preset threshold is 60%, then it is determined that the gimbal arm is in an unlocked state.
步骤9:根据云台轴臂的检测状态判断是否对云台进行自整定操作。Step 9: Determine whether to perform self-tuning operation on the gimbal according to the detection state of the gimbal shaft arm.
具体的,在云台轴臂处于锁定状态时,则停止对云台进行自整定操作;在云台轴臂处于未锁定状态时,则基于自整定请求对云台进行自整定操作。Specifically, when the pivot arm of the gimbal is in a locked state, the self-tuning operation of the gimbal is stopped; when the pivot arm of the gimbal is in an unlocked state, the self-tuning operation of the gimbal is performed based on the self-tuning request.
本应用实施例提供的云台的检测方法,可以有效地实现在对云台进行控制参数自整定操作的过程中,通过IMU所测量得到的电机的角速度的变化情况来判断云台轴臂在激励信号的激励下是否处于锁定状态,以避免对稳定器和载荷的损害,在确定云台轴臂的状态之后,可以基于不同的检测状态对自整定操作进行控制,从而避免了因云台轴臂处于锁定状态而与其他部件发生碰撞,进而会降低稳定器的使用寿命,并对用户载荷的安全造成影响、导致控制参数与载荷不匹配,影响稳定器的增稳性能的问题,进一步保证了云台工 作的稳定可靠性,提高了该方法的实用性,有利于市场的推广与应用。The gimbal detection method provided in this application example can effectively realize that during the self-tuning operation of the control parameters of the gimbal, it can be judged that the shaft arm of the gimbal is excited by the change of the angular velocity of the motor measured by the IMU. Whether it is in a locked state under the excitation of the signal to avoid damage to the stabilizer and the load, after determining the state of the gimbal shaft arm, the self-tuning operation can be controlled based on different detection states, thus avoiding the problem of the gimbal shaft arm. In the locked state, it collides with other components, which will reduce the service life of the stabilizer, affect the safety of the user's load, cause the control parameters to not match the load, and affect the stabilization performance of the stabilizer, which further ensures the cloud The stability and reliability of the table work are improved, the practicability of the method is improved, and it is beneficial to the promotion and application of the market.
图14为本发明实施例提供的另一种云台的检测方法的流程示意图;参考附图14所示,本实施例提供了另一种云台的检测方法,该云台可以包括云台部件、用于驱动云台部件转动的电机以及用于锁定云台部件的锁定机构。其中,在不同的应用场景中,云台部件可以用于表征云台上的不同结构,例如:对于三轴云台而言,云台部件可以包括以下至少之一:位于两个电机之间的第一支架、与第一支架活动连接的第二支架、与第二支架活动连接的第三支架(用于支撑负载)、基座或者手柄等等。具体的,云台上包括的云台部件的个数可以为一个或多个,本实施例中的检测方法可以获取任意一个或多个云台部件的检测状态。FIG. 14 is a schematic flowchart of another pan/tilt detection method provided by an embodiment of the present invention; with reference to FIG. 14 , the present embodiment provides another pan/tilt detection method, and the pan/tilt may include pan/tilt components , a motor for driving the rotation of the pan-tilt parts and a locking mechanism for locking the pan-tilt parts. Wherein, in different application scenarios, the pan/tilt components can be used to represent different structures on the pan/tilt. For example, for a three-axis pan/tilt, the pan/tilt components may include at least one of the following: A first bracket, a second bracket movably connected to the first bracket, a third bracket movably connected to the second bracket (for supporting a load), a base or a handle, and the like. Specifically, the number of pan/tilt components included on the pan/tilt may be one or more, and the detection method in this embodiment may acquire the detection status of any one or more pan/tilt components.
另外,该方法的执行主体可以为云台的检测装置,可以理解的是,该云台的检测装置可以实现为软件、或者软件和硬件的组合,具体应用时,云台的检测装置可以实现为一增稳云台。具体的,该云台的检测方法可以包括:In addition, the execution body of the method may be the detection device of the pan/tilt. It can be understood that the detection device of the pan/tilt may be implemented as software or a combination of software and hardware. In specific applications, the detection device of the pan/tilt may be implemented as One to stabilize the gimbal. Specifically, the detection method of the PTZ may include:
步骤S1401:获取用于实现对云台进行自整定操作的自整定请求。Step S1401: Obtain a self-tuning request for implementing the self-tuning operation on the PTZ.
步骤S1402:基于云台部件的状态,确定是否对云台进行自整定操作。Step S1402: Based on the state of the pan/tilt components, determine whether to perform a self-tuning operation on the pan/tilt.
步骤S1403:在云台部件处于锁定状态时,停止对云台进行自整定操作。Step S1403: When the pan/tilt component is in a locked state, stop the self-tuning operation on the pan/tilt.
其中,自整定请求用于实现对云台的控制参数(包括以下至少之一:云台上电机的力度信息、对负载位姿的响应速度、云台上滤波器的配置参数)进行自整定操作,即以云台的控制参数进行阶跃扰动实验,根据云台的运行状态计算出整定参数值的操作。Among them, the self-tuning request is used to realize the self-tuning operation of the control parameters of the gimbal (including at least one of the following: the force information of the motor on the gimbal, the response speed to the load pose, and the configuration parameters of the filter on the gimbal). , that is, the step disturbance experiment is performed with the control parameters of the gimbal, and the operation of setting the parameter value is calculated according to the running state of the gimbal.
另外,自整定请求可以是根据用户对增稳云台输入执行操作所生成的,在获取到自整定请求之后,可以基于自整定请求对云台进行自整定操作,在对云台进行自整定操作的过程中或者在对云台进行自整定操作之前,可以基于云台部件的状态确定是否对云台进行自整定操作。其中,云台部件的状态可以包括锁定状态和未锁定状态,具体的,在云台部件处于锁定状态时,可以停止对云台进行自整定操作,在云台部件处于未锁定状态时,则可以继续对云台进行自整定操作。此外,本实施例中检测云台部件的状态的具体实现方式与上述实施例中的获取云台部件的检测状态的具体实现方式相类似,具体可参考上述陈述内容,在此不再赘述。In addition, the self-tuning request can be generated according to the user's operation on the stabilization gimbal. After the self-tuning request is obtained, the gimbal can be self-tuned based on the self-tuning request. After the self-tuning operation is performed on the gimbal During the process or before performing the self-tuning operation on the PTZ, it can be determined whether to perform the self-tuning operation on the PTZ based on the status of the PTZ components. The state of the gimbal part may include a locked state and an unlocked state. Specifically, when the gimbal part is in a locked state, the self-tuning operation of the gimbal can be stopped, and when the gimbal part is in an unlocked state, it can be Continue to auto-tune the gimbal. In addition, the specific implementation manner of detecting the state of the pan/tilt component in this embodiment is similar to the specific implementation manner of acquiring the detection state of the pan/tilt component in the above-mentioned embodiment. For details, reference may be made to the above statement, which will not be repeated here.
在获取到云台部件处于锁定状态时,为了避免在云台部件处于锁定状态时,云台无法进行正常的自整定操作、以及云台部件与其他部件发生碰撞的 情况出现,则可以停止对云台进行自整定操作。在一些实例中,在停止对云台进行自整定操作之后,为了让用户及时了解到云台的自整定操作的状态,可以显示用于标识停止对云台进行自整定操作的标识信息。When it is obtained that the gimbal parts are in the locked state, in order to avoid the situation that the gimbal cannot perform normal self-tuning operations and the gimbal parts collide with other parts when the gimbal parts are in the locked state, you can stop the cloud The station performs self-tuning operation. In some instances, after the self-tuning operation of the gimbal is stopped, in order to let the user know the status of the self-tuning operation of the gimbal in time, identification information for identifying the stop of the self-tuning operation of the gimbal may be displayed.
本实施例提供的云台的检测方法,通过获取用于实现对云台进行自整定操作的自整定请求,基于所述云台部件的状态来确定是否对所述云台进行所述自整定操作;具体的,在所述云台部件处于锁定状态时,停止对所述云台进行所述自整定操作,可以有效地避免在云台部件处于锁定状态时,无法进行正常的自整定操作的情况,同时也避免了云台部件与其他部件发生碰撞,从而可以保证并提高了云台的使用寿命,进一步提高了该方法使用的稳定可靠性,有利于市场的推广与应用。The method for detecting a pan/tilt provided by this embodiment determines whether to perform the self-tuning operation on the pan/tilt based on the state of the pan/tilt components by acquiring a self-tuning request for performing the self-tuning operation on the pan/tilt. ; Specifically, when the pan/tilt components are in a locked state, the self-tuning operation on the pan/tilt is stopped, which can effectively avoid the situation that normal self-tuning operations cannot be performed when the pan/tilt components are in a locked state. At the same time, it also avoids the collision between the pan/tilt parts and other components, thereby ensuring and improving the service life of the pan/tilt, further improving the stability and reliability of the method, which is beneficial to market promotion and application.
图15为本发明实施例提供的一种增稳云台的流程示意图;参考附图15所示,本实施例提供了一种增稳云台,其中,增稳云台包括云台部件、用于驱动云台部件转动的电机以及用于锁定云台部件的锁定机构,本实施例中的增稳云台可以执行上述图2所示的云台的检测方法,具体的,该增稳云台包括:FIG. 15 is a schematic flowchart of a stabilization pan/tilt provided by an embodiment of the present invention; with reference to FIG. 15 , the present embodiment provides a stabilization pan/tilt, wherein the stabilization pan/tilt includes pan/tilt components, a Due to the motor for driving the rotation of the pan/tilt components and the locking mechanism for locking the pan/tilt components, the stabilization pan/tilt in this embodiment can perform the detection method of the pan/tilt shown in FIG. 2 above. Specifically, the stabilization pan/tilt include:
云台部件12,用于机械耦合连接拍摄装置13;The pan/tilt part 12 is used for mechanically coupling and connecting the photographing device 13;
电机14,用于驱动云台部件12转动,以调整拍摄装置13的姿态,从而对拍摄装置13进行增稳;The motor 14 is used to drive the pan/tilt component 12 to rotate to adjust the posture of the photographing device 13, thereby enhancing the stability of the photographing device 13;
控制器11,与电机14电连接,用于控制电机14;The controller 11 is electrically connected to the motor 14 for controlling the motor 14;
姿态传感器15,与控制器通信连接,用于感测云台部件12的姿态信息,The attitude sensor 15 is connected in communication with the controller, and is used for sensing the attitude information of the PTZ component 12,
其中,控制器获取与姿态传感器15相对应的状态检测信号,并根据状态检测信号确定云台部件12的检测状态,检测状态包括锁定状态和未锁定状态。Wherein, the controller acquires the state detection signal corresponding to the attitude sensor 15, and determines the detection state of the pan/tilt component 12 according to the state detection signal, and the detection state includes a locked state and an unlocked state.
在一些实例中,在获取姿态传感器15相对应的状态检测信号时,控制器11用于:获取用于实现对云台进行自整定操作的自整定请求;根据自整定请求确定状态检测信号。In some instances, when acquiring the state detection signal corresponding to the attitude sensor 15 , the controller 11 is configured to: acquire a self-tuning request for implementing the self-tuning operation on the gimbal; and determine the state detection signal according to the self-tuning request.
在一些实例中,状态检测信号所对应的波形包括以下至少之一:正弦波、余弦波、方波、三角波。In some examples, the waveform corresponding to the state detection signal includes at least one of the following: sine wave, cosine wave, square wave, and triangle wave.
在一些实例中,在基于状态检测信号确定云台的检测状态之后,控制器11还用于:在确定云台部件12处于未锁定状态时,则继续基于自整定请求对云台进行自整定操作;或者,在确定云台部件12处于锁定状态时,则停止基于自整定请求对云台进行自整定操作。In some instances, after determining the detection state of the gimbal based on the state detection signal, the controller 11 is further configured to: when it is determined that the gimbal component 12 is in an unlocked state, continue to perform the self-tuning operation on the gimbal based on the self-tuning request or, when it is determined that the pan/tilt component 12 is in a locked state, the self-tuning operation of the pan/tilt based on the self-tuning request is stopped.
在一些实例中,在确定云台部件12处于锁定状态之后,控制器11还用于: 获取与云台部件12相对应的控制参数;基于控制参数对云台部件12进行控制,以使云台部件12在预设范围内进行转动,其中,预设范围用于避免云台部件12在锁定状态下与锁定机构发生碰撞。In some instances, after determining that the pan-tilt part 12 is in a locked state, the controller 11 is further configured to: acquire control parameters corresponding to the pan-tilt part 12; control the pan-tilt part 12 based on the control parameters, so that the pan-tilt The part 12 rotates within a preset range, wherein the preset range is used to avoid collision between the pan/tilt part 12 and the locking mechanism in a locked state.
在一些实例中,在基于状态检测信号确定云台的检测状态之后,控制器11还用于:在确定云台部件12处于锁定状态时,输出用于提示云台部件12处于锁定状态的信息。In some instances, after determining the detection state of the pan/tilt based on the state detection signal, the controller 11 is further configured to: when it is determined that the pan/tilt component 12 is in the locked state, output information for prompting the pan/tilt component 12 to be in the locked state.
在一些实例中,检测状态的检测时长小于自整定操作的整定时长。In some instances, the detection duration of the detection state is less than the set duration of the auto-tuning operation.
在一些实例中,在基于状态检测信号,确定云台部件12的检测状态时,控制器11用于:基于状态检测信号,获得电机14的角速度;根据电机14的角速度确定云台部件12的检测状态。In some instances, when determining the detection state of the pan/tilt unit 12 based on the state detection signal, the controller 11 is configured to: obtain the angular velocity of the motor 14 based on the state detection signal; determine the detection state of the pan/tilt unit 12 according to the angular velocity of the motor 14 state.
在一些实例中,在根据电机14的角速度确定云台部件12的检测状态时,控制器11用于:根据电机14的角速度确定状态检测信号对应的信号总能量和一次谐波分量能量,信号总能量包括一次谐波分量能量;根据信号总能量和一次谐波分量能量,确定云台部件12的检测状态。In some instances, when determining the detection state of the pan/tilt head component 12 according to the angular velocity of the motor 14, the controller 11 is configured to: determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal according to the angular velocity of the motor 14, and the total energy of the signal The energy includes the energy of the first harmonic component; according to the total energy of the signal and the energy of the first harmonic component, the detection state of the pan/tilt component 12 is determined.
在一些实例中,信号总能量与角速度的数量呈负相关、与角速度的大小呈正相关。In some instances, the total signal energy is negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity.
在一些实例中,一次谐波分量能量与角速度的数量呈负相关、与角速度的大小呈正相关、与角速度对应的基倍频率呈负相关。In some instances, the energy of the first harmonic component is negatively correlated with the amount of angular velocity, positively correlated with the magnitude of the angular velocity, and negatively correlated with the fundamental frequency corresponding to the angular velocity.
在一些实例中,控制器11还用于:获取与角速度相对应的设定频率和采样频率;根据设定频率和采样频率,确定基倍频率。In some instances, the controller 11 is further configured to: acquire the set frequency and the sampling frequency corresponding to the angular velocity; and determine the fundamental frequency according to the set frequency and the sampling frequency.
在一些实例中,角速度的数量为多个。In some instances, the number of angular velocities is multiple.
在一些实例中,控制器11还用于:获取与角速度相对应的设定频率和采样频率;根据设定频率和采样频率,确定角速度的数量。In some instances, the controller 11 is further configured to: acquire the set frequency and the sampling frequency corresponding to the angular velocity; and determine the quantity of the angular velocity according to the set frequency and the sampling frequency.
在一些实例中,在根据设定频率和采样频率,确定角速度的数量时,控制器11还用于:将采样频率与设定频率的比值,确定为角速度的数量。In some instances, when determining the number of angular velocities according to the set frequency and the sampling frequency, the controller 11 is further configured to: determine the ratio of the sampling frequency to the set frequency as the number of angular velocities.
在一些实例中,在根据信号总能量和一次谐波分量能量,确定云台部件12的检测状态时,控制器11还用于:获取一次谐波分量能量相对于信号总能量的第一比例信息;根据第一比例信息,确定云台部件12的检测状态。In some instances, when determining the detection state of the pan/tilt component 12 according to the total energy of the signal and the energy of the first harmonic component, the controller 11 is further configured to: obtain first proportional information of the energy of the first harmonic component relative to the total energy of the signal ; According to the first scale information, the detection state of the pan/tilt component 12 is determined.
在一些实例中,在根据第一比例信息,确定云台部件12的检测状态时,控制器11还用于:在第一比例信息大于或等于第一预设阈值时,则确定云台部件12的检测状态为未锁定状态;或者,在第一比例信息小于第一预设阈值 时,则确定云台部件12的检测状态为锁定状态。In some instances, when determining the detection state of the pan/tilt unit 12 according to the first scale information, the controller 11 is further configured to: when the first scale information is greater than or equal to a first preset threshold, determine the pan/tilt unit 12 The detection state of the PTZ is an unlocked state; or, when the first ratio information is less than the first preset threshold, it is determined that the detection state of the pan/tilt component 12 is a locked state.
在一些实例中,控制器11还用于:确定与电机14的角速度相对应的直流分量能量,信号总能量包括直流分量能量;根据信号总能量和一次谐波分量能量,确定云台部件12的检测状态,包括:将信号总能量与直流分量能量之间的差值确定为非直流总能量;根据一次谐波分量能量和非直流总能量,确定云台部件12的检测状态。In some instances, the controller 11 is further configured to: determine the DC component energy corresponding to the angular velocity of the motor 14, and the total signal energy includes the DC component energy; The detection state includes: determining the difference between the signal total energy and the DC component energy as the non-DC total energy; determining the detection state of the pan/tilt component 12 according to the first harmonic component energy and the non-DC total energy.
在一些实例中,直流分量能量与角速度的数量呈负相关、与角速度的大小呈正相关。In some instances, the DC component energy is negatively correlated with the amount of angular velocity and positively correlated with the magnitude of the angular velocity.
在一些实例中,在根据一次谐波分量能量和非直流总能量,确定云台部件12的检测状态时,控制器11还用于:获取一次谐波分量能量相对于非直流总能量的第二比例信息;根据第二比例信息,确定云台部件12的检测状态。In some instances, when determining the detection state of the pan/tilt component 12 according to the energy of the first harmonic component and the total non-DC energy, the controller 11 is further configured to: obtain a second value of the energy of the first harmonic component relative to the total non-DC energy. Scale information; according to the second scale information, determine the detection state of the pan/tilt component 12 .
在一些实例中,在根据第二比例信息,确定云台部件12的检测状态时,控制器11还用于:在第二比例信息大于或等于第二预设阈值时,则确定云台部件12的检测状态为未锁定状态;或者,在第二比例信息小于第二预设阈值时,则确定云台部件12的检测状态为锁定状态。In some instances, when determining the detection state of the pan-tilt component 12 according to the second scale information, the controller 11 is further configured to: when the second scale information is greater than or equal to the second preset threshold, determine the pan-tilt component 12 The detection state of 12 is an unlocked state; or, when the second ratio information is less than the second preset threshold, it is determined that the detection state of the pan/tilt component 12 is a locked state.
在一些实例中,在根据电机14的角速度确定云台部件12的检测状态时,控制器11还用于:根据状态检测信号所对应的波形对电机14的角速度进行拟合处理,获得与电机14的角速度相对应的拟合波形;根据拟合波形和电机14的角速度,确定云台部件12的检测状态。In some instances, when determining the detection state of the gimbal component 12 according to the angular velocity of the motor 14, the controller 11 is further configured to: perform a fitting process on the angular velocity of the motor 14 according to the waveform corresponding to the state detection signal, and obtain a correlation with the motor 14. The fitting waveform corresponding to the angular velocity of ; according to the fitting waveform and the angular velocity of the motor 14 , the detection state of the pan/tilt component 12 is determined.
在一些实例中,在根据拟合波形和电机14角速度,确定云台部件12的检测状态时,控制器11还用于:在拟合波形中,获取与角速度相对应的拟合角速度;确定角速度与拟合角速度之间的角速度误差;根据角速度误差,确定云台部件12的检测状态。In some instances, when determining the detection state of the gimbal component 12 according to the fitting waveform and the angular velocity of the motor 14, the controller 11 is further configured to: obtain a fitting angular velocity corresponding to the angular velocity in the fitting waveform; determine the angular velocity The angular velocity error between the fitting angular velocity and the fitting angular velocity; according to the angular velocity error, the detection state of the gimbal component 12 is determined.
在一些实例中,在根据角速度误差,确定云台部件12的检测状态时,控制器11还用于:在预设数量的角速度误差小于预设误差阈值时,则确定云台部件12处于未锁定状态;或者,在预设数量的角速度误差大于或等于预设误差阈值时,则确定云台处于锁定状态。In some instances, when determining the detection state of the pan-tilt unit 12 according to the angular velocity error, the controller 11 is further configured to: when a preset number of angular velocity errors are smaller than a preset error threshold, determine that the pan-tilt unit 12 is unlocked state; or, when the preset number of angular velocity errors is greater than or equal to a preset error threshold, it is determined that the gimbal is in a locked state.
在一些实例中,云台为处于折叠状态的云台或者处于回中状态的云台。In some instances, the gimbal is a gimbal in a folded state or a gimbal in a centered state.
在一些实例中,在云台处于折叠状态时,云台的至少两个云台部件12所对应的位置之间存在重叠;在云台处于回中状态时,云台的云台部件12之间处于正交位置。In some instances, when the gimbal is in the folded state, there is overlap between the positions corresponding to at least two gimbal parts 12 of the gimbal; in an orthogonal position.
图15所示装置可以执行图1-图13所示实施例的方法,本实施例未详细描述的部分,可参考对图1-图13所示实施例的相关说明。该技术方案的执行过程和技术效果参见图1-图13所示实施例中的描述,在此不再赘述。The apparatus shown in FIG. 15 may execute the method of the embodiment shown in FIG. 1 to FIG. 13 . For parts not described in detail in this embodiment, reference may be made to the related description of the embodiment shown in FIG. 1 to FIG. 13 . For the execution process and technical effects of the technical solution, refer to the descriptions in the embodiments shown in FIG. 1 to FIG. 13 , which will not be repeated here.
图16为本发明实施例提供的另一种增稳云台的流程示意图;参考附图16所示,本实施例提供了另一种增稳云台,其中,云台包括云台部件、用于驱动云台部件转动的电机以及用于锁定云台部件的锁定机构,本实施例中的增稳云台可以执行上述图14所示的云台的检测方法,具体的,该增稳云台包括:FIG. 16 is a schematic flowchart of another stabilization pan/tilt provided by an embodiment of the present invention; with reference to FIG. 16 , the present embodiment provides another stabilization pan/tilt, wherein the pan/tilt includes pan/tilt components, a Due to the motor for driving the rotation of the pan/tilt components and the locking mechanism for locking the pan/tilt components, the stabilization pan/tilt in this embodiment can perform the detection method of the pan/tilt shown in FIG. 14 above. Specifically, the stabilization pan/tilt include:
云台部件22,用于机械耦合连接拍摄装置23;The pan/tilt part 22 is used for mechanically coupling and connecting the photographing device 23;
电机24,用于驱动云台部件22转动,以调整拍摄装置23的姿态,从而对拍摄装置23进行增稳;The motor 24 is used to drive the rotation of the pan/tilt part 22 to adjust the posture of the photographing device 23, thereby enhancing the stability of the photographing device 23;
控制器21,与电机24电连接,用于控制电机24;The controller 21 is electrically connected to the motor 24 for controlling the motor 24;
姿态传感器25,与控制器21通信连接,用于感测云台部件22的姿态信息,The attitude sensor 25, connected in communication with the controller 21, is used for sensing the attitude information of the PTZ component 22,
其中,控制器21获取用于实现对云台进行自整定操作的自整定请求;基于云台部件22的状态,确定是否对云台进行自整定操作;在云台部件22处于锁定状态时,停止对云台进行自整定操作。Wherein, the controller 21 obtains a self-tuning request for realizing the self-tuning operation on the pan/tilt; based on the state of the pan/tilt component 22, determines whether to perform the auto-tuning operation on the pan/tilt; when the pan/tilt component 22 is in a locked state, stops Perform self-tuning operation on the PTZ.
图15所示装置可以执行图14所示实施例的方法,本实施例未详细描述的部分,可参考对图14所示实施例的相关说明。该技术方案的执行过程和技术效果参见图14所示实施例中的描述,在此不再赘述。The apparatus shown in FIG. 15 may execute the method of the embodiment shown in FIG. 14 . For the parts not described in detail in this embodiment, reference may be made to the related description of the embodiment shown in FIG. 14 . For the execution process and technical effect of the technical solution, refer to the description in the embodiment shown in FIG. 14 , which will not be repeated here.
图17为本发明实施例提供的一种可移动平台的结构示意图;参考附图17所示,本实施例提供了一种可移动平台,其中,可移动平台可以包括但不限于无人机、无人船、无人车、可移动机器人等等。具体的,该可移动平台可以包括:Fig. 17 is a schematic structural diagram of a movable platform provided by an embodiment of the present invention; with reference to Fig. 17, this embodiment provides a movable platform, wherein the movable platform may include but not limited to unmanned aerial vehicles, Unmanned ships, unmanned vehicles, mobile robots, etc. Specifically, the movable platform may include:
上述图15所示的增稳云台32;The stabilization gimbal 32 shown in Figure 15 above;
支撑件31,与增稳云台32机械耦合连接,用于支撑增稳云台32。The support member 31 is mechanically coupled and connected to the stabilization gimbal 32 for supporting the stabilization gimbal 32 .
在一些实例中,支撑件31可以为以下任意之一:无人飞行器的本体、手持云台的手持部件、遥控地面机器人的机体、车辆的车体等等。In some examples, the support 31 may be any one of the following: the body of the unmanned aerial vehicle, the hand-held part of the hand-held gimbal, the body of the remote control ground robot, the body of the vehicle, and the like.
图17所示实施例提供的可移动平台的具体实现原理和实现效果与图15所对应的增稳云台的具体实现原理和实现效果相一致,具体可参考上述陈述内容,在这里不再赘述。The specific implementation principle and implementation effect of the movable platform provided by the embodiment shown in FIG. 17 are consistent with the specific implementation principle and implementation effect of the stabilization gimbal corresponding to FIG. 15 . For details, please refer to the above statement, which will not be repeated here. .
图18为本发明实施例提供的另一种可移动平台的结构示意图;参考附图18所示,本实施例提供了另一种可移动平台,其中,可移动平台可以包括但 不限于无人机、无人船、无人车、可移动机器人等等。具体的,该可移动平台可以包括:FIG. 18 is a schematic structural diagram of another movable platform provided by an embodiment of the present invention; with reference to FIG. 18 , this embodiment provides another movable platform, wherein the movable platform may include but not limited to unmanned aerial vehicles. drones, unmanned ships, unmanned vehicles, mobile robots, etc. Specifically, the movable platform may include:
上述图16的增稳云台42;The stabilization gimbal 42 of the above-mentioned FIG. 16;
支撑件41,与增稳云台42机械耦合连接,用于支撑增稳云台42。The support member 41 is mechanically coupled and connected to the stabilization gimbal 42 for supporting the stabilization gimbal 42 .
在一些实例中,支撑件41可以为以下任意之一:无人飞行器的本体、手持云台的手持部件、遥控地面机器人的机体、车辆的车体等等。In some examples, the support 41 may be any one of the following: the body of the unmanned aerial vehicle, the hand-held part of the hand-held gimbal, the body of the remote control ground robot, the body of the vehicle, and the like.
图18所示实施例提供的可移动平台的具体实现原理和实现效果与图16所对应的增稳云台的具体实现原理和实现效果相一致,具体可参考上述陈述内容,在这里不再赘述。The specific implementation principle and implementation effect of the movable platform provided by the embodiment shown in FIG. 18 are consistent with the specific implementation principle and implementation effect of the stabilization gimbal corresponding to FIG. 16 . For details, please refer to the above statement, which will not be repeated here. .
另外,本发明实施例提供了一种计算机可读存储介质,存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,程序指令用于实现上述图2-图13的云台的检测方法。In addition, an embodiment of the present invention provides a computer-readable storage medium, where the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement the above-mentioned cloud in FIG. 2 to FIG. 13 . method of detection.
另外,本发明实施例提供了一种计算机可读存储介质,存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,程序指令用于实现上述图14的云台的检测方法。In addition, an embodiment of the present invention provides a computer-readable storage medium, where the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement the detection of the pan/tilt in the above-mentioned FIG. 14 . method.
以上各个实施例中的技术方案、技术特征在与本相冲突的情况下均可以单独,或者进行组合,只要未超出本领域技术人员的认知范围,均属于本申请保护范围内的等同实施例。The technical solutions and technical features in the above embodiments can be used alone or combined in the case of conflict with the present invention, as long as they do not exceed the cognitive scope of those skilled in the art, they all belong to the equivalent embodiments within the protection scope of the present application .
在本发明所提供的几个实施例中,应该理解到,所揭露的相关遥控装置和方法,可以通过其它的方式实现。例如,以上所描述的遥控装置实施例仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,遥控装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。In the several embodiments provided by the present invention, it should be understood that the disclosed related remote control devices and methods may be implemented in other manners. For example, the embodiments of the remote control device described above are only illustrative. For example, the division of the modules or units is only a logical function division. In actual implementation, there may be other division methods, such as multiple units or components. May be combined or may be integrated into another system, or some features may be omitted, or not implemented. On the other hand, the shown or discussed mutual coupling or direct coupling or communication connection may be through some interfaces, and the indirect coupling or communication connection of the remote control device or unit may be in electrical, mechanical or other forms.
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。The units described as separate components may or may not be physically separated, and components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution in this embodiment.
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中, 也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically alone, or two or more units may be integrated into one unit. The above-mentioned integrated units may be implemented in the form of hardware, or may be implemented in the form of software functional units.
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得计算机处理器(processor)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁盘或者光盘等各种可以存储程序代码的介质。The integrated unit, if implemented in the form of a software functional unit and sold or used as an independent product, may be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention is essentially or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium , including several instructions for causing a computer processor (processor) to execute all or part of the steps of the methods described in the various embodiments of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, Read-Only Memory (ROM, Read-Only Memory), Random Access Memory (RAM, Random Access Memory), magnetic disk or optical disk and other media that can store program codes.
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。The above descriptions are only the embodiments of the present invention, and are not intended to limit the scope of the present invention. Any equivalent structure or equivalent process transformation made by using the contents of the description and drawings of the present invention, or directly or indirectly applied to other related technologies Fields are similarly included in the scope of patent protection of the present invention.
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, but not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: The technical solutions described in the foregoing embodiments can still be modified, or some or all of the technical features thereof can be equivalently replaced; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the technical solutions of the embodiments of the present invention. Scope.

Claims (58)

  1. 一种云台的检测方法,其特征在于,所述云台包括云台部件、用于驱动所述云台部件转动的电机以及用于锁定所述云台部件的锁定机构,所述方法包括:A method for detecting a pan/tilt, characterized in that the pan/tilt comprises a pan/tilt component, a motor for driving the pan/tilt component to rotate, and a locking mechanism for locking the pan/tilt component, and the method includes:
    获取姿态传感器相对应的状态检测信号,所述姿态传感器用于感测所述云台部件的姿态信息;acquiring a state detection signal corresponding to an attitude sensor, where the attitude sensor is used to sense the attitude information of the gimbal component;
    基于所述状态检测信号,确定所述云台部件的检测状态;Based on the state detection signal, determine the detection state of the pan/tilt component;
    其中,所述检测状态包括锁定状态和未锁定状态。Wherein, the detection state includes a locked state and an unlocked state.
  2. 根据权利要求1所述的方法,其特征在于,获取姿态传感器相对应的状态检测信号,包括:The method according to claim 1, wherein acquiring the state detection signal corresponding to the attitude sensor comprises:
    获取用于实现对所述云台进行自整定操作的自整定请求;obtaining a self-tuning request for implementing the self-tuning operation on the PTZ;
    根据所述自整定请求确定所述状态检测信号。The state detection signal is determined according to the self-tuning request.
  3. 根据权利要求2所述的方法,其特征在于,所述状态检测信号所对应的波形包括以下至少之一:正弦波、余弦波、方波、三角波。The method according to claim 2, wherein the waveform corresponding to the state detection signal comprises at least one of the following: a sine wave, a cosine wave, a square wave, and a triangular wave.
  4. 根据权利要求2所述的方法,其特征在于,在基于所述状态检测信号,确定所述云台部件的检测状态之后,所述方法还包括:The method according to claim 2, wherein after determining the detection state of the pan/tilt component based on the state detection signal, the method further comprises:
    在确定所述云台部件处于所述未锁定状态时,则继续基于所述自整定请求对所述云台进行所述自整定操作;或者,When it is determined that the pan-tilt component is in the unlocked state, continue to perform the self-tuning operation on the pan-tilt based on the self-tuning request; or,
    在确定所述云台部件处于所述锁定状态时,则停止基于所述自整定请求对所述云台进行所述自整定操作。When it is determined that the pan-tilt component is in the locked state, the self-tuning operation on the pan-tilt based on the self-tuning request is stopped.
  5. 根据权利要求4所述的方法,其特征在于,在确定所述云台部件处于所述锁定状态之后,所述方法还包括:The method according to claim 4, wherein after determining that the pan/tilt part is in the locked state, the method further comprises:
    获取与所述云台部件相对应的控制参数;acquiring control parameters corresponding to the pan-tilt components;
    基于所述控制参数对所述云台部件进行控制,以使所述云台部件在预设范围内进行转动,其中,所述预设范围用于避免所述云台部件在锁定状态下与所述锁定机构发生碰撞。The pan-tilt part is controlled based on the control parameter, so that the pan-tilt part rotates within a preset range, wherein the preset range is used to prevent the pan-tilt part from being in a locked state with any The locking mechanism collides.
  6. 根据权利要求2所述的方法,其特征在于,在基于所述状态检测信号,确定所述云台部件的检测状态之后,所述方法还包括:The method according to claim 2, wherein after determining the detection state of the pan/tilt component based on the state detection signal, the method further comprises:
    在确定所述云台部件处于所述锁定状态时,输出用于提示所述云台部件处于所述锁定状态的信息。When it is determined that the pan/tilt unit is in the locked state, information for prompting that the pan/tilt unit is in the locked state is output.
  7. 根据权利要求2所述的方法,其特征在于,所述检测状态的检测时长 小于所述自整定操作的整定时长。The method according to claim 2, wherein the detection duration of the detection state is shorter than the setting duration of the self-tuning operation.
  8. 根据权利要求1所述的方法,其特征在于,基于所述状态检测信号,确定所述云台部件的检测状态,包括:The method according to claim 1, wherein determining the detection state of the pan/tilt component based on the state detection signal comprises:
    基于所述状态检测信号,获得所述电机的角速度;obtaining the angular velocity of the motor based on the state detection signal;
    根据所述电机的角速度确定所述云台部件的检测状态。The detection state of the pan/tilt unit is determined according to the angular velocity of the motor.
  9. 根据权利要求8所述的方法,其特征在于,根据所述电机的角速度确定所述云台部件的检测状态,包括:The method according to claim 8, wherein determining the detection state of the pan/tilt component according to the angular velocity of the motor, comprising:
    根据所述电机的角速度确定所述状态检测信号对应的信号总能量和一次谐波分量能量,所述信号总能量包括所述一次谐波分量能量;Determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal according to the angular velocity of the motor, and the total energy of the signal includes the energy of the first harmonic component;
    根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态。According to the total energy of the signal and the energy of the first harmonic component, the detection state of the pan/tilt component is determined.
  10. 根据权利要求9所述的方法,其特征在于,所述信号总能量与所述角速度的数量呈负相关、与所述角速度的大小呈正相关。The method according to claim 9, wherein the total energy of the signal is negatively correlated with the quantity of the angular velocity, and positively correlated with the magnitude of the angular velocity.
  11. 根据权利要求9所述的方法,其特征在于,所述一次谐波分量能量与所述角速度的数量呈负相关、与所述角速度的大小呈正相关、与所述角速度对应的基倍频率呈负相关。The method according to claim 9, wherein the energy of the first harmonic component is negatively correlated with the quantity of the angular velocity, positively correlated with the magnitude of the angular velocity, and the fundamental frequency corresponding to the angular velocity is negatively correlated related.
  12. 根据权利要求11所述的方法,其特征在于,所述方法还包括:The method according to claim 11, wherein the method further comprises:
    获取与所述角速度相对应的设定频率和采样频率;obtaining a set frequency and a sampling frequency corresponding to the angular velocity;
    根据所述设定频率和所述采样频率,确定所述基倍频率。The fundamental frequency is determined according to the set frequency and the sampling frequency.
  13. 根据权利要求9所述的方法,其特征在于,所述角速度的数量为多个。The method according to claim 9, wherein the number of the angular velocities is plural.
  14. 根据权利要求13所述的方法,其特征在于,所述方法还包括:The method of claim 13, wherein the method further comprises:
    获取与所述角速度相对应的设定频率和采样频率;obtaining a set frequency and a sampling frequency corresponding to the angular velocity;
    根据所述设定频率和所述采样频率,确定所述角速度的数量。The quantity of the angular velocity is determined according to the set frequency and the sampling frequency.
  15. 根据权利要求14所述的方法,其特征在于,根据所述设定频率和所述采样频率,确定所述角速度的数量,包括:The method according to claim 14, wherein determining the quantity of the angular velocity according to the set frequency and the sampling frequency, comprising:
    将所述采样频率与所述设定频率的比值,确定为所述角速度的数量。The ratio of the sampling frequency to the set frequency is determined as the quantity of the angular velocity.
  16. 根据权利要求9所述的方法,其特征在于,根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态,包括:The method according to claim 9, wherein determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component, comprising:
    获取所述一次谐波分量能量相对于所述信号总能量的第一比例信息;acquiring first proportional information of the energy of the first harmonic component relative to the total energy of the signal;
    根据所述第一比例信息,确定所述云台部件的检测状态。According to the first scale information, the detection state of the pan/tilt component is determined.
  17. 根据权利要求16所述的方法,其特征在于,根据所述第一比例信息, 确定所述云台部件的检测状态,包括:The method according to claim 16, wherein determining the detection state of the pan/tilt component according to the first scale information, comprising:
    在所述第一比例信息大于或等于第一预设阈值时,则确定所述云台部件的检测状态为所述未锁定状态;或者,When the first ratio information is greater than or equal to a first preset threshold, it is determined that the detection state of the pan/tilt component is the unlocked state; or,
    在所述第一比例信息小于第一预设阈值时,则确定所述云台部件的检测状态为所述锁定状态。When the first ratio information is less than a first preset threshold, it is determined that the detection state of the pan/tilt component is the locked state.
  18. 根据权利要求9所述的方法,其特征在于,所述方法还包括:The method according to claim 9, wherein the method further comprises:
    确定与所述电机的角速度相对应的直流分量能量,所述信号总能量包括所述直流分量能量;determining the energy of the DC component corresponding to the angular velocity of the motor, the total energy of the signal including the energy of the DC component;
    根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态,包括:将所述信号总能量与所述直流分量能量之间的差值确定为非直流总能量;According to the total energy of the signal and the energy of the first harmonic component, determining the detection state of the pan/tilt component includes: determining the difference between the total energy of the signal and the energy of the DC component as the total energy of non-DC ;
    根据所述一次谐波分量能量和所述非直流总能量,确定所述云台部件的检测状态。According to the first harmonic component energy and the non-DC total energy, the detection state of the pan/tilt component is determined.
  19. 根据权利要求18所述的方法,其特征在于,所述直流分量能量与所述角速度的数量呈负相关、与所述角速度的大小呈正相关。The method according to claim 18, wherein the DC component energy is negatively correlated with the quantity of the angular velocity, and positively correlated with the magnitude of the angular velocity.
  20. 根据权利要求18所述的方法,其特征在于,根据所述一次谐波分量能量和所述非直流总能量,确定所述云台部件的检测状态,包括:The method according to claim 18, wherein determining the detection state of the pan/tilt component according to the first harmonic component energy and the non-DC total energy, comprising:
    获取所述一次谐波分量能量相对于所述非直流总能量的第二比例信息;acquiring second proportional information of the energy of the first harmonic component relative to the total non-DC energy;
    根据所述第二比例信息,确定所述云台部件的检测状态。According to the second scale information, the detection state of the pan/tilt component is determined.
  21. 根据权利要求20所述的方法,其特征在于,根据所述第二比例信息,确定所述云台部件的检测状态,包括:The method according to claim 20, wherein determining the detection state of the pan/tilt component according to the second scale information comprises:
    在所述第二比例信息大于或等于第二预设阈值时,则确定所述云台部件的检测状态为所述未锁定状态;或者,When the second ratio information is greater than or equal to a second preset threshold, it is determined that the detection state of the pan/tilt component is the unlocked state; or,
    在所述第二比例信息小于第二预设阈值时,则确定所述云台部件的检测状态为所述锁定状态。When the second ratio information is smaller than the second preset threshold, it is determined that the detection state of the pan/tilt component is the locked state.
  22. 根据权利要求8所述的方法,其特征在于,根据所述电机的角速度确定所述云台部件的检测状态,包括:The method according to claim 8, wherein determining the detection state of the pan/tilt component according to the angular velocity of the motor, comprising:
    根据所述状态检测信号所对应的波形对所述电机的角速度进行拟合处理,获得与所述电机的角速度相对应的拟合波形;Perform fitting processing on the angular velocity of the motor according to the waveform corresponding to the state detection signal, to obtain a fitting waveform corresponding to the angular velocity of the motor;
    根据所述拟合波形和所述电机的角速度,确定所述云台部件的检测状态。According to the fitting waveform and the angular velocity of the motor, the detection state of the pan/tilt component is determined.
  23. 根据权利要求22所述的方法,其特征在于,根据所述拟合波形和所 述电机角速度,确定所述云台部件的检测状态,包括:The method according to claim 22, wherein, according to the fitting waveform and the motor angular velocity, determining the detection state of the pan/tilt component, comprising:
    在所述拟合波形中,获取与所述角速度相对应的拟合角速度;In the fitting waveform, obtain a fitting angular velocity corresponding to the angular velocity;
    确定所述角速度与所述拟合角速度之间的角速度误差;determining an angular velocity error between the angular velocity and the fitted angular velocity;
    根据所述角速度误差,确定所述云台部件的检测状态。According to the angular velocity error, the detection state of the pan/tilt component is determined.
  24. 根据权利要求23所述的方法,其特征在于,根据所述角速度误差,确定所述云台部件的检测状态,包括:The method according to claim 23, wherein determining the detection state of the pan/tilt component according to the angular velocity error, comprising:
    在预设数量的所述角速度误差小于预设误差阈值时,则确定所述云台部件处于所述未锁定状态;或者,When the preset number of the angular velocity errors is less than a preset error threshold, it is determined that the pan/tilt component is in the unlocked state; or,
    在预设数量的所述角速度误差大于或等于预设误差阈值时,则确定所述云台处于所述锁定状态。When the preset number of the angular velocity errors is greater than or equal to a preset error threshold, it is determined that the pan/tilt head is in the locked state.
  25. 根据权利要求1-24中任意一项所述的方法,其特征在于,所述云台为处于折叠状态的云台或者处于回中状态的云台。The method according to any one of claims 1-24, wherein the pan/tilt is a pan/tilt in a folded state or a pan/tilt in a centering state.
  26. 根据权利要求25所述的方法,其特征在于,在所述云台处于折叠状态时,所述云台的至少两个所述云台部件所对应的位置之间存在重叠;The method according to claim 25, wherein when the pan/tilt is in a folded state, there is overlap between the positions corresponding to at least two of the pan/tilt components of the pan/tilt;
    在所述云台处于回中状态时,所述云台的云台部件之间处于正交位置。When the pan/tilt is in the centering state, the pan/tilt components of the pan/tilt are in an orthogonal position.
  27. 一种云台的检测方法,其特征在于,所述云台包括云台部件、用于驱动所述云台部件转动的电机以及用于锁定所述云台部件的锁定机构,所述方法包括:A method for detecting a pan/tilt, characterized in that the pan/tilt comprises a pan/tilt component, a motor for driving the pan/tilt component to rotate, and a locking mechanism for locking the pan/tilt component, and the method includes:
    获取用于实现对所述云台进行自整定操作的自整定请求;obtaining a self-tuning request for implementing the self-tuning operation on the PTZ;
    基于所述云台部件的状态,确定是否对所述云台进行所述自整定操作;determining whether to perform the self-tuning operation on the gimbal based on the state of the gimbal component;
    在所述云台部件处于锁定状态时,停止对所述云台进行所述自整定操作。When the pan/tilt component is in a locked state, the self-tuning operation on the pan/tilt is stopped.
  28. 一种增稳云台,其特征在于,包括:A stabilization gimbal, characterized in that it includes:
    云台部件,用于机械耦合连接拍摄装置;The pan/tilt part is used to mechanically couple and connect the photographing device;
    电机,用于驱动所述云台部件转动,以调整所述拍摄装置的姿态,从而对所述拍摄装置进行增稳;a motor, used to drive the pan/tilt component to rotate, so as to adjust the posture of the photographing device, so as to enhance the stability of the photographing device;
    控制器,与所述电机电连接,用于控制所述电机;a controller, electrically connected to the motor, for controlling the motor;
    姿态传感器,与所述控制器通信连接,用于感测所述云台部件的姿态信息,an attitude sensor, connected in communication with the controller, for sensing the attitude information of the pan/tilt component,
    其中,所述控制器获取与所述姿态传感器相对应的状态检测信号,并根据所述状态检测信号确定所述云台部件的检测状态,所述检测状态包括锁定状态和未锁定状态。Wherein, the controller acquires a state detection signal corresponding to the attitude sensor, and determines a detection state of the pan/tilt component according to the state detection signal, and the detection state includes a locked state and an unlocked state.
  29. 根据权利要求28所述的增稳云台,其特征在于,在获取姿态传感器相对应的状态检测信号时,所述控制器用于:The stabilization gimbal according to claim 28, wherein when acquiring the state detection signal corresponding to the attitude sensor, the controller is used for:
    获取用于实现对所述云台进行自整定操作的自整定请求;obtaining a self-tuning request for implementing the self-tuning operation on the PTZ;
    根据所述自整定请求确定所述状态检测信号。The state detection signal is determined according to the self-tuning request.
  30. 根据权利要求29所述的增稳云台,其特征在于,所述状态检测信号所对应的波形包括以下至少之一:正弦波、余弦波、方波、三角波。The stabilization pan/tilt according to claim 29, wherein the waveform corresponding to the state detection signal includes at least one of the following: sine wave, cosine wave, square wave, and triangle wave.
  31. 根据权利要求29所述的增稳云台,其特征在于,在基于所述状态检测信号,确定所述云台部件的检测状态之后,所述控制器还用于:The stabilization gimbal according to claim 29, wherein after determining the detection state of the gimbal component based on the state detection signal, the controller is further configured to:
    在确定所述云台部件处于所述未锁定状态时,则继续基于所述自整定请求对所述云台进行所述自整定操作;或者,When it is determined that the pan-tilt component is in the unlocked state, continue to perform the self-tuning operation on the pan-tilt based on the self-tuning request; or,
    在确定所述云台部件处于所述锁定状态时,则停止基于所述自整定请求对所述云台进行所述自整定操作。When it is determined that the pan-tilt component is in the locked state, the self-tuning operation on the pan-tilt based on the self-tuning request is stopped.
  32. 根据权利要求31所述的增稳云台,其特征在于,在确定所述云台部件处于所述锁定状态之后,所述控制器还用于:The stabilization gimbal according to claim 31, wherein after determining that the gimbal component is in the locked state, the controller is further configured to:
    获取与所述云台部件相对应的控制参数;acquiring control parameters corresponding to the pan-tilt components;
    基于所述控制参数对所述云台部件进行控制,以使所述云台部件在预设范围内进行转动,其中,所述预设范围用于避免所述云台部件在锁定状态下与所述锁定机构发生碰撞。The pan-tilt part is controlled based on the control parameter, so that the pan-tilt part rotates within a preset range, wherein the preset range is used to prevent the pan-tilt part from being in a locked state with any The locking mechanism collides.
  33. 根据权利要求29所述的增稳云台,其特征在于,在基于所述状态检测信号,确定所述云台部件的检测状态之后,所述控制器还用于:The stabilization gimbal according to claim 29, wherein after determining the detection state of the gimbal component based on the state detection signal, the controller is further configured to:
    在确定所述云台部件处于所述锁定状态时,输出用于提示所述云台部件处于所述锁定状态的信息。When it is determined that the pan/tilt unit is in the locked state, information for prompting that the pan/tilt unit is in the locked state is output.
  34. 根据权利要求29所述的增稳云台,其特征在于,所述检测状态的检测时长小于所述自整定操作的整定时长。The stabilization gimbal according to claim 29, wherein the detection duration of the detection state is shorter than the setting duration of the self-tuning operation.
  35. 根据权利要求28所述的增稳云台,其特征在于,在基于所述状态检测信号,确定所述云台部件的检测状态时,所述控制器用于:The stabilization pan/tilt according to claim 28, wherein, when determining the detection state of the pan/tilt component based on the state detection signal, the controller is configured to:
    基于所述状态检测信号,获得所述电机的角速度;obtaining the angular velocity of the motor based on the state detection signal;
    根据所述电机的角速度确定所述云台部件的检测状态。The detection state of the pan/tilt unit is determined according to the angular velocity of the motor.
  36. 根据权利要求35所述的增稳云台,其特征在于,在根据所述电机的角速度确定所述云台部件的检测状态时,所述控制器用于:The stabilization gimbal according to claim 35, wherein when the detection state of the gimbal component is determined according to the angular velocity of the motor, the controller is configured to:
    根据所述电机的角速度确定所述状态检测信号对应的信号总能量和一次 谐波分量能量,所述信号总能量包括所述一次谐波分量能量;Determine the total energy of the signal and the energy of the first harmonic component corresponding to the state detection signal according to the angular velocity of the motor, and the total energy of the signal includes the energy of the first harmonic component;
    根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态。According to the total energy of the signal and the energy of the first harmonic component, the detection state of the pan/tilt component is determined.
  37. 根据权利要求36所述的增稳云台,其特征在于,所述信号总能量与所述角速度的数量呈负相关、与所述角速度的大小呈正相关。The stabilization gimbal according to claim 36, wherein the total energy of the signal is negatively correlated with the quantity of the angular velocity, and positively correlated with the magnitude of the angular velocity.
  38. 根据权利要求36所述的增稳云台,其特征在于,所述一次谐波分量能量与所述角速度的数量呈负相关、与所述角速度的大小呈正相关、与所述角速度对应的基倍频率呈负相关。The stabilization gimbal according to claim 36, wherein the energy of the first harmonic component is negatively correlated with the quantity of the angular velocity, positively correlated with the magnitude of the angular velocity, and has a fundamental multiplier corresponding to the angular velocity Frequency is negatively correlated.
  39. 根据权利要求38所述的增稳云台,其特征在于,所述控制器还用于:The stabilization gimbal according to claim 38, wherein the controller is further used for:
    获取与所述角速度相对应的设定频率和采样频率;obtaining a set frequency and a sampling frequency corresponding to the angular velocity;
    根据所述设定频率和所述采样频率,确定所述基倍频率。The fundamental frequency is determined according to the set frequency and the sampling frequency.
  40. 根据权利要求36所述的增稳云台,其特征在于,所述角速度的数量为多个。The stabilization gimbal according to claim 36, wherein the number of the angular velocities is plural.
  41. 根据权利要求40所述的增稳云台,其特征在于,所述控制器还用于:The stabilization gimbal according to claim 40, wherein the controller is further used for:
    获取与所述角速度相对应的设定频率和采样频率;obtaining a set frequency and a sampling frequency corresponding to the angular velocity;
    根据所述设定频率和所述采样频率,确定所述角速度的数量。The quantity of the angular velocity is determined according to the set frequency and the sampling frequency.
  42. 根据权利要求41所述的增稳云台,其特征在于,在根据所述设定频率和所述采样频率,确定所述角速度的数量时,所述控制器还用于:The stabilization gimbal according to claim 41, wherein, when determining the quantity of the angular velocity according to the set frequency and the sampling frequency, the controller is further configured to:
    将所述采样频率与所述设定频率的比值,确定为所述角速度的数量。The ratio of the sampling frequency to the set frequency is determined as the quantity of the angular velocity.
  43. 根据权利要求36所述的增稳云台,其特征在于,在根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态时,所述控制器还用于:The stabilization pan/tilt according to claim 36, wherein when determining the detection state of the pan/tilt component according to the total energy of the signal and the energy of the first harmonic component, the controller is further configured to: :
    获取所述一次谐波分量能量相对于所述信号总能量的第一比例信息;acquiring first proportional information of the energy of the first harmonic component relative to the total energy of the signal;
    根据所述第一比例信息,确定所述云台部件的检测状态。According to the first scale information, the detection state of the pan/tilt component is determined.
  44. 根据权利要求43所述的增稳云台,其特征在于,在根据所述第一比例信息,确定所述云台部件的检测状态时,所述控制器还用于:The stabilization gimbal according to claim 43, wherein when determining the detection state of the gimbal component according to the first scale information, the controller is further configured to:
    在所述第一比例信息大于或等于第一预设阈值时,则确定所述云台部件的检测状态为所述未锁定状态;或者,When the first ratio information is greater than or equal to a first preset threshold, it is determined that the detection state of the pan/tilt component is the unlocked state; or,
    在所述第一比例信息小于第一预设阈值时,则确定所述云台部件的检测状态为所述锁定状态。When the first ratio information is less than a first preset threshold, it is determined that the detection state of the pan/tilt component is the locked state.
  45. 根据权利要求36所述的增稳云台,其特征在于,所述控制器还用于:The stabilization gimbal according to claim 36, wherein the controller is further used for:
    确定与所述电机的角速度相对应的直流分量能量,所述信号总能量包括所述直流分量能量;determining the energy of the DC component corresponding to the angular velocity of the motor, the total energy of the signal including the energy of the DC component;
    根据所述信号总能量和所述一次谐波分量能量,确定所述云台部件的检测状态,包括:将所述信号总能量与所述直流分量能量之间的差值确定为非直流总能量;According to the total energy of the signal and the energy of the first harmonic component, determining the detection state of the pan/tilt component includes: determining the difference between the total energy of the signal and the energy of the DC component as the total energy of non-DC ;
    根据所述一次谐波分量能量和所述非直流总能量,确定所述云台部件的检测状态。According to the first harmonic component energy and the non-DC total energy, the detection state of the pan/tilt component is determined.
  46. 根据权利要求45所述的增稳云台,其特征在于,所述直流分量能量与所述角速度的数量呈负相关、与所述角速度的大小呈正相关。The stabilization gimbal according to claim 45, wherein the DC component energy is negatively correlated with the quantity of the angular velocity, and positively correlated with the magnitude of the angular velocity.
  47. 根据权利要求45所述的增稳云台,其特征在于,在根据所述一次谐波分量能量和所述非直流总能量,确定所述云台部件的检测状态时,所述控制器还用于:The stabilization pan/tilt according to claim 45, wherein when determining the detection state of the pan/tilt component according to the first harmonic component energy and the non-DC total energy, the controller further uses At:
    获取所述一次谐波分量能量相对于所述非直流总能量的第二比例信息;acquiring second proportional information of the energy of the first harmonic component relative to the total non-DC energy;
    根据所述第二比例信息,确定所述云台部件的检测状态。According to the second scale information, the detection state of the pan/tilt component is determined.
  48. 根据权利要求47所述的增稳云台,其特征在于,在根据所述第二比例信息,确定所述云台部件的检测状态时,所述控制器还用于:The stabilization gimbal according to claim 47, wherein when determining the detection state of the gimbal component according to the second ratio information, the controller is further configured to:
    在所述第二比例信息大于或等于第二预设阈值时,则确定所述云台部件的检测状态为所述未锁定状态;或者,When the second ratio information is greater than or equal to a second preset threshold, it is determined that the detection state of the pan/tilt component is the unlocked state; or,
    在所述第二比例信息小于第二预设阈值时,则确定所述云台部件的检测状态为所述锁定状态。When the second ratio information is smaller than the second preset threshold, it is determined that the detection state of the pan/tilt component is the locked state.
  49. 根据权利要求35所述的增稳云台,其特征在于,在根据所述电机的角速度确定所述云台部件的检测状态时,所述控制器还用于:The stabilization gimbal according to claim 35, wherein when the detection state of the gimbal component is determined according to the angular velocity of the motor, the controller is further configured to:
    根据所述状态检测信号所对应的波形对所述电机的角速度进行拟合处理,获得与所述电机的角速度相对应的拟合波形;Perform fitting processing on the angular velocity of the motor according to the waveform corresponding to the state detection signal, to obtain a fitting waveform corresponding to the angular velocity of the motor;
    根据所述拟合波形和所述电机的角速度,确定所述云台部件的检测状态。According to the fitting waveform and the angular velocity of the motor, the detection state of the pan/tilt component is determined.
  50. 根据权利要求49所述的增稳云台,其特征在于,在根据所述拟合波形和所述电机角速度,确定所述云台部件的检测状态时,所述控制器还用于:The stabilization gimbal according to claim 49, wherein when determining the detection state of the gimbal component according to the fitting waveform and the motor angular velocity, the controller is further configured to:
    在所述拟合波形中,获取与所述角速度相对应的拟合角速度;In the fitting waveform, obtain a fitting angular velocity corresponding to the angular velocity;
    确定所述角速度与所述拟合角速度之间的角速度误差;determining an angular velocity error between the angular velocity and the fitted angular velocity;
    根据所述角速度误差,确定所述云台部件的检测状态。According to the angular velocity error, the detection state of the pan/tilt component is determined.
  51. 根据权利要求50所述的增稳云台,其特征在于,在根据所述角速度 误差,确定所述云台部件的检测状态时,所述控制器还用于:The stabilization pan/tilt according to claim 50, wherein, when determining the detection state of the pan/tilt component according to the angular velocity error, the controller is further configured to:
    在预设数量的所述角速度误差小于预设误差阈值时,则确定所述云台部件处于所述未锁定状态;或者,When the preset number of the angular velocity errors is less than a preset error threshold, it is determined that the pan-tilt component is in the unlocked state; or,
    在预设数量的所述角速度误差大于或等于预设误差阈值时,则确定所述云台处于所述锁定状态。When the preset number of the angular velocity errors is greater than or equal to a preset error threshold, it is determined that the pan/tilt head is in the locked state.
  52. 根据权利要求28-51中任意一项所述的增稳云台,其特征在于,所述云台为处于折叠状态的云台或者处于回中状态的云台。The stabilization gimbal according to any one of claims 28 to 51, wherein the gimbal is a gimbal in a folded state or a gimbal in a centering state.
  53. 根据权利要求52所述的增稳云台,其特征在于,在所述云台处于折叠状态时,所述云台的至少两个所述云台部件所对应的位置之间存在重叠;The stabilization gimbal according to claim 52, wherein when the gimbal is in a folded state, there is overlap between the positions corresponding to at least two of the gimbal components of the gimbal;
    在所述云台处于回中状态时,所述云台的云台部件之间处于正交位置。When the pan/tilt is in the centering state, the pan/tilt components of the pan/tilt are in an orthogonal position.
  54. 一种增稳云台,其特征在于,包括:A stabilization gimbal, characterized in that it includes:
    云台部件,用于机械耦合连接拍摄装置;The pan/tilt part is used to mechanically couple and connect the photographing device;
    电机,用于驱动所述云台部件转动,以调整所述拍摄装置的姿态,从而对所述拍摄装置进行增稳;a motor, used to drive the pan/tilt component to rotate, so as to adjust the posture of the photographing device, so as to enhance the stability of the photographing device;
    控制器,与所述电机电连接,用于控制所述电机;a controller, electrically connected to the motor, for controlling the motor;
    姿态传感器,与所述控制器通信连接,用于感测所述云台部件的姿态信息,an attitude sensor, connected in communication with the controller, for sensing the attitude information of the pan/tilt component,
    其中,所述控制器获取用于实现对所述云台进行自整定操作的自整定请求;基于所述云台部件的状态,确定是否对所述云台进行所述自整定操作;在所述云台部件处于锁定状态时,停止对所述云台进行所述自整定操作。Wherein, the controller obtains a self-tuning request for implementing the self-tuning operation on the pan/tilt; determines whether to perform the self-tuning operation on the pan/tilt based on the state of the pan/tilt components; When the pan/tilt part is in a locked state, the self-tuning operation on the pan/tilt is stopped.
  55. 一种可移动平台,其特征在于,包括:A movable platform, characterized in that, comprising:
    权利要求28-53中任意一项所述的增稳云台;The stabilization gimbal according to any one of claims 28-53;
    支撑件,与所述增稳云台机械耦合连接,用于支撑所述增稳云台。The support piece is mechanically coupled and connected with the stabilization gimbal, and is used for supporting the stabilization gimbal.
  56. 一种可移动平台,其特征在于,包括:A movable platform, characterized in that, comprising:
    权利要求54所述的增稳云台;The stabilization gimbal of claim 54;
    支撑件,与所述增稳云台机械耦合连接,用于支撑所述增稳云台。The support piece is mechanically coupled and connected with the stabilization gimbal, and is used for supporting the stabilization gimbal.
  57. 一种计算机可读存储介质,其特征在于,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于实现权利要求1-26中任意一项所述的云台的检测方法。A computer-readable storage medium, characterized in that the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement any one of claims 1-26 The detection method of the PTZ described in item.
  58. 一种计算机可读存储介质,其特征在于,所述存储介质为计算机可读存储介质,该计算机可读存储介质中存储有程序指令,所述程序指令用于 实现权利要求27所述的云台的检测方法。A computer-readable storage medium, characterized in that the storage medium is a computer-readable storage medium, and program instructions are stored in the computer-readable storage medium, and the program instructions are used to implement the cloud platform of claim 27 detection method.
PCT/CN2020/107791 2020-08-07 2020-08-07 Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium WO2022027579A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2020/107791 WO2022027579A1 (en) 2020-08-07 2020-08-07 Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium
CN202080006194.XA CN113168192A (en) 2020-08-07 2020-08-07 Detection method of holder, stability-increasing holder, movable platform and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/107791 WO2022027579A1 (en) 2020-08-07 2020-08-07 Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium

Publications (1)

Publication Number Publication Date
WO2022027579A1 true WO2022027579A1 (en) 2022-02-10

Family

ID=76879269

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/107791 WO2022027579A1 (en) 2020-08-07 2020-08-07 Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium

Country Status (2)

Country Link
CN (1) CN113168192A (en)
WO (1) WO2022027579A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023070461A1 (en) * 2021-10-28 2023-05-04 深圳市大疆创新科技有限公司 Gimbal control method and apparatus, gimbal, and computer storage medium

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101631260A (en) * 2009-08-06 2010-01-20 杭州华三通信技术有限公司 Rational platform detection method and detection device
CN105090699A (en) * 2015-08-27 2015-11-25 深圳市大疆创新科技有限公司 Cradle head
CN207292469U (en) * 2017-08-31 2018-05-01 深圳曼塔智能科技有限公司 Multi-pose sensor cradle head device, camera and unmanned plane during flying device
CN108513637A (en) * 2017-04-21 2018-09-07 深圳市大疆创新科技有限公司 Holder and cloud platform control method
CN207945437U (en) * 2018-02-08 2018-10-09 桂林智神信息技术有限公司 The locking structure and holder of holder
CN109292103A (en) * 2018-07-27 2019-02-01 北京臻迪科技股份有限公司 Holder method of adjustment, device, unmanned plane and holder adjust system
WO2020000423A1 (en) * 2018-06-29 2020-01-02 深圳市大疆创新科技有限公司 Control method for gimbal, gimbal, aerial vehicle, and computer-readable storage medium
CN211176244U (en) * 2019-11-02 2020-08-04 深圳景行机器人科技有限公司 Hand-held cloud platform

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019019152A1 (en) * 2017-07-28 2019-01-31 深圳市大疆创新科技有限公司 Reliability testing method and device for cradle head
KR102387819B1 (en) * 2017-12-27 2022-04-15 에스지 디제이아이 테크놀러지 코., 엘티디 How to switch gimbal operating mode, controller and image stabilization device
CN110825124A (en) * 2019-11-15 2020-02-21 杭州电子科技大学 Holder control method and system

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101631260A (en) * 2009-08-06 2010-01-20 杭州华三通信技术有限公司 Rational platform detection method and detection device
CN105090699A (en) * 2015-08-27 2015-11-25 深圳市大疆创新科技有限公司 Cradle head
CN108513637A (en) * 2017-04-21 2018-09-07 深圳市大疆创新科技有限公司 Holder and cloud platform control method
CN207292469U (en) * 2017-08-31 2018-05-01 深圳曼塔智能科技有限公司 Multi-pose sensor cradle head device, camera and unmanned plane during flying device
CN207945437U (en) * 2018-02-08 2018-10-09 桂林智神信息技术有限公司 The locking structure and holder of holder
WO2020000423A1 (en) * 2018-06-29 2020-01-02 深圳市大疆创新科技有限公司 Control method for gimbal, gimbal, aerial vehicle, and computer-readable storage medium
CN109292103A (en) * 2018-07-27 2019-02-01 北京臻迪科技股份有限公司 Holder method of adjustment, device, unmanned plane and holder adjust system
CN211176244U (en) * 2019-11-02 2020-08-04 深圳景行机器人科技有限公司 Hand-held cloud platform

Also Published As

Publication number Publication date
CN113168192A (en) 2021-07-23

Similar Documents

Publication Publication Date Title
US11852958B2 (en) Gimbal control method, device, and gimbal
CN107813345B (en) Robot collision detection method and device
WO2019223270A1 (en) Method and apparatus for estimating angle and angular velocity of electric motor of gimbal, and gimbal and aerial vehicle
WO2019119896A1 (en) Method and apparatus for detecting motor rotor position, electronic device, and unmanned aircraft
CN215929180U (en) Cloud platform
CN108780324B (en) Unmanned aerial vehicle, and unmanned aerial vehicle control method and device
WO2018148906A1 (en) Method of configuring mounting device parameter, device, and mounting device
Rafiq et al. Development of a simple and low-cost smartphone gimbal with MPU-6050 sensor
US20210200247A1 (en) Gimbal control method, gimbal, mobile platform and computer-readable storage medium
WO2022027579A1 (en) Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium
JP5019478B2 (en) Marker automatic registration method and system
CN112154480B (en) Positioning method and device for movable platform, movable platform and storage medium
WO2022205207A1 (en) Gimbal, and configuration recognition method and apparatus therefor
Li et al. Extended Kalman filter based hand-shake detector for optical image stabilization using a low cost gyroscope
WO2020042159A1 (en) Rotation control method and apparatus for gimbal, control device, and mobile platform
WO2021142789A1 (en) Angular velocity measurement mechanism, method and apparatus, and movable platform and storage medium
Antonello et al. IMU-aided image stabilization and tracking in a HSM-driven camera positioning unit
CN112153270B (en) Cloud deck zero point detection method and device, camera and storage medium
WO2022016322A1 (en) Gimbal, gimbal performance evaluation method and device, and mobile platform
WO2022006782A1 (en) Gimbal control method and apparatus, gimbal assembly, movable platform, and storage medium
CN114585986A (en) Detection method and device of holder, movable platform and storage medium
CN110914781A (en) Control method and control device of holder, holder and moving trolley
WO2023279310A1 (en) Monitor control method, gimbal, photographing system, and storage medium
CN113280805B (en) Method, processor and device for identifying boom posture and engineering machinery
CN110337619B (en) Cloud deck protection method, cloud deck protection device, cloud deck and unmanned aerial vehicle

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

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

Country of ref document: EP

Kind code of ref document: A1