WO2018191957A1 - Camera mount attitude estimation method and device, and corresponding camera mount - Google Patents
Camera mount attitude estimation method and device, and corresponding camera mount Download PDFInfo
- Publication number
- WO2018191957A1 WO2018191957A1 PCT/CN2017/081442 CN2017081442W WO2018191957A1 WO 2018191957 A1 WO2018191957 A1 WO 2018191957A1 CN 2017081442 W CN2017081442 W CN 2017081442W WO 2018191957 A1 WO2018191957 A1 WO 2018191957A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- pan
- tilt
- carrier
- attitude
- data
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000005259 measurement Methods 0.000 claims abstract description 73
- 230000001133 acceleration Effects 0.000 claims description 60
- 238000004891 communication Methods 0.000 claims description 19
- 238000005242 forging Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 11
- 230000009471 action Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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
- G01C21/166—Mechanical, construction or arrangement details of inertial navigation systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Definitions
- the invention belongs to the field of automatic control, and specifically designs a method and device for estimating the attitude of the gimbal and the corresponding cloud platform.
- control of the gimbal is to measure the attitude of the gimbal through the inertial measurement component on the gimbal, and compare the measured attitude of the gimbal with a given target attitude, and control the action of the triaxial motor according to the deviation of the two.
- target posture by controlling the real-time posture of the gimbal.
- the inertial measurement element 110 mainly includes a gyroscope and an accelerometer.
- the gyroscope can perform integral acquisition to obtain the attitude of the gimbal, but the speed output of each axis of the gyroscope has a zero offset, and the zero offset cannot be completely eliminated. Therefore, it is inaccurate to obtain the attitude of the gimbal by using the gyroscope speed output integral.
- the inertial measurement element 110 also uses an accelerometer to give an attitude reference for the gimbal.
- the processor 120 corrects the attitude of the gimbal obtained by the gyro integral according to the attitude reference output by the accelerometer, and finally obtains a relatively stable attitude of the pan/tilt, and performs position output position control and speed control signals on the basis of Control the action of the three-axis motor.
- the accelerometer in the inertial measurement element 110 cannot accurately measure the motion state of the carrier when the pan/tilt is mounted on the carrier and the motion of the carrier is in a non-uniform linear motion.
- the influence on the attitude of the gimbal caused the attitude estimation of the gimbal to be incorrect, causing the picture taken by the lens on the gimbal to tilt and not to capture the desired picture.
- the attitude of the gimbal itself may be estimated to be affected by the acceleration of the carrier line, and the lens mounted on the gimbal may be tilted involuntarily.
- the posture of the PTZ itself will be affected by the linear acceleration and the error will be estimated, causing the lens mounted on the PTZ to involuntarily go up. tilt.
- the attitude of the gimbal itself may be estimated to be affected by the linear acceleration, resulting in an involuntary lens mounted on the gimbal.
- One aspect of the present invention provides a pan/tilt attitude estimation method.
- the method includes: S1: measuring an angular velocity value of the pan-tilt, and obtaining measured attitude data based on the angular velocity value; S2, measuring motion state data of the carrier of the pan-tilt, and calculating reference pose data of the carrier according to the motion state data, The carrier supports the pan/tilt; S3, correcting the measured attitude data by using the reference attitude data to obtain pan/tilt attitude data.
- the apparatus includes a first inertial measurement element for measuring an angular velocity value of the pan/tilt, and obtaining measured attitude data based on the angular velocity value; a communication interface for obtaining motion state data of the carrier, the carrier supporting the pan/tilt And a processor, configured to calculate reference attitude data of the carrier according to the motion state data of the carrier, and correct the measurement posture data by using the reference posture data to obtain pan/tilt attitude data.
- Another aspect of the present invention provides a pan/tilt head comprising the pan/tilt attitude estimating device described above.
- the pan-tilt attitude estimation method, the pan-tilt attitude estimation device, and the pan/tilt head of the present invention can effectively calculate the influence of the motion state of the carrier on the attitude of the pan-tilt when estimating the attitude of the gimbal, thereby enabling more accurate estimation of the gimbal
- the posture is to make the control of the attitude of the gimbal more accurate.
- FIG. 1 is a block diagram schematically showing an apparatus for measuring a posture of a gimbal in the prior art
- FIG. 2 is a flow chart schematically showing a pan/tilt attitude estimation method according to an embodiment of the invention
- FIG. 3 is a flow chart schematically showing a method for correcting measurement attitude data by using reference attitude data in a pan/tilt attitude estimation method according to an embodiment of the invention
- FIG. 4 is a flow chart schematically showing a pan/tilt attitude estimation method according to another embodiment of the present invention.
- FIG. 5 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to an embodiment of the present invention
- FIG. 6 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to an embodiment of the present invention.
- FIG. 7 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt according to an embodiment of the present invention
- FIG. 8 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt according to another embodiment of the present invention.
- Figure 9 is a schematic block diagram of a pan/tilt head in accordance with an embodiment of the present invention.
- the present invention mainly considers a situation in which the gimbal is mounted on a certain carrier, and when the carrier is in a non-uniform linear motion, the motion state of the carrier may deviate from the estimation of the attitude of the gimbal. Due to the existence of this deviation, after the estimated attitude of the gimbal is compared with the target attitude, the control of the attitude of the gimbal according to the comparison result may not be accurate enough. In this case, how to effectively deal with the estimated deviation of the attitude of the gimbal caused by the motion state of the carrier, thereby more accurately estimating the attitude of the gimbal, in order to achieve accurate control of the attitude of the gimbal is critical.
- the coordinate position change of the particle in the world coordinate system is determined by the motion of the carrier, that is, the movement of the gimbal with the carrier is Move in the world coordinate system.
- the attitude of the gimbal is the position of the gimbal and the angle of rotation in each direction in the local coordinate system composed of the carrier as a reference.
- a spatial three-dimensional local coordinate system can be defined by using a point on the carrier as a coordinate origin.
- the posture of the pan-tilt is the position in the local coordinate system, and the pan-tilt is in the local coordinate system.
- a pan/tilt attitude estimation method is provided. First, the angular velocity value of the gimbal is measured, and the measured attitude data is obtained based on the angular velocity value. Next, the motion state data of the carrier of the pan/tilt is measured, and reference pose data of the carrier is calculated according to the motion state data, and the carrier supports the pan/tilt. Finally, the measured attitude data is corrected by using the reference attitude data to obtain pan/tilt attitude data.
- the measurement posture data of the pan/tilt is corrected by using the reference attitude data related to the motion state of the carrier, so as to eliminate the motion state of the carrier and the estimation of the attitude of the pan/tilt.
- the deviation which results in more accurate gimbal attitude data, can more accurately estimate the attitude of the gimbal.
- a pan/tilt attitude estimating apparatus comprising a first inertial measurement element, a communication interface, and a processor.
- the first inertial measurement component is configured to measure an angular velocity value of the pan/tilt, and obtain measurement attitude data based on the angular velocity value.
- a communication interface for obtaining motion state data of the carrier, the carrier supporting the pan/tilt.
- a processor configured to calculate reference attitude data of the carrier according to the motion state data of the carrier, and correct the measurement posture data by using the reference posture data to obtain pan/tilt attitude data.
- a pan/tilt head comprising the pan/tilt attitude estimating device provided by the present invention.
- the attitude of the gimbal can be accurately controlled, so that the control of the lens mounted on the gimbal is more accurate and effective, and the captured image is more accurate.
- FIG. 2 is a flow chart schematically showing a pan/tilt attitude estimation method according to an embodiment of the present invention.
- the pan/tilt attitude estimation method includes steps S210 to S230.
- step S210 the angular velocity value of the gimbal is measured, and the measured attitude data is obtained based on the angular velocity value.
- the angular velocity value of the gimbal may be measured by the first inertial measurement element, and the measured attitude data of the gimbal may be calculated based on the angular velocity.
- the first inertial measurement element includes a gyroscope
- a gyroscope can be utilized.
- the angular velocity value of the gimbal is measured, and the gyroscope can obtain the attitudes of the pitch, roll, and yaw directions of the gimbal by using the integral.
- the first inertial measurement component is directly mounted on the gimbal to form part of the composition of the gimbal.
- step S220 motion state data of the carrier of the pan/tilt is measured, and reference pose data of the carrier is calculated according to the motion state data, and the carrier supports the pan/tilt.
- the carrier supporting the gimbal may be a device such as an airplane or a car.
- the motion state of the carrier may be a uniform linear motion or a non-uniform linear motion.
- the motion state data of the carrier may be, for example, the linear acceleration of the carrier.
- the linear acceleration of the carrier is zero.
- the linear acceleration of the carrier is measured at this time, and the reference attitude data of the carrier is obtained according to the linear acceleration value.
- the motion state data of the carrier may also be, for example, an angular velocity, an angular acceleration, a rotational angular velocity of the carrier, etc. during motion of the carrier curve, and different calculation methods may be used to obtain a reference posture of the corresponding carrier based on different motion state data. data.
- the reference attitude data of the carrier is calculated according to the measured motion state data of the carrier, for example, the motion state data of the carrier can be converted into a quaternion or the like.
- step S230 the measured attitude data is corrected using the reference attitude data to obtain pan/tilt attitude data.
- the reference attitude data is compared with the measured attitude data to obtain a small angle error between the two.
- An extended Kalman filter (EKF) estimation is performed on the small angle error, and the measured attitude data is corrected by the EKF estimation, thereby obtaining more accurate pan/tilt attitude data.
- EKF extended Kalman filter
- the measurement attitude data of the pan-tilt is corrected by the reference attitude data of the carrier obtained from the motion state data of the carrier, so as to eliminate the estimation of the posture of the pan-tilt by the motion state of the carrier.
- the deviation thus obtaining more accurate gimbal attitude data, can more accurately estimate the attitude of the gimbal.
- FIG. 3 is a flow chart schematically showing a method for correcting measurement attitude data by using reference attitude data in a pan/tilt attitude estimation method according to an embodiment of the invention.
- the step of correcting the measurement posture data by using the reference posture data in step S210 includes step S331-1, step S331-2, and step S332.
- the posture data is forged.
- step 331-2 the three-axis joint angle of the gimbal is read.
- reference pose data is obtained based on the triaxial joint angle and the forged pose data.
- the attitude and encoder data of the part connected to the pan-tilt on the carrier can be used to forge the attitude data.
- the measurement attitude data of the pan/tilt is corrected based on the reference attitude data obtained from the forged posture data. In this way, it is possible to ensure the stability of the attitude of the gimbal, so that the gimbal is not affected by the state of motion of the carrier.
- the forged posture data may specifically be a forged posture quaternion (1000).
- step S331-2 the three-axis joint angle of the pan/tilt is read, including the joint angles of the three axes of the pitch axis, the roll axis, and the yaw axis of the pan/tilt.
- step S332 the read three-axis joint angle of the pan/tilt can be converted into a quaternion, and the quaternion is multiplied by the forged pose quaternion (1000) to obtain the quaternion of the reference pose data. number.
- FIG. 4 is a flow chart schematically showing a pan/tilt attitude estimation method according to another embodiment of the present invention.
- a pan/tilt attitude estimation method includes steps S410, S420, and step S230.
- step S230 is consistent with step S230 described in FIG. 2.
- step S410 the angular velocity value of the gimbal is measured, and the measured attitude data is obtained based on the angular velocity value; and the acceleration value of the pan/tilt is measured.
- step S410 while measuring the angular velocity value of the gimbal, the acceleration value of the gimbal is also measured.
- step S420 the motion state data of the carrier of the pan/tilt is measured, wherein the motion state data includes a linear acceleration of the carrier, and the acceleration value of the pan-tilt is subtracted from the linear acceleration of the carrier to obtain reference attitude data.
- the linear acceleration of the carrier is obtained, and the reference attitude data of the carrier is obtained according to the linear acceleration, and then the reference attitude data is subtracted from the measured attitude data, thereby obtaining a more accurate gimbal. Gesture data.
- the linear acceleration of the carrier can be measured by a compass and a satellite positioning device. Both the compass and the satellite positioning device are mounted on the carrier. GPS is used to obtain the linear acceleration of the large coordinate system download body, and the compass is used to measure the direction. The combination of the two can measure the linear acceleration of the carrier in the PTZ coordinate system.
- the linear acceleration of the carrier can also be measured by a second accelerometer mounted on the carrier.
- the second accelerometer is mounted on the carrier in accordance with the movement of the carrier, and can effectively measure the linear acceleration of the carrier.
- the reference attitude data can be obtained by subtracting the linear acceleration of the carrier from the acceleration value of the gimbal.
- the acceleration value of the pan/tilt may be measured by the first inertial measurement component, and further, may be measured by the first accelerometer of the first measurement component.
- the linear acceleration of the carrier is subtracted from the acceleration value of the gimbal, and the influence of the linear acceleration of the carrier on the attitude of the gimbal is removed.
- step S230 the measured attitude data is corrected using the reference attitude data obtained in step 430 to obtain pan/tilt attitude data.
- the pan/tilt includes a first inertial measurement element, and an angular velocity value of the pan/tilt is measured by the first inertial measurement element.
- the first inertial measurement element may comprise a gyroscope.
- the gyroscope is an angular motion detecting device that uses a momentum moment sensitive housing of a high-speed rotating body to rotate around one or two axes orthogonal to the rotating shaft with respect to the inertial space, and an angular motion detecting device made by the principle thereof, which can be accurately and effectively Measure the angular velocity value of the gimbal.
- the gyroscope can also integrate the measured angular velocity values and output the pitch, roll, and yaw three-axis directions of the gimbal.
- first inertial measurement element may further include a first accelerometer, which may be used to measure the acceleration value of the pan/tilt.
- the carrier may include a second inertial measurement element, and the second inertial measurement element may be used to measure the motion state data of the carrier.
- the second accelerometer used when measuring the linear acceleration of the carrier belongs to the second inertial measurement element.
- FIG. 5 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to an embodiment of the present invention.
- a pan/tilt attitude estimating apparatus 500 includes a first inertial measurement component including a first inertial measurement component 510, a communication interface 520, and a processor 530.
- the first inertial measurement element 510 is configured to measure an angular velocity value of the gimbal and obtain measurement attitude data based on the angular velocity value.
- the communication interface 520 is configured to obtain motion state data of the carrier, wherein the carrier supports the pan/tilt.
- the processor 530 is configured to calculate reference posture data of the carrier according to the motion state data of the carrier, and correct the measurement posture data by using the reference posture data to obtain pan/tilt attitude data.
- the first inertial measurement element 510 measures an angular velocity value of the pan-tilt and calculates measurement attitude data of the gimbal based on the angular velocity. Specifically, for example, when the first inertial measurement element includes a gyroscope, the angular velocity value of the gimbal can be measured by using the gyroscope, and the gyroscope can perform the attitude of obtaining the pitch, roll, and yaw directions of the gimbal by using the integral. .
- the motion state data of the carrier obtained by the communication interface 520 may be, for example, the linear acceleration of the carrier, the angular velocity at which the carrier curve moves, the angular acceleration, the rotational angular velocity of the carrier, and the like.
- the processor 530 calculates the reference attitude data of the carrier according to the motion state data of the carrier, including acquiring the reference posture data of the corresponding carrier according to different calculation methods according to different motion state data, for example, converting the motion state data of the carrier For quaternions, etc.
- the processor 530 further corrects the measured attitude data by using the reference attitude data to obtain pan/tilt attitude data. Specifically, for example, the reference attitude data is compared with the measured attitude data to obtain a small angle error between the two. An extended Kalman filter (EKF) estimation is performed on the small angle error, and the measured attitude data is corrected by the EKF estimation, thereby obtaining more accurate pan/tilt attitude data.
- EKF extended Kalman filter
- the pan/tilt attitude estimating apparatus 500 uses the acquired reference posture data of the motion state data carrier of the carrier, and corrects the measurement attitude data of the pan/tilt using the reference attitude data of the carrier to eliminate the motion state of the carrier.
- the deviation caused by the estimation of the attitude of the gimbal, resulting in more accurate gimbal attitude data, can more accurately estimate the attitude of the gimbal.
- the processor 530 when the motion state data of the carrier obtained by the communication interface 520 includes the three-axis joint angle of the pan/tilt, the processor 530 is further configured to establish forged posture data, and based on the three-axis joint angle of the gimbal The forged pose data is used to obtain reference pose data.
- the forged pose data established by processor 530 can be a forged pose quaternion (1000).
- the processor 530 obtains the reference attitude data based on the three-axis joint angle of the pan-tilt and the forged posture data, and may convert the three-axis joint angle of the gimbal into a quaternion, and quaternize the quaternion and the forged posture.
- the number (1000) is multiplied to obtain the quaternion of the reference attitude data of the gimbal.
- the processor 530 corrects the measured attitude data of the pan/tilt according to the obtained quaternion of the reference attitude data, thereby obtaining pan/tilt attitude data.
- FIG. 6 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to another embodiment of the present invention.
- a pan/tilt attitude estimating apparatus 500 includes a first inertial measurement element including a first inertial measurement element 510, a communication interface 520, and a processor 530.
- the first inertial measurement element 510 further includes a gyroscope 511.
- the gyroscope 511 is an angular motion detecting device that uses a momentum moment sensitive housing of a high speed rotating body to orbit the one or two axes orthogonal to the rotation axis with respect to the inertia space, and an angular motion detecting device made by the principle thereof, which can be accurately and effectively The angular velocity value of the measuring platform.
- the gyroscope 511 can also integrate the measured angular velocity values to output the pitch, roll, and yaw attitudes of the pan/tilt.
- the first inertial measurement element 510 can also include a first accelerometer 512.
- the first accelerometer 512 can measure the acceleration value of the pan/tilt.
- FIG. 7 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt to perform pan-tilt attitude estimation according to an embodiment of the present invention.
- the pan/tilt attitude estimating apparatus 500 includes a first inertial measurement component including a first inertial measurement component 510, a communication interface 520, and a processor 530.
- the first inertial measurement element 510 further includes a gyroscope 511 and a first accelerometer 512.
- the communication interface 520 of the pan/tilt attitude estimating apparatus 500 acquires motion state data of the carrier from the carrier 700. More specifically, the number of motion states of the carrier includes the linear acceleration of the carrier, measured by the GPS on the carrier and the compass 710, and transmitted to the communication interface 520 of the pan/tilt attitude estimating device 500.
- the gyroscope 511 measures the angular velocity value of the gimbal and integrates it to obtain the measurement attitude data of the gimbal, and transmits it to the processor 530.
- the first accelerometer 512 measures the acceleration value of the gimbal and transmits it to the processor 530.
- the GPS and compass 710 measure the linear acceleration of the carrier and is transmitted by the communication interface 520 to the processor 530.
- the processor 530 subtracts the linear acceleration of the carrier from the acceleration value of the pan/tilt to obtain reference attitude data. And the measurement attitude data of the pan/tilt is corrected according to the reference attitude data, and the attitude information of the gimbal is obtained.
- the reference attitude data obtained by the processor 530 is obtained by subtracting the linear acceleration of the carrier from the acceleration value of the gimbal, thereby eliminating the deviation caused by the estimation of the attitude of the carrier by the motion state of the carrier.
- FIG. 8 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt to perform pan-tilt attitude estimation according to another embodiment of the present invention.
- the pan/tilt attitude estimating apparatus 500 communication interface 520 acquires motion state data of the carrier from the carrier 800. And the motion state of the carrier is measured by the second inertial measurement element 810 on the carrier.
- the second inertial measurement element 810 includes a second gyroscope 811 and a second accelerometer 812.
- the second gyroscope 811 measures the angular velocity value of the carrier and transmits it to the communication interface 520 of the pan/tilt attitude estimating device 500.
- the second accelerometer 820 measures the linear acceleration of the carrier and is transmitted by the communication interface 520 to the processor 530.
- the processor 530 subtracts the linear acceleration of the carrier from the acceleration value of the pan/tilt to obtain reference attitude data. And the measurement attitude data of the pan/tilt is corrected according to the reference attitude data, and the attitude information of the gimbal is obtained.
- the reference attitude data obtained by the processor 530 is obtained by subtracting the linear acceleration of the carrier from the acceleration value of the gimbal, thereby eliminating the deviation caused by the estimation of the attitude of the carrier by the motion state of the carrier.
- Figure 9 is a schematic block diagram of a pan/tilt head in accordance with an embodiment of the present invention.
- the pan/tilt 900 includes a pan/tilt attitude estimating device 500.
- the other parts of the gimbal are not limited by the present invention.
- the pan/tilt head further includes a pan-tilt body, and the pan-tilt attitude estimating device 500 is installed on the pan-tilt body.
- the structure of the pan/tilt attitude estimation apparatus 500 can be referred to the description in FIGS. 5-7.
- the other components or structures of the gimbal can be set according to actual needs. For example, for the structure and function of the gimbal itself, any existing structure can be used and any other functions can be implemented, which is not limited in the present invention.
- the pan/tilt attitude estimating apparatus 500 can implement the method described with reference to FIG. 2 to FIG. 4 to obtain the pan-tilt attitude data, so that the posture of the pan-tilt 900 can be accurately controlled.
- the control of the lens mounted on the pan/tilt is more accurate and effective, and the captured image is more accurate.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
Provided in the present invention are a camera mount attitude estimation method, camera mount estimation device, and camera mount having the camera mount estimation device. The method comprises: S1, measuring an angular velocity of a camera mount, and acquiring measurement attitude data on the basis of the angular velocity; S2, measuring motion state data of a carrier of the camera mount, and computing, according to the motion state data, reference attitude data of the carrier, the carrier carrying the camera mount; and S3, correcting, by employing the reference attitude data, the measurement attitude data to obtain camera mount attitude data. The present invention effectively handles an influence of a motion state of the carrier on the attitude of the camera mount when estimating the attitude of the camera mount, thus providing a highly accurate attitude estimate of the camera mount, and enabling precision control of the attitude of the camera mount.
Description
版权申明Copyright statement
本专利文件披露的内容包含受版权保护的材料。该版权为版权所有人所有。版权所有人不反对任何人复制专利与商标局的官方记录和档案中所存在的该专利文件或者专利披露。The disclosure of this patent document contains material that is subject to copyright protection. This copyright is the property of the copyright holder. The copyright owner has no objection to the reproduction of the patent document or patent disclosure contained in the official records and files of the Patent and Trademark Office.
本发明属于自动控制领域,具体设计一种云台姿态估计方法、装置以及相应的云台。The invention belongs to the field of automatic control, and specifically designs a method and device for estimating the attitude of the gimbal and the corresponding cloud platform.
目前云台的控制是通过云台上的惯性测量元件测量云台的姿态,并将测量得到的云台的姿态与一个给定的目标姿态进行比较,根据二者的偏差控制三轴电机的动作,以控制实现云台的实时姿态达到目标姿态。At present, the control of the gimbal is to measure the attitude of the gimbal through the inertial measurement component on the gimbal, and compare the measured attitude of the gimbal with a given target attitude, and control the action of the triaxial motor according to the deviation of the two. To achieve the target posture by controlling the real-time posture of the gimbal.
现有技术中测量云台姿态的装置如图1所示。其中,惯性测量元件110主要包含陀螺仪和加速度计。陀螺仪能够进行积分获取得到云台的姿态,但是陀螺仪的各个轴的速度输出都有零偏,该零偏不能完全消除,因此用陀螺仪速度输出积分获得云台的姿态是不准确的。基于此,惯性测量元件110还使用加速度计给定云台的姿态参考。然后,处理器120根据加速度计输出的姿态参考对陀螺积分获取的云台的姿态进行修正,最后获得较为稳定的云台的姿态,并在此基础上做位置输出位置控制和速度控制信号,以控制三轴电机的动作。A device for measuring the posture of a gimbal in the prior art is shown in FIG. Among them, the inertial measurement element 110 mainly includes a gyroscope and an accelerometer. The gyroscope can perform integral acquisition to obtain the attitude of the gimbal, but the speed output of each axis of the gyroscope has a zero offset, and the zero offset cannot be completely eliminated. Therefore, it is inaccurate to obtain the attitude of the gimbal by using the gyroscope speed output integral. Based on this, the inertial measurement element 110 also uses an accelerometer to give an attitude reference for the gimbal. Then, the processor 120 corrects the attitude of the gimbal obtained by the gyro integral according to the attitude reference output by the accelerometer, and finally obtains a relatively stable attitude of the pan/tilt, and performs position output position control and speed control signals on the basis of Control the action of the three-axis motor.
图1所示的装置测量云台的姿态时,当在将云台安装于载体上并且载体的运动处于非匀速直线运动时,惯性测量元件110中的加速度计会无法准确测量出载体的运动状态对云台的姿态的影响,从而引起云台的姿态估计错误,导致云台上的镜头拍摄的画面发生倾斜而拍摄不到想要的画面。例如,当云台镜头朝前,载体加速向前行驶时,云台自身的姿态会受载体线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往下倾斜。或者,当云台镜头朝前,载体急刹车时,云台自身的姿态会受线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往上
倾斜。或者,当云台镜头方向与载体行驶的方向偏离90°,载体加速向前行驶时,云台自身的姿态会受线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往左倾斜;又或者,当云台镜头方向与载体行驶的方向偏离90°,载体急刹车时,云台自身的姿态会受线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往右倾斜。When the apparatus shown in Fig. 1 measures the attitude of the gimbal, the accelerometer in the inertial measurement element 110 cannot accurately measure the motion state of the carrier when the pan/tilt is mounted on the carrier and the motion of the carrier is in a non-uniform linear motion. The influence on the attitude of the gimbal caused the attitude estimation of the gimbal to be incorrect, causing the picture taken by the lens on the gimbal to tilt and not to capture the desired picture. For example, when the PTZ lens is facing forward and the carrier accelerates forward, the attitude of the gimbal itself may be estimated to be affected by the acceleration of the carrier line, and the lens mounted on the gimbal may be tilted involuntarily. Or, when the PTZ lens is facing forward and the carrier is suddenly braking, the posture of the PTZ itself will be affected by the linear acceleration and the error will be estimated, causing the lens mounted on the PTZ to involuntarily go up.
tilt. Or, when the direction of the pan-tilt lens is deviated from the direction of the carrier by 90°, when the carrier accelerates forward, the attitude of the gimbal itself may be estimated to be affected by the linear acceleration, resulting in an involuntary lens mounted on the gimbal. Tilt to the left; or, when the direction of the pan-tilt lens deviates from the direction of the carrier by 90°, when the carrier brakes suddenly, the attitude of the gimbal itself is estimated to be affected by the linear acceleration, resulting in a lens mounted on the gimbal. Involuntarily tilted to the right.
发明内容Summary of the invention
本发明的一个方面提供了一种云台姿态估计方法。该方法包括:S1、测量云台的角速度值,并基于该角速度值得到测量姿态数据;S2、测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台;S3、利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。One aspect of the present invention provides a pan/tilt attitude estimation method. The method includes: S1: measuring an angular velocity value of the pan-tilt, and obtaining measured attitude data based on the angular velocity value; S2, measuring motion state data of the carrier of the pan-tilt, and calculating reference pose data of the carrier according to the motion state data, The carrier supports the pan/tilt; S3, correcting the measured attitude data by using the reference attitude data to obtain pan/tilt attitude data.
本发明的另一个方面提供了一种云台姿态估计装置。该装置包括第一惯性测量元件,用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据;通信接口,用于获得载体的运动状态数据,所述载体支承所述云台;处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据,以及利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。Another aspect of the present invention provides a pan/tilt attitude estimating apparatus. The apparatus includes a first inertial measurement element for measuring an angular velocity value of the pan/tilt, and obtaining measured attitude data based on the angular velocity value; a communication interface for obtaining motion state data of the carrier, the carrier supporting the pan/tilt And a processor, configured to calculate reference attitude data of the carrier according to the motion state data of the carrier, and correct the measurement posture data by using the reference posture data to obtain pan/tilt attitude data.
本发明的另一个方面提供了一种云台,包括上述的云台姿态估计装置。Another aspect of the present invention provides a pan/tilt head comprising the pan/tilt attitude estimating device described above.
本发明的云台姿态估计方法、云台姿态估计装置以及云台,估计云台的姿态时能够有效地处理载体的运动状态对云台的姿态产生的影响,从而能够更为准确地估计云台的姿态,以使得对云台的姿态的控制更为准确。The pan-tilt attitude estimation method, the pan-tilt attitude estimation device, and the pan/tilt head of the present invention can effectively calculate the influence of the motion state of the carrier on the attitude of the pan-tilt when estimating the attitude of the gimbal, thereby enabling more accurate estimation of the gimbal The posture is to make the control of the attitude of the gimbal more accurate.
为了更完整地理解本发明及其优势,现在将参考结合附图的以下描述,其中:For a more complete understanding of the present invention and its advantages, reference will now be made to the following description
图1示意性示出了现有技术中测量云台姿态的装置的框图;FIG. 1 is a block diagram schematically showing an apparatus for measuring a posture of a gimbal in the prior art; FIG.
图2示意性示出了根据本发明一实施例的云台姿态估计方法的流程图;2 is a flow chart schematically showing a pan/tilt attitude estimation method according to an embodiment of the invention;
图3示意性示出了根据本发明一实施例的云台姿态估计方法中利用参考姿态数据对测量姿态数据进行修正的方法流程图;3 is a flow chart schematically showing a method for correcting measurement attitude data by using reference attitude data in a pan/tilt attitude estimation method according to an embodiment of the invention;
图4示意性示出了根据本发明另一实施例的云台姿态估计方法的流程图;FIG. 4 is a flow chart schematically showing a pan/tilt attitude estimation method according to another embodiment of the present invention; FIG.
图5示意性示出了根据本发明一实施例的云台姿态估计装置的框图;
FIG. 5 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to an embodiment of the present invention; FIG.
图6示意性示出了根据本发明一实施例的云台姿态估计装置的框图;FIG. 6 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to an embodiment of the present invention; FIG.
图7示意性示出了根据本发明一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图;FIG. 7 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt according to an embodiment of the present invention; FIG.
图8示意性示出了根据本发明另一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图;FIG. 8 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt according to another embodiment of the present invention; FIG.
图9示意性示出了根据本发明一实施例的云台的框图。Figure 9 is a schematic block diagram of a pan/tilt head in accordance with an embodiment of the present invention.
根据结合附图对本发明示例性实施例的以下详细描述,本发明的其它方面、优势和突出特征对于本领域技术人员将变得显而易见。Other aspects, advantages, and salient features of the present invention will become apparent to those skilled in the <
在本发明中,术语“包括”和“含有”及其派生词意为包括而非限制;术语“或”是包含性的,意为和/或。In the present invention, the terms "include" and "including" and their derivatives are intended to be inclusive and not limiting; the term "or" is inclusive, meaning and/or.
在本说明书中,下述用于描述本发明原理的各种实施例只是说明,不应该以任何方式解释为限制发明的范围。参照附图的下述描述用于帮助全面理解由权利要求及其等同物限定的本发明的示例性实施例。下述描述包括多种具体细节来帮助理解,但这些细节应认为仅仅是示例性的。因此,本领域普通技术人员应认识到,在不背离本发明的范围和精神的情况下,可以对本文中描述的实施例进行多种改变和修改。此外,为了清楚和简洁起见,省略了公知功能和结构的描述。此外,贯穿附图,相同附图标记用于相同或相似的功能和步骤。In the present specification, the following various embodiments for describing the principles of the present invention are merely illustrative and should not be construed as limiting the scope of the invention. The following description of the invention is intended to be understood as The description below includes numerous specific details to assist the understanding, but these details should be considered as merely exemplary. Accordingly, it will be apparent to those skilled in the art that various changes and modifications may be made to the embodiments described herein without departing from the scope and spirit of the invention. In addition, descriptions of well-known functions and constructions are omitted for clarity and conciseness. Further, the same reference numerals are used throughout the drawings for the same or similar functions and steps.
对于云台姿态估计,本发明主要考虑这样一种情形,即云台安装在一定的载体上,而载体处于非匀速直线运动时,载体的运动状态会对云台的姿态的估计造成偏差。由于此偏差的存在,使得将估计的云台的姿态与目标姿态进行比较后,根据比较结果对云台的姿态的控制会不够准确。在此种情况,如何有效处理载体的运动状态带来的云台的姿态的估计偏差,从而更加准确地估计出云台的姿态,以便实现对云台的姿态的准确控制非常关键。For pan/tilt attitude estimation, the present invention mainly considers a situation in which the gimbal is mounted on a certain carrier, and when the carrier is in a non-uniform linear motion, the motion state of the carrier may deviate from the estimation of the attitude of the gimbal. Due to the existence of this deviation, after the estimated attitude of the gimbal is compared with the target attitude, the control of the attitude of the gimbal according to the comparison result may not be accurate enough. In this case, how to effectively deal with the estimated deviation of the attitude of the gimbal caused by the motion state of the carrier, thereby more accurately estimating the attitude of the gimbal, in order to achieve accurate control of the attitude of the gimbal is critical.
当云台安装在载体上时,如果将云台和载体作为整体看成是一个质点,则该质点在世界坐标系中的坐标位置变化由载体的运动决定,即云台随着载体的运动在世界坐标系中移动。
When the gimbal is installed on the carrier, if the gimbal and the carrier are regarded as a mass point as a whole, the coordinate position change of the particle in the world coordinate system is determined by the motion of the carrier, that is, the movement of the gimbal with the carrier is Move in the world coordinate system.
与此同时,云台也会相对于载体本身发生平移或旋转。云台的姿态则是在以载体为参照物所构成的本地坐标系中,云台所在的位置以及沿各个方向的旋转角度。例如,可以以该载体上的某一点为坐标原点而定义一个空间三维的本地坐标系,此时,云台的姿态即为在该本地坐标系中的位置、以及云台沿本地坐标系中的三个轴的旋转角度。At the same time, the gimbal will also translate or rotate relative to the carrier itself. The attitude of the gimbal is the position of the gimbal and the angle of rotation in each direction in the local coordinate system composed of the carrier as a reference. For example, a spatial three-dimensional local coordinate system can be defined by using a point on the carrier as a coordinate origin. At this time, the posture of the pan-tilt is the position in the local coordinate system, and the pan-tilt is in the local coordinate system. The angle of rotation of the three axes.
根据本发明的实施例,提供了一种云台姿态估计方法。首先测量云台的角速度值,并基于该角速度值得到测量姿态数据。其次,测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台。最后,利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。根据本发明的实施例,在得到云台的测量姿态数据后,利用与载体的运动状态相关的参考姿态数据对该测量姿态数据进行修正,以消除载体的运动状态对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。According to an embodiment of the present invention, a pan/tilt attitude estimation method is provided. First, the angular velocity value of the gimbal is measured, and the measured attitude data is obtained based on the angular velocity value. Next, the motion state data of the carrier of the pan/tilt is measured, and reference pose data of the carrier is calculated according to the motion state data, and the carrier supports the pan/tilt. Finally, the measured attitude data is corrected by using the reference attitude data to obtain pan/tilt attitude data. According to the embodiment of the present invention, after the measurement attitude data of the pan/tilt is obtained, the measurement posture data is corrected by using the reference attitude data related to the motion state of the carrier, so as to eliminate the motion state of the carrier and the estimation of the attitude of the pan/tilt. The deviation, which results in more accurate gimbal attitude data, can more accurately estimate the attitude of the gimbal.
根据本发明的实施例,还提供了一种云台姿态估计装置,包括第一惯性测量元件、通信接口和处理器。其中,第一惯性测量元件用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据。通信接口,用于获得载体的运动状态数据,所述载体支承所述云台。处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据,以及利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。According to an embodiment of the present invention, there is also provided a pan/tilt attitude estimating apparatus comprising a first inertial measurement element, a communication interface, and a processor. Wherein, the first inertial measurement component is configured to measure an angular velocity value of the pan/tilt, and obtain measurement attitude data based on the angular velocity value. a communication interface for obtaining motion state data of the carrier, the carrier supporting the pan/tilt. And a processor, configured to calculate reference attitude data of the carrier according to the motion state data of the carrier, and correct the measurement posture data by using the reference posture data to obtain pan/tilt attitude data.
根据本发明的实施例,还提供了一种云台,该云台包括本发明提供的云台姿态估计装置。该云台的姿态能够得到准确地控制,从而使安装在该云台上的镜头的控制更加准确有效,拍摄得到的画面更加准确。According to an embodiment of the present invention, there is also provided a pan/tilt head comprising the pan/tilt attitude estimating device provided by the present invention. The attitude of the gimbal can be accurately controlled, so that the control of the lens mounted on the gimbal is more accurate and effective, and the captured image is more accurate.
图2示意性示出了根据本发明一实施例的云台姿态估计方法的流程图。FIG. 2 is a flow chart schematically showing a pan/tilt attitude estimation method according to an embodiment of the present invention.
如图2所示,根据本发明一实施例的云台姿态估计方法包括步骤S210~步骤S230。As shown in FIG. 2, the pan/tilt attitude estimation method according to an embodiment of the present invention includes steps S210 to S230.
首先,在步骤S210,测量云台的角速度值,并基于该角速度值得到测量姿态数据。First, in step S210, the angular velocity value of the gimbal is measured, and the measured attitude data is obtained based on the angular velocity value.
具体地,可以通过第一惯性测量元件测量云台的角速度值,并基于该角速度计算云台的测量姿态数据。例如当第一惯性测量元件包括陀螺仪时,可以利用陀螺仪
测量云台的角速度值,同时陀螺仪可以进行利用积分获取得到云台的pitch、roll、和yaw三轴方向的姿态。Specifically, the angular velocity value of the gimbal may be measured by the first inertial measurement element, and the measured attitude data of the gimbal may be calculated based on the angular velocity. For example, when the first inertial measurement element includes a gyroscope, a gyroscope can be utilized.
The angular velocity value of the gimbal is measured, and the gyroscope can obtain the attitudes of the pitch, roll, and yaw directions of the gimbal by using the integral.
通常,为获得云台的实时状态以及惯性运动状态数据,第一惯性测量元件直接安装在云台上,构成云台的组成的一部分。Generally, in order to obtain the real-time state of the gimbal and the inertial motion state data, the first inertial measurement component is directly mounted on the gimbal to form part of the composition of the gimbal.
然后,在步骤S220,测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台。Then, in step S220, motion state data of the carrier of the pan/tilt is measured, and reference pose data of the carrier is calculated according to the motion state data, and the carrier supports the pan/tilt.
支持云台的载体可以是飞机、汽车等装置。The carrier supporting the gimbal may be a device such as an airplane or a car.
载体的运动状态可以是匀速直线运动,或者非匀速直线运动。The motion state of the carrier may be a uniform linear motion or a non-uniform linear motion.
载体的运动状态数据可以是,例如载体的线加速度。在此种情况下,当载体的运动状态为匀速直线运动时,载体的线加速度即为零。而当载体的运动状态为非匀速执行运动时,此时测量得到载体的线加速度,并根据该线加速度值得到载体的参考姿态数据。The motion state data of the carrier may be, for example, the linear acceleration of the carrier. In this case, when the motion state of the carrier is a uniform linear motion, the linear acceleration of the carrier is zero. When the motion state of the carrier is non-uniformly performing motion, the linear acceleration of the carrier is measured at this time, and the reference attitude data of the carrier is obtained according to the linear acceleration value.
另外,载体的运动状态数据还可以是,例如,载体曲线运动时的角速度、角加速度、载体的旋转角速度等,基于不同的运动状态数据,可以有不同的计算方法以获取对应的载体的参考姿态数据。In addition, the motion state data of the carrier may also be, for example, an angular velocity, an angular acceleration, a rotational angular velocity of the carrier, etc. during motion of the carrier curve, and different calculation methods may be used to obtain a reference posture of the corresponding carrier based on different motion state data. data.
根据测量得到的载体的运动状态数据计算得到载体的参考姿态数据,例如可以将载体的运动状态数据转换为四元数等。The reference attitude data of the carrier is calculated according to the measured motion state data of the carrier, for example, the motion state data of the carrier can be converted into a quaternion or the like.
在步骤S230,利用参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。In step S230, the measured attitude data is corrected using the reference attitude data to obtain pan/tilt attitude data.
具体可以是,例如,将参考姿态数据与测量姿态数据进行比较,得到二者之间的小角度误差。对该小角度误差做扩展卡尔曼滤波器(Extended Kalman Filter,EKF)估计,通过EKF估计修正测量姿态数据,从而得到更为准确的云台姿态数据。Specifically, for example, the reference attitude data is compared with the measured attitude data to obtain a small angle error between the two. An extended Kalman filter (EKF) estimation is performed on the small angle error, and the measured attitude data is corrected by the EKF estimation, thereby obtaining more accurate pan/tilt attitude data.
根据本发明的实施例的云台姿态估计方法,通过根据载体的运动状态数据得到的载体的参考姿态数据修正云台的测量姿态数据,以消除载体的运动状态对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。According to the pan/tilt attitude estimation method of the embodiment of the present invention, the measurement attitude data of the pan-tilt is corrected by the reference attitude data of the carrier obtained from the motion state data of the carrier, so as to eliminate the estimation of the posture of the pan-tilt by the motion state of the carrier. The deviation, thus obtaining more accurate gimbal attitude data, can more accurately estimate the attitude of the gimbal.
图3示意性示出了根据本发明一实施例的云台姿态估计方法中利用参考姿态数据对测量姿态数据进行修正的方法流程图。
FIG. 3 is a flow chart schematically showing a method for correcting measurement attitude data by using reference attitude data in a pan/tilt attitude estimation method according to an embodiment of the invention.
如图3所示,根据本发明一实施例的云台姿态估计方法中,步骤S210中利用参考姿态数据对测量姿态数据进行修正包括步骤S331-1、步骤S331-2和步骤S332。As shown in FIG. 3, in the pan/tilt attitude estimation method according to an embodiment of the present invention, the step of correcting the measurement posture data by using the reference posture data in step S210 includes step S331-1, step S331-2, and step S332.
在步骤331-1,伪造姿态数据。At step 331-1, the posture data is forged.
在步骤331-2,读取云台的三轴关节角度。In step 331-2, the three-axis joint angle of the gimbal is read.
在步骤332,基于该三轴关节角度与该伪造姿态数据得到参考姿态数据。At step 332, reference pose data is obtained based on the triaxial joint angle and the forged pose data.
具体地,例如,当云台直接水平安装在载体上,中间不加减震,或安装的减震形变较小,可以利用载体上与云台连接的部位的姿态和编码器数据伪造姿态数据,并根据由伪造姿态数据得到的参考姿态数据来修正云台的测量姿态数据。通过这种方式,能够保证云台的姿态的稳定,从而使云台的不受到载体运动状态的影响。Specifically, for example, when the pan/tilt is directly mounted horizontally on the carrier without damping in the middle, or the shock absorbing deformation of the installation is small, the attitude and encoder data of the part connected to the pan-tilt on the carrier can be used to forge the attitude data. The measurement attitude data of the pan/tilt is corrected based on the reference attitude data obtained from the forged posture data. In this way, it is possible to ensure the stability of the attitude of the gimbal, so that the gimbal is not affected by the state of motion of the carrier.
在步骤S331-1中,伪造姿态数据具体可以是伪造姿态四元数(1000)。In step S331-1, the forged posture data may specifically be a forged posture quaternion (1000).
在步骤S331-2中,读取云台的三轴关节角度,包括读取云台的的pitch轴、roll轴、和yaw轴这三个轴的关节角度。In step S331-2, the three-axis joint angle of the pan/tilt is read, including the joint angles of the three axes of the pitch axis, the roll axis, and the yaw axis of the pan/tilt.
在步骤S332中,可以将读取到的云台的三轴关节角度换算成四元数,并将该四元数与伪造姿态四元数(1000)相乘,从而得到参考姿态数据的四元数。In step S332, the read three-axis joint angle of the pan/tilt can be converted into a quaternion, and the quaternion is multiplied by the forged pose quaternion (1000) to obtain the quaternion of the reference pose data. number.
图4示意性示出了根据本发明另一实施例的云台姿态估计方法的流程图。FIG. 4 is a flow chart schematically showing a pan/tilt attitude estimation method according to another embodiment of the present invention.
如图4所示,根据本发明另一实施例的云台姿态估计方法包括步骤S410、S420和步骤S230。其中,步骤S230与图2中描述的步骤S230一致。As shown in FIG. 4, a pan/tilt attitude estimation method according to another embodiment of the present invention includes steps S410, S420, and step S230. Wherein, step S230 is consistent with step S230 described in FIG. 2.
首先,在步骤S410,测量云台的角速度值,并基于该角速度值得到测量姿态数据;并且测量所述云台的加速度值。本步骤S410在测量云台的角速度值的同时,还要测量云台的加速度值。First, in step S410, the angular velocity value of the gimbal is measured, and the measured attitude data is obtained based on the angular velocity value; and the acceleration value of the pan/tilt is measured. In step S410, while measuring the angular velocity value of the gimbal, the acceleration value of the gimbal is also measured.
然后,在步骤S420,测量该云台的载体的运动状态数据,其中,运动状态数据包括载体的线加速度,将该云台的加速度值减去该载体的线加速度得到参考姿态数据。Then, in step S420, the motion state data of the carrier of the pan/tilt is measured, wherein the motion state data includes a linear acceleration of the carrier, and the acceleration value of the pan-tilt is subtracted from the linear acceleration of the carrier to obtain reference attitude data.
例如,当云台直接水平安装在载体上,获得载体的线加速度后根据该线加速度得到载体的参考姿态数据,然后从测量姿态数据中减去该参考姿态数据,从而得到更为准确的云台姿态数据。For example, when the pan/tilt is directly horizontally mounted on the carrier, the linear acceleration of the carrier is obtained, and the reference attitude data of the carrier is obtained according to the linear acceleration, and then the reference attitude data is subtracted from the measured attitude data, thereby obtaining a more accurate gimbal. Gesture data.
具体地,载体的线加速度可以由指南针和卫星定位装置测量得到。指南针和卫星定位装置均安装于载体上。GPS用于获得大坐标体系下载体的线加速度,指南针用于测定方向,二者结合可以测量得到载体在云台坐标系下的线加速度。
Specifically, the linear acceleration of the carrier can be measured by a compass and a satellite positioning device. Both the compass and the satellite positioning device are mounted on the carrier. GPS is used to obtain the linear acceleration of the large coordinate system download body, and the compass is used to measure the direction. The combination of the two can measure the linear acceleration of the carrier in the PTZ coordinate system.
或者,载体的线加速度也可以由安装在载体上的第二加速度计测量得到。第二加速度计安装在载体上,和载体的运动一致,能够有效地测量载体的线加速度。Alternatively, the linear acceleration of the carrier can also be measured by a second accelerometer mounted on the carrier. The second accelerometer is mounted on the carrier in accordance with the movement of the carrier, and can effectively measure the linear acceleration of the carrier.
根据本发明的实施例,参考姿态数据可以由云台的加速度值减去载体的线加速度得到。其中云台的加速度值可以是通过第一惯性测量元件测量得到,更进一步地,可以是第一测量元件中的第一加速度计测量得到。According to an embodiment of the invention, the reference attitude data can be obtained by subtracting the linear acceleration of the carrier from the acceleration value of the gimbal. The acceleration value of the pan/tilt may be measured by the first inertial measurement component, and further, may be measured by the first accelerometer of the first measurement component.
由云台的加速度值减去载体的线加速度,剔除了对载体的线加速度对云台的姿态的影响。The linear acceleration of the carrier is subtracted from the acceleration value of the gimbal, and the influence of the linear acceleration of the carrier on the attitude of the gimbal is removed.
最后,在步骤S230,利用步骤430得到的参考姿态数据对测量姿态数据进行修正,得到云台姿态数据。Finally, in step S230, the measured attitude data is corrected using the reference attitude data obtained in step 430 to obtain pan/tilt attitude data.
使用步骤420得到的参考姿态数据对云台的测量姿态数据修正,能够有效地消除载体的线加速度对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据。By using the reference attitude data obtained in step 420 to correct the measurement attitude data of the pan/tilt, it is possible to effectively eliminate the deviation caused by the estimation of the attitude of the carrier by the linear acceleration of the carrier, thereby obtaining more accurate pan/tilt attitude data.
根据本发明的实施例的云台姿态估计方法中,云台包括第一惯性测量元件,云台的角速度值由第一惯性测量元件测量得到。进一步地,第一惯性测量元件可以包括陀螺仪。In the pan/tilt attitude estimation method according to an embodiment of the present invention, the pan/tilt includes a first inertial measurement element, and an angular velocity value of the pan/tilt is measured by the first inertial measurement element. Further, the first inertial measurement element may comprise a gyroscope.
陀螺仪是用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的一个或二个轴的角运动检测装置,以及利用其原理制成的角运动检测装置,能够准确有效的测量云台的角速度值。The gyroscope is an angular motion detecting device that uses a momentum moment sensitive housing of a high-speed rotating body to rotate around one or two axes orthogonal to the rotating shaft with respect to the inertial space, and an angular motion detecting device made by the principle thereof, which can be accurately and effectively Measure the angular velocity value of the gimbal.
并且陀螺仪还可以对测量得到的角速度值进行积分,输出云台的pitch、roll、和yaw三轴方向的姿态。And the gyroscope can also integrate the measured angular velocity values and output the pitch, roll, and yaw three-axis directions of the gimbal.
另外,第一惯性测量元件还可以包括第一加速度计,可以用来测量云台的加速度值。In addition, the first inertial measurement element may further include a first accelerometer, which may be used to measure the acceleration value of the pan/tilt.
根据本发明的实施例的云台姿态估计方法中,载体可以包括第二惯性测量元件,可以使用第二惯性测量元件测量载体的运动状态数据。例如,当测量载体的线加速度时使用的第二加速度计就属于第二惯性测量元件。In the pan/tilt attitude estimation method according to an embodiment of the present invention, the carrier may include a second inertial measurement element, and the second inertial measurement element may be used to measure the motion state data of the carrier. For example, the second accelerometer used when measuring the linear acceleration of the carrier belongs to the second inertial measurement element.
图5示意性示出了根据本发明一实施例的云台姿态估计装置的框图。FIG. 5 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to an embodiment of the present invention.
如图5所示,根据本发明一实施例的云台姿态估计装置500包括第一惯性测量元件包括第一惯性测量元件510,通信接口520和处理器530。
As shown in FIG. 5, a pan/tilt attitude estimating apparatus 500 according to an embodiment of the present invention includes a first inertial measurement component including a first inertial measurement component 510, a communication interface 520, and a processor 530.
第一惯性测量元件510用于测量云台的角速度值,并基于该角速度值得到测量姿态数据。The first inertial measurement element 510 is configured to measure an angular velocity value of the gimbal and obtain measurement attitude data based on the angular velocity value.
通信接口520用于获得载体的运动状态数据,其中该载体支承该云台。The communication interface 520 is configured to obtain motion state data of the carrier, wherein the carrier supports the pan/tilt.
处理器530用于根据载体的运动状态数据计算该载体的参考姿态数据,以及利用该参考姿态数据对测量姿态数据进行修正,得到云台姿态数据。The processor 530 is configured to calculate reference posture data of the carrier according to the motion state data of the carrier, and correct the measurement posture data by using the reference posture data to obtain pan/tilt attitude data.
第一惯性测量元件510测量云台的角速度值,并基于该角速度计算云台的测量姿态数据。具体地,例如,当第一惯性测量元件包括陀螺仪时,可以利用陀螺仪测量云台的角速度值,同时陀螺仪可以进行利用积分获取得到云台的pitch、roll、和yaw三轴方向的姿态。The first inertial measurement element 510 measures an angular velocity value of the pan-tilt and calculates measurement attitude data of the gimbal based on the angular velocity. Specifically, for example, when the first inertial measurement element includes a gyroscope, the angular velocity value of the gimbal can be measured by using the gyroscope, and the gyroscope can perform the attitude of obtaining the pitch, roll, and yaw directions of the gimbal by using the integral. .
通信接口520获得的载体的运动状态数据可以是,例如载体的线加速度、载体曲线运动时的角速度、角加速度、载体的旋转角速度等。The motion state data of the carrier obtained by the communication interface 520 may be, for example, the linear acceleration of the carrier, the angular velocity at which the carrier curve moves, the angular acceleration, the rotational angular velocity of the carrier, and the like.
处理器530根据载体的运动状态数据计算该载体的参考姿态数据,包括基于不同的运动状态数据,根据不同的计算方法以获取对应的载体的参考姿态数据,例如,可以将载体的运动状态数据转换为四元数等。The processor 530 calculates the reference attitude data of the carrier according to the motion state data of the carrier, including acquiring the reference posture data of the corresponding carrier according to different calculation methods according to different motion state data, for example, converting the motion state data of the carrier For quaternions, etc.
处理器530还利用该参考姿态数据对测量姿态数据进行修正,得到云台姿态数据。具体可以是,例如,将参考姿态数据与测量姿态数据进行比较,得到二者之间的小角度误差。对该小角度误差做扩展卡尔曼滤波器(Extended Kalman Filter,EKF)估计,通过EKF估计修正测量姿态数据,从而得到更为准确的云台姿态数据。The processor 530 further corrects the measured attitude data by using the reference attitude data to obtain pan/tilt attitude data. Specifically, for example, the reference attitude data is compared with the measured attitude data to obtain a small angle error between the two. An extended Kalman filter (EKF) estimation is performed on the small angle error, and the measured attitude data is corrected by the EKF estimation, thereby obtaining more accurate pan/tilt attitude data.
根据本发明的实施例,云台姿态估计装置500利用获取的载体的运动状态数据载体的参考姿态数据,并使用该载体的参考姿态数据修正云台的测量姿态数据,以消除载体的运动状态对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。According to an embodiment of the present invention, the pan/tilt attitude estimating apparatus 500 uses the acquired reference posture data of the motion state data carrier of the carrier, and corrects the measurement attitude data of the pan/tilt using the reference attitude data of the carrier to eliminate the motion state of the carrier. The deviation caused by the estimation of the attitude of the gimbal, resulting in more accurate gimbal attitude data, can more accurately estimate the attitude of the gimbal.
根据本发明的实施例,当通信接口520获得的载体的运动状态数据包括云台的三轴关节角度时,处理器530还用于建立伪造姿态数据,并基于云台的三轴关节角度与该伪造姿态数据得到参考姿态数据。According to an embodiment of the present invention, when the motion state data of the carrier obtained by the communication interface 520 includes the three-axis joint angle of the pan/tilt, the processor 530 is further configured to establish forged posture data, and based on the three-axis joint angle of the gimbal The forged pose data is used to obtain reference pose data.
例如,处理器530建立的伪造姿态数据可以是伪造姿态四元数(1000)。For example, the forged pose data established by processor 530 can be a forged pose quaternion (1000).
同时,处理器530基于云台的三轴关节角度与该伪造姿态数据得到参考姿态数据,可以是将云台的三轴关节角度换算成四元数,并将该四元数与伪造姿态四元数(1000)相乘,从而得到云台的参考姿态数据的四元数。
At the same time, the processor 530 obtains the reference attitude data based on the three-axis joint angle of the pan-tilt and the forged posture data, and may convert the three-axis joint angle of the gimbal into a quaternion, and quaternize the quaternion and the forged posture. The number (1000) is multiplied to obtain the quaternion of the reference attitude data of the gimbal.
最后,处理器530根据得到的该参考姿态数据的四元数对云台的测量姿态数据进行修正,从而得到云台姿态数据。Finally, the processor 530 corrects the measured attitude data of the pan/tilt according to the obtained quaternion of the reference attitude data, thereby obtaining pan/tilt attitude data.
图6示意性示出了根据本发明另一实施例的云台姿态估计装置的框图。FIG. 6 is a block diagram schematically showing a pan/tilt attitude estimating apparatus according to another embodiment of the present invention.
如图6所示,根据本发明另一实施例的云台姿态估计装置500包括第一惯性测量元件包括第一惯性测量元件510,通信接口520和处理器530。As shown in FIG. 6, a pan/tilt attitude estimating apparatus 500 according to another embodiment of the present invention includes a first inertial measurement element including a first inertial measurement element 510, a communication interface 520, and a processor 530.
其中第一惯性测量元件510还包括陀螺仪511。The first inertial measurement element 510 further includes a gyroscope 511.
陀螺仪511是用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的一个或二个轴的角运动检测装置,以及利用其原理制成的角运动检测装置,能够准确有效的测量云台的角速度值。The gyroscope 511 is an angular motion detecting device that uses a momentum moment sensitive housing of a high speed rotating body to orbit the one or two axes orthogonal to the rotation axis with respect to the inertia space, and an angular motion detecting device made by the principle thereof, which can be accurately and effectively The angular velocity value of the measuring platform.
陀螺仪511还可以对测量得到的角速度值进行积分,输出云台的pitch、roll、和yaw三轴方向的姿态。The gyroscope 511 can also integrate the measured angular velocity values to output the pitch, roll, and yaw attitudes of the pan/tilt.
第一惯性测量元件510还可以包括第一加速度计512。The first inertial measurement element 510 can also include a first accelerometer 512.
第一加速度计512可以测量获得云台的加速度值。The first accelerometer 512 can measure the acceleration value of the pan/tilt.
图7示意性示出了根据本发明一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图。FIG. 7 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt to perform pan-tilt attitude estimation according to an embodiment of the present invention.
如图7所示,云台姿态估计装置500包括第一惯性测量元件包括第一惯性测量元件510,通信接口520和处理器530。其中第一惯性测量元件510还包括陀螺仪511和第一加速度计512。As shown in FIG. 7, the pan/tilt attitude estimating apparatus 500 includes a first inertial measurement component including a first inertial measurement component 510, a communication interface 520, and a processor 530. The first inertial measurement element 510 further includes a gyroscope 511 and a first accelerometer 512.
云台姿态估计装置500的通信接口520从载体700中获取载体的运动状态数据。更具体地,载体的运动状态数包括载体的线加速度,由载体上的GPS和指南针710测量得到后,传输云台姿态估计装置500的通信接口520。The communication interface 520 of the pan/tilt attitude estimating apparatus 500 acquires motion state data of the carrier from the carrier 700. More specifically, the number of motion states of the carrier includes the linear acceleration of the carrier, measured by the GPS on the carrier and the compass 710, and transmitted to the communication interface 520 of the pan/tilt attitude estimating device 500.
陀螺仪511测量得到云台的角速度值,并进行积分得到云台的测量姿态数据,传输至处理器530。The gyroscope 511 measures the angular velocity value of the gimbal and integrates it to obtain the measurement attitude data of the gimbal, and transmits it to the processor 530.
第一加速度计512测量得到云台的加速度值,并传输至处理器530。The first accelerometer 512 measures the acceleration value of the gimbal and transmits it to the processor 530.
GPS和指南针710测量得到载体的线加速度,并由通信接口520传输至处理器530。The GPS and compass 710 measure the linear acceleration of the carrier and is transmitted by the communication interface 520 to the processor 530.
处理器530将云台的加速度值减去载体的线加速度,得到参考姿态数据。并根据该参考姿态数据对云台的测量姿态数据进行修正,得到云台姿态数据。
The processor 530 subtracts the linear acceleration of the carrier from the acceleration value of the pan/tilt to obtain reference attitude data. And the measurement attitude data of the pan/tilt is corrected according to the reference attitude data, and the attitude information of the gimbal is obtained.
处理器530得到的参考姿态数据由云台的加速度值减去载体的线加速度得到,从而消除载体的运动状态对云台的姿态的估计造成的偏差。以此参考姿态数据对测量姿态数据进行修正后,能够得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。The reference attitude data obtained by the processor 530 is obtained by subtracting the linear acceleration of the carrier from the acceleration value of the gimbal, thereby eliminating the deviation caused by the estimation of the attitude of the carrier by the motion state of the carrier. By correcting the measured attitude data with the reference attitude data, more accurate pan/tilt attitude data can be obtained, and the attitude of the pan/tilt can be estimated more accurately.
图8示意性示出了根据本发明另一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图。FIG. 8 is a block diagram schematically showing a pan-tilt attitude estimation device interacting with a carrier of a pan-tilt to perform pan-tilt attitude estimation according to another embodiment of the present invention.
如图8所示,与图7不同的是,云台姿态估计装置500通信接口520从载体800中获取载体的运动状态数据。并且载体的运动状态由载体上的第二惯性测量元件810测量得到。第二惯性测量元件810包括第二陀螺仪811和第二加速度计812。As shown in FIG. 8, unlike FIG. 7, the pan/tilt attitude estimating apparatus 500 communication interface 520 acquires motion state data of the carrier from the carrier 800. And the motion state of the carrier is measured by the second inertial measurement element 810 on the carrier. The second inertial measurement element 810 includes a second gyroscope 811 and a second accelerometer 812.
第二陀螺仪811测量载体的角速度值,并传输给云台姿态估计装置500的通信接口520。The second gyroscope 811 measures the angular velocity value of the carrier and transmits it to the communication interface 520 of the pan/tilt attitude estimating device 500.
第二加速度计820测量得到载体的线加速度,并由通信接口520传输至处理器530。The second accelerometer 820 measures the linear acceleration of the carrier and is transmitted by the communication interface 520 to the processor 530.
处理器530将云台的加速度值减去载体的线加速度,得到参考姿态数据。并根据该参考姿态数据对云台的测量姿态数据进行修正,得到云台姿态数据。The processor 530 subtracts the linear acceleration of the carrier from the acceleration value of the pan/tilt to obtain reference attitude data. And the measurement attitude data of the pan/tilt is corrected according to the reference attitude data, and the attitude information of the gimbal is obtained.
处理器530得到的参考姿态数据由云台的加速度值减去载体的线加速度得到,从而消除载体的运动状态对云台的姿态的估计造成的偏差。以此参考姿态数据对测量姿态数据进行修正后,能够得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。The reference attitude data obtained by the processor 530 is obtained by subtracting the linear acceleration of the carrier from the acceleration value of the gimbal, thereby eliminating the deviation caused by the estimation of the attitude of the carrier by the motion state of the carrier. By correcting the measured attitude data with the reference attitude data, more accurate pan/tilt attitude data can be obtained, and the attitude of the pan/tilt can be estimated more accurately.
图9示意性示出了根据本发明一实施例的云台的框图。Figure 9 is a schematic block diagram of a pan/tilt head in accordance with an embodiment of the present invention.
如图9所示,云台900包括云台姿态估计装置500。云台的其它部分,本发明不作限制。例如,作为一种具体实施方式,云台还包括云台本体,所述云台姿态估计装置500安装于云台本体。As shown in FIG. 9, the pan/tilt 900 includes a pan/tilt attitude estimating device 500. The other parts of the gimbal are not limited by the present invention. For example, as a specific implementation manner, the pan/tilt head further includes a pan-tilt body, and the pan-tilt attitude estimating device 500 is installed on the pan-tilt body.
其中云台姿态估计装置500的结构可以参考图5~图7中的描述。云台的其他部件或结构可以根据实际需要设定,例如,对于云台本身的结构和功能,可以采用现有的任何结构并实现任意其他功能,本发明中不作限制。The structure of the pan/tilt attitude estimation apparatus 500 can be referred to the description in FIGS. 5-7. The other components or structures of the gimbal can be set according to actual needs. For example, for the structure and function of the gimbal itself, any existing structure can be used and any other functions can be implemented, which is not limited in the present invention.
并且,云台姿态估计装置500在进行云台姿态估计时,可以实现参考图2~图4所描述的方法来得到云台姿态数据,从而使得该云台900的姿态能够得到准确地控制,使安装在该云台上的镜头的控制更加准确有效,拍摄得到的画面更加准确。
In addition, when performing the pan/tilt attitude estimation, the pan/tilt attitude estimating apparatus 500 can implement the method described with reference to FIG. 2 to FIG. 4 to obtain the pan-tilt attitude data, so that the posture of the pan-tilt 900 can be accurately controlled. The control of the lens mounted on the pan/tilt is more accurate and effective, and the captured image is more accurate.
尽管已经参照本发明的特定示例性实施例示出并描述了本发明,但是本领域技术人员应该理解,在不背离所附权利要求及其等同物限定的本发明的精神和范围的情况下,可以对本发明进行形式和细节上的多种改变。因此,本发明的范围不应该限于上述实施例,而是应该不仅由所附权利要求来进行确定,还由所附权利要求的等同物来进行限定。
Although the present invention has been shown and described with respect to the specific exemplary embodiments of the present invention, those skilled in the art Various changes in form and detail are made to the invention. Therefore, the scope of the invention should not be construed as being limited by the appended claims.
Claims (17)
- 一种云台姿态估计方法,该方法包括:A gimbal attitude estimation method, the method comprising:S1、测量云台的角速度值,并基于该角速度值得到测量姿态数据;S1, measuring an angular velocity value of the gimbal, and obtaining measurement attitude data based on the angular velocity value;S2、测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台;S2, measuring motion state data of the carrier of the pan/tilt, calculating reference attitude data of the carrier according to the motion state data, the carrier supporting the cloud platform;S3、利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。S3. Correct the measurement posture data by using the reference attitude data to obtain pan/tilt attitude data.
- 根据权利要求1所述的云台姿态估计方法,其中,步骤S2包括:The pan/tilt attitude estimation method according to claim 1, wherein the step S2 comprises:伪造姿态数据;Forging gesture data;读取云台的三轴关节角度;Reading the three-axis joint angle of the gimbal;基于所述三轴关节角度与所述伪造姿态数据得到所述参考姿态数据。The reference attitude data is obtained based on the triaxial joint angle and the forged posture data.
- 根据权利要求1所述的云台姿态估计方法,其中,所述运动状态数据包括载体的线加速度;The pan/tilt attitude estimation method according to claim 1, wherein the motion state data comprises a linear acceleration of a carrier;步骤S1还包括:测量所述云台的线加速度;Step S1 further includes: measuring a linear acceleration of the pan/tilt;步骤S2中计算载体的参考姿态数据包括:将所述云台的加速度值减去所述载体的线加速度得到所述参考姿态数据;Calculating the reference attitude data of the carrier in step S2 includes: subtracting the acceleration value of the pan/tilt from the linear acceleration of the carrier to obtain the reference attitude data;
- 根据权利要求3所述的云台姿态估计方法,其中,The pan/tilt attitude estimation method according to claim 3, wherein所述载体的线加速度由指南针与卫星定位装置测量得到。The linear acceleration of the carrier is measured by a compass and a satellite positioning device.
- 根据权利要求3所述的云台姿态估计方法,其中,The pan/tilt attitude estimation method according to claim 3, wherein所述载体的线加速度由第二加速度计测量得到。The linear acceleration of the carrier is measured by a second accelerometer.
- 如权利要求1至5中任一项所述的云台姿态估计方法,其中,所述云台包括第一惯性测量元件:The pan/tilt attitude estimation method according to any one of claims 1 to 5, wherein the pan/tilt head comprises a first inertial measurement element:所述云台的角速度值由第一惯性测量元件测量得到;并且/或者The angular velocity value of the pan/tilt is measured by the first inertial measurement component; and/or所述第一惯性测量元件包括陀螺仪。The first inertial measurement element includes a gyroscope.
- 如权利要求3至5中任一项所述的云台姿态估计方法,其中,所述云台包括第一惯性测量元件:The pan/tilt attitude estimation method according to any one of claims 3 to 5, wherein the pan/tilt head comprises a first inertial measurement element:所述云台的角速度值和加速度值由第一惯性测量元件测量得到;并且/或者The angular velocity value and the acceleration value of the pan/tilt are measured by the first inertial measurement component; and/or所述第一惯性测量元件包括陀螺仪和/或第一加速度计。The first inertial measurement element comprises a gyroscope and/or a first accelerometer.
- 如权利要求5所述的云台姿态估计方法,其中,所述载体包括第二惯性测量 元件,所述第二加速度计属于该第二惯性测量元件。The pan/tilt attitude estimating method according to claim 5, wherein said carrier comprises a second inertial measurement The second accelerometer belongs to the second inertial measurement component.
- 一种云台姿态估计装置,包括:A pan/tilt attitude estimating device, comprising:第一惯性测量元件,用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据;a first inertial measurement component, configured to measure an angular velocity value of the pan/tilt, and obtain measurement attitude data based on the angular velocity value;通信接口,用于获得载体的运动状态数据,所述载体支承所述云台;a communication interface, configured to obtain motion state data of the carrier, the carrier supporting the cloud platform;处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据,以及利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。And a processor, configured to calculate reference attitude data of the carrier according to the motion state data of the carrier, and correct the measurement posture data by using the reference posture data to obtain pan/tilt attitude data.
- 根据权利要求9所述的云台姿态估计装置,其中,所述载体的运动状态数据为三轴关节角度,所述处理器还用于:The pan/tilt attitude estimating apparatus according to claim 9, wherein the motion state data of the carrier is a three-axis joint angle, and the processor is further configured to:建立伪造姿态数据;Establish forged posture data;基于所述三轴关节角度与所述伪造姿态数据得到素数参考姿态数据。A prime reference attitude data is obtained based on the triaxial joint angle and the forged posture data.
- 根据权利要求10所述的云台姿态估计装置,其中,The pan/tilt attitude estimating apparatus according to claim 10, wherein所述第一惯性测量元件还用于测量所述云台的加速度值;The first inertial measurement component is further configured to measure an acceleration value of the pan/tilt;所述通信接口获得的载体的运动状态数据包括载体的线加速度;The motion state data of the carrier obtained by the communication interface includes a linear acceleration of the carrier;所述处理器用于将所述云台的加速度值减去所述载体的线加速度得到所述参考姿态数据。The processor is configured to obtain the reference attitude data by subtracting an acceleration value of the pan/tilt from a linear acceleration of the carrier.
- 如权利要求9至11中任一项所述的云台姿态估计装置,所述第一惯性测量元件包括陀螺仪。The pan/tilt attitude estimating apparatus according to any one of claims 9 to 11, wherein the first inertial measurement element comprises a gyroscope.
- 如权利要求11所述的云台姿态估计装置,所述第一惯性测量元件包括陀螺仪和第一加速度计。The pan/tilt attitude estimating apparatus according to claim 11, wherein said first inertial measurement element comprises a gyroscope and a first accelerometer.
- 一种云台,包括云台本体以及安装于所述云台本体的云台姿态估计装置,所述云台姿态估计装置包括:A pan/tilt head includes a pan-tilt body and a pan-tilt attitude estimating device installed on the pan-tilt body, the pan-tilt attitude estimating device comprising:第一惯性测量元件,用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据;a first inertial measurement component, configured to measure an angular velocity value of the pan/tilt, and obtain measurement attitude data based on the angular velocity value;通信接口,用于获得载体的运动状态数据,所述载体支承所述云台;a communication interface, configured to obtain motion state data of the carrier, the carrier supporting the cloud platform;处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据。And a processor, configured to calculate reference attitude data of the carrier according to the motion state data of the carrier.
- 根据权利要求14所述的云台,其中,所述载体的运动状态数据为三轴关节角度,所述处理器还用于:The pan/tilt head according to claim 14, wherein the motion state data of the carrier is a triaxial joint angle, and the processor is further configured to:建立伪造姿态数据; Establish forged posture data;基于所述三轴关节角度与所述伪造姿态数据得到素数参考姿态数据。A prime reference attitude data is obtained based on the triaxial joint angle and the forged posture data.
- 根据权利要求15所述的云台,其中,The pan/tilt head according to claim 15, wherein所述第一惯性测量元件还用于测量所述云台的加速度值;The first inertial measurement component is further configured to measure an acceleration value of the pan/tilt;所述通信接口获得的载体的运动状态数据包括载体的线加速度;The motion state data of the carrier obtained by the communication interface includes a linear acceleration of the carrier;所述处理器用于将所述云台的加速度值减去所述载体的线加速度得到所述参考姿态数据。The processor is configured to obtain the reference attitude data by subtracting an acceleration value of the pan/tilt from a linear acceleration of the carrier.
- 如权利要求14至16中任一项所述的云台,所述第一惯性测量元件包括陀螺仪。 A pan/tilt head according to any one of claims 14 to 16, the first inertial measurement element comprising a gyroscope.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201780004424.7A CN108513610A (en) | 2017-04-21 | 2017-04-21 | A kind of holder Attitude estimation method, apparatus and corresponding holder |
PCT/CN2017/081442 WO2018191957A1 (en) | 2017-04-21 | 2017-04-21 | Camera mount attitude estimation method and device, and corresponding camera mount |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2017/081442 WO2018191957A1 (en) | 2017-04-21 | 2017-04-21 | Camera mount attitude estimation method and device, and corresponding camera mount |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2018191957A1 true WO2018191957A1 (en) | 2018-10-25 |
Family
ID=63375200
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2017/081442 WO2018191957A1 (en) | 2017-04-21 | 2017-04-21 | Camera mount attitude estimation method and device, and corresponding camera mount |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN108513610A (en) |
WO (1) | WO2018191957A1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110296684A (en) * | 2019-06-03 | 2019-10-01 | 新纳传感系统有限公司 | A kind of dynamic inclination meter with Express Order Wire acceleration detection function |
CN114869604A (en) * | 2022-05-07 | 2022-08-09 | 江苏理工学院 | Internet of things wheelchair intelligent navigation system |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110770671A (en) * | 2018-09-30 | 2020-02-07 | 深圳市大疆创新科技有限公司 | Cloud platform, control method thereof and movable platform |
WO2020062281A1 (en) * | 2018-09-30 | 2020-04-02 | 深圳市大疆创新科技有限公司 | Cradle head control method, cradle head, movable platform and readable storage medium |
CN113848999B (en) * | 2021-12-01 | 2022-02-15 | 普宙科技(深圳)有限公司 | Adaptive control method and device for forward and reverse inversion of holder and holder |
CN120447627A (en) * | 2025-07-09 | 2025-08-08 | 浙江华飞智能科技有限公司 | Method, device and equipment for determining attitude deviation angle of cradle head |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5922039A (en) * | 1996-09-19 | 1999-07-13 | Astral, Inc. | Actively stabilized platform system |
CN101403848A (en) * | 2008-11-14 | 2009-04-08 | 天津市联大通讯发展有限公司 | Three-dimensional automatic stabilization camera shooting system |
CN104881033A (en) * | 2015-03-27 | 2015-09-02 | 深圳市大疆创新科技有限公司 | Cloud-tilt control system, cloud-tilt control method, and unmanned aerial vehicle |
CN205176664U (en) * | 2015-08-25 | 2016-04-20 | 深圳市大疆创新科技有限公司 | Handheld cloud platform |
CN105588562A (en) * | 2015-12-16 | 2016-05-18 | 北京理工大学 | Method for modulating angular movement of isolation carrier in inertial navigation system through rotation |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102564416B (en) * | 2011-12-30 | 2014-08-20 | 浙江国自机器人技术有限公司 | System and method for reconstructing and positioning three-dimensional environment for mirror cleaning robot |
CN102707734A (en) * | 2012-06-19 | 2012-10-03 | 上海大学 | Self-stabilizing cloud deck based on inertia attitude sensor |
KR101676940B1 (en) * | 2015-01-13 | 2016-11-16 | 아주대학교산학협력단 | Providing traffic safety Information system Based On Cloud Platform and Method for Providing traffic safety Information Using the same |
CN105045293B (en) * | 2015-05-27 | 2018-05-08 | 深圳一电航空技术有限公司 | Cloud platform control method, outer carrier control method and holder |
CN106289244B (en) * | 2016-08-10 | 2019-11-26 | 极翼机器人(上海)有限公司 | A kind of attitude determination method of anti-acceleration noise |
-
2017
- 2017-04-21 WO PCT/CN2017/081442 patent/WO2018191957A1/en active Application Filing
- 2017-04-21 CN CN201780004424.7A patent/CN108513610A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5922039A (en) * | 1996-09-19 | 1999-07-13 | Astral, Inc. | Actively stabilized platform system |
CN101403848A (en) * | 2008-11-14 | 2009-04-08 | 天津市联大通讯发展有限公司 | Three-dimensional automatic stabilization camera shooting system |
CN104881033A (en) * | 2015-03-27 | 2015-09-02 | 深圳市大疆创新科技有限公司 | Cloud-tilt control system, cloud-tilt control method, and unmanned aerial vehicle |
CN205176664U (en) * | 2015-08-25 | 2016-04-20 | 深圳市大疆创新科技有限公司 | Handheld cloud platform |
CN105588562A (en) * | 2015-12-16 | 2016-05-18 | 北京理工大学 | Method for modulating angular movement of isolation carrier in inertial navigation system through rotation |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110296684A (en) * | 2019-06-03 | 2019-10-01 | 新纳传感系统有限公司 | A kind of dynamic inclination meter with Express Order Wire acceleration detection function |
CN114869604A (en) * | 2022-05-07 | 2022-08-09 | 江苏理工学院 | Internet of things wheelchair intelligent navigation system |
Also Published As
Publication number | Publication date |
---|---|
CN108513610A (en) | 2018-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2018191957A1 (en) | Camera mount attitude estimation method and device, and corresponding camera mount | |
CN106814753B (en) | Target position correction method, device and system | |
CN110325822B (en) | Cradle head pose correction method and cradle head pose correction device | |
WO2019071916A1 (en) | Antenna beam attitude control method and system | |
TWI556198B (en) | Positioning and directing data analysis system and method thereof | |
CN112611394B (en) | Aircraft attitude alignment method and system under emission coordinate system | |
CN101413800A (en) | Navigating and steady aiming method of navigation / steady aiming integrated system | |
JP2012173190A (en) | Positioning system and positioning method | |
JP2011503571A (en) | Object orientation measurement | |
CN103591955A (en) | Combined navigation system | |
JP4876204B2 (en) | Small attitude sensor | |
JP7025215B2 (en) | Positioning system and positioning method | |
CN106813662A (en) | A kind of air navigation aid based on light stream | |
CN107621266B (en) | Space non-cooperative target relative navigation method based on feature point tracking | |
WO2019205002A1 (en) | Method for attitude solution of handheld camera stabilizer and camera stabilizer system | |
CN106370178B (en) | Attitude measurement method and device of mobile terminal equipment | |
CN107990901B (en) | User direction positioning method based on sensor | |
CN114184194A (en) | A method for autonomous navigation and positioning of unmanned aerial vehicles in denial environments | |
CN116443028B (en) | Head posture data acquisition system and method | |
JP5511088B2 (en) | Portable device, program and method for correcting gravity vector used for autonomous positioning | |
CN111307114B (en) | Measurement method of horizontal attitude of surface ship based on motion reference unit | |
CN112649001B (en) | Gesture and position resolving method for small unmanned aerial vehicle | |
JP2003065793A (en) | Inertial device | |
JP6677576B2 (en) | Method and apparatus for estimating position / posture of suspended moving object using acceleration signal | |
KR101990404B1 (en) | Method for calculating tilt angle of ins using roll rotation of launch tube and apparatus thereof |
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: 17906267 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: 17906267 Country of ref document: EP Kind code of ref document: A1 |