WO2022016322A1 - Gimbal, gimbal performance evaluation method and device, and mobile platform - Google Patents

Gimbal, gimbal performance evaluation method and device, and mobile platform Download PDF

Info

Publication number
WO2022016322A1
WO2022016322A1 PCT/CN2020/103049 CN2020103049W WO2022016322A1 WO 2022016322 A1 WO2022016322 A1 WO 2022016322A1 CN 2020103049 W CN2020103049 W CN 2020103049W WO 2022016322 A1 WO2022016322 A1 WO 2022016322A1
Authority
WO
WIPO (PCT)
Prior art keywords
gimbal
angular velocity
attitude
preset
attitude error
Prior art date
Application number
PCT/CN2020/103049
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/103049 priority Critical patent/WO2022016322A1/en
Priority to CN202080032549.2A priority patent/CN113795798A/en
Publication of WO2022016322A1 publication Critical patent/WO2022016322A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B23/00Testing or monitoring of control systems or parts thereof
    • G05B23/02Electric testing or monitoring
    • G05B23/0205Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
    • G05B23/0208Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterized by the configuration of the monitoring system
    • G05B23/0213Modular or universal configuration of the monitoring system, e.g. monitoring system having modules that may be combined to build monitoring program; monitoring system that can be applied to legacy systems; adaptable monitoring system; using different communication protocols
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B23/00Testing or monitoring of control systems or parts thereof
    • G05B23/02Electric testing or monitoring
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/20Pc systems
    • G05B2219/24Pc safety
    • G05B2219/24065Real time diagnostics

Definitions

  • the present application relates to the field of PTZ, and in particular, to a PTZ and its performance evaluation method and device, and a movable platform.
  • the working principle of the gimbal is: by detecting the actual attitude of the load and comparing the actual attitude with the set target attitude of the gimbal, the attitude deviation is determined, so as to carry out negative feedback control, output the torque to the motor, and finally reduce the attitude deviation, to ensure that the attitude deviation of the load is as small as possible.
  • control parameters of the gimbal such as the output strength of the motor (the response of the motor to the speed), the strength (the response of the motor to the angle), the filter parameters, etc. are artificially modified and/or the load is changed, the control parameters may not match the load.
  • the control parameters may not match the load.
  • the anti-interference ability of the gimbal decreases, the reliability and stabilization performance of the gimbal are both low, and the user experience of using the gimbal is poor.
  • the present application provides a gimbal, a method and device for evaluating its performance, and a movable platform.
  • an embodiment of the present application provides a method for evaluating the performance of a gimbal.
  • the gimbal is mounted on a support platform, the gimbal is used to support a payload, and the gimbal or the payload is provided with a first Inertial measurement unit, the support platform is provided with a second inertial measurement unit, and the method includes:
  • attitude error is determined based on the measured attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected The angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit;
  • the anti-interference ability of the gimbal is evaluated.
  • an embodiment of the present application provides a device for evaluating the performance of a gimbal.
  • the gimbal is mounted on a support platform, the gimbal is used to support a payload, and the gimbal or the payload is provided with a first Inertial measurement unit, the support platform is provided with a second inertial measurement unit, and the evaluation device for the performance of the pan/tilt includes:
  • a storage device for storing program instructions
  • processors that invoke program instructions stored in the memory device, the one or more processors, when executed, are individually or collectively configured to perform the following operations:
  • attitude error is determined based on the measured attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected The angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit;
  • the anti-interference ability of the gimbal is evaluated.
  • an embodiment of the present application provides a pan/tilt, the pan/tilt is mounted on a support platform, and the pan/tilt includes:
  • the load-bearing part which is used to support the payload
  • a first inertial measurement unit arranged on the bearing portion or the payload
  • a second inertial measurement unit disposed on the support platform
  • the device for evaluating the performance of the pan/tilt according to the second aspect is electrically connected to the first inertial measurement unit and the second inertial measurement unit, respectively.
  • an embodiment of the present application provides a movable platform, where the movable platform includes:
  • the pan/tilt according to the third aspect is mounted on the body.
  • the present application obtains the attitude error and the expected angular velocity of the gimbal, and evaluates the anti-interference ability of the gimbal according to the attitude error and the expected angular velocity.
  • the inertial measurement unit and the second inertial measurement unit on the support platform ensure that in any scenario, the measured attitude of the gimbal and the angular velocity of the support platform can always be obtained, so as to ensure that the attitude error and expected angular velocity can always be obtained.
  • the accuracy of this evaluation method It can give users more accurate evaluation results, which is of great significance for improving the reliability and stabilization performance of the gimbal and improving the user experience of using the gimbal.
  • FIG. 1A is a schematic diagram of a usage scenario of a gimbal in an embodiment of the present application
  • FIG. 1B is a schematic diagram of a usage scenario of a PTZ in another embodiment of the present application.
  • FIG. 2 is a schematic flowchart of a method for evaluating the performance of a gimbal in an embodiment of the present application
  • Fig. 3 is a kind of realization process schematic diagram of evaluating the anti-interference ability of the pan-tilt head according to attitude error and expected angular velocity in an embodiment of the present application;
  • FIG. 4 is a schematic structural diagram of a device for evaluating the performance of a gimbal in an embodiment of the present application
  • FIG. 5 is a schematic structural diagram of a pan/tilt in an embodiment of the present application.
  • the control parameters of the gimbal such as the output strength of the motor (the response of the motor to the speed), the strength (the response of the motor to the angle), the filter parameters, etc. are artificially modified and/or the load is changed, the control parameters may not match the load.
  • the anti-interference ability of the gimbal the ability to suppress disturbance, which can be reflected in such as stabilization capability
  • the reliability and stabilization performance of the gimbal are both low, and the user experience of using the gimbal is relatively low. Difference.
  • the inventor has made various attempts to adjust the accuracy of judging the anti-interference ability of the gimbal based on the attitude error, for example, to strengthen the connection strength between the gimbal and the load, but in the case of changes in disturbance, the attitude-based The accuracy of the error judgment of the anti-interference ability of the gimbal is still poor. Later, the inventor found that the rotation angular velocity of the motor combined with the anti-interference ability of the attitude error feedback gimbal can solve the problem that the degree of disturbance change is different, but the accuracy of the anti-interference ability of the gimbal is not accurate.
  • the rotational angular velocity of the motor is 1 degree/second, and the attitude error corresponding to the motor is 0.1 degree; at the second moment, the rotational angular velocity of the motor is 10 degrees/second, and the attitude error corresponding to the motor is 0.2
  • the attitude error at the second moment is twice that of the first moment, and the attitude error becomes larger, but the rotational angular velocity at the second moment is 10 times the rotational angular velocity at the first moment, that is, the second moment
  • the disturbance is much larger than the disturbance at the first moment, and the anti-interference ability at the second moment should be better than the anti-interference ability at the first moment. Therefore, this method of evaluating whether the anti-jamming capability of the gimbal is degraded only based on the attitude error will lead to misjudgment.
  • the anti-interference ability of the gimbal is evaluated by obtaining the attitude error and the expected angular velocity of the gimbal, and evaluating the anti-interference ability of the gimbal according to the attitude error and the expected angular velocity.
  • the first inertial measurement unit on the gimbal or payload and the second inertial measurement unit on the support platform ensure that the measured attitude of the gimbal and the angular velocity of the support platform can always be obtained in any scenario, thus ensuring that the attitude error can always be obtained. and expected angular velocity, this evaluation method has high accuracy and can give users more accurate evaluation results, which is of great significance for improving the reliability and stabilization performance of the gimbal and improving the user experience of using the gimbal.
  • At least one means one or more, and “plurality” means two or more.
  • And/or which describes the relationship of the associated objects, indicates that there can be three kinds of relationships, for example, A and/or B, it can indicate that A exists alone, A and B exist at the same time, and B exists alone, where A, B can be singular or plural.
  • the character “/” generally indicates that the associated objects are an “or” relationship.
  • At least one item(s) below” or similar expressions thereof refer to any combination of these items, including any combination of single item(s) or plural items(s).
  • At least one (a) of a, b, or c may represent: a, b, c, a and b, a and c, b and c, or a and b and c, where a, b, c can be single or multiple.
  • the gimbal of the embodiment of the present application is mounted on a support platform, and the gimbal is used to support a payload.
  • the gimbal may be a handheld gimbal or an airborne gimbal, or the gimbal may be used as a handheld gimbal or an airborne gimbal.
  • the type of the supporting platform is related to the type of the pan/tilt. Exemplarily, the pan/tilt is a handheld pan/tilt, and the supporting platform is the handle (or called the base) of the hand-held pan/tilt; exemplarily, the pan/tilt is an airborne pan/tilt.
  • the gimbal can be mounted on a movable platform, the supporting platform is the body of the movable platform, and the movable platform can be a mobile car, an unmanned aerial vehicle (such as an unmanned aerial vehicle or a manned aerial vehicle) or a mobile robot. It can be understood that, The movable platform can also be other movable devices or devices.
  • the pan/tilt 200 is mounted on the body 110 of the drone 100
  • the payload 300 is mounted on the pan/tilt 200
  • the support platform is the body 110 of the drone 100 .
  • the gimbal 200 is a handheld gimbal
  • the payload 300 is carried on the bearing portion 220 of the gimbal 200
  • the support platform is the handle 210 .
  • the pan/tilt in the embodiment of the present application may be a single-axis pan/tilt, or may be a multi-axis pan/tilt, such as a two-axis pan/tilt, a three-axis pan/tilt, and the like.
  • the gimbal includes multiple drive axes, such as at least two of the yaw axis, the pitch axis and the roll axis.
  • the gimbal is three.
  • Axis gimbal including yaw axis, pitch axis and roll axis; exemplarily, the gimbal is a two-axis gimbal including yaw axis and pitch axis, or yaw axis and roll axis, or pitch axis and yaw axis roller.
  • the payload refers to the payload that can change with the attitude change of the gimbal.
  • the payload may include a camera or other objects, such as obstacle avoidance sensors.
  • the payload is a photographing device; exemplarily, the payload is an obstacle avoidance sensor; exemplarily, the payload includes a photographing device and an obstacle avoidance sensor.
  • a first inertial measurement unit is provided on the gimbal or payload, so that the measurement attitude of the gimbal can be obtained through detection by the first inertial measurement unit.
  • the setting position of the first inertial measurement unit can be determined according to the cooperation mode between the gimbal and the payload.
  • the gimbal is configured to be detachably connected to the payload, and the first inertial measurement unit is arranged on the gimbal, In this way, after replacing the payload, there is no need to reinstall the first inertial measurement unit; optionally, the gimbal is configured to be non-detachably connected to the payload, and the first inertial measurement unit is provided on the gimbal or the payload.
  • a second inertial measurement unit is provided on the support platform, so that the angular velocity of the support platform can be obtained through detection by the second inertial measurement unit.
  • the support platform is the handle. If the user manually rotates the handle, the angular velocity of the handle is not zero, but the gimbal is still stationary, that is, the angular velocity of the gimbal is zero.
  • the first inertia The angular velocity of the gimbal detected by the measurement unit is not the angular velocity of the handle, that is, when the user manually rotates the handle but the gimbal is stationary, the angular velocity of the handle cannot be detected by the first inertial measurement unit; it is understandable that when the user rotates the handle When the handle and the gimbal follow the movement of the handle, the angular velocity detected by the first inertial measurement unit is the angular velocity of the gimbal and the angular velocity of the handle.
  • a first inertial measurement unit to detect the angular velocity of the handle For the airborne pan/tilt, the above situation is also applicable and will not be repeated here.
  • the pan/tilt can be mounted on a movable platform
  • the support platform is the body of the movable platform
  • the second inertial measurement unit may be an inertial measurement unit in the body, for example, for the movable platform
  • an inertial measurement unit is also provided in the unmanned aerial vehicle to be able to feedback the attitude of the unmanned aerial vehicle.
  • both the first inertial measurement unit and the second inertial measurement unit include an accelerometer and a gyroscope.
  • a method for evaluating the performance of a PTZ in an embodiment of the present application may include S201 to S202:
  • the attitude error and expected angular velocity of the gimbal are obtained, the attitude error is determined based on the measurement attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected angular velocity is determined based on the target attitude and the set target attitude of the gimbal.
  • the attitude error is determined based on the measurement attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal
  • the expected angular velocity is determined based on the target attitude and the set target attitude of the gimbal.
  • the target posture is the default posture size.
  • the target posture may be (0, 0, 0) by default; in some embodiments, The target posture is set by the user.
  • the target posture is determined according to the amount of the rod that the user hits; in some embodiments, the target posture is set based on the posture of the support platform.
  • the attitude of the target follows the attitude of the support platform, and the target attitude is set based on the attitude of the support platform.
  • the method for evaluating the performance of the gimbal in the embodiment of the present application can be applied when the gimbal is in the lock mode, and can also be applied when the gimbal is in the follow mode.
  • the gimbal is in a locking mode, and the locking mode is used to instruct the gimbal to maintain a target attitude. It should be noted that in the locked mode, when the gimbal is in the target attitude, each drive axis of the gimbal is used for stabilization, so that the payload is oriented in space.
  • the target attitude is used to orient the payload in space, so as to determine the desired angular velocity of the motor corresponding to each drive shaft of the gimbal.
  • the calculation of the desired angular velocity can be free from the interference of the target attitude, which is beneficial to simplify the calculation.
  • the attitude error obtained in S201 may be located in the joint angle space coordinate system; of course, the attitude error obtained in S201 may not be located in the joint angle space coordinate system, and the attitude error can be converted into the joint angle space coordinate system through coordinate transformation. , so that both the attitude error and the desired angular velocity are located in the joint angular coordinate system.
  • the attitude error in the joint angle coordinate system can be expressed as:
  • ⁇ J is the attitude error in the joint angle coordinate system, where, is the attitude error of the drive shaft with serial number 1 in the joint angular coordinate system, is the attitude error of the drive shaft with serial number n in the joint angular coordinate system, is the attitude error of the drive shaft with serial number N in the joint angular coordinate system;
  • N is the axis number of the drive shaft of the gimbal. For example, if the gimbal is a three-axis gimbal, N is equal to 3; if the gimbal is a two-axis gimbal, N is equal to 2; if the gimbal is a single-axis gimbal, N is equal to 2. 1, and so on;
  • n is a positive integer, indicating the serial number of the drive shaft with serial number n, 1 ⁇ n ⁇ N.
  • the attitude error is caused by the fact that when the measured attitude is controlled to approach the target attitude, the target attitude cannot be fully reached, and there is a difference between the measured attitude and the target attitude (that is, the size of the measured attitude approaching the target attitude and the target attitude are not equal) , resulting in an orientation error of the gimbal.
  • the measured attitude can be obtained by integrating the actual angular velocity of the motor
  • the target attitude can be obtained by integrating the expected angular velocity of the motor.
  • the attitude error is due to the actual angular velocity of the motor and the expected angular velocity.
  • the angular velocity is not equal, that is, the attitude error can also be obtained by integrating the difference between the actual angular velocity and the expected angular velocity, and the disturbance suppression capability of the gimbal can be estimated by using the attitude error and the expected angular velocity.
  • the desired angular velocity of the gimbal includes the expected angular velocity of the motor corresponding to each drive axis of the gimbal, and the desired angular velocity is located in the joint angular space coordinate system;
  • the target attitude of the gimbal is the target attitude of the load, which can be determined by the angular velocity of the load. (or called the angular velocity of the gimbal), the target attitude of the gimbal is located in the load coordinate system (also called the body coordinate system ⁇ b ⁇ ); the angular velocity of the support platform is located in the support platform coordinate system (also called the base coordinate) system ⁇ 0 ⁇ ).
  • the motors corresponding to each drive shaft of the gimbal need to output force to suppress the disturbance.
  • the target attitude is caused by two parts: the expected angular velocity of the motor corresponding to each drive axis of the gimbal and the angular velocity of the support platform, and the target attitude and the expected angular velocity of the motor corresponding to each drive axis of the gimbal, support
  • the angular velocity of the platform can be related as follows:
  • i is the serial number of the drive shaft of the gimbal, i is a positive integer and 1 ⁇ i ⁇ N;
  • T b0 is the representation of the support platform coordinate system in the load coordinate system
  • J is the Jacobian matrix
  • Formula (2) converts the angular velocity of the motor corresponding to each drive shaft of the gimbal and the angular velocity of the support platform to the load coordinate system, and then converts the angular velocity of the motor corresponding to each drive shaft of the gimbal to the load coordinate system and the angular velocity of the support platform.
  • the angular velocities are added to obtain the target attitude.
  • the gimbal after the gimbal is powered on, the gimbal is in the lock mode, and the user does not hit the stick. It can be 0; after the gimbal is powered on, the gimbal is in follow mode, the user hits the stick, It can be determined according to the component of the rod amount that the user hits on the drive shaft with the serial number i.
  • Desired angular velocity of the gimbal It is expressed as follows:
  • the above formula for calculating the desired angular velocity of the gimbal is only exemplary, and the above formula can be deformed to calculate the desired angular velocity of the gimbal, or the desired angular velocity of the gimbal can also be calculated in other ways.
  • multiple attitude errors and multiple expected angular velocities of the gimbal are acquired. It should be noted that multiple attitude errors and multiple desired angles are acquired simultaneously, that is, one desired angle is acquired while acquiring one attitude error.
  • the preset evaluation period in this embodiment of the present application can be updated, or the preset evaluation period is fixed.
  • the fixed preset evaluation period does not mean that the sizes of multiple preset evaluation periods within a period of time (such as the period from the startup to the shutdown of the gimbal) are the same, but refers to the same period of time.
  • the preset evaluation period can be updated means that in a plurality of preset evaluation periods within a certain period of time, the size of each preset evaluation period can be adjusted over time.
  • each preset evaluation period in the multiple preset evaluation periods within a period of time can be set as required.
  • at least two preset evaluation periods can be different.
  • the size of each preset evaluation period is equal.
  • the determination method of the preset evaluation period can be selected according to needs.
  • the preset evaluation period is determined according to the disturbance frequency and the preset sampling frequency, wherein the disturbance frequency is the frequency when the gimbal is disturbed.
  • the preset evaluation period may be updateable or fixed.
  • the preset evaluation period in the evaluation process of the performance of the gimbal, if the magnitude of the disturbance frequency changes, the preset evaluation period can be updated; during the evaluation of the gimbal performance, the magnitude of the disturbance frequency is fixed, and the preset evaluation period is The size of the period is also fixed.
  • the preset evaluation period is negatively correlated with the disturbance frequency, and positively correlated with the preset sampling frequency.
  • the data length of the preset evaluation period can be expressed as:
  • M is the data length of the preset evaluation period
  • f s is the preset sampling frequency
  • f is the disturbance frequency
  • M attitude errors and M expected angular velocities are collected, and the M attitude errors can be expressed as
  • f s 10 Hz
  • f 2 Hz
  • M is 5, that is, if the attitude error and the expected angular velocity are collected once in 0.1 second, but within a preset evaluation period, 5 attitude errors and 5 expected angular velocities are collected. , then it can be determined that the preset evaluation period is 0.5 seconds.
  • the preset evaluation period when the preset evaluation period is negatively correlated with the disturbance frequency and positively correlated with the preset sampling frequency, the preset evaluation period is not limited to formula (5), and may be other.
  • the preset evaluation period may not be determined according to the disturbance frequency and the preset sampling frequency, but may also be determined in other ways, for example, the preset evaluation period may be set by the user.
  • the disturbance frequency in the embodiment of the present application is related to the support platform.
  • the disturbance frequency is positively correlated with the change speed of the angular velocity of the support platform, that is, the faster the change of the angular velocity of the support platform, the greater the disturbance frequency; the slower the change of the angular velocity of the support platform, the higher the disturbance frequency. small. Because the faster the angular velocity of the support platform changes, the greater the disturbance to the gimbal will be, and the greater the disturbance frequency will be. Setting the disturbance frequency to be positively correlated with the change of the angular velocity of the support platform can accurately reflect that the gimbal is affected by the size of the disturbance.
  • the perturbation frequency is related to the type of support platform, wherein the support platform may include a hand-held support platform and/or an airborne support platform.
  • the support platform is a hand-held support platform, for example, the support platform is a handle of a hand-held PTZ; exemplarily, the support platform is an airborne platform, such as the PTZ mounted on a movable platform, and the support platform is the body of the movable platform.
  • the gimbal can be used as both a handheld gimbal and an airborne gimbal.
  • the support platform is the handle of the handheld gimbal; when the gimbal is used as an airborne gimbal When the platform is in use, the supporting platform is the body of the movable platform.
  • the disturbance frequencies of different types of support platforms are not the same. This is because when the gimbal is mounted on different types of support platforms, the disturbance magnitude of the gimbal may be different. Therefore, the disturbance of different types of support platforms may be different.
  • the frequencies are also different.
  • the gimbal is mounted on different types of movable platforms, and the disturbance frequencies corresponding to different types of movable platforms are different.
  • the movable platform includes a mobile car, an unmanned aerial vehicle, and a mobile robot.
  • the disturbance received by the gimbal is transmitted by the mobile car; when the gimbal is mounted on the unmanned aerial vehicle, the disturbance of the gimbal is transmitted by the unmanned aerial vehicle; when the gimbal is mounted on the mobile robot, the gimbal
  • the perturbations received are delivered by the mobile robot. Due to the different power systems and/or motion modes and/or motion parameters of the mobile car, UAV and mobile robot, the magnitude of the disturbance transmitted to the gimbal by the mobile car, UAV and mobile robot will also be different.
  • the disturbance frequency of the car, the UAV and the mobile robot is not the same. Exemplarily, the disturbance frequency corresponding to the handle of the handheld gimbal is different from the disturbance frequency corresponding to the movable platform, and the disturbance frequencies corresponding to different types of movable platforms may be different or the same.
  • the gimbal is detachably connected to the support platform, and the method for evaluating the performance of the gimbal according to the embodiment of the present application may further include: when the gimbal changes the supported support platform, adjusting the disturbance frequency based on the current support platform carried by the gimbal.
  • the gimbal is an airborne gimbal, and the gimbal is mounted on a mobile car.
  • the disturbance frequency is the disturbance frequency corresponding to the mobile car; After being installed on the unmanned aerial vehicle, when evaluating the performance of the gimbal, it is necessary to set the disturbance frequency from the disturbance frequency corresponding to the mobile car to the disturbance frequency corresponding to the unmanned aerial vehicle.
  • the gimbal can be used as a handheld gimbal or an airborne gimbal.
  • the gimbal is mounted on a movable platform.
  • the disturbance frequency is the corresponding disturbance of the movable platform.
  • the disturbance frequency needs to be set from the disturbance frequency corresponding to the movable platform to the disturbance frequency corresponding to the handle.
  • the disturbance frequency is related to the motion scene where the support platform is located, that is, the magnitude of the disturbance frequency can be adjusted based on the motion scene where the support platform is located.
  • the gimbal is a handheld gimbal.
  • the disturbance transmitted to the gimbal through the handle is smaller than that when the user uses the gimbal during running. Therefore, the frequency of disturbance when the user uses the gimbal during walking is It is less than the disturbance frequency when the user uses the gimbal during running.
  • the disturbance frequency when the user uses the gimbal during walking is 2 Hz
  • the disturbance frequency when the user uses the gimbal during running is 4 Hz.
  • the disturbance frequency can be a preset disturbance frequency, that is, the magnitude of the disturbance frequency is fixed.
  • the magnitude of the disturbance frequency can be fixed;
  • the disturbance frequency may also be updated in real time.
  • the type of the support platform and/or the scene in which the support platform is located eg, a motion scene
  • the magnitude of the disturbance frequency changes accordingly.
  • the anti-interference ability of the gimbal is evaluated according to the attitude error and the expected angular velocity.
  • the attitude error is 1 degree, and the expected angular velocity is 1 degree/second; at the second moment, the attitude error is 2 degrees, and the expected angular velocity is 10 degrees/second, wherein the first moment and the second moment are two adjacent moments. From the first moment to the second moment, the change of attitude error is 2 times, and the ratio of attitude error to expected angular velocity is changed to 10 times. The change of attitude error and the ratio of attitude error to expected angular velocity are different.
  • the attitude error evaluates the anti-interference ability of the gimbal, and the evaluation accuracy is low; the embodiment of the present application jointly evaluates the anti-interference ability of the gimbal according to the attitude error and the expected angular velocity, and improves the evaluation accuracy.
  • the anti-interference ability of the gimbal may include the gimbal's ability to suppress internal resistance (such as friction, coaxial line disturbance, etc.) and/or the gimbal's ability to suppress external disturbances.
  • the external interference can be the disturbance transmitted to the gimbal through the handle when the user holds the handle; when the gimbal is an airborne gimbal, the external disturbance can be transmitted to the cloud through the body of the movable platform when the movable platform moves. disturbance of the station.
  • the anti-jamming capability of the embodiment of the present application can reflect the control performance of the gimbal. When the anti-jamming capability is weak, it indicates that the gimbal has poor control performance; when the anti-jamming capability is strong, it indicates that the gimbal has strong control performance.
  • the gimbal is a multi-axis gimbal, and the gimbal includes multiple drive shafts.
  • the anti-interference capability of the embodiment of the present application is used to characterize the anti-interference capability of the gimbal corresponding to each drive shaft.
  • the gimbal is a three-axis gimbal, including a yaw axis, a pitch axis, and a roll axis, and the anti-jamming capability is used to characterize the anti-jamming capability of the gimbal corresponding to the yaw axis, the pitch axis, and the roll axis.
  • the anti-interference ability of the gimbal corresponding to any one of the multiple drive shafts is weak, it indicates that the anti-interference ability of the gimbal is poor; when the anti-interference ability of the gimbal corresponding to each of the multiple drive shafts is strong , indicating that the gimbal has strong anti-interference ability.
  • FIG. 3 is a schematic diagram of an implementation process of evaluating the anti-interference ability of a pan/tilt head according to an attitude error and a desired angular velocity according to an embodiment of the present application. It can be understood that the embodiment shown in FIG. 3 is different from the above in the preset evaluation period. , which corresponds to the embodiment of acquiring multiple attitude errors of the gimbal and multiple desired angular velocities.
  • the implementation process of evaluating the anti-interference ability of the gimbal may include S301-S302:
  • the plurality of attitude errors acquired in the preset evaluation period are converted into the frequency domain, and the attitude error amplitude in the preset evaluation period is obtained.
  • the attitude error amplitude of the gimbal corresponding to the drive shaft with serial number n can be expressed as:
  • M is the data length of the preset evaluation period
  • n is the sampling sequence number
  • j is the unit of the imaginary number
  • the attitude error magnitude is the maximum magnitude of the attitude error in the frequency domain.
  • a plurality of desired angular velocities obtained in a preset evaluation period are converted into the frequency domain, and the angular velocity amplitudes in the preset evaluation period are obtained.
  • the disturbance frequency f the angular velocity amplitude of the gimbal corresponding to the drive shaft with serial number n can be expressed as:
  • M is the data length of the preset evaluation period
  • n is the sampling sequence number
  • the angular velocity amplitude is the maximum amplitude value of the expected angular velocity in the frequency domain.
  • the anti-interference ability of the gimbal is evaluated according to the attitude error amplitude and the angular velocity amplitude.
  • the anti-interference ability of the gimbal is evaluated by evaluating the attitude error amplitude and the angular velocity amplitude in the preset evaluation period, and the accuracy is high. That is, the desired angular velocity of the motor can feed back the target attitude of the gimbal.
  • the desired angular velocity changes greatly, if the anti-interference ability of the gimbal is better, the actual angular velocity should also change greatly, so that the expected angular velocity and the actual angular velocity can change greatly.
  • the deviation between them is small, and it is reflected in that the attitude error of the gimbal is small, which is further reflected in that the following disturbance suppression is relatively small, and if the attitude error change is small, but the disturbance suppression is relatively large, it means that the expected angular velocity The deviation from the actual angular velocity is large. Even if the obtained attitude error is small, the anti-interference ability of the gimbal is still poor.
  • the anti-jamming capability of the gimbal is evaluated according to the attitude error magnitude and the disturbance rejection ratio.
  • the disturbance suppression ratio is the ratio of the attitude error amplitude to the angular velocity amplitude.
  • R n (f) is the disturbance rejection ratio of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f.
  • the anti-interference ability of the gimbal when evaluating the anti-interference ability of the gimbal according to the attitude error amplitude and the disturbance suppression ratio, optionally, when the attitude error amplitude and disturbance suppression ratio in at least one preset evaluation period meet the preset conditions, determine The anti-interference ability of the gimbal is weak, that is, in a plurality of preset evaluation periods within a certain period of time, as long as there is a preset evaluation period that satisfies the preset conditions, the anti-interference ability of the gimbal is considered to be weak.
  • the attitude error amplitude and the disturbance suppression ratio in at least two consecutive preset evaluation periods meet the preset conditions, and the number of at least two consecutive preset evaluation periods is greater than or equal to the preset number, determine The anti-interference ability of the PTZ is weak, that is, among the multiple preset evaluation periods within a certain period of time, there are at least two consecutive preset evaluation periods that satisfy the preset conditions, and at least two consecutive preset evaluation periods that satisfy the preset conditions.
  • the number of evaluation cycles is greater than or equal to the preset number, it is considered that the anti-interference ability of the gimbal is weak, and this method can reduce misjudgments; in addition, it is determined that the number of consecutive preset evaluation cycles in which the anti-jamming capability of the gimbal is weak is less than the predicted number. Set the number, it can be considered that the disturbance is small, and the control error of the gimbal is also small, which meets the control requirements.
  • the attitude error amplitude and the disturbance suppression ratio do not meet the preset conditions in at least two consecutive preset evaluation periods, or if there are at least two consecutive preset evaluation periods
  • the attitude error amplitude and the disturbance rejection ratio of the PTZ meet the preset conditions, but the number of consecutive at least two preset evaluation periods is less than the preset number, then the anti-interference ability of the gimbal is considered to meet the requirements, that is, the anti-interference ability of the gimbal is not considered. weak.
  • the size of the preset number can be set as required, and in an example, the preset number is 5; of course, the preset number can also be set to other numerical values, such as 10.
  • the number of preset evaluation periods that meet the preset conditions is counted by a counter.
  • the counter is incremented by 1.
  • the value of the counter is greater than or equal to 5
  • the initial value of the counter is 0.
  • the value of the counter is set to the initial value, that is, the counter is reset to zero.
  • the preset conditions may include: the attitude error magnitude is greater than a preset error magnitude threshold, and the disturbance suppression ratio is greater than a preset ratio threshold.
  • the preset condition is expressed as:
  • R n (f) is the disturbance suppression ratio of the gimbal corresponding to the drive shaft with the serial number n at the disturbance frequency f;
  • R n_thr (f) is the preset ratio threshold of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f.
  • the rotational angular velocity of the motor is 1 degree/second at the first moment
  • the attitude error corresponding to the motor is 0.1 degree
  • the rotational angular velocity of the motor is 10 degrees/second
  • the attitude corresponding to the motor The error is 0.2 degrees
  • the attitude error at the first moment is twice that of the attitude error at the second moment
  • the disturbance suppression ratio is 5 times, so even if the change of attitude error is large, if the disturbance suppression ratio does not exceed the expected value. Setting the ratio threshold will not judge that the anti-interference ability of the gimbal is poor.
  • the anti-interference ability of the gimbal can be more accurately judged, avoiding the small attitude error and the large change of the rotation angular speed of the motor, which are caused by the poor anti-interference ability of the gimbal. It also avoids the situation of using the disturbance suppression ratio alone to judge that the anti-jamming capability of the gimbal is poor when the disturbance suppression ratio is greater than the preset ratio threshold, but in fact, the attitude error is small at this time.
  • the error meets the control and control requirements, and there is no need to output the evaluation result, so that the user can repeatedly modify the control parameters to adjust the anti-interference ability of the gimbal.
  • the preset error amplitude thresholds of different disturbance frequencies are different, or the preset error amplitude thresholds of different disturbance frequencies are the same; optionally, the preset error amplitude thresholds of different drive shafts may be different, or different The preset error amplitude thresholds of the drive shafts are the same; optionally, the preset ratio thresholds of different disturbance frequencies are different, or the preset ratio thresholds of different disturbance frequencies are the same; optionally, the preset ratio thresholds of different drive shafts are different, Or the preset ratio thresholds for different drive shafts are the same.
  • the preset conditions in this embodiment of the present application may also be set to other preset conditions.
  • the preset conditions may be: the attitude error amplitude is greater than or equal to the preset error amplitude threshold, and the disturbance suppression ratio is greater than or equal to the preset ratio threshold.
  • the anti-interference ability of the gimbal can also be directly evaluated according to the attitude error and expected angular velocity collected at the same time. For example, according to the attitude error and attitude The ratio of the error to the expected angular velocity (that is, the attitude error/desired angular velocity), to evaluate the anti-interference ability of the gimbal, that is, to replace the above-mentioned attitude error amplitude with attitude error, and replace the disturbance suppression ratio with the ratio of attitude error and expected angular velocity, The specific evaluation process is similar.
  • the evaluation result is output, so that the user can adjust the control parameters of the gimbal according to the evaluation result, thereby improving the anti-interference ability of the gimbal.
  • Interference ability the evaluation results are used to characterize the strength of the anti-interference ability of the gimbal.
  • the evaluation results may be various ways to output the evaluation results. Taking the PTZ as an example of the execution subject of the performance evaluation method of the PTZ, exemplarily, text/graphics etc. Output the evaluation results, you can also output the evaluation results through the indicator light of the gimbal, or output the evaluation results in other ways.
  • the evaluation results are output through text/graphics, etc., wherein, when the gimbal has its own display screen, the evaluation results can be output through the display screen of the gimbal and/or through the display screen of the control device of the gimbal. Evaluation results; when the gimbal does not have its own display screen, the evaluation results can be output through the display screen of the control device of the gimbal.
  • the above-mentioned evaluation procedure of gimbal performance may be performed all the time, except that the gimbal is in sleep state, that is, when the gimbal is in a dormant state, the above-mentioned gimbal performance will not be performed.
  • the anti-jamming performance of the gimbal will continue to be evaluated based on the above method, and the evaluation result will be output, so that after the gimbal is started, it can continue to Identify the anti-interference performance of the gimbal, so as to continuously feedback the evaluation results to the user in a timely manner, which is beneficial for the user to perform corresponding operations according to the evaluation results, thereby improving the reliability and stabilization performance of the gimbal, and improving the user experience of using the gimbal
  • the evaluation result indicates that the anti-jamming capability of the gimbal is weak, or the gimbal is switched from a working state to a dormant state, or is switched from a working state to an off state
  • the evaluation of the anti-jamming performance of the gimbal is ended.
  • the program exemplarily, when the evaluation result indicates that the anti-jamming capability of the gimbal is weak, the evaluation procedure of the anti-jamming performance of the gimbal is ended, and the evaluation result indicates that the anti-jamming capability of the gimbal is weak, which indicates that the control parameters of the gimbal are effective and effective.
  • the load does not match, requiring the user to adjust the control parameters and/or the payload, such as adjusting the size of the control parameters and/or the location of the payload installed on the gimbal and/or replacing the payload, etc. After the user adjusts the control parameters and/or the payload In the process of/or payload, it is of little significance to evaluate the anti-jamming performance of the gimbal.
  • the evaluation procedure of the anti-jamming performance of the gimbal is ended; exemplarily, When the gimbal is switched from the working state to the dormant state, or from the working state to the off state, the evaluation procedure of the anti-interference performance of the gimbal ends.
  • the gimbal is in the dormant state or the closed state, the user does not need to use the gimbal. Therefore, there is no need to evaluate the anti-jamming performance of the gimbal.
  • the modification of the control parameter means that the size of the control parameter is modified
  • the change of the payload may include: change of the type of the payload and/or change of the installation position of the payload.
  • the embodiment of the present application further provides a device for evaluating the performance of the pan/tilt.
  • the apparatus for evaluating the performance of the pan/tilt according to the embodiment of the present application may include a storage device and a processor, and the processor includes one or more processors.
  • the storage device is used for storing program instructions.
  • the storage device stores the executable instruction computer program of the evaluation method for the performance of the PTZ
  • the storage device may include at least one type of storage medium, and the storage medium includes a flash memory, a hard disk, a multimedia card, a card-type memory (for example, SD or DX memory, etc.), Random Access Memory (RAM), Static Random Access Memory (SRAM), Read Only Memory (ROM), Electrically Erasable Programmable Read Only Memory (EEPROM), Programmable Read Only Memory (PROM) ), magnetic memory, magnetic disks, optical disks, etc.
  • the device for evaluating the performance of the PTZ may cooperate with a network storage device that performs the storage function of the memory through a network connection.
  • the memory may be an internal storage unit of the device for evaluating the performance of the PTZ, such as a hard disk or a memory of the device for evaluating the performance of the PTZ.
  • the memory can also be an external storage device of the performance evaluation device of the PTZ, such as a plug-in hard disk, a Smart Media Card (SMC), a Secure Digital (SD) card equipped on the performance evaluation device of the PTZ , Flash card (Flash Card) and so on.
  • the memory may also include both an internal storage unit of the apparatus for evaluating the performance of the PTZ and an external storage device.
  • Memory is used to store computer programs and other programs and data required by the device.
  • the memory can also be used to temporarily store data that has been or will be output.
  • One or more processors call program instructions stored in the storage device, and when the program instructions are executed, the one or more processors are individually or collectively configured to perform the following operations: acquiring the attitude error of the pan/tilt and the Desired angular velocity, the attitude error is determined based on the measurement attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit ; Evaluate the anti-interference ability of the gimbal according to the attitude error and expected angular velocity.
  • the processor of this embodiment can implement the pan-tilt performance evaluation method according to the embodiment shown in FIG. 2 and FIG. 3 of the present application.
  • the processor may be a central processing unit (Central Processing Unit, CPU), or other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), application specific integrated circuits (Application Specific Integrated Circuit, ASIC), field Field-Programmable Gate Array (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc.
  • CPU Central Processing Unit
  • DSP Digital Signal Processor
  • ASIC Application Specific Integrated Circuit
  • FPGA field Field-Programmable Gate Array
  • a general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.
  • an embodiment of the present application further provides a pan/tilt head, which is mounted on a support platform.
  • the unit 220, the second inertial measurement unit 230, and the device for evaluating the performance of the gimbal in the above-mentioned embodiment wherein the bearing part 210 is used to support the payload, the first inertial measurement unit 220 is arranged on the bearing part or the payload, and the second inertial
  • the measurement unit 230 is disposed on the support platform, and the device for evaluating the performance of the gimbal is electrically connected to the first inertial measurement unit 220 and the second inertial measurement unit 230 respectively.
  • the gimbal in the embodiment of the present application may be a handheld gimbal or an airborne gimbal.
  • an embodiment of the present application further provides a movable platform
  • the movable platform may include a body and the pan/tilt of the above embodiment, and the pan/tilt is mounted on the body.
  • the movable platform in the embodiment of the present application may be a mobile car, an unmanned aerial vehicle (such as an unmanned aerial vehicle or a manned aerial vehicle) or a mobile robot, and it should be understood that the movable platform may also be other movable equipment or devices.
  • the movable platform is an unmanned aerial vehicle 100
  • the supporting platform is the body 110 of the unmanned aerial vehicle 100 .
  • an embodiment of the present application further provides a computer-readable storage medium on which a computer program is stored, and when the program is executed by a processor, implements the steps of the method for evaluating the performance of the pan/tilt in the foregoing embodiment.
  • the computer-readable storage medium may be an internal storage unit of the PTZ described in any of the foregoing embodiments, such as a hard disk or a memory.
  • the computer-readable storage medium can also be an external storage device of the PTZ, such as a plug-in hard disk, a smart memory card (Smart Media Card, SMC), an SD card, a flash memory card (Flash Card), etc. that are equipped on the device.
  • the computer-readable storage medium may also include both an internal storage unit of the PTZ and an external storage device.
  • the computer-readable storage medium is used to store the computer program and other programs and data required by the PTZ, and can also be used to temporarily store data that has been output or will be output.
  • the storage medium may be a magnetic disk, an optical disk, a read-only memory (Read-Only Memory, ROM), or a random access memory (Random Access Memory, RAM) or the like.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Studio Devices (AREA)
  • Gyroscopes (AREA)

Abstract

A gimbal performance evaluation method. A gimbal is mounted on a support platform; the gimbal is used for supporting a payload; the gimbal or the payload is provided with a first inertia measurement unit; and the support platform is provided with a second inertia measurement unit. The method comprises: obtaining an attitude error and a desired angular velocity of a gimbal, wherein the attitude error is determined on the basis of a measured attitude of the gimbal determined by a first inertia measurement unit and a set target attitude of the gimbal, and the desired angular velocity is determined on the basis of the target attitude and an angular velocity of a support platform determined by a second inertia measurement unit; and evaluating an anti-interference capability of the gimbal according to the attitude error and the desired angular velocity. The evaluation mode of the present application is high in precision, can provide a user with an accurate evaluation result, and has significance for improving the reliability and stability augmentation performance of a gimbal and improving gimbal use experience of a user.

Description

云台及其性能的评估方法及装置、可移动平台PTZ and its performance evaluation method and device, and movable platform 技术领域technical field
本申请涉及云台领域,尤其涉及一种云台及其性能的评估方法及装置、可移动平台。The present application relates to the field of PTZ, and in particular, to a PTZ and its performance evaluation method and device, and a movable platform.
背景技术Background technique
云台的工作原理是:通过检测负载的实际姿态,并将实际姿态和设定的云台的目标姿态做比较,确定姿态偏差,以此进行负反馈控制,输出给电机力矩,最终减小姿态偏差,保证负载的姿态偏差尽量小。The working principle of the gimbal is: by detecting the actual attitude of the load and comparing the actual attitude with the set target attitude of the gimbal, the attitude deviation is determined, so as to carry out negative feedback control, output the torque to the motor, and finally reduce the attitude deviation, to ensure that the attitude deviation of the load is as small as possible.
在云台的控制参数如电机的输出力度(电机对应速度的响应)、强度(电机对于角度的响应)、滤波参数等被人为修改和/或负载变更后,可能会出现控制参数与负载不匹配而导致云台的抗干扰能力下降的情况,此时,云台的可靠性和增稳性能均较低,用户使用云台的体验较差。然而,目前的云台大都不具备抗干扰能力的评估功能,另外一些云台虽然在云台的控制参数被人为修改和/或负载变更后,会根据姿态误差来评估云台的抗干扰能力是否下降,以对用户提醒,而仅根据姿态误差评估云台的抗干扰能力是否下降的方式会出现误判。After the control parameters of the gimbal, such as the output strength of the motor (the response of the motor to the speed), the strength (the response of the motor to the angle), the filter parameters, etc. are artificially modified and/or the load is changed, the control parameters may not match the load. In the situation where the anti-interference ability of the gimbal decreases, the reliability and stabilization performance of the gimbal are both low, and the user experience of using the gimbal is poor. However, most of the current gimbals do not have the evaluation function of anti-jamming capability, and some gimbals will evaluate the anti-interference ability of the gimbals according to the attitude error even after the control parameters of the gimbals are artificially modified and/or the load is changed. Drop, to remind the user, and only evaluating the anti-interference ability of the gimbal based on the attitude error will lead to misjudgment.
发明内容SUMMARY OF THE INVENTION
本申请提供一种云台及其性能的评估方法及装置、可移动平台。The present application provides a gimbal, a method and device for evaluating its performance, and a movable platform.
第一方面,本申请实施例提供一种云台性能的评估方法,云台搭载在支撑平台上,所述云台用于支撑有效载荷,所述云台或所述有效载荷上设有第一惯性测量单元,所述支撑平台上设有第二惯性测量单元,所述方法包括:In the first aspect, an embodiment of the present application provides a method for evaluating the performance of a gimbal. The gimbal is mounted on a support platform, the gimbal is used to support a payload, and the gimbal or the payload is provided with a first Inertial measurement unit, the support platform is provided with a second inertial measurement unit, and the method includes:
获取所述云台的姿态误差和期望角速度,所述姿态误差为基于所述第一惯性测量单元确定的所述云台的测量姿态和设定的所述云台的目标姿态确定,所述期望角速度为根据所述目标姿态和基于所述第二惯性测量单元确定的所述支撑平台的角速度确定;Obtain the attitude error and expected angular velocity of the gimbal, where the attitude error is determined based on the measured attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected The angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit;
根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力。According to the attitude error and the expected angular velocity, the anti-interference ability of the gimbal is evaluated.
第二方面,本申请实施例提供一种云台性能的评估装置,云台搭载在支撑平台上,所述云台用于支撑有效载荷,所述云台或所述有效载荷上设有第一惯性测量单元,所述支撑平台上设有第二惯性测量单元,所述云台性能的评估装置包括:In a second aspect, an embodiment of the present application provides a device for evaluating the performance of a gimbal. The gimbal is mounted on a support platform, the gimbal is used to support a payload, and the gimbal or the payload is provided with a first Inertial measurement unit, the support platform is provided with a second inertial measurement unit, and the evaluation device for the performance of the pan/tilt includes:
存储装置,用于存储程序指令;以及a storage device for storing program instructions; and
一个或多个处理器,调用所述存储装置中存储的程序指令,当所述程序指令被 执行时,所述一个或多个处理器单独地或共同地被配置成用于实施如下操作:one or more processors that invoke program instructions stored in the memory device, the one or more processors, when executed, are individually or collectively configured to perform the following operations:
获取所述云台的姿态误差和期望角速度,所述姿态误差为基于所述第一惯性测量单元确定的所述云台的测量姿态和设定的所述云台的目标姿态确定,所述期望角速度为根据所述目标姿态和基于所述第二惯性测量单元确定的所述支撑平台的角速度确定;Obtain the attitude error and expected angular velocity of the gimbal, where the attitude error is determined based on the measured attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected The angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit;
根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力。According to the attitude error and the expected angular velocity, the anti-interference ability of the gimbal is evaluated.
第三方面,本申请实施例提供一种云台,云台搭载在支撑平台上,所述云台包括:In a third aspect, an embodiment of the present application provides a pan/tilt, the pan/tilt is mounted on a support platform, and the pan/tilt includes:
承载部,用于支撑有效载荷;the load-bearing part, which is used to support the payload;
第一惯性测量单元,设于所述承载部或所述有效载荷上;a first inertial measurement unit, arranged on the bearing portion or the payload;
第二惯性测量单元,设于所述支撑平台上;和a second inertial measurement unit, disposed on the support platform; and
第二方面所述的云台性能的评估装置,与所述第一惯性测量单元及所述第二惯性测量单元分别电连接。The device for evaluating the performance of the pan/tilt according to the second aspect is electrically connected to the first inertial measurement unit and the second inertial measurement unit, respectively.
第四方面,本申请实施例提供一种可移动平台,所述可移动平台包括:In a fourth aspect, an embodiment of the present application provides a movable platform, where the movable platform includes:
机体;和body; and
第三方面所述的云台,搭载在所述机体上。The pan/tilt according to the third aspect is mounted on the body.
根据本申请实施例提供的技术方案,本申请通过获取云台的姿态误差和期望角速度,并根据姿态误差和期望角速度来评估云台的抗干扰能力,同时通过云台或有效载荷上的第一惯性测量单元以及支撑平台上的第二惯性测量单元,确保在任何场景下,始终能够得到云台的测量姿态和支撑平台的角速度,从而确保始终能够获取姿态误差和期望角速度,这种评估方式精度高,可以给用户较为准确的评估结果,这对于提高云台可靠性和增稳性能以及提升用户使用云台的体验均具有重要的意义。According to the technical solutions provided by the embodiments of the present application, the present application obtains the attitude error and the expected angular velocity of the gimbal, and evaluates the anti-interference ability of the gimbal according to the attitude error and the expected angular velocity. The inertial measurement unit and the second inertial measurement unit on the support platform ensure that in any scenario, the measured attitude of the gimbal and the angular velocity of the support platform can always be obtained, so as to ensure that the attitude error and expected angular velocity can always be obtained. The accuracy of this evaluation method It can give users more accurate evaluation results, which is of great significance for improving the reliability and stabilization performance of the gimbal and improving the user experience of using the gimbal.
附图说明Description of drawings
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to illustrate the technical solutions in the embodiments of the present application more clearly, the following briefly introduces the drawings that are used in the description of the embodiments. Obviously, the drawings in the following description are only some embodiments of the present application. For those of ordinary skill in the art, other drawings can also be obtained from these drawings without creative labor.
图1A是本申请一实施例中的云台的使用场景示意图;FIG. 1A is a schematic diagram of a usage scenario of a gimbal in an embodiment of the present application;
图1B是本申请另一实施例中的云台的使用场景示意图;FIG. 1B is a schematic diagram of a usage scenario of a PTZ in another embodiment of the present application;
图2是本申请一实施例中的云台性能的评估方法的方法流程示意图;2 is a schematic flowchart of a method for evaluating the performance of a gimbal in an embodiment of the present application;
图3是本申请一实施例中的根据姿态误差和期望角速度,评估云台的抗干扰能 力的一种实现过程示意图;Fig. 3 is a kind of realization process schematic diagram of evaluating the anti-interference ability of the pan-tilt head according to attitude error and expected angular velocity in an embodiment of the present application;
图4是本申请一实施例中的云台性能的评估装置的结构示意图;4 is a schematic structural diagram of a device for evaluating the performance of a gimbal in an embodiment of the present application;
图5是本申请一实施例中的云台的结构示意图。FIG. 5 is a schematic structural diagram of a pan/tilt in an embodiment of the present application.
具体实施方式detailed description
在云台的控制参数如电机的输出力度(电机对应速度的响应)、强度(电机对于角度的响应)、滤波参数等被人为修改和/或负载变更后,可能会出现控制参数与负载不匹配而导致云台的抗干扰能力(对扰动的抑制能力,可以体现为诸如增稳能力)下降的情况,此时,云台的可靠性和增稳性能均较低,用户使用云台的体验较差。After the control parameters of the gimbal, such as the output strength of the motor (the response of the motor to the speed), the strength (the response of the motor to the angle), the filter parameters, etc. are artificially modified and/or the load is changed, the control parameters may not match the load. As a result, the anti-interference ability of the gimbal (the ability to suppress disturbance, which can be reflected in such as stabilization capability) decreases. At this time, the reliability and stabilization performance of the gimbal are both low, and the user experience of using the gimbal is relatively low. Difference.
然而,目前的云台大都不具备抗干扰能力的评估功能,另外一些云台虽然在云台的控制参数被人为修改和/或负载变更后,会根据姿态误差来评估云台的抗干扰能力是否下降,以对用户提醒,而发明人发现在姿态误差较小的情况下,也出现了抗干扰能力下降的问题,但在实际应用中,影响云台抗干扰能力的因素有多种,比如控制参数与负载之间的匹配度、云台与负载之间的连接强度、云台的结构稳定性,如何准确评估云台的抗干扰能力并不是容易的问题。However, most of the current gimbals do not have the evaluation function of anti-jamming capability, and some gimbals will evaluate the anti-interference ability of the gimbals according to the attitude error even after the control parameters of the gimbals are artificially modified and/or the load is changed. drop to remind the user, and the inventor found that in the case of a small attitude error, the problem of decreased anti-interference ability also occurs, but in practical applications, there are many factors that affect the anti-interference ability of the gimbal, such as control The matching degree between the parameters and the load, the connection strength between the gimbal and the load, the structural stability of the gimbal, how to accurately evaluate the anti-interference ability of the gimbal is not an easy problem.
对于此,发明人做了多种尝试,以调整基于姿态误差判断云台的抗干扰能力的准确度,例如,加固云台与负载之间的连接强度,但在扰动变化的情况下,基于姿态误差判断云台的抗干扰能力的准确度仍较差。后来,发明人发现电机的转动角速度结合姿态误差反馈云台的抗干扰能力,可以解决扰动变化程度不同,但云台的抗干扰能力的准确度的判断不准的问题。例如,在第一时刻,电机的转动角速度为1度/秒,该电机对应的姿态误差为0.1度;在第二时刻,电机的转动角速度为10度/秒,该电机对应的姿态误差为0.2度,由此可见,第二时刻的姿态误差是第一时刻的姿态误差的2倍,姿态误差变大,但是第二时刻的转动角速度是第一时刻的转动角速度的10倍,即第二时刻的扰动远大于第一时刻的扰动,此时第二时刻的抗干扰能力应该是优于第一时刻的抗干扰能力。因此,这种仅根据姿态误差评估云台的抗干扰能力是否下降的方式会出现误判。In this regard, the inventor has made various attempts to adjust the accuracy of judging the anti-interference ability of the gimbal based on the attitude error, for example, to strengthen the connection strength between the gimbal and the load, but in the case of changes in disturbance, the attitude-based The accuracy of the error judgment of the anti-interference ability of the gimbal is still poor. Later, the inventor found that the rotation angular velocity of the motor combined with the anti-interference ability of the attitude error feedback gimbal can solve the problem that the degree of disturbance change is different, but the accuracy of the anti-interference ability of the gimbal is not accurate. For example, at the first moment, the rotational angular velocity of the motor is 1 degree/second, and the attitude error corresponding to the motor is 0.1 degree; at the second moment, the rotational angular velocity of the motor is 10 degrees/second, and the attitude error corresponding to the motor is 0.2 It can be seen that the attitude error at the second moment is twice that of the first moment, and the attitude error becomes larger, but the rotational angular velocity at the second moment is 10 times the rotational angular velocity at the first moment, that is, the second moment The disturbance is much larger than the disturbance at the first moment, and the anti-interference ability at the second moment should be better than the anti-interference ability at the first moment. Therefore, this method of evaluating whether the anti-jamming capability of the gimbal is degraded only based on the attitude error will lead to misjudgment.
基于现有根据姿态误差评估云台的抗干扰能力是否下降的方式进行了改进,通过获取云台的姿态误差和期望角速度,并根据姿态误差和期望角速度来评估云台的抗干扰能力,同时通过云台或有效载荷上的第一惯性测量单元以及支撑平台上的第二惯性测量单元,确保在任何场景下,始终能够得到云台的测量姿态和支撑平台的角速度,从而确保始终能够获取姿态误差和期望角速度,这种评估方式精度高,可以给用户较为准确的评估结果,这对于提高云台可靠性和增稳性能以及提升用户使用云台的体验均具有重要的意义。Based on the existing method of assessing whether the anti-interference ability of the gimbal is declining according to the attitude error, the anti-interference ability of the gimbal is evaluated by obtaining the attitude error and the expected angular velocity of the gimbal, and evaluating the anti-interference ability of the gimbal according to the attitude error and the expected angular velocity. The first inertial measurement unit on the gimbal or payload and the second inertial measurement unit on the support platform ensure that the measured attitude of the gimbal and the angular velocity of the support platform can always be obtained in any scenario, thus ensuring that the attitude error can always be obtained. and expected angular velocity, this evaluation method has high accuracy and can give users more accurate evaluation results, which is of great significance for improving the reliability and stabilization performance of the gimbal and improving the user experience of using the gimbal.
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行描述,显然。The technical solutions in the embodiments of the present application will be described below with reference to the accompanying drawings in the embodiments of the present application, obviously.
需要说明的是,在不冲突的情况下,下述的实施例及实施方式中的特征可以相互组合。It should be noted that, in the case of no conflict, the features in the following embodiments and implementations can be combined with each other.
本申请中,“至少一个”是指一个或者多个,“多个”是指两个或两个以上。“和/或”,描述关联对象的关联关系,表示可以存在三种关系,例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B的情况,其中A,B可以是单数或者复数。字符“/”一般表示前后关联对象是一种“或”的关系。“以下至少一项(个)”或其类似表达,是指的这些项中的任意组合,包括单项(个)或复数项(个)的任意组合。例如,a、b、或c中的至少一项(个),可以表示:a、b、c,a和b,a和c,b和c,或a和b和c,其中a、b、c可以是单个,也可以是多个。In this application, "at least one" means one or more, and "plurality" means two or more. "And/or", which describes the relationship of the associated objects, indicates that there can be three kinds of relationships, for example, A and/or B, it can indicate that A exists alone, A and B exist at the same time, and B exists alone, where A, B can be singular or plural. The character "/" generally indicates that the associated objects are an "or" relationship. "At least one item(s) below" or similar expressions thereof refer to any combination of these items, including any combination of single item(s) or plural items(s). For example, at least one (a) of a, b, or c may represent: a, b, c, a and b, a and c, b and c, or a and b and c, where a, b, c can be single or multiple.
本申请实施例的云台搭载在支撑平台上,且云台用于支撑有效载荷。其中,云台可以为手持云台,也可以为机载云台,或者云台既可以作为手持云台,也可以作为机载云台使用。支撑平台的类型与云台的类型相关,示例性的,云台为手持云台,支撑平台为手持云台的手柄(或称作基座);示例性的,云台为机载云台,例如,云台可搭载在可移动平台上,支撑平台为可移动平台的机体,可移动平台可以为移动小车、无人飞行器(如无人机或有人飞行器)或移动机器人,可以理解的是,可移动平台也可为其他可移动的设备或装置。示例性的,请参见图1A,云台200搭载在无人机100的机体110上,有效载荷300搭载在云台200上,支撑平台为无人机100的机体110。示例性的,请参见图1B,云台200为手持云台,有效载荷300搭载在云台200的承载部220上,支撑平台为手柄210。The gimbal of the embodiment of the present application is mounted on a support platform, and the gimbal is used to support a payload. The gimbal may be a handheld gimbal or an airborne gimbal, or the gimbal may be used as a handheld gimbal or an airborne gimbal. The type of the supporting platform is related to the type of the pan/tilt. Exemplarily, the pan/tilt is a handheld pan/tilt, and the supporting platform is the handle (or called the base) of the hand-held pan/tilt; exemplarily, the pan/tilt is an airborne pan/tilt. For example, the gimbal can be mounted on a movable platform, the supporting platform is the body of the movable platform, and the movable platform can be a mobile car, an unmanned aerial vehicle (such as an unmanned aerial vehicle or a manned aerial vehicle) or a mobile robot. It can be understood that, The movable platform can also be other movable devices or devices. 1A , the pan/tilt 200 is mounted on the body 110 of the drone 100 , the payload 300 is mounted on the pan/tilt 200 , and the support platform is the body 110 of the drone 100 . Exemplarily, please refer to FIG. 1B , the gimbal 200 is a handheld gimbal, the payload 300 is carried on the bearing portion 220 of the gimbal 200 , and the support platform is the handle 210 .
另外,本申请实施例的云台可以为单轴云台,也可以为多轴云台,如两轴云台、三轴云台等。下述实施例中,以云台为多轴云台为例,云台包括多个驱动轴,如偏航轴、俯仰轴和横滚轴中的至少两个,示例性的,云台为三轴云台,包括偏航轴、俯仰轴和横滚轴;示例性的,云台为两轴云台,包括偏航轴和俯仰轴,或者偏航轴和横滚轴,或者俯仰轴和横滚轴。In addition, the pan/tilt in the embodiment of the present application may be a single-axis pan/tilt, or may be a multi-axis pan/tilt, such as a two-axis pan/tilt, a three-axis pan/tilt, and the like. In the following embodiments, taking the gimbal as a multi-axis gimbal as an example, the gimbal includes multiple drive axes, such as at least two of the yaw axis, the pitch axis and the roll axis. Exemplarily, the gimbal is three. Axis gimbal, including yaw axis, pitch axis and roll axis; exemplarily, the gimbal is a two-axis gimbal including yaw axis and pitch axis, or yaw axis and roll axis, or pitch axis and yaw axis roller.
有效载荷是指能够随云台的姿态变化而变化的负载,该负载可以包括拍摄装置,也可以包括其他,如避障传感器。示例性的,负载为拍摄装置;示例性的,负载为避障传感器;示例性的,负载包括拍摄装置和避障传感器。The payload refers to the payload that can change with the attitude change of the gimbal. The payload may include a camera or other objects, such as obstacle avoidance sensors. Exemplarily, the payload is a photographing device; exemplarily, the payload is an obstacle avoidance sensor; exemplarily, the payload includes a photographing device and an obstacle avoidance sensor.
本申请实施例中,云台或有效载荷上设有第一惯性测量单元,从而可以通过第一惯性测量单元检测获得云台的测量姿态。第一惯性测量单元的设置位置可以根据云台和有效载荷之间的配合方式决定,可选的,云台被配置为与有效载荷可拆卸地连接,第一惯性测量单元设于云台上,如此,在更换有效载荷后,无需重新安装第一惯性测量单元;可选的,云台被配置为与有效载荷不可拆卸地连接,第一惯性测量单元设于云台或有效载荷上。In the embodiment of the present application, a first inertial measurement unit is provided on the gimbal or payload, so that the measurement attitude of the gimbal can be obtained through detection by the first inertial measurement unit. The setting position of the first inertial measurement unit can be determined according to the cooperation mode between the gimbal and the payload. Optionally, the gimbal is configured to be detachably connected to the payload, and the first inertial measurement unit is arranged on the gimbal, In this way, after replacing the payload, there is no need to reinstall the first inertial measurement unit; optionally, the gimbal is configured to be non-detachably connected to the payload, and the first inertial measurement unit is provided on the gimbal or the payload.
进一步的,支撑平台上设有第二惯性测量单元,从而可以通过第二惯性测量单 元检测获得支撑平台的角速度。其中,当云台为手持云台时,支撑平台为手柄,若用户手动转动手柄,即手柄的角速度不是零,但云台还是静止的,即云台的角速度为零,此时,第一惯性测量单元检测获得的云台的角速度并非手柄的角速度,即在用户手动转动手柄,但云台静止的情况下,无法通过第一惯性测量单元来检测手柄的角速度;可以理解的是,在用户转动手柄,云台跟随手柄运动的情况下,第一惯性测量单元检测获得的角速度即为云台的角速度,也为手柄的角速度,即在用户转动手柄,云台跟随手柄运动的情况下,可以通过第一惯性测量单元来检测手柄的角速度。对于机载云台,上述情况同样适用,不再赘述。其中,对于机载云台,例如,云台可搭载在可移动平台上,支撑平台为可移动平台的机体,第二惯性测量单元可以是在机体内的惯性测量单元,例如,对于可移动平台为无人飞行器而言,无人飞行器内也设有惯性测量单元,以能够反馈无人飞行器的姿态。Further, a second inertial measurement unit is provided on the support platform, so that the angular velocity of the support platform can be obtained through detection by the second inertial measurement unit. Among them, when the gimbal is a handheld gimbal, the support platform is the handle. If the user manually rotates the handle, the angular velocity of the handle is not zero, but the gimbal is still stationary, that is, the angular velocity of the gimbal is zero. At this time, the first inertia The angular velocity of the gimbal detected by the measurement unit is not the angular velocity of the handle, that is, when the user manually rotates the handle but the gimbal is stationary, the angular velocity of the handle cannot be detected by the first inertial measurement unit; it is understandable that when the user rotates the handle When the handle and the gimbal follow the movement of the handle, the angular velocity detected by the first inertial measurement unit is the angular velocity of the gimbal and the angular velocity of the handle. A first inertial measurement unit to detect the angular velocity of the handle. For the airborne pan/tilt, the above situation is also applicable and will not be repeated here. Wherein, for the airborne pan/tilt, for example, the pan/tilt can be mounted on a movable platform, the support platform is the body of the movable platform, and the second inertial measurement unit may be an inertial measurement unit in the body, for example, for the movable platform For the unmanned aerial vehicle, an inertial measurement unit is also provided in the unmanned aerial vehicle to be able to feedback the attitude of the unmanned aerial vehicle.
需要说明的是,通过第一惯性测量单元检测获得云台的测量姿态,以及通过第二惯性测量单元检测获得支撑平台的角速度均为现有技术,本申请对此不作具体介绍。It should be noted that, obtaining the measurement attitude of the pan/tilt head through detection by the first inertial measurement unit, and obtaining the angular velocity of the support platform through detection by the second inertial measurement unit are both in the prior art, which are not described in detail in this application.
另外,本申请实施例对第一惯性测量单元、第二惯性测量单元的类型不作具体限定,示例性的,第一惯性测量单元和第二惯性测量单元均包括加速度计和陀螺仪。In addition, the embodiments of the present application do not specifically limit the types of the first inertial measurement unit and the second inertial measurement unit. Exemplarily, both the first inertial measurement unit and the second inertial measurement unit include an accelerometer and a gyroscope.
图2是本申请一实施例中的云台性能的评估方法的方法流程示意图;本申请实施例的云台性能的评估方法的执行主体可以为云台,也可以为其他,如云台的控制装置,其中,云台的控制装置可以包括遥控器、手机、平板电脑或智能穿戴设备等;又如当云台搭载在可移动平台上时,云台性能的评估方法的执行主体可以为可移动平台;当然,云台性能的评估方法的执行主体不限于上述列举的几种执行主体,还可以为其他能够与云台通信的装置。请参见图2,本申请实施例提供一种云台性能的评估方法可以包括S201~S202:2 is a schematic flowchart of a method for evaluating the performance of a PTZ in an embodiment of the present application; the execution subject of the method for evaluating performance of a PTZ in an embodiment of the present application may be the PTZ, or may be other, such as the control of the PTZ device, wherein the control device of the gimbal may include a remote control, a mobile phone, a tablet computer or a smart wearable device, etc.; for another example, when the gimbal is mounted on a movable platform, the execution subject of the evaluation method of the gimbal performance may be a movable Platform; of course, the execution subject of the PTZ performance evaluation method is not limited to the execution subjects listed above, and may also be other devices that can communicate with the PTZ. Referring to FIG. 2 , a method for evaluating the performance of a gimbal provided by an embodiment of the present application may include S201 to S202:
在S201中,获取云台的姿态误差和期望角速度,姿态误差为基于第一惯性测量单元确定的云台的测量姿态和设定的云台的目标姿态确定,期望角速度为根据目标姿态和基于第二惯性测量单元确定的支撑平台的角速度确定;In S201, the attitude error and expected angular velocity of the gimbal are obtained, the attitude error is determined based on the measurement attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected angular velocity is determined based on the target attitude and the set target attitude of the gimbal. 2. Determine the angular velocity of the support platform determined by the inertial measurement unit;
其中,在一些实施例中,目标姿态为默认姿态大小,示例性的,云台上电启动后,用户未打杆,目标姿态可默认为(0,0,0);在一些实施例中,目标姿态由用户设定,示例性的,目标姿态为根据用户打杆的杆量确定;在一些实施例中,目标姿态基于支撑平台的姿态设定,示例性的,在跟随模式下,云台的姿态跟随支撑平台的姿态,目标姿态即基于支撑平台的姿态设定。Wherein, in some embodiments, the target posture is the default posture size. Exemplarily, after the gimbal is powered on and the user does not hit the stick, the target posture may be (0, 0, 0) by default; in some embodiments, The target posture is set by the user. Exemplarily, the target posture is determined according to the amount of the rod that the user hits; in some embodiments, the target posture is set based on the posture of the support platform. The attitude of the target follows the attitude of the support platform, and the target attitude is set based on the attitude of the support platform.
本申请实施例的云台性能的评估方法可适用于云台处于锁定模式下,也可适用于云台处于跟随模式下。示例性的,本申请实施例的云台性能的评估方法云台处于锁定模式下,锁定模式用于指示云台保持在目标姿态。需要说明的是,在锁定模式下,当云台处于目标姿态时,云台的各个驱动轴均用于增稳,从而使得有效载荷在空间定 向。本申请即通过目标姿态使得有效载荷在空间定向,从而确定云台各驱动轴对应的电机的期望角速度,其中,在锁定模式下,目标姿态保持不变,使得云台各驱动轴对应的电机的期望角速度的计算可以免受目标姿态的干扰,有利于简化计算。The method for evaluating the performance of the gimbal in the embodiment of the present application can be applied when the gimbal is in the lock mode, and can also be applied when the gimbal is in the follow mode. Exemplarily, in the method for evaluating the performance of the gimbal in the embodiment of the present application, the gimbal is in a locking mode, and the locking mode is used to instruct the gimbal to maintain a target attitude. It should be noted that in the locked mode, when the gimbal is in the target attitude, each drive axis of the gimbal is used for stabilization, so that the payload is oriented in space. In this application, the target attitude is used to orient the payload in space, so as to determine the desired angular velocity of the motor corresponding to each drive shaft of the gimbal. The calculation of the desired angular velocity can be free from the interference of the target attitude, which is beneficial to simplify the calculation.
S201中获取的姿态误差可以位于关节角空间坐标系中;当然,S201中获取的姿态误差也可以不是位于关节角空间坐标系中的,可以通过坐标转换,将姿态误差转换至关节角空间坐标系中,以使得姿态误差和期望角速度均位于关节角坐标系。其中,姿态误差在关节角坐标系中可以表示为:The attitude error obtained in S201 may be located in the joint angle space coordinate system; of course, the attitude error obtained in S201 may not be located in the joint angle space coordinate system, and the attitude error can be converted into the joint angle space coordinate system through coordinate transformation. , so that both the attitude error and the desired angular velocity are located in the joint angular coordinate system. Among them, the attitude error in the joint angle coordinate system can be expressed as:
Figure PCTCN2020103049-appb-000001
Figure PCTCN2020103049-appb-000001
公式(1)中,δ J为关节角坐标系中的姿态误差,其中,
Figure PCTCN2020103049-appb-000002
为序号为1的驱动轴在关节角坐标系中的姿态误差,
Figure PCTCN2020103049-appb-000003
为序号为n的驱动轴在关节角坐标系中的姿态误差,
Figure PCTCN2020103049-appb-000004
为序号为N的驱动轴在关节角坐标系中的姿态误差;
In formula (1), δ J is the attitude error in the joint angle coordinate system, where,
Figure PCTCN2020103049-appb-000002
is the attitude error of the drive shaft with serial number 1 in the joint angular coordinate system,
Figure PCTCN2020103049-appb-000003
is the attitude error of the drive shaft with serial number n in the joint angular coordinate system,
Figure PCTCN2020103049-appb-000004
is the attitude error of the drive shaft with serial number N in the joint angular coordinate system;
N为云台的驱动轴的轴数,例如,云台为三轴云台,N则等于3;云台为两轴云台,N则等于2;云台为单轴云台,N则等于1,以此类推;N is the axis number of the drive shaft of the gimbal. For example, if the gimbal is a three-axis gimbal, N is equal to 3; if the gimbal is a two-axis gimbal, N is equal to 2; if the gimbal is a single-axis gimbal, N is equal to 2. 1, and so on;
n为正整数,表示序号为n的驱动轴的序号,1≤n≤N。n is a positive integer, indicating the serial number of the drive shaft with serial number n, 1≤n≤N.
姿态误差的产生是由于在控制测量姿态趋近于目标姿态时,无法完全到达目标姿态,而与目标姿态之间存在差值(即趋近于目标姿态的测量姿态和目标姿态的大小不相等),导致云台产生定向误差,在关节角坐标系中,测量姿态可以利用电机的实际角速度进行积分得到,目标姿态可以利用电机的期望角速度进行积分得到,则姿态误差是由于电机的实际角速度与期望角速度的大小不相等导致,也即,姿态误差也可以由实际角速度与期望角速度的差值进行积分得到,可以利用姿态误差和期望角速度对云台的扰动抑制能力进行估计。The attitude error is caused by the fact that when the measured attitude is controlled to approach the target attitude, the target attitude cannot be fully reached, and there is a difference between the measured attitude and the target attitude (that is, the size of the measured attitude approaching the target attitude and the target attitude are not equal) , resulting in an orientation error of the gimbal. In the joint angular coordinate system, the measured attitude can be obtained by integrating the actual angular velocity of the motor, and the target attitude can be obtained by integrating the expected angular velocity of the motor. The attitude error is due to the actual angular velocity of the motor and the expected angular velocity. The angular velocity is not equal, that is, the attitude error can also be obtained by integrating the difference between the actual angular velocity and the expected angular velocity, and the disturbance suppression capability of the gimbal can be estimated by using the attitude error and the expected angular velocity.
可以理解的是,云台的期望角速度包括云台各驱动轴对应的电机的期望角速度,期望角速度位于关节角空间坐标系中;云台的目标姿态也即载荷的目标姿态,可以通过载荷的角速度(或称作云台的角速度)表征,云台的目标姿态位于载荷坐标系(也可称作body坐标系{b})中;支撑平台的角速度位于支撑平台坐标系(也可称作base坐标系{0})中。It can be understood that the desired angular velocity of the gimbal includes the expected angular velocity of the motor corresponding to each drive axis of the gimbal, and the desired angular velocity is located in the joint angular space coordinate system; the target attitude of the gimbal is the target attitude of the load, which can be determined by the angular velocity of the load. (or called the angular velocity of the gimbal), the target attitude of the gimbal is located in the load coordinate system (also called the body coordinate system {b}); the angular velocity of the support platform is located in the support platform coordinate system (also called the base coordinate) system {0}).
由于云台的主要扰动源是通过支撑平台传递到有效载荷上的,为了使得有效载荷在空间定向,云台各驱动轴对应的电机需要输出力抑制扰动。当有效载荷的目标姿态不变时,目标姿态由两部分导致:云台各驱动轴对应的电机的期望角速度和支撑平台的角速度,目标姿态与云台各驱动轴对应的电机的期望角速度、支撑平台的角速度的关系可以如下:Since the main disturbance source of the gimbal is transmitted to the payload through the support platform, in order to orient the payload in space, the motors corresponding to each drive shaft of the gimbal need to output force to suppress the disturbance. When the target attitude of the payload does not change, the target attitude is caused by two parts: the expected angular velocity of the motor corresponding to each drive axis of the gimbal and the angular velocity of the support platform, and the target attitude and the expected angular velocity of the motor corresponding to each drive axis of the gimbal, support The angular velocity of the platform can be related as follows:
Figure PCTCN2020103049-appb-000005
Figure PCTCN2020103049-appb-000005
公式(2)中,i为云台的驱动轴的序号,i为正整数且1≤i≤N;In formula (2), i is the serial number of the drive shaft of the gimbal, i is a positive integer and 1≤i≤N;
Figure PCTCN2020103049-appb-000006
为目标姿态中云台在序号为i的驱动轴上的角速度;
Figure PCTCN2020103049-appb-000006
is the angular velocity of the gimbal on the drive shaft with serial number i in the target attitude;
T b0为支撑平台坐标系在载荷坐标系中的表示; T b0 is the representation of the support platform coordinate system in the load coordinate system;
Figure PCTCN2020103049-appb-000007
为支撑平台的角速度;
Figure PCTCN2020103049-appb-000007
is the angular velocity of the supporting platform;
J为雅克比矩阵;J is the Jacobian matrix;
Figure PCTCN2020103049-appb-000008
为云台序号为i的驱动轴对应的电机的期望角速度。
Figure PCTCN2020103049-appb-000008
is the expected angular velocity of the motor corresponding to the drive shaft with the gimbal serial number i.
公式(2)通过将云台各驱动轴对应的电机的角速度和支撑平台的角速度均转换至载荷坐标系,再加转换至载荷坐标系的云台各驱动轴对应的电机的角速度和支撑平台的角速度相加,得到目标姿态。Formula (2) converts the angular velocity of the motor corresponding to each drive shaft of the gimbal and the angular velocity of the support platform to the load coordinate system, and then converts the angular velocity of the motor corresponding to each drive shaft of the gimbal to the load coordinate system and the angular velocity of the support platform. The angular velocities are added to obtain the target attitude.
则根据公式(2)可也得到:Then according to formula (2), we can also get:
Figure PCTCN2020103049-appb-000009
Figure PCTCN2020103049-appb-000009
其中,云台上电启动后,云台处于锁定模式下,用户未打杆,
Figure PCTCN2020103049-appb-000010
可为0;云台上电启动后,云台处于跟随模式下,用户打杆,
Figure PCTCN2020103049-appb-000011
可为根据用户打杆的杆量在序号为i的驱动轴上的分量确定。
Among them, after the gimbal is powered on, the gimbal is in the lock mode, and the user does not hit the stick.
Figure PCTCN2020103049-appb-000010
It can be 0; after the gimbal is powered on, the gimbal is in follow mode, the user hits the stick,
Figure PCTCN2020103049-appb-000011
It can be determined according to the component of the rod amount that the user hits on the drive shaft with the serial number i.
云台的期望角速度
Figure PCTCN2020103049-appb-000012
表示如下:
Desired angular velocity of the gimbal
Figure PCTCN2020103049-appb-000012
It is expressed as follows:
Figure PCTCN2020103049-appb-000013
Figure PCTCN2020103049-appb-000013
公式(4)中,
Figure PCTCN2020103049-appb-000014
为云台序号为1的驱动轴对应的电机的期望角速度,
Figure PCTCN2020103049-appb-000015
为云台序号为n的驱动轴对应的电机的期望角速度,
Figure PCTCN2020103049-appb-000016
为云台序号为N的驱动轴对应的电机的期望角速度。
In formula (4),
Figure PCTCN2020103049-appb-000014
is the expected angular velocity of the motor corresponding to the drive shaft with the gimbal serial number 1,
Figure PCTCN2020103049-appb-000015
is the expected angular velocity of the motor corresponding to the drive shaft with the gimbal serial number n,
Figure PCTCN2020103049-appb-000016
is the expected angular velocity of the motor corresponding to the drive shaft with the gimbal serial number N.
需要说明的是,上述计算云台的期望角速度的公式仅是示例性的,可以对上述公式进行变形以计算云台的期望角速度,或者还可以通过其他方式来计算云台的期望角速度。It should be noted that the above formula for calculating the desired angular velocity of the gimbal is only exemplary, and the above formula can be deformed to calculate the desired angular velocity of the gimbal, or the desired angular velocity of the gimbal can also be calculated in other ways.
在一些实施例中,在预设评估周期内,获取云台的多个姿态误差和多个期望角速度。需要说明的是,多个姿态误差和多个期望角度是同步获取的,也即,在获取一个姿态误差的同时,获取一个期望角度。In some embodiments, within a preset evaluation period, multiple attitude errors and multiple expected angular velocities of the gimbal are acquired. It should be noted that multiple attitude errors and multiple desired angles are acquired simultaneously, that is, one desired angle is acquired while acquiring one attitude error.
本申请实施例的预设评估周期是可更新的,或者,预设评估周期是固定不变的。需要说明的是,预设评估周期固定不变并不是指一段时长(如云台从开机到关机的这一段时长)内的多个预设评估周期的大小均相同,而是指在一段时长内的多个预设评估周期中,每个预设评估周期的大小一旦设定好,则保持固定不变,一段时长内的多个预设评估周期的大小可以相等,也可以至少部分不相等。预设评估周期可更新则指在一段时长内的多个预设评估周期中,每个预设评估周期的大小可随时间调整。The preset evaluation period in this embodiment of the present application can be updated, or the preset evaluation period is fixed. It should be noted that the fixed preset evaluation period does not mean that the sizes of multiple preset evaluation periods within a period of time (such as the period from the startup to the shutdown of the gimbal) are the same, but refers to the same period of time. In the plurality of preset evaluation periods, once the size of each preset evaluation period is set, it remains fixed, and the sizes of the multiple preset evaluation periods within a period of time may be equal or at least partially unequal. That the preset evaluation period can be updated means that in a plurality of preset evaluation periods within a certain period of time, the size of each preset evaluation period can be adjusted over time.
可根据需设置一段时长内的多个预设评估周期中各预设评估周期的大小,可选 的,在一段时长内的多个预设评估周期中,至少两个预设评估周期能够不同。可选的,在一段时长内的多个预设评估周期中,每个预设评估周期的大小均相等。The size of each preset evaluation period in the multiple preset evaluation periods within a period of time can be set as required. Optionally, in the multiple preset evaluation periods within a period of time, at least two preset evaluation periods can be different. Optionally, in a plurality of preset evaluation periods within a certain period of time, the size of each preset evaluation period is equal.
预设评估周期的确定方式可以根据需要选择,示例性的,预设评估周期为根据扰动频率和预设采样频率确定,其中,扰动频率为云台受到扰动时的频率。The determination method of the preset evaluation period can be selected according to needs. Exemplarily, the preset evaluation period is determined according to the disturbance frequency and the preset sampling frequency, wherein the disturbance frequency is the frequency when the gimbal is disturbed.
需要说明的是,在根据扰动频率和预设采样频率确定预设评估周期时,预设评估周期可能是可更新的,也可能是固定不变的。例如,在云台性能的评估过程中,扰动频率的大小是变化的,则预设评估周期是可更新的;在云台性能的评估过程中,扰动频率的大小固定不变,则预设评估周期的大小也是固定不变的。It should be noted that when the preset evaluation period is determined according to the disturbance frequency and the preset sampling frequency, the preset evaluation period may be updateable or fixed. For example, in the evaluation process of the performance of the gimbal, if the magnitude of the disturbance frequency changes, the preset evaluation period can be updated; during the evaluation of the gimbal performance, the magnitude of the disturbance frequency is fixed, and the preset evaluation period is The size of the period is also fixed.
可选的,预设评估周期与扰动频率负相关,并与预设采样频率正相关。示例性的,预设评估周期的数据长度可表示为:Optionally, the preset evaluation period is negatively correlated with the disturbance frequency, and positively correlated with the preset sampling frequency. Exemplarily, the data length of the preset evaluation period can be expressed as:
Figure PCTCN2020103049-appb-000017
Figure PCTCN2020103049-appb-000017
公式(5)中,M为预设评估周期的数据长度;In formula (5), M is the data length of the preset evaluation period;
f s为预设采样频率; f s is the preset sampling frequency;
f为扰动频率。f is the disturbance frequency.
也即,在一个预设评估周期内,采集M个姿态误差和M个期望角速度,M个姿态误差可表示为
Figure PCTCN2020103049-appb-000018
M个期望角速度可表示为
Figure PCTCN2020103049-appb-000019
m=0,1,…,M-1。
That is, in a preset evaluation period, M attitude errors and M expected angular velocities are collected, and the M attitude errors can be expressed as
Figure PCTCN2020103049-appb-000018
The M desired angular velocities can be expressed as
Figure PCTCN2020103049-appb-000019
m=0,1,...,M-1.
示例性的,f s=10Hz,f=2Hz,M则为5,即若0.1秒采集一次姿态误差和期望角速度,但在一个预设评估周期内,采集到5个姿态误差和5个期望角速度,则由此可以确定预设评估周期为0.5秒。 Exemplarily, f s = 10 Hz, f = 2 Hz, and M is 5, that is, if the attitude error and the expected angular velocity are collected once in 0.1 second, but within a preset evaluation period, 5 attitude errors and 5 expected angular velocities are collected. , then it can be determined that the preset evaluation period is 0.5 seconds.
可以理解的是,当预设评估周期与扰动频率负相关,并与预设采样频率正相关时,预设评估周期不限于公式(5),还可以为其他。另外,预设评估周期也可以不是根据扰动频率和预设采样频率确定,还可以采用其他方式确定,如预设评估周期可以由用户设定。It can be understood that when the preset evaluation period is negatively correlated with the disturbance frequency and positively correlated with the preset sampling frequency, the preset evaluation period is not limited to formula (5), and may be other. In addition, the preset evaluation period may not be determined according to the disturbance frequency and the preset sampling frequency, but may also be determined in other ways, for example, the preset evaluation period may be set by the user.
由于云台的主要扰动源是通过支撑平台传递到有效载荷上的,因此,本申请实施例的扰动频率与支撑平台相关。示例性的,在一些实施例中,扰动频率与支撑平台的角速度的变化快慢正相关,即支撑平台的角速度的变化越快,扰动频率越大;支撑平台的角速度的变化越慢,扰动频率越小。由于支撑平台的角速度的变化越快,表明云台受到的扰动会越大,故扰动频率也越大,将扰动频率设置成与支撑平台的角速度的变化快慢正相关,能够准确地体现云台受到的扰动大小。Since the main disturbance source of the gimbal is transmitted to the payload through the support platform, the disturbance frequency in the embodiment of the present application is related to the support platform. Exemplarily, in some embodiments, the disturbance frequency is positively correlated with the change speed of the angular velocity of the support platform, that is, the faster the change of the angular velocity of the support platform, the greater the disturbance frequency; the slower the change of the angular velocity of the support platform, the higher the disturbance frequency. small. Because the faster the angular velocity of the support platform changes, the greater the disturbance to the gimbal will be, and the greater the disturbance frequency will be. Setting the disturbance frequency to be positively correlated with the change of the angular velocity of the support platform can accurately reflect that the gimbal is affected by the size of the disturbance.
在一些实施例中,扰动频率与支撑平台的类型相关,其中,支撑平台可包括手持支撑平台和/或机载支撑平台。示例性的,支撑平台为手持支撑平台,如支撑平台为 手持云台的手柄;示例性的,支撑平台为机载平台,如云台搭载在可移动平台上,支撑平台为可移动平台的机体;示例性的,云台既可以作为手持云台使用,也可以作为机载云台使用,当云台作为手持云台使用时,支撑平台为手持云台的手柄;当云台作为机载云台使用时,支撑平台为可移动平台的机体。In some embodiments, the perturbation frequency is related to the type of support platform, wherein the support platform may include a hand-held support platform and/or an airborne support platform. Exemplarily, the support platform is a hand-held support platform, for example, the support platform is a handle of a hand-held PTZ; exemplarily, the support platform is an airborne platform, such as the PTZ mounted on a movable platform, and the support platform is the body of the movable platform. ; Exemplarily, the gimbal can be used as both a handheld gimbal and an airborne gimbal. When the gimbal is used as a handheld gimbal, the support platform is the handle of the handheld gimbal; when the gimbal is used as an airborne gimbal When the platform is in use, the supporting platform is the body of the movable platform.
可选的,不同类型的支撑平台的扰动频率不相同,这是由于当云台搭载在不同类型的支撑平台上时,云台受到的扰动大小可能不相同,因此,不同类型的支撑平台的扰动频率也不相同。示例性的,云台搭载在不同类型的可移动平台上,不同类型的可移动平台对应的扰动频率不相同,如可移动平台包括移动小车、无人飞行器和移动机器人,当云台搭载在移动小车上时,云台受到的扰动是移动小车传递的;当云台搭载在无人飞行器上时,云台受到的扰动是无人飞行器传递的;当云台搭载在移动机器人上时,云台受到的扰动是移动机器人传递的。由于移动小车、无人飞行器和移动机器人的动力系统和/或运动方式和/或运动参数不同,因此,移动小车、无人飞行器和移动机器人传递给云台的扰动的大小也会不同,故移动小车、无人飞行器和移动机器人的扰动频率不相同。示例性的,手持云台的手柄对应的扰动频率不同于可移动平台对应的扰动频率,不同类型的可移动平台对应的扰动频率可以不相同,也可以相同。Optionally, the disturbance frequencies of different types of support platforms are not the same. This is because when the gimbal is mounted on different types of support platforms, the disturbance magnitude of the gimbal may be different. Therefore, the disturbance of different types of support platforms may be different. The frequencies are also different. Exemplarily, the gimbal is mounted on different types of movable platforms, and the disturbance frequencies corresponding to different types of movable platforms are different. For example, the movable platform includes a mobile car, an unmanned aerial vehicle, and a mobile robot. When the gimbal is mounted on the trolley, the disturbance received by the gimbal is transmitted by the mobile car; when the gimbal is mounted on the unmanned aerial vehicle, the disturbance of the gimbal is transmitted by the unmanned aerial vehicle; when the gimbal is mounted on the mobile robot, the gimbal The perturbations received are delivered by the mobile robot. Due to the different power systems and/or motion modes and/or motion parameters of the mobile car, UAV and mobile robot, the magnitude of the disturbance transmitted to the gimbal by the mobile car, UAV and mobile robot will also be different. The disturbance frequency of the car, the UAV and the mobile robot is not the same. Exemplarily, the disturbance frequency corresponding to the handle of the handheld gimbal is different from the disturbance frequency corresponding to the movable platform, and the disturbance frequencies corresponding to different types of movable platforms may be different or the same.
可选的,云台与支撑平台可拆卸地连接,本申请实施例的云台性能的评估方法还可包括:在云台改变搭载的支撑平台时,基于云台搭载的当前支撑平台调整扰动频率。示例性的,云台为机载云台,云台搭载在移动小车上,在进行云台性能的评估时,扰动频率为移动小车对应的扰动频率;在将云台从移动小车上拆卸下来,再安装至无人飞行器上后,则在进行云台性能的评估时,需要将扰动频率由移动小车对应的扰动频率设置成无人飞行器对应的扰动频率。示例性的,云台既可以作为手持云台使用,也可以作为机载云台使用,云台搭载在可移动平台上,在进行云台性能的评估时,扰动频率为可移动平台对应的扰动频率;则将云台从可移动平台拆卸下来,由用户手持使用并进行云台性能的评估时,需要将扰动频率由可移动平台对应的扰动频率设置成手柄对应的扰动频率。Optionally, the gimbal is detachably connected to the support platform, and the method for evaluating the performance of the gimbal according to the embodiment of the present application may further include: when the gimbal changes the supported support platform, adjusting the disturbance frequency based on the current support platform carried by the gimbal. . Exemplarily, the gimbal is an airborne gimbal, and the gimbal is mounted on a mobile car. When evaluating the performance of the gimbal, the disturbance frequency is the disturbance frequency corresponding to the mobile car; After being installed on the unmanned aerial vehicle, when evaluating the performance of the gimbal, it is necessary to set the disturbance frequency from the disturbance frequency corresponding to the mobile car to the disturbance frequency corresponding to the unmanned aerial vehicle. Exemplarily, the gimbal can be used as a handheld gimbal or an airborne gimbal. The gimbal is mounted on a movable platform. When evaluating the performance of the gimbal, the disturbance frequency is the corresponding disturbance of the movable platform. When the gimbal is disassembled from the movable platform and used by the user to evaluate the performance of the gimbal, the disturbance frequency needs to be set from the disturbance frequency corresponding to the movable platform to the disturbance frequency corresponding to the handle.
在一些实施例中,扰动频率与支撑平台所处的运动场景相关,也即,可以基于支撑平台所处的运动场景调整扰动频率的大小。示例性的,云台为手持云台,用户走路过程中使用云台时,通过手柄传递给云台的扰动小于用户跑步过程中使用云台,因此,用户走路过程中使用云台时的扰动频率小于用户跑步过程中使用云台时的扰动频率,示例性的,用户走路过程中使用云台时的扰动频率为2Hz,用户跑步过程中使用云台时的扰动频率为4Hz。In some embodiments, the disturbance frequency is related to the motion scene where the support platform is located, that is, the magnitude of the disturbance frequency can be adjusted based on the motion scene where the support platform is located. Exemplarily, the gimbal is a handheld gimbal. When the user uses the gimbal while walking, the disturbance transmitted to the gimbal through the handle is smaller than that when the user uses the gimbal during running. Therefore, the frequency of disturbance when the user uses the gimbal during walking is It is less than the disturbance frequency when the user uses the gimbal during running. Exemplarily, the disturbance frequency when the user uses the gimbal during walking is 2 Hz, and the disturbance frequency when the user uses the gimbal during running is 4 Hz.
扰动频率可以是预设扰动频率,即扰动频率大小固定不变,例如,当支撑平台的类型和支撑平台所处的场景(如运动场景)固定不变时,扰动频率的大小可以固定不变;当然,扰动频率也可以是实时更新的,如支撑平台的类型和/或支撑平台所处的场景(如运动场景)变化时,扰动频率的大小相应变化。The disturbance frequency can be a preset disturbance frequency, that is, the magnitude of the disturbance frequency is fixed. For example, when the type of the support platform and the scene where the support platform is located (such as a motion scene) are fixed, the magnitude of the disturbance frequency can be fixed; Of course, the disturbance frequency may also be updated in real time. For example, when the type of the support platform and/or the scene in which the support platform is located (eg, a motion scene) changes, the magnitude of the disturbance frequency changes accordingly.
可以理解的是,也可以不按照周期方式获取云台的多个姿态误差和多个期望角速度。It can be understood that, multiple attitude errors and multiple desired angular velocities of the gimbal may not be acquired in a periodic manner.
在S202中,根据姿态误差和期望角速度,评估云台的抗干扰能力。In S202, the anti-interference ability of the gimbal is evaluated according to the attitude error and the expected angular velocity.
示例性的,在第一时刻,姿态误差为1度,期望角速度为1度/秒;第二时刻姿态误差为2度,期望角速度为10度/秒,其中,第一时刻与第二时刻为相邻的两个时刻。由第一时刻到第二时刻,姿态误差的变化为2倍,而姿态误差与期望角速度的比值变化为10倍,姿态误差的变化、姿态误差与期望角速度的比值变化不同,因此,若仅根据姿态误差评估云台的抗干扰能力,评估精度较低;本申请实施例根据姿态误差和期望角速度共同评估云台的抗干扰能力,提高评估精度。Exemplarily, at the first moment, the attitude error is 1 degree, and the expected angular velocity is 1 degree/second; at the second moment, the attitude error is 2 degrees, and the expected angular velocity is 10 degrees/second, wherein the first moment and the second moment are two adjacent moments. From the first moment to the second moment, the change of attitude error is 2 times, and the ratio of attitude error to expected angular velocity is changed to 10 times. The change of attitude error and the ratio of attitude error to expected angular velocity are different. The attitude error evaluates the anti-interference ability of the gimbal, and the evaluation accuracy is low; the embodiment of the present application jointly evaluates the anti-interference ability of the gimbal according to the attitude error and the expected angular velocity, and improves the evaluation accuracy.
需要说明的是,云台的抗干扰能力可包括云台对于内部阻力的抑制能力(如摩擦、同轴线的扰动等)和/或云台对于外部扰动的抑制能力,当云台为手持云台时,外部干扰可为用户手持手柄时,通过手柄传递给云台的扰动;当云台为机载云台时,外部干扰可为可移动平台运动时,通过可移动平台的机体传递给云台的扰动。本申请实施例的抗干扰能力能够反映云台的控制性能,当抗干扰能力弱时,表明云台的控制性能差;当抗干扰能力强时,表明云台的控制性能强。It should be noted that the anti-interference ability of the gimbal may include the gimbal's ability to suppress internal resistance (such as friction, coaxial line disturbance, etc.) and/or the gimbal's ability to suppress external disturbances. When the gimbal is a handheld cloud When the gimbal is used, the external interference can be the disturbance transmitted to the gimbal through the handle when the user holds the handle; when the gimbal is an airborne gimbal, the external disturbance can be transmitted to the cloud through the body of the movable platform when the movable platform moves. disturbance of the station. The anti-jamming capability of the embodiment of the present application can reflect the control performance of the gimbal. When the anti-jamming capability is weak, it indicates that the gimbal has poor control performance; when the anti-jamming capability is strong, it indicates that the gimbal has strong control performance.
示例性的,云台为多轴云台,云台包括多个驱动轴,本申请实施例的抗干扰能力用于表征云台相应于每个驱动轴的抗干扰能力。示例性的,云台为三轴云台,包括偏航轴、俯仰轴和横滚轴,抗干扰能力用于表征云台相应于偏航轴、俯仰轴和横滚轴的抗干扰能力。当云台相应于多个驱动轴中任一驱动轴的抗干扰能力弱时,表明云台的抗干扰能力差;当云台相应于多个驱动轴中每一驱动轴的抗干扰能力强时,表明云台的抗干扰能力强。Exemplarily, the gimbal is a multi-axis gimbal, and the gimbal includes multiple drive shafts. The anti-interference capability of the embodiment of the present application is used to characterize the anti-interference capability of the gimbal corresponding to each drive shaft. Exemplarily, the gimbal is a three-axis gimbal, including a yaw axis, a pitch axis, and a roll axis, and the anti-jamming capability is used to characterize the anti-jamming capability of the gimbal corresponding to the yaw axis, the pitch axis, and the roll axis. When the anti-interference ability of the gimbal corresponding to any one of the multiple drive shafts is weak, it indicates that the anti-interference ability of the gimbal is poor; when the anti-interference ability of the gimbal corresponding to each of the multiple drive shafts is strong , indicating that the gimbal has strong anti-interference ability.
图3是本申请一实施例中的根据姿态误差和期望角速度,评估云台的抗干扰能力的一种实现过程示意图,可以理解的是,图3所示实施例与上述在预设评估周期内,获取云台的多个姿态误差和多个期望角速度的实施例相对应。请参见图3,根据姿态误差和期望角速度,评估云台的抗干扰能力的实现过程可以包括S301~S302:FIG. 3 is a schematic diagram of an implementation process of evaluating the anti-interference ability of a pan/tilt head according to an attitude error and a desired angular velocity according to an embodiment of the present application. It can be understood that the embodiment shown in FIG. 3 is different from the above in the preset evaluation period. , which corresponds to the embodiment of acquiring multiple attitude errors of the gimbal and multiple desired angular velocities. Referring to Fig. 3, according to the attitude error and the expected angular velocity, the implementation process of evaluating the anti-interference ability of the gimbal may include S301-S302:
在S301中、根据预设评估周期内获取的多个姿态误差和多个期望角速度,分别确定预设评估周期内的姿态误差幅值和角速度幅值;In S301, according to multiple attitude errors and multiple expected angular velocities obtained in the preset evaluation period, respectively determine the attitude error amplitude and the angular velocity amplitude in the preset evaluation period;
示例性的,根据傅里叶变换,将预设评估周期内获取的多个姿态误差转换至频域,获得预设评估周期内的姿态误差幅值。其中,在扰动频率f,云台相应于序号为n的驱动轴的姿态误差幅值可以表示为:Exemplarily, according to Fourier transform, the plurality of attitude errors acquired in the preset evaluation period are converted into the frequency domain, and the attitude error amplitude in the preset evaluation period is obtained. Among them, at the disturbance frequency f, the attitude error amplitude of the gimbal corresponding to the drive shaft with serial number n can be expressed as:
Figure PCTCN2020103049-appb-000020
Figure PCTCN2020103049-appb-000020
公式(6)中,
Figure PCTCN2020103049-appb-000021
为在扰动频率f,云台相应于序号为n的驱动轴的姿态误差 幅值;
In formula (6),
Figure PCTCN2020103049-appb-000021
is the attitude error amplitude of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f;
M为预设评估周期的数据长度;M is the data length of the preset evaluation period;
m为采样序号;m is the sampling sequence number;
Figure PCTCN2020103049-appb-000022
为第m个姿态误差;
Figure PCTCN2020103049-appb-000022
is the mth attitude error;
j为虚数的单位;j is the unit of the imaginary number;
w 0为基角频率,
Figure PCTCN2020103049-appb-000023
w 0 is the fundamental frequency,
Figure PCTCN2020103049-appb-000023
姿态误差幅值即为频域上的姿态误差的最大幅度值。The attitude error magnitude is the maximum magnitude of the attitude error in the frequency domain.
示例性的,根据傅里叶变换,将预设评估周期内获取的多个期望角速度转换至频域,获得预设评估周期内的角速度幅值。其中,在扰动频率f,云台相应于序号为n的驱动轴的角速度幅值可以表示为:Exemplarily, according to Fourier transform, a plurality of desired angular velocities obtained in a preset evaluation period are converted into the frequency domain, and the angular velocity amplitudes in the preset evaluation period are obtained. Among them, at the disturbance frequency f, the angular velocity amplitude of the gimbal corresponding to the drive shaft with serial number n can be expressed as:
Figure PCTCN2020103049-appb-000024
Figure PCTCN2020103049-appb-000024
公式(6)中,
Figure PCTCN2020103049-appb-000025
为在扰动频率f,云台相应于序号为n的驱动轴的角速度幅值;
In formula (6),
Figure PCTCN2020103049-appb-000025
is the angular velocity amplitude of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f;
M为预设评估周期的数据长度;M is the data length of the preset evaluation period;
m为采样序号;m is the sampling sequence number;
Figure PCTCN2020103049-appb-000026
为第m个期望角速度。
Figure PCTCN2020103049-appb-000026
is the mth expected angular velocity.
角速度幅值即为频域上的期望角速度的最大幅度值。The angular velocity amplitude is the maximum amplitude value of the expected angular velocity in the frequency domain.
需要说明的是,在根据预设评估周期内获取的多个姿态误差和多个期望角速度,分别确定预设评估周期内的姿态误差幅值和角速度幅值时,也可以采用其他策略,不限于傅里叶变换方式。It should be noted that, when determining the attitude error amplitude and angular velocity amplitude in the preset evaluation period according to the multiple attitude errors and multiple expected angular velocities obtained in the preset evaluation period, other strategies can also be used, not limited to Fourier transform method.
在S302中、根据姿态误差幅值和角速度幅值,评估云台的抗干扰能力。In S302, the anti-interference ability of the gimbal is evaluated according to the attitude error amplitude and the angular velocity amplitude.
本申请实施例中,通过预设评估周期内的姿态误差幅值和角速度幅值评估来评估云台的抗干扰能力,精确度高。也即,电机的期望角速度可以反馈云台的目标姿态,在期望角速度变化较大的情况下,如果云台的抗干扰能力较佳,实际角速度也应该变化较大,从而使得期望角速度与实际角速度之间的偏差较小,并体现为云台的姿态误差较小,进一步体现为下述的扰动抑制比较小,而若姿态误差变化较小,但扰动抑制比较大的情况,则意味着期望角速度与实际角速度之间的偏差较大,即使获取的姿态误差较小,云台的抗干扰能力依然较差。In the embodiment of the present application, the anti-interference ability of the gimbal is evaluated by evaluating the attitude error amplitude and the angular velocity amplitude in the preset evaluation period, and the accuracy is high. That is, the desired angular velocity of the motor can feed back the target attitude of the gimbal. When the desired angular velocity changes greatly, if the anti-interference ability of the gimbal is better, the actual angular velocity should also change greatly, so that the expected angular velocity and the actual angular velocity can change greatly. The deviation between them is small, and it is reflected in that the attitude error of the gimbal is small, which is further reflected in that the following disturbance suppression is relatively small, and if the attitude error change is small, but the disturbance suppression is relatively large, it means that the expected angular velocity The deviation from the actual angular velocity is large. Even if the obtained attitude error is small, the anti-interference ability of the gimbal is still poor.
示例性的,根据姿态误差幅值及扰动抑制比,评估云台的抗干扰能力。其中, 扰动抑制比为姿态误差幅值与角速度幅值的比值。Exemplarily, the anti-jamming capability of the gimbal is evaluated according to the attitude error magnitude and the disturbance rejection ratio. Among them, the disturbance suppression ratio is the ratio of the attitude error amplitude to the angular velocity amplitude.
结合公式(1)和(7),可以得到在扰动频率f,云台相应于序号为n的驱动轴扰动抑制比的公式:Combining formulas (1) and (7), the formula of the disturbance rejection ratio of the gimbal corresponding to the drive shaft with the serial number n at the disturbance frequency f can be obtained:
Figure PCTCN2020103049-appb-000027
Figure PCTCN2020103049-appb-000027
公式(8)中,R n(f)为在扰动频率f,云台相应于序号为n的驱动轴的扰动抑制比。 In formula (8), R n (f) is the disturbance rejection ratio of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f.
其中,在根据姿态误差幅值及扰动抑制比,评估云台的抗干扰能力时,可选的,当至少一个预设评估周期内的姿态误差幅值及扰动抑制比满足预设条件时,确定云台的抗干扰能力弱,即一段时长内的多个预设评估周期中,只要存在满足预设条件的预设评估周期,即认为云台的抗干扰能力弱。Wherein, when evaluating the anti-interference ability of the gimbal according to the attitude error amplitude and the disturbance suppression ratio, optionally, when the attitude error amplitude and disturbance suppression ratio in at least one preset evaluation period meet the preset conditions, determine The anti-interference ability of the gimbal is weak, that is, in a plurality of preset evaluation periods within a certain period of time, as long as there is a preset evaluation period that satisfies the preset conditions, the anti-interference ability of the gimbal is considered to be weak.
进一步可选的,当连续至少两个的预设评估周期内的姿态误差幅值及扰动抑制比满足预设条件,且连续至少两个预设评估周期的数量大于或等于预设数量时,确定云台的抗干扰能力弱,也即,一段时长内的多个预设评估周期中,存在连续至少两个满足预设条件的预设评估周期,且连续至少两个满足预设条件的预设评估周期的数量大于或等于预设数量时,认为云台的抗干扰能力弱,这种方式能够减少误判;另外,确定出云台的抗干扰能力弱的连续预设评估周期的数量小于预设数量,可认为扰动小,云台的控制误差也小,满足控制需求。可以理解的是,本实施例中,若不存在连续至少两个的预设评估周期内的姿态误差幅值及扰动抑制比满足预设条件,或者,存在连续至少两个的预设评估周期内的姿态误差幅值及扰动抑制比满足预设条件,但连续至少两个预设评估周期的数量小于预设数量,则认为云台的抗干扰能力满足需求,即不认为云台的抗干扰能力弱。Further optionally, when the attitude error amplitude and the disturbance suppression ratio in at least two consecutive preset evaluation periods meet the preset conditions, and the number of at least two consecutive preset evaluation periods is greater than or equal to the preset number, determine The anti-interference ability of the PTZ is weak, that is, among the multiple preset evaluation periods within a certain period of time, there are at least two consecutive preset evaluation periods that satisfy the preset conditions, and at least two consecutive preset evaluation periods that satisfy the preset conditions. When the number of evaluation cycles is greater than or equal to the preset number, it is considered that the anti-interference ability of the gimbal is weak, and this method can reduce misjudgments; in addition, it is determined that the number of consecutive preset evaluation cycles in which the anti-jamming capability of the gimbal is weak is less than the predicted number. Set the number, it can be considered that the disturbance is small, and the control error of the gimbal is also small, which meets the control requirements. It can be understood that, in this embodiment, if the attitude error amplitude and the disturbance suppression ratio do not meet the preset conditions in at least two consecutive preset evaluation periods, or if there are at least two consecutive preset evaluation periods The attitude error amplitude and the disturbance rejection ratio of the PTZ meet the preset conditions, but the number of consecutive at least two preset evaluation periods is less than the preset number, then the anti-interference ability of the gimbal is considered to meet the requirements, that is, the anti-interference ability of the gimbal is not considered. weak.
其中,预设数量的大小可以根据需要设定,示例性的,预设数量为5;当然,预设数量也可以设定为其他数值大小,如10。The size of the preset number can be set as required, and in an example, the preset number is 5; of course, the preset number can also be set to other numerical values, such as 10.
示例性的,通过计数器计数方式来统计满足预设条件的预设评估周期的数量,具体的,当至少一个预设评估周期内的姿态误差幅值及扰动抑制比满足预设条件,计数器加1,当计数器的数值大于或等于5时,确定云台的抗干扰能力弱。另外,需要说明的是,计数器的初始值为0。另外,若当前预设评估周期内的姿态误差幅值及扰动抑制比不满足预设条件,则将计数器的数值设置为初始值,即将计数器清零。Exemplarily, the number of preset evaluation periods that meet the preset conditions is counted by a counter. Specifically, when the attitude error amplitude and the disturbance suppression ratio in at least one preset evaluation period meet the preset conditions, the counter is incremented by 1. , when the value of the counter is greater than or equal to 5, it is determined that the anti-interference ability of the gimbal is weak. In addition, it should be noted that the initial value of the counter is 0. In addition, if the attitude error amplitude and the disturbance suppression ratio in the current preset evaluation period do not meet the preset conditions, the value of the counter is set to the initial value, that is, the counter is reset to zero.
可选的,预设条件可以包括:姿态误差幅值大于预设误差幅值阈值,且扰动抑制比大于预设比值阈值。示例性的,预设条件表示为:Optionally, the preset conditions may include: the attitude error magnitude is greater than a preset error magnitude threshold, and the disturbance suppression ratio is greater than a preset ratio threshold. Exemplarily, the preset condition is expressed as:
Figure PCTCN2020103049-appb-000028
Figure PCTCN2020103049-appb-000028
公式(8)中,
Figure PCTCN2020103049-appb-000029
为在扰动频率f,云台相应于序号为n的驱动轴的角速度幅值;
In formula (8),
Figure PCTCN2020103049-appb-000029
is the angular velocity amplitude of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f;
Figure PCTCN2020103049-appb-000030
为在扰动频率f,云台相应于序号为n的驱动轴的预设误差幅值阈值;
Figure PCTCN2020103049-appb-000030
is the preset error amplitude threshold of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f;
R n(f)为在扰动频率f,云台相应于序号为n的驱动轴的扰动抑制比; R n (f) is the disturbance suppression ratio of the gimbal corresponding to the drive shaft with the serial number n at the disturbance frequency f;
R n_thr(f)为在扰动频率f,云台相应于序号为n的驱动轴的预设比值阈值。 R n_thr (f) is the preset ratio threshold of the gimbal corresponding to the drive shaft with serial number n at the disturbance frequency f.
从上述可知,假设在第一时刻,电机的转动角速度为1度/秒,该电机对应的姿态误差为0.1度;在第二时刻,电机的转动角速度为10度/秒,该电机对应的姿态误差为0.2度,第一时刻的姿态误差是第二时刻的姿态误差的2倍,而扰动抑制比是5倍,那么即使在姿态误差的变化较大的情况下,若扰动抑制比未超过预设比值阈值,也不会判断云台的抗干扰能力较差。因此,结合姿态误差与扰动抑制比,可以更为准确地判断云台的抗干扰能力,避免了姿态误差较小、电机的转动角速度变化较大,而出现的云台的抗干扰能力较差的情况,也避免了单独利用扰动抑制比,在扰动抑制比大于预设比值阈值时判断云台的抗干扰能力差的情况,但实际上此时姿态误差小,在扰动小的情况下,该姿态误差满足控制控制需求,无需输出评估结果使得用户反复修改控制参数,以调整云台的抗干扰能力。As can be seen from the above, assuming that the rotational angular velocity of the motor is 1 degree/second at the first moment, the attitude error corresponding to the motor is 0.1 degree; at the second moment, the rotational angular velocity of the motor is 10 degrees/second, and the attitude corresponding to the motor The error is 0.2 degrees, the attitude error at the first moment is twice that of the attitude error at the second moment, and the disturbance suppression ratio is 5 times, so even if the change of attitude error is large, if the disturbance suppression ratio does not exceed the expected value. Setting the ratio threshold will not judge that the anti-interference ability of the gimbal is poor. Therefore, combined with the attitude error and the disturbance rejection ratio, the anti-interference ability of the gimbal can be more accurately judged, avoiding the small attitude error and the large change of the rotation angular speed of the motor, which are caused by the poor anti-interference ability of the gimbal. It also avoids the situation of using the disturbance suppression ratio alone to judge that the anti-jamming capability of the gimbal is poor when the disturbance suppression ratio is greater than the preset ratio threshold, but in fact, the attitude error is small at this time. The error meets the control and control requirements, and there is no need to output the evaluation result, so that the user can repeatedly modify the control parameters to adjust the anti-interference ability of the gimbal.
其中,可选的,不同扰动频率的预设误差幅值阈值不同,或者不同扰动频率的预设误差幅值阈值相同;可选的,不同驱动轴的预设误差幅值阈值可不同,或者不同驱动轴的预设误差幅值阈值相同;可选的,不同扰动频率的预设比值阈值不同,或者不同扰动频率的预设比值阈值相同;可选的,不同驱动轴的预设比值阈值不同,或者不同驱动轴的预设比值阈值相同。Wherein, optionally, the preset error amplitude thresholds of different disturbance frequencies are different, or the preset error amplitude thresholds of different disturbance frequencies are the same; optionally, the preset error amplitude thresholds of different drive shafts may be different, or different The preset error amplitude thresholds of the drive shafts are the same; optionally, the preset ratio thresholds of different disturbance frequencies are different, or the preset ratio thresholds of different disturbance frequencies are the same; optionally, the preset ratio thresholds of different drive shafts are different, Or the preset ratio thresholds for different drive shafts are the same.
本申请实施例的预设条件也可以设置为其他,例如,预设条件可以为:姿态误差幅值大于或等于预设误差幅值阈值,且扰动抑制比大于或等于预设比值阈值。The preset conditions in this embodiment of the present application may also be set to other preset conditions. For example, the preset conditions may be: the attitude error amplitude is greater than or equal to the preset error amplitude threshold, and the disturbance suppression ratio is greater than or equal to the preset ratio threshold.
需要说明的是,在根据姿态误差和期望角速度,评估云台的抗干扰能力时,也可以根据同一时刻采集的姿态误差和期望角速度直接评估云台的抗干扰能力,例如,根据姿态误差及姿态误差与期望角速度的比值(即姿态误差/期望角速度),评估云台的抗干扰能力,也即,将上述姿态误差幅值替换成姿态误差,扰动抑制比替换成姿态误差与期望角速度的比值,具体评估过程相类似。It should be noted that when evaluating the anti-interference ability of the gimbal based on the attitude error and expected angular velocity, the anti-interference ability of the gimbal can also be directly evaluated according to the attitude error and expected angular velocity collected at the same time. For example, according to the attitude error and attitude The ratio of the error to the expected angular velocity (that is, the attitude error/desired angular velocity), to evaluate the anti-interference ability of the gimbal, that is, to replace the above-mentioned attitude error amplitude with attitude error, and replace the disturbance suppression ratio with the ratio of attitude error and expected angular velocity, The specific evaluation process is similar.
进一步的,在一些实施例中,在根据姿态误差和期望角速度,评估云台的抗干扰能力之后,输出评估结果,以使得用户可以根据评估结果调整云台的控制参数,进而提高云台的抗干扰能力。其中,评估结果用于表征云台的抗干扰能力的强弱。输出评估结果的方式可包括多种,以云台性能的评估方法的执行主体为云台为例,示例性 的,可以通过云台和/或云台的控制装置显示屏以文字/图形等方式输出评估结果,也可以通过云台的指示灯输出评估结果,或者通过其他方式输出评估结果。Further, in some embodiments, after evaluating the anti-interference ability of the gimbal according to the attitude error and the expected angular velocity, the evaluation result is output, so that the user can adjust the control parameters of the gimbal according to the evaluation result, thereby improving the anti-interference ability of the gimbal. Interference ability. Among them, the evaluation results are used to characterize the strength of the anti-interference ability of the gimbal. There may be various ways to output the evaluation results. Taking the PTZ as an example of the execution subject of the performance evaluation method of the PTZ, exemplarily, text/graphics etc. Output the evaluation results, you can also output the evaluation results through the indicator light of the gimbal, or output the evaluation results in other ways.
示例性的,通过文字/图形等方式输出评估结果,其中,当云台自带显示屏时,可以通过云台自带的显示屏输出评估结果和/或通过云台的控制装置的显示屏输出评估结果;当云台未自带显示屏时,可以通过云台的控制装置的显示屏输出评估结果。Exemplarily, the evaluation results are output through text/graphics, etc., wherein, when the gimbal has its own display screen, the evaluation results can be output through the display screen of the gimbal and/or through the display screen of the control device of the gimbal. Evaluation results; when the gimbal does not have its own display screen, the evaluation results can be output through the display screen of the control device of the gimbal.
需要说明的是,在一些实施例中,在云台启动后,可以一直进行上述云台性能的评估程序,除云台休眠外,即在云台处于休眠状态下,不会进行上述云台性能的评估程序,也即,即使在评估结果指示云台的抗干扰能力弱后,还会基于上述方式继续评估云台的抗干扰性能,并输出评估结果,这样,在云台启动后,可以持续识别出云台的抗干扰性能,从而持续将评估结果及时反馈给用户,有利于用户根据评估结果进行相应的操作,从而提高云台的可靠性和增稳性能,并提升用户使用云台的体验;在另外一些实施例中,当评估结果指示云台的抗干扰能力弱、或者云台由工作状态切换成休眠状态、或者由工作状态切换成关闭状态时,结束云台的抗干扰性能的评估程序,示例性的,当评估结果指示云台的抗干扰能力弱时,结束云台的抗干扰性能的评估程序,评估结果指示云台的抗干扰能力弱,这说明云台的控制参数与有效载荷不匹配,需要用户对控制参数和/或有效载荷进行调节,如调节控制参数的大小和/或有效载荷的安装在云台上的位置和/或更换有效载荷等,在用户调节控制参数和/或有效载荷的过程中,评估云台的抗干扰性能的意义不大,因此,当评估结果指示云台的抗干扰能力弱时,结束云台的抗干扰性能的评估程序;示例性的,当云台由工作状态切换成休眠状态、或者由工作状态切换成关闭状态时,结束云台的抗干扰性能的评估程序,在云台处于休眠状态下或关闭状态下,用户无需使用云台,因此,无需评估云台的抗干扰性能。It should be noted that, in some embodiments, after the gimbal is started, the above-mentioned evaluation procedure of gimbal performance may be performed all the time, except that the gimbal is in sleep state, that is, when the gimbal is in a dormant state, the above-mentioned gimbal performance will not be performed. That is, even after the evaluation result indicates that the anti-interference ability of the gimbal is weak, the anti-jamming performance of the gimbal will continue to be evaluated based on the above method, and the evaluation result will be output, so that after the gimbal is started, it can continue to Identify the anti-interference performance of the gimbal, so as to continuously feedback the evaluation results to the user in a timely manner, which is beneficial for the user to perform corresponding operations according to the evaluation results, thereby improving the reliability and stabilization performance of the gimbal, and improving the user experience of using the gimbal In other embodiments, when the evaluation result indicates that the anti-jamming capability of the gimbal is weak, or the gimbal is switched from a working state to a dormant state, or is switched from a working state to an off state, the evaluation of the anti-jamming performance of the gimbal is ended. The program, exemplarily, when the evaluation result indicates that the anti-jamming capability of the gimbal is weak, the evaluation procedure of the anti-jamming performance of the gimbal is ended, and the evaluation result indicates that the anti-jamming capability of the gimbal is weak, which indicates that the control parameters of the gimbal are effective and effective. The load does not match, requiring the user to adjust the control parameters and/or the payload, such as adjusting the size of the control parameters and/or the location of the payload installed on the gimbal and/or replacing the payload, etc. After the user adjusts the control parameters and/or the payload In the process of/or payload, it is of little significance to evaluate the anti-jamming performance of the gimbal. Therefore, when the evaluation result indicates that the anti-jamming capability of the gimbal is weak, the evaluation procedure of the anti-jamming performance of the gimbal is ended; exemplarily, When the gimbal is switched from the working state to the dormant state, or from the working state to the off state, the evaluation procedure of the anti-interference performance of the gimbal ends. When the gimbal is in the dormant state or the closed state, the user does not need to use the gimbal. Therefore, there is no need to evaluate the anti-jamming performance of the gimbal.
另外,需要说明的是,在一些实施例中,在云台开机或者用户触发(如通过操作云台上的按键或者云台的控制装置)或者云台的控制参数被修改或者有效载荷变更时,可以进入上述云台性能的评估程序。其中,控制参数被修改是指控制参数的大小被修改,有效载荷变更可以包括:有效载荷的类型变更和/或有效载荷的安装位置变更。In addition, it should be noted that, in some embodiments, when the gimbal is powered on or triggered by the user (for example, by operating a button on the gimbal or the control device of the gimbal), or when the control parameters of the gimbal are modified or the payload is changed, You can enter the evaluation procedure of the performance of the gimbal mentioned above. Wherein, the modification of the control parameter means that the size of the control parameter is modified, and the change of the payload may include: change of the type of the payload and/or change of the installation position of the payload.
对应于上述实施例的云台性能的评估方法,本申请实施例还提供一种云台性能的评估装置。请参见图4,本申请实施例的云台性能的评估装置可以包括存储装置和处理器,处理器包括一个或多个。Corresponding to the method for evaluating the performance of the pan/tilt in the above embodiment, the embodiment of the present application further provides a device for evaluating the performance of the pan/tilt. Referring to FIG. 4 , the apparatus for evaluating the performance of the pan/tilt according to the embodiment of the present application may include a storage device and a processor, and the processor includes one or more processors.
其中,存储装置,用于存储程序指令。所述存储装置存储所述云台性能的评估方法的可执行指令计算机程序,所述存储装置可以包括至少一种类型的存储介质,存储介质包括闪存、硬盘、多媒体卡、卡型存储器(例如,SD或DX存储器等等)、随机访问存储器(RAM)、静态随机访问存储器(SRAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、可编程只读存储器(PROM)、磁性存储器、磁盘、光盘等 等。而且,所述云台性能的评估装置可以与通过网络连接执行存储器的存储功能的网络存储装置协作。存储器可以是云台性能的评估装置的内部存储单元,例如云台性能的评估装置的硬盘或内存。存储器也可以是云台性能的评估装置的外部存储设备,例如云台性能的评估装置上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步的,存储器还可以既包括云台性能的评估装置的内部存储单元也包括外部存储设备。存储器用于存储计算机程序以及设备所需的其他程序和数据。存储器还可以用于暂时地存储已经输出或者将要输出的数据。The storage device is used for storing program instructions. The storage device stores the executable instruction computer program of the evaluation method for the performance of the PTZ, and the storage device may include at least one type of storage medium, and the storage medium includes a flash memory, a hard disk, a multimedia card, a card-type memory (for example, SD or DX memory, etc.), Random Access Memory (RAM), Static Random Access Memory (SRAM), Read Only Memory (ROM), Electrically Erasable Programmable Read Only Memory (EEPROM), Programmable Read Only Memory (PROM) ), magnetic memory, magnetic disks, optical disks, etc. Also, the device for evaluating the performance of the PTZ may cooperate with a network storage device that performs the storage function of the memory through a network connection. The memory may be an internal storage unit of the device for evaluating the performance of the PTZ, such as a hard disk or a memory of the device for evaluating the performance of the PTZ. The memory can also be an external storage device of the performance evaluation device of the PTZ, such as a plug-in hard disk, a Smart Media Card (SMC), a Secure Digital (SD) card equipped on the performance evaluation device of the PTZ , Flash card (Flash Card) and so on. Further, the memory may also include both an internal storage unit of the apparatus for evaluating the performance of the PTZ and an external storage device. Memory is used to store computer programs and other programs and data required by the device. The memory can also be used to temporarily store data that has been or will be output.
一个或多个处理器,调用存储装置中存储的程序指令,当程序指令被执行时,一个或多个处理器单独地或共同地被配置成用于实施如下操作:获取云台的姿态误差和期望角速度,姿态误差为基于第一惯性测量单元确定的云台的测量姿态和设定的云台的目标姿态确定,期望角速度为根据目标姿态和基于第二惯性测量单元确定的支撑平台的角速度确定;根据姿态误差和期望角速度,评估云台的抗干扰能力。One or more processors call program instructions stored in the storage device, and when the program instructions are executed, the one or more processors are individually or collectively configured to perform the following operations: acquiring the attitude error of the pan/tilt and the Desired angular velocity, the attitude error is determined based on the measurement attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit ; Evaluate the anti-interference ability of the gimbal according to the attitude error and expected angular velocity.
本实施例的处理器可以实现如本申请图2、图3所示实施例的云台性能的评估方法,可参见上述实施例的云台性能的评估方法对本实施例的云台性能的评估装置进行说明。The processor of this embodiment can implement the pan-tilt performance evaluation method according to the embodiment shown in FIG. 2 and FIG. 3 of the present application. For details, please refer to the pan-tilt performance evaluation method of the above-mentioned embodiment for the pan-tilt performance evaluation device of this embodiment. Be explained.
所述处理器可以是中央处理单元(Central Processing Unit,CPU),还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The processor may be a central processing unit (Central Processing Unit, CPU), or other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), application specific integrated circuits (Application Specific Integrated Circuit, ASIC), field Field-Programmable Gate Array (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.
进一步的,本申请实施例还提供一种云台,云台搭载在支撑平台上,请参见图1A、图1B和图5,本申请实施例的云台可以包括承载部210、第一惯性测量单元220、第二惯性测量单元230和上述实施例的云台性能的评估装置,其中,承载部210用于支撑有效载荷,第一惯性测量单元220设于承载部或有效载荷上,第二惯性测量单元230设于支撑平台上,云台性能的评估装置与第一惯性测量单元220及第二惯性测量单元230分别电连接。Further, an embodiment of the present application further provides a pan/tilt head, which is mounted on a support platform. Please refer to FIG. 1A , FIG. 1B and FIG. 5 . The unit 220, the second inertial measurement unit 230, and the device for evaluating the performance of the gimbal in the above-mentioned embodiment, wherein the bearing part 210 is used to support the payload, the first inertial measurement unit 220 is arranged on the bearing part or the payload, and the second inertial The measurement unit 230 is disposed on the support platform, and the device for evaluating the performance of the gimbal is electrically connected to the first inertial measurement unit 220 and the second inertial measurement unit 230 respectively.
本申请实施例的云台可以为手持云台,也可以为机载云台。The gimbal in the embodiment of the present application may be a handheld gimbal or an airborne gimbal.
进一步的,本申请实施例还提供一种可移动平台,可移动平台可以包括机体和上述实施例的云台,云台搭载在机体上。Further, an embodiment of the present application further provides a movable platform, and the movable platform may include a body and the pan/tilt of the above embodiment, and the pan/tilt is mounted on the body.
本申请实施例的可移动平台可以为移动小车、无人飞行器(如无人机或有人飞行器)或移动机器人,可以理解的是,可移动平台也可为其他可移动的设备或装置。The movable platform in the embodiment of the present application may be a mobile car, an unmanned aerial vehicle (such as an unmanned aerial vehicle or a manned aerial vehicle) or a mobile robot, and it should be understood that the movable platform may also be other movable equipment or devices.
示例性的,请参见图1A,可移动平台为无人机100,支撑平台为无人机100的机体110。Illustratively, please refer to FIG. 1A , the movable platform is an unmanned aerial vehicle 100 , and the supporting platform is the body 110 of the unmanned aerial vehicle 100 .
此外,本申请实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述实施例的云台性能的评估方法的步骤。In addition, an embodiment of the present application further provides a computer-readable storage medium on which a computer program is stored, and when the program is executed by a processor, implements the steps of the method for evaluating the performance of the pan/tilt in the foregoing embodiment.
所述计算机可读存储介质可以是前述任一实施例所述的云台的内部存储单元,例如硬盘或内存。所述计算机可读存储介质也可以是云台的外部存储设备,例如所述设备上配备的插接式硬盘、智能存储卡(Smart Media Card,SMC)、SD卡、闪存卡(Flash Card)等。进一步的,所述计算机可读存储介质还可以既包括云台的内部存储单元也包括外部存储设备。所述计算机可读存储介质用于存储所述计算机程序以及所述云台所需的其他程序和数据,还可以用于暂时地存储已经输出或者将要输出的数据。The computer-readable storage medium may be an internal storage unit of the PTZ described in any of the foregoing embodiments, such as a hard disk or a memory. The computer-readable storage medium can also be an external storage device of the PTZ, such as a plug-in hard disk, a smart memory card (Smart Media Card, SMC), an SD card, a flash memory card (Flash Card), etc. that are equipped on the device. . Further, the computer-readable storage medium may also include both an internal storage unit of the PTZ and an external storage device. The computer-readable storage medium is used to store the computer program and other programs and data required by the PTZ, and can also be used to temporarily store data that has been output or will be output.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random Access Memory,RAM)等。Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be implemented by instructing relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium. During execution, the processes of the embodiments of the above-mentioned methods may be included. The storage medium may be a magnetic disk, an optical disk, a read-only memory (Read-Only Memory, ROM), or a random access memory (Random Access Memory, RAM) or the like.
以上所揭露的仅为本申请部分实施例而已,当然不能以此来限定本申请之权利范围,因此依本申请权利要求所作的等同变化,仍属本申请所涵盖的范围。The above disclosure is only a part of the embodiments of the present application, of course, the scope of the rights of the present application cannot be limited by this, so the equivalent changes made according to the claims of the present application are still within the scope of the present application.

Claims (45)

  1. 一种云台性能的评估方法,其特征在于,云台搭载在支撑平台上,所述云台用于支撑有效载荷,所述云台或所述有效载荷上设有第一惯性测量单元,所述支撑平台上设有第二惯性测量单元,所述方法包括:A method for evaluating the performance of a gimbal, characterized in that the gimbal is mounted on a support platform, the gimbal is used to support a payload, the gimbal or the payload is provided with a first inertial measurement unit, so The support platform is provided with a second inertial measurement unit, and the method includes:
    获取所述云台的姿态误差和期望角速度,所述姿态误差为基于所述第一惯性测量单元确定的所述云台的测量姿态和设定的所述云台的目标姿态确定,所述期望角速度为根据所述目标姿态和基于所述第二惯性测量单元确定的所述支撑平台的角速度确定;Obtain the attitude error and expected angular velocity of the gimbal, where the attitude error is determined based on the measured attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected The angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit;
    根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力。According to the attitude error and the expected angular velocity, the anti-interference ability of the gimbal is evaluated.
  2. 根据权利要求1所述的方法,其特征在于,所述云台被配置为与所述有效载荷可拆卸地连接,所述第一惯性测量单元设于所述云台上;和/或The method of claim 1, wherein the pan/tilt is configured to be detachably connected to the payload, and the first inertial measurement unit is provided on the pan/tilt; and/or
    所述目标姿态为默认姿态大小或由用户设定或基于所述支撑平台的姿态设定。The target posture is a default posture size or is set by the user or is set based on the posture of the support platform.
  3. 根据权利要求1所述的方法,其特征在于,所述云台处于锁定模式下,所述锁定模式用于指示所述云台保持在所述目标姿态。The method of claim 1, wherein the pan/tilt is in a lock mode, and the lock mode is used to instruct the pan/tilt to maintain the target attitude.
  4. 根据权利要求1所述的方法,其特征在于,所述获取所述云台的姿态误差和期望角速度,包括:The method according to claim 1, wherein the acquiring the attitude error and the desired angular velocity of the gimbal comprises:
    在预设评估周期内,获取所述云台的多个姿态误差和多个期望角速度。In a preset evaluation period, multiple attitude errors and multiple expected angular velocities of the gimbal are acquired.
  5. 根据权利要求4所述的方法,其特征在于,所述预设评估周期是可更新的。The method of claim 4, wherein the preset evaluation period is updatable.
  6. 根据权利要求5所述的方法,其特征在于,在一段时长内的多个所述预设评估周期中,至少两个所述预设评估周期能够不同。The method according to claim 5, wherein, in a plurality of the preset evaluation periods within a period of time, at least two of the preset evaluation periods can be different.
  7. 根据权利要求4所述的方法,其特征在于,所述预设评估周期为根据扰动频率和预设采样频率确定。The method according to claim 4, wherein the preset evaluation period is determined according to the disturbance frequency and the preset sampling frequency.
  8. 根据权利要求7所述的方法,其特征在于,所述预设评估周期与所述扰动频率负相关,并与所述预设采样频率正相关。The method according to claim 7, wherein the preset evaluation period is negatively correlated with the disturbance frequency and positively correlated with the preset sampling frequency.
  9. 根据权利要求7所述的方法,其特征在于,所述扰动频率与所述支撑平台的角速度的变化快慢正相关。The method according to claim 7, wherein the disturbance frequency is positively correlated with the change speed of the angular velocity of the support platform.
  10. 根据权利要求7所述的方法,其特征在于,所述扰动频率与所述支撑平台的类型相关,所述支撑平台包括手持支撑平台和/或机载支撑平台。The method of claim 7, wherein the disturbance frequency is related to the type of the support platform, the support platform comprising a hand-held support platform and/or an airborne support platform.
  11. 根据权利要求10所述的方法,其特征在于,不同类型的所述支撑平台的扰动频率不相同。The method according to claim 10, wherein the disturbance frequencies of different types of the support platforms are different.
  12. 根据权利要求10或11所述的方法,其特征在于,所述云台与所述支撑平台可拆卸地连接,所述方法还包括:The method according to claim 10 or 11, wherein the head and the supporting platform are detachably connected, and the method further comprises:
    在所述云台改变搭载的所述支撑平台时,基于所述云台搭载的当前支撑平台调整所述扰动频率。When the gimbal changes the mounted support platform, the disturbance frequency is adjusted based on the current support platform mounted on the gimbal.
  13. 根据权利要求7所述的方法,其特征在于,所述扰动频率与所述支撑平台所处的运动场景相关。The method according to claim 7, wherein the disturbance frequency is related to a motion scene in which the support platform is located.
  14. 根据权利要求4所述的方法,其特征在于,所述根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力,包括:The method according to claim 4, wherein the evaluating the anti-interference ability of the gimbal according to the attitude error and the desired angular velocity comprises:
    根据所述预设评估周期内获取的多个所述姿态误差和多个所述期望角速度,分别确定所述预设评估周期内的姿态误差幅值和角速度幅值;According to a plurality of the attitude errors and a plurality of the expected angular velocities obtained in the preset evaluation period, the attitude error amplitude and the angular velocity amplitude in the preset evaluation period are respectively determined;
    根据所述姿态误差幅值和所述角速度幅值,评估所述云台的抗干扰能力。According to the attitude error amplitude and the angular velocity amplitude, the anti-interference ability of the gimbal is evaluated.
  15. 根据权利要求14所述的方法,其特征在于,所述根据所述预设评估周期内获取的多个所述姿态误差和多个所述期望角速度,分别确定所述预设评估周期内的姿态误差幅值和角速度幅值,包括:The method according to claim 14, wherein the attitude in the preset evaluation period is determined respectively according to a plurality of the attitude errors and a plurality of the expected angular velocities obtained in the preset evaluation period Error magnitude and angular velocity magnitude, including:
    根据傅里叶变换,将所述预设评估周期内获取的多个姿态误差转换至频域,获得所述预设评估周期内的姿态误差幅值;According to the Fourier transform, the plurality of attitude errors obtained in the preset evaluation period are converted to the frequency domain, and the attitude error amplitude in the preset evaluation period is obtained;
    根据傅里叶变换,将所述预设评估周期内获取的多个期望角速度转换至频域,获得所述预设评估周期内的角速度幅值。According to the Fourier transform, a plurality of desired angular velocities obtained in the preset evaluation period are converted into the frequency domain, and the angular velocity amplitudes in the preset evaluation period are obtained.
  16. 根据权利要求14所述的方法,其特征在于,所述根据所述姿态误差幅值和所述角速度幅值,评估所述云台的抗干扰能力,包括:The method according to claim 14, wherein the evaluating the anti-interference ability of the gimbal according to the attitude error magnitude and the angular velocity magnitude comprises:
    根据所述姿态误差幅值及扰动抑制比,评估所述云台的抗干扰能力;Evaluate the anti-interference ability of the gimbal according to the attitude error amplitude and the disturbance rejection ratio;
    其中,所述扰动抑制比为所述姿态误差幅值与所述角速度幅值的比值。Wherein, the disturbance suppression ratio is the ratio of the attitude error amplitude to the angular velocity amplitude.
  17. 根据权利要求16所述的方法,其特征在于,所述根据所述姿态误差幅值及所述扰动抑制比,评估所述云台的抗干扰能力,包括:The method according to claim 16, wherein the evaluating the anti-jamming capability of the gimbal according to the attitude error magnitude and the disturbance rejection ratio comprises:
    当至少一个所述预设评估周期内的所述姿态误差幅值及所述扰动抑制比满足预设条件时,确定所述云台的抗干扰能力弱。When the attitude error amplitude and the disturbance suppression ratio in at least one of the preset evaluation periods satisfy preset conditions, it is determined that the anti-interference capability of the pan/tilt head is weak.
  18. 根据权利要求17所述的方法,其特征在于,所述当至少一个所述预设评估周期内的所述姿态误差幅值及所述扰动抑制比满足预设条件时,确定所述云台的抗干扰能力弱,包括:The method according to claim 17, wherein, when the attitude error amplitude and the disturbance suppression ratio in at least one of the preset evaluation periods meet preset conditions, determining the gimbal's Weak anti-interference ability, including:
    当连续至少两个的预设评估周期内的所述姿态误差幅值及所述扰动抑制比满足所述预设条件,且所述连续至少两个预设评估周期的数量大于或等于预设数量时,确定所述云台的抗干扰能力弱。When the attitude error magnitude and the disturbance suppression ratio in at least two consecutive preset evaluation periods satisfy the preset condition, and the number of the at least two consecutive preset evaluation periods is greater than or equal to a preset number , it is determined that the anti-interference ability of the gimbal is weak.
  19. 根据权利要求17或18所述的方法,其特征在于,所述预设条件包括:The method according to claim 17 or 18, wherein the preset condition comprises:
    所述姿态误差幅值大于预设误差幅值阈值,且所述扰动抑制比大于预设比值阈值。The attitude error amplitude is greater than a preset error amplitude threshold, and the disturbance suppression ratio is greater than a preset ratio threshold.
  20. 根据权利要求1所述的方法,其特征在于,所述根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力之后,还包括:The method according to claim 1, wherein after evaluating the anti-interference ability of the gimbal according to the attitude error and the desired angular velocity, the method further comprises:
    输出评估结果;output evaluation results;
    其中,所述评估结果用于表征所述云台的抗干扰能力的强弱。Wherein, the evaluation result is used to characterize the strength of the anti-interference ability of the gimbal.
  21. 根据权利要求1所述的方法,其特征在于,所述云台为多轴云台,包括多个驱动轴,所述抗干扰能力用于表征所述云台相应于每个所述驱动轴的抗干扰能力。The method according to claim 1, wherein the pan/tilt is a multi-axis pan/tilt and includes a plurality of drive shafts, and the anti-interference capability is used to characterize the corresponding Anti-interference ability.
  22. 一种云台性能的评估装置,其特征在于,云台搭载在支撑平台上,所述云台用于支撑有效载荷,所述云台或所述有效载荷上设有第一惯性测量单元,所述支撑平 台上设有第二惯性测量单元,所述云台性能的评估装置包括:A device for evaluating the performance of a gimbal, characterized in that the gimbal is mounted on a support platform, the gimbal is used to support a payload, and a first inertial measurement unit is arranged on the gimbal or the payload, so The support platform is provided with a second inertial measurement unit, and the evaluation device for the performance of the pan-tilt includes:
    存储装置,用于存储程序指令;以及a storage device for storing program instructions; and
    一个或多个处理器,调用所述存储装置中存储的程序指令,当所述程序指令被执行时,所述一个或多个处理器单独地或共同地被配置成用于实施如下操作:One or more processors that invoke program instructions stored in the storage device, the one or more processors, when executed, are individually or collectively configured to perform the following operations:
    获取所述云台的姿态误差和期望角速度,所述姿态误差为基于所述第一惯性测量单元确定的所述云台的测量姿态和设定的所述云台的目标姿态确定,所述期望角速度为根据所述目标姿态和基于所述第二惯性测量单元确定的所述支撑平台的角速度确定;Obtain the attitude error and expected angular velocity of the gimbal, where the attitude error is determined based on the measured attitude of the gimbal determined by the first inertial measurement unit and the set target attitude of the gimbal, and the expected The angular velocity is determined according to the target attitude and the angular velocity of the support platform determined based on the second inertial measurement unit;
    根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力。According to the attitude error and the expected angular velocity, the anti-interference ability of the gimbal is evaluated.
  23. 根据权利要求22所述的装置,其特征在于,所述云台被配置为与所述有效载荷可拆卸地连接,所述第一惯性测量单元设于所述云台上;和/或The apparatus of claim 22, wherein the pan/tilt is configured to be detachably connected to the payload, and the first inertial measurement unit is provided on the pan/tilt; and/or
    所述目标姿态为默认姿态大小或由用户设定或基于所述支撑平台的姿态设定。The target posture is a default posture size or is set by the user or is set based on the posture of the support platform.
  24. 根据权利要求22所述的装置,其特征在于,所述云台处于锁定模式下,所述锁定模式用于指示所述云台保持在所述目标姿态。The apparatus of claim 22, wherein the pan/tilt is in a lock mode, and the lock mode is used to instruct the pan/tilt to maintain the target attitude.
  25. 根据权利要求22所述的装置,其特征在于,所述一个或多个处理器在获取所述云台的姿态误差和期望角速度时,单独地或共同地被进一步配置成用于实施如下操作:23. The apparatus of claim 22, wherein the one or more processors are further configured, individually or collectively, to perform the following operations when acquiring the attitude error and desired angular velocity of the pan/tilt head:
    在预设评估周期内,获取所述云台的多个姿态误差和多个期望角速度。In a preset evaluation period, multiple attitude errors and multiple expected angular velocities of the gimbal are acquired.
  26. 根据权利要求25所述的装置,其特征在于,所述预设评估周期是可更新的。The apparatus of claim 25, wherein the preset evaluation period is updatable.
  27. 根据权利要求26所述的装置,其特征在于,在一段时长内的多个所述预设评估周期中,至少两个所述预设评估周期能够不同。The apparatus according to claim 26, wherein, in a plurality of the preset evaluation periods within a period of time, at least two of the preset evaluation periods can be different.
  28. 根据权利要求25所述的装置,其特征在于,所述预设评估周期为根据扰动频率和预设采样频率确定。The device according to claim 25, wherein the preset evaluation period is determined according to a disturbance frequency and a preset sampling frequency.
  29. 根据权利要求28所述的装置,其特征在于,所述预设评估周期与所述扰动频率负相关,并与所述预设采样频率正相关。The device according to claim 28, wherein the preset evaluation period is negatively correlated with the disturbance frequency and positively correlated with the preset sampling frequency.
  30. 根据权利要求28所述的装置,其特征在于,所述扰动频率与所述支撑平台的角速度的变化快慢正相关。The device according to claim 28, wherein the disturbance frequency is positively correlated with the change speed of the angular velocity of the support platform.
  31. 根据权利要求28所述的装置,其特征在于,所述扰动频率与所述支撑平台的类型相关,所述支撑平台包括手持支撑平台和/或机载支撑平台。28. The apparatus of claim 28, wherein the disturbance frequency is related to the type of the support platform, the support platform comprising a hand-held support platform and/or an airborne support platform.
  32. 根据权利要求31所述的装置,其特征在于,不同类型的所述支撑平台的扰动频率不相同。The device according to claim 31, wherein the disturbance frequencies of different types of the support platforms are different.
  33. 根据权利要求31或32所述的装置,其特征在于,所述云台与所述支撑平台可拆卸地连接,所述一个或多个处理器单独地或共同地还被配置成用于实施如下操作:32. The apparatus of claim 31 or 32, wherein the pan/tilt head is detachably connected to the support platform, and the one or more processors, individually or collectively, are further configured to implement the following operate:
    在所述云台改变搭载的所述支撑平台时,基于所述云台搭载的当前支撑平台调整所述扰动频率。When the gimbal changes the mounted support platform, the disturbance frequency is adjusted based on the current support platform mounted on the gimbal.
  34. 根据权利要求28所述的装置,其特征在于,所述扰动频率与所述支撑平台所 处的运动场景相关。The apparatus of claim 28, wherein the disturbance frequency is related to a motion scene in which the support platform is located.
  35. 根据权利要求25所述的装置,其特征在于,所述一个或多个处理器在根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力时,单独地或共同地被进一步配置成用于实施如下操作:26. The apparatus of claim 25, wherein the one or more processors are individually or collectively used when evaluating the anti-jamming capability of the gimbal based on the attitude error and the desired angular velocity. is further configured to perform the following operations:
    根据所述预设评估周期内获取的多个所述姿态误差和多个所述期望角速度,分别确定所述预设评估周期内的姿态误差幅值和角速度幅值;According to a plurality of the attitude errors and a plurality of the expected angular velocities obtained in the preset evaluation period, the attitude error amplitude and the angular velocity amplitude in the preset evaluation period are respectively determined;
    根据所述姿态误差幅值和所述角速度幅值,评估所述云台的抗干扰能力。According to the attitude error amplitude and the angular velocity amplitude, the anti-interference ability of the gimbal is evaluated.
  36. 根据权利要求35所述的装置,其特征在于,所述一个或多个处理器在根据所述预设评估周期内获取的多个所述姿态误差和多个所述期望角速度,分别确定所述预设评估周期内的姿态误差幅值和角速度幅值时,单独地或共同地被进一步配置成用于实施如下操作:The device according to claim 35, wherein the one or more processors respectively determine the When the attitude error magnitude and the angular velocity magnitude within the preset evaluation period are individually or collectively further configured to perform the following operations:
    根据傅里叶变换,将所述预设评估周期内获取的多个姿态误差转换至频域,获得所述预设评估周期内的姿态误差幅值;According to the Fourier transform, the plurality of attitude errors obtained in the preset evaluation period are converted to the frequency domain, and the attitude error amplitude in the preset evaluation period is obtained;
    根据傅里叶变换,将所述预设评估周期内获取的多个期望角速度转换至频域,获得所述预设评估周期内的角速度幅值。According to the Fourier transform, a plurality of desired angular velocities obtained in the preset evaluation period are converted into the frequency domain, and the angular velocity amplitudes in the preset evaluation period are obtained.
  37. 根据权利要求35所述的装置,其特征在于,所述一个或多个处理器在根据所述姿态误差幅值和所述角速度幅值,评估所述云台的抗干扰能力时,单独地或共同地被进一步配置成用于实施如下操作:The apparatus of claim 35, wherein the one or more processors, when evaluating the anti-jamming capability of the gimbal based on the attitude error magnitude and the angular velocity magnitude, individually or are collectively further configured to perform the following operations:
    根据所述姿态误差幅值及扰动抑制比,评估所述云台的抗干扰能力;Evaluate the anti-interference ability of the gimbal according to the attitude error amplitude and the disturbance rejection ratio;
    其中,所述扰动抑制比为所述姿态误差幅值与所述角速度幅值的比值。Wherein, the disturbance suppression ratio is the ratio of the attitude error amplitude to the angular velocity amplitude.
  38. 根据权利要求37所述的装置,其特征在于,所述一个或多个处理器在根据所述姿态误差幅值及所述扰动抑制比,评估所述云台的抗干扰能力时,单独地或共同地被进一步配置成用于实施如下操作:The apparatus of claim 37, wherein the one or more processors, when evaluating the anti-jamming capability of the gimbal based on the attitude error magnitude and the disturbance rejection ratio, individually or are collectively further configured to perform the following operations:
    当至少一个所述预设评估周期内的所述姿态误差幅值及所述扰动抑制比满足预设条件时,确定所述云台的抗干扰能力弱。When the attitude error amplitude and the disturbance suppression ratio in at least one of the preset evaluation periods satisfy preset conditions, it is determined that the anti-interference capability of the pan/tilt head is weak.
  39. 根据权利要求38所述的装置,其特征在于,所述一个或多个处理器在至少一个所述预设评估周期内的所述姿态误差幅值及所述扰动抑制比满足预设条件时,确定所述云台的抗干扰能力弱时,单独地或共同地被进一步配置成用于实施如下操作:The device according to claim 38, wherein the one or more processors, when the attitude error amplitude and the disturbance rejection ratio in at least one of the preset evaluation periods meet preset conditions, When it is determined that the anti-interference ability of the PTZ is weak, it is further configured to perform the following operations individually or collectively:
    当连续至少两个的预设评估周期内的所述姿态误差幅值及所述扰动抑制比满足所述预设条件,且所述连续至少两个预设评估周期的数量大于或等于预设数量时,确定所述云台的抗干扰能力弱。When the attitude error magnitude and the disturbance suppression ratio in at least two consecutive preset evaluation periods satisfy the preset condition, and the number of the at least two consecutive preset evaluation periods is greater than or equal to a preset number , it is determined that the anti-interference ability of the gimbal is weak.
  40. 根据权利要求38或39所述的装置,其特征在于,所述预设条件包括:The device according to claim 38 or 39, wherein the preset conditions include:
    所述姿态误差幅值大于预设误差幅值阈值,且所述扰动抑制比大于预设比值阈值。The attitude error amplitude is greater than a preset error amplitude threshold, and the disturbance suppression ratio is greater than a preset ratio threshold.
  41. 根据权利要求22所述的装置,其特征在于,所述一个或多个处理器在根据所述姿态误差和所述期望角速度,评估所述云台的抗干扰能力之后,单独地或共同地还被配置成用于实施如下操作:23. The apparatus of claim 22, wherein the one or more processors, individually or collectively, after evaluating the anti-jamming capability of the gimbal based on the attitude error and the desired angular velocity is configured to perform the following operations:
    输出评估结果;output evaluation results;
    其中,所述评估结果用于表征所述云台的抗干扰能力的强弱。Wherein, the evaluation result is used to characterize the strength of the anti-interference ability of the gimbal.
  42. 根据权利要求22所述的装置,其特征在于,所述云台为多轴云台,包括多个驱动轴,所述抗干扰能力用于表征所述云台相应于每个所述驱动轴的抗干扰能力。The device according to claim 22, wherein the pan/tilt is a multi-axis pan/tilt and includes a plurality of drive shafts, and the anti-interference capability is used to characterize the corresponding Anti-interference ability.
  43. 一种云台,其特征在于,云台搭载在支撑平台上,所述云台包括:A pan-tilt, characterized in that the pan-tilt is mounted on a support platform, and the pan-tilt comprises:
    承载部,用于支撑有效载荷;the load-bearing part, which is used to support the payload;
    第一惯性测量单元,设于所述承载部或所述有效载荷上;a first inertial measurement unit, arranged on the bearing portion or the payload;
    第二惯性测量单元,设于所述支撑平台上;和a second inertial measurement unit, disposed on the support platform; and
    权利要求22至42任一项所述的云台性能的评估装置,与所述第一惯性测量单元及所述第二惯性测量单元分别电连接。The device for evaluating the performance of a pan/tilt head according to any one of claims 22 to 42, which is electrically connected to the first inertial measurement unit and the second inertial measurement unit, respectively.
  44. 根据权利要求43所述的云台,其特征在于,所述云台为手持云台,所述支撑平台为所述手持云台的手柄;或,The PTZ according to claim 43, wherein the PTZ is a handheld PTZ, and the supporting platform is a handle of the handheld PTZ; or,
    所述云台为机载云台,所述云台搭载在可移动平台上,所述支撑平台为所述可移动平台的机体。The pan/tilt is an airborne pan/tilt, the pan/tilt is mounted on a movable platform, and the support platform is the body of the movable platform.
  45. 一种可移动平台,其特征在于,所述可移动平台包括:A movable platform, characterized in that the movable platform comprises:
    机体;和body; and
    权利要求43所述的云台,搭载在所述机体上。The pan/tilt according to claim 43, which is mounted on the body.
PCT/CN2020/103049 2020-07-20 2020-07-20 Gimbal, gimbal performance evaluation method and device, and mobile platform WO2022016322A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2020/103049 WO2022016322A1 (en) 2020-07-20 2020-07-20 Gimbal, gimbal performance evaluation method and device, and mobile platform
CN202080032549.2A CN113795798A (en) 2020-07-20 2020-07-20 Holder, holder performance evaluation method and device and movable platform

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/103049 WO2022016322A1 (en) 2020-07-20 2020-07-20 Gimbal, gimbal performance evaluation method and device, and mobile platform

Publications (1)

Publication Number Publication Date
WO2022016322A1 true WO2022016322A1 (en) 2022-01-27

Family

ID=78877221

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/103049 WO2022016322A1 (en) 2020-07-20 2020-07-20 Gimbal, gimbal performance evaluation method and device, and mobile platform

Country Status (2)

Country Link
CN (1) CN113795798A (en)
WO (1) WO2022016322A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118090264A (en) * 2022-11-28 2024-05-28 影石创新科技股份有限公司 Cloud deck state identification method and device, storage medium and cloud deck

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105784346A (en) * 2016-04-13 2016-07-20 中国计量学院 Aircraft holder stability testing device and method based on digital camera
CN105915899A (en) * 2016-07-04 2016-08-31 广东容祺智能科技有限公司 Onboard multi-shaft holder debugging platform of unmanned aerial vehicle
CN106953553A (en) * 2017-03-12 2017-07-14 纳恩博(北京)科技有限公司 The control method and device of a kind of head and horizontal stage electric machine
US20180115716A1 (en) * 2016-10-22 2018-04-26 Gopro, Inc. Fast Attitude Error Correction
CN108488572A (en) * 2018-05-23 2018-09-04 高新兴科技集团股份有限公司 A kind of active stabilization holder and its control method
CN109313439A (en) * 2017-07-28 2019-02-05 深圳市大疆创新科技有限公司 Holder method for testing reliability and device

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106959110B (en) * 2017-04-06 2020-08-11 亿航智能设备(广州)有限公司 Cloud deck attitude detection method and device
CN110352331A (en) * 2018-04-25 2019-10-18 深圳市大疆创新科技有限公司 The method and clouds terrace system of the attitude algorithm of hand-held holder

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105784346A (en) * 2016-04-13 2016-07-20 中国计量学院 Aircraft holder stability testing device and method based on digital camera
CN105915899A (en) * 2016-07-04 2016-08-31 广东容祺智能科技有限公司 Onboard multi-shaft holder debugging platform of unmanned aerial vehicle
US20180115716A1 (en) * 2016-10-22 2018-04-26 Gopro, Inc. Fast Attitude Error Correction
CN106953553A (en) * 2017-03-12 2017-07-14 纳恩博(北京)科技有限公司 The control method and device of a kind of head and horizontal stage electric machine
CN109313439A (en) * 2017-07-28 2019-02-05 深圳市大疆创新科技有限公司 Holder method for testing reliability and device
CN108488572A (en) * 2018-05-23 2018-09-04 高新兴科技集团股份有限公司 A kind of active stabilization holder and its control method

Also Published As

Publication number Publication date
CN113795798A (en) 2021-12-14

Similar Documents

Publication Publication Date Title
US11852958B2 (en) Gimbal control method, device, and gimbal
WO2019223270A1 (en) Method and apparatus for estimating angle and angular velocity of electric motor of gimbal, and gimbal and aerial vehicle
WO2019223271A1 (en) Correction method and device for yaw of aircraft, and aircraft
US20200213518A1 (en) Method for controlling gimbal, gimbal controller, and gimbal
US11156905B2 (en) Control method for gimbal, controller, and gimbal
US11041588B2 (en) Method and system for controlling a gimbal
WO2020042152A1 (en) Control method for handheld gimbal, handheld gimbal, and image acquisition device
US20220155800A1 (en) Method and apparatus for yaw fusion and aircraft
CN203705964U (en) Stable closed-loop control device of airborne 3-DOF pan-tilt
WO2019127029A1 (en) Obstacle avoidance method and device and aircraft
WO2018148906A1 (en) Method of configuring mounting device parameter, device, and mounting device
US20200141969A1 (en) System and method for determining airspeed
US11669109B2 (en) Method and apparatus for yaw fusion and aircraft
WO2019134154A1 (en) Control method for non-orthogonal tripod head, tripod head thereof, and storage device
WO2021037047A1 (en) Yaw angle correction method and apparatus for aircraft, and aircraft
US9904341B2 (en) Cascading power consumption
CN112135124A (en) Method, device and system for calibrating and detecting position of holder
WO2020042159A1 (en) Rotation control method and apparatus for gimbal, control device, and mobile platform
WO2022077357A1 (en) Detection method and apparatus for gimbal, and gimbal, movable platform and storage medium
WO2022016322A1 (en) Gimbal, gimbal performance evaluation method and device, and mobile platform
WO2019119441A1 (en) Method for controlling pan-tilt by means of somatosensory controller, and pan-tilt, somatosensory controller and system
WO2022205207A1 (en) Gimbal, and configuration recognition method and apparatus therefor
WO2022027579A1 (en) Detection method for gimbal, stability-enhanced gimbal, mobile platform, and storage medium
WO2022134036A1 (en) Movable platform and control method and device therefor
WO2022082442A1 (en) Gimbal control method and gimbal

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20946422

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

Country of ref document: EP

Kind code of ref document: A1