WO2020237493A1 - Zero calibration method for gimbal and gimbal - Google Patents

Zero calibration method for gimbal and gimbal Download PDF

Info

Publication number
WO2020237493A1
WO2020237493A1 PCT/CN2019/088731 CN2019088731W WO2020237493A1 WO 2020237493 A1 WO2020237493 A1 WO 2020237493A1 CN 2019088731 W CN2019088731 W CN 2019088731W WO 2020237493 A1 WO2020237493 A1 WO 2020237493A1
Authority
WO
WIPO (PCT)
Prior art keywords
pan
joint angle
tilt
offset
gimbal
Prior art date
Application number
PCT/CN2019/088731
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 CN201980009600.5A priority Critical patent/CN111684386A/en
Priority to PCT/CN2019/088731 priority patent/WO2020237493A1/en
Publication of WO2020237493A1 publication Critical patent/WO2020237493A1/en

Links

Images

Classifications

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

Abstract

A zero calibration method for a gimbal and a gimbal, the gimbal comprising an accelerometer (5) that is used for detecting the posture of a load mounted on the gimbal, and the zero calibration method for a gimbal comprising: when a gimbal is in a specific state, acquiring the current posture of the gimbal on the basis of an accelerometer (5); determining the offset of a pitch axis joint angle and/or a roll axis joint angle of the gimbal according to the current posture of the gimbal; and determining a pitch axis zero joint angle and/or a roll axis zero joint angle of the gimbal according to the offset of the pitch axis joint angle and/or the roll axis joint angle of the gimbal. The ground gravity direction detected by the accelerometer is used to estimate the offset of the pitch axis joint angle and/or the roll axis joint angle of the gimbal, and compensate for the deviation of a joint angle of a corresponding axis; the offset estimated by using said means has higher accuracy, thereby improving the accuracy of the zero calibration of a joint angle, and preventing the roll axis of the gimbal from tilting, while also solving the problem in which the zero calibration of a gimbal overly relies on the structural accuracy of a fixture.

Description

云台零位标定方法和云台PTZ zero calibration method and PTZ 技术领域Technical field
本发明涉及云台领域,尤其涉及一种云台零位标定方法和云台。The invention relates to the field of pan/tilt, in particular to a method for calibrating the zero position of the pan/tilt and the pan/tilt.
背景技术Background technique
现有的大云台不能与有结构限位的小云台一样,通过上电检测机械限位点来确定云台的关节角零位,大云台一般利用治具来完成关节角的零位标定。而长期使用治具,治具会产生磨损,磨损以及操作不当等因素会导致治具存在虚位,导致零位标定出现偏差,影响了零位标定的精度。若关节角的零位偏差大于一定阈值,陀螺仪速度映射到关节角角速度计算雅克比矩阵会出现偏差,基于速度积分方式计算获得的关节角角度也存在偏差,最终导致用户在拍摄运动的画面时,若快速遥控云台的偏航轴(yaw)转动,云台的横滚轴(roll)则会出现歪斜,使得拍摄质量不佳。The existing big gimbal cannot be the same as the small gimbal with structural limits. The zero position of the joint angle of the gimbal can be determined by detecting the mechanical limit point by power-on. The big gimbal generally uses a jig to complete the zero position of the joint angle Calibration. Long-term use of the fixture will cause wear, abrasion and improper operation of the fixture, which will cause the fixture to have a virtual position, resulting in a deviation in the zero calibration, and affecting the accuracy of the zero calibration. If the zero deviation of the joint angle is greater than a certain threshold, the gyro speed mapping to the joint angular velocity calculation Jacobian matrix will be deviated, and the joint angle angle calculated based on the velocity integration method will also deviate, which will eventually cause the user to shoot moving pictures. , If the yaw axis of the pan/tilt is quickly rotated, the roll axis of the pan/tilt will be skewed, resulting in poor shooting quality.
发明内容Summary of the invention
本发明提供一种云台零位标定方法和云台。The invention provides a method for calibrating the zero position of a pan-tilt and a pan-tilt.
具体地,本发明是通过如下技术方案实现的:Specifically, the present invention is implemented through the following technical solutions:
根据本发明的第一方面,提供一种云台零位标定方法,所述云台包括加速度计,用于检测搭载在所述云台上的负载的姿态;所述方法包括:According to a first aspect of the present invention, a method for zero calibration of a pan/tilt head is provided, the pan/tilt head includes an accelerometer for detecting the posture of a load mounted on the pan/tilt head; the method includes:
在所述云台处于特定状态时,基于所述加速度计获取所述云台的当前姿态;When the pan/tilt is in a specific state, acquiring the current posture of the pan/tilt based on the accelerometer;
根据所述云台的当前姿态,确定所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量;Determine the offset of the pitch axis joint angle and/or roll axis joint angle of the pan/tilt according to the current posture of the gimbal;
根据所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定所述云台的俯仰轴零位关节角和/或横滚轴零位关节角。According to the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt, the pitch axis zero joint angle and/or the roll axis zero joint angle of the pan/tilt head are determined.
根据本发明的第二方面,提供一种云台,所述云台包括:According to a second aspect of the present invention, there is provided a pan-tilt, the pan-tilt including:
俯仰轴组件,用于搭载负载,并能够绕俯仰轴转动;The pitch axis assembly is used to carry loads and can rotate around the pitch axis;
横滚轴组件,能够绕横滚轴转动,带动所述俯仰轴组件和所述负载绕横滚轴转动;The roll axis assembly is capable of rotating around the roll axis to drive the pitch axis assembly and the load to rotate around the roll axis;
加速度计,用于检测所述负载的姿态;以及An accelerometer for detecting the posture of the load; and
处理器,与所述俯仰轴组件、所述横滚轴组件以及所述加速度计分别电连接,其中,所述处理器用于执行如下操:The processor is electrically connected to the pitch axis assembly, the roll axis assembly, and the accelerometer, respectively, wherein the processor is configured to perform the following operations:
在所述云台处于特定状态时,基于所述加速度计获取所述云台的当前姿态;When the pan/tilt is in a specific state, acquiring the current posture of the pan/tilt based on the accelerometer;
根据所述云台的当前姿态,确定所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量;Determine the offset of the pitch axis joint angle and/or roll axis joint angle of the pan/tilt according to the current posture of the gimbal;
根据所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定所述云台的俯仰轴零位关节角和/或横滚轴零位关节角。According to the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt, the pitch axis zero joint angle and/or the roll axis zero joint angle of the pan/tilt head are determined.
由以上本发明实施例提供的技术方案可见,本发明利用云台上的加速度计确定云台的俯仰轴关节角和/或横滚轴关节角的偏移量,再根据偏移量标定对应轴的零位关节角,即利用加速度计检测的大地重力方向估计出云台的俯仰轴关节角和/或横滚轴关节角的偏移量,补偿对应轴的关节角的偏差,采用这种方式估算的偏移量精度较高,从而提高了关节角零位标定的精度,防止了云台横滚轴出现歪斜的情况,同时也解决了云台零位标定过分依赖治具结构精度的问题。As can be seen from the technical solutions provided by the above embodiments of the present invention, the present invention uses the accelerometer on the pan/tilt to determine the pitch axis joint angle and/or roll axis joint angle offset of the pan/tilt, and then calibrate the corresponding axis according to the offset The zero joint angle, that is, the offset of the pitch axis joint angle and/or the roll axis joint angle of the gimbal is estimated by using the ground gravity direction detected by the accelerometer to compensate for the deviation of the joint angle of the corresponding axis. This method is adopted The estimated offset has a high accuracy, which improves the accuracy of the joint angle zero calibration, prevents the tilt of the pan/tilt roll axis, and also solves the problem that the gimbal zero calibration depends excessively on the accuracy of the fixture structure.
附图说明Description of the drawings
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to explain the technical solutions in the embodiments of the present invention more clearly, the following will briefly introduce the accompanying drawings needed in the description of the embodiments. Obviously, the accompanying drawings in the following description are only some embodiments of the present invention. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without creative labor.
图1是本发明一实施例中的云台的结构示意图;FIG. 1 is a schematic structural diagram of a pan-tilt in an embodiment of the present invention;
图2是本发明一实施例中的云台零位标定方法的方法流程图;Figure 2 is a method flow chart of a method for zero calibration of a pan/tilt in an embodiment of the present invention;
图3A是本发明一实施例中的云台的俯仰轴关节角和横滚轴关节角不存在零位偏差时,重力加速度与俯仰轴、横滚轴的位置关系示意图;3A is a schematic diagram of the positional relationship between the acceleration of gravity and the pitch axis and the roll axis when there is no zero deviation between the pitch axis joint angle and the roll axis joint angle of the pan/tilt in an embodiment of the present invention;
图3B是本发明一实施例中的云台的俯仰轴关节角和横滚轴关节角存在零位偏差时,重力加速度与俯仰轴、横滚轴的位置关系示意图;3B is a schematic diagram of the positional relationship between the acceleration of gravity and the pitch axis and the roll axis when the pitch axis joint angle and the roll axis joint angle of the pan/tilt in an embodiment of the present invention have a zero deviation;
图4是本发明一实施例中的云台零位标定方法的一具体的方法流程图;4 is a specific method flow chart of the zero calibration method of the pan/tilt in an embodiment of the present invention;
图5是本发明一实施例中的云台的结构框图。Fig. 5 is a structural block diagram of a pan-tilt in an embodiment of the present invention.
附图标记:Reference signs:
1:俯仰轴组件;11:俯仰轴轴臂;12:俯仰轴电机;2:横滚轴组件;21:横滚轴轴臂;22:横滚轴电机;3:偏航轴组件;4:承载部;5加速度计;6:握持部;7:处理器。1: Pitch axis assembly; 11: Pitch axis arm; 12: Pitch axis motor; 2: Roll axis assembly; 21: Roll axis arm; 22: Roll axis motor; 3: Yaw axis assembly; 4: Bearing part; 5 accelerometer; 6: grip part; 7: processor.
具体实施方式Detailed ways
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only a part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of the present invention.
应当理解,在不冲突的情况下,下述的实施例及实施方式中的特征可以相互组合。It should be understood that, in the case of no conflict, the following embodiments and features in the implementation manners can be combined with each other.
本发明实施例中,云台被配置为能够绕俯仰轴和横滚轴转动,可选的,本实施例的云台被配置为能够绕俯仰轴和横滚轴转动;可选的,云台还被配置为能够绕偏航轴转动,也即,云台被配置为能够绕偏航轴、俯仰轴和横滚轴转动。In the embodiment of the present invention, the pan/tilt is configured to be able to rotate around the pitch axis and the roll axis. Optionally, the pan/tilt in this embodiment is configured to be capable of rotating around the pitch axis and the roll axis; optionally, the pan/tilt It is also configured to be able to rotate around the yaw axis, that is, the pan/tilt is configured to be able to rotate around the yaw axis, pitch axis, and roll axis.
可选的,云台为两轴云台,该云台包括俯仰轴组件和横滚轴组件,其中,俯仰轴组件用于搭载负载,并能够绕俯仰轴转动,带动负载绕俯仰轴转动,使得负载的俯仰轴姿态角变化;横滚轴组件能够绕横滚轴转动,带动俯仰轴组件和负载绕横滚轴转动,使得负载的横滚轴姿态角变化。Optionally, the pan/tilt is a two-axis pan/tilt, which includes a pitch axis assembly and a roll axis assembly, wherein the pitch axis assembly is used to carry loads and can rotate around the pitch axis to drive the load to rotate around the pitch axis, so that The attitude angle of the pitch axis of the load changes; the roll axis assembly can rotate around the roll axis, driving the pitch axis assembly and the load to rotate around the roll axis, so that the attitude angle of the roll axis of the load changes.
可选的,云台为三轴云台,该云台包括俯仰轴组件、横滚轴组件和偏航轴组件,其中,俯仰轴组件用于搭载负载,并能够绕俯仰轴转动,带动负载绕俯仰轴转动,使得负载的俯仰轴姿态角变化;横滚轴组件能够绕横滚轴转动,带动俯仰轴组件和负载绕横滚轴转动,使得负载的横滚轴姿态角变化;偏航轴组件能够绕偏航轴转动,带动横滚轴组件、俯仰轴组件和负载绕偏航轴转动,使得负载的偏航轴姿态角变化。Optionally, the gimbal is a three-axis gimbal, which includes a pitch axis assembly, a roll axis assembly, and a yaw axis assembly. The pitch axis assembly is used to carry loads and can rotate around the pitch axis to drive the load around The rotation of the pitch axis changes the attitude angle of the load's pitch axis; the roll axis assembly can rotate around the roll axis, driving the pitch axis assembly and the load to rotate around the roll axis, so that the attitude angle of the load's roll axis changes; yaw axis assembly It can rotate around the yaw axis, drive the roll axis assembly, the pitch axis assembly and the load to rotate around the yaw axis, so that the attitude angle of the yaw axis of the load changes.
以三轴云台为例,如图1所示,俯仰轴组件1可包括俯仰轴轴臂11和能够绕俯仰轴转动的俯仰轴电机12,横滚轴组件2可包括横滚轴轴臂21和能够绕横滚轴转动的横滚轴电机22,偏航轴组件3可包括能够绕偏航轴转动的偏航轴电机,其中,横滚轴轴臂21的一端连接偏航轴电机的转子,横滚轴轴臂21的另一端连接横滚轴电机22的定子;俯仰轴轴臂11的一端连接横滚轴电机22的转子,俯仰轴轴臂11的另一端连接俯仰轴电机12,负载搭载在俯仰轴电机12的转子上。Taking a three-axis pan/tilt head as an example, as shown in FIG. 1, the pitch axis assembly 1 may include a pitch axis shaft arm 11 and a pitch axis motor 12 that can rotate around the pitch axis, and the roll axis assembly 2 may include a roll axis shaft arm 21. And the roll axis motor 22 capable of rotating around the roll axis, the yaw axis assembly 3 may include a yaw axis motor capable of rotating around the yaw axis, wherein one end of the roll axis arm 21 is connected to the rotor of the yaw axis motor , The other end of the roll axis arm 21 is connected to the stator of the roll axis motor 22; one end of the pitch axis arm 11 is connected to the rotor of the roll axis motor 22, and the other end of the pitch axis arm 11 is connected to the pitch axis motor 12, load It is mounted on the rotor of the pitch axis motor 12.
负载可以为成像传感器,也可为承载部4,该承载部4用于搭载相机等具有拍摄功能的设备。进一步的,请再参见图1,云台包括加速度计5,该加速计可以用于检测负载的姿态。可以理解,负载的姿态也即云台的姿态。可选的,加速度计5固定在负载上。The load may be an imaging sensor, or a carrying part 4, which is used to carry equipment with a photographing function such as a camera. Further, referring to Fig. 1 again, the pan/tilt includes an accelerometer 5, which can be used to detect the attitude of the load. It can be understood that the attitude of the payload is also the attitude of the PTZ. Optionally, the accelerometer 5 is fixed on the load.
本发明实施例的云台可以为手持云台,也可以为非手持云台;该云台可以搭载在无人机、车辆等可移动设备上。当云台为手持云台时,云台进一步包括握持部6,偏航轴电机固定连接在握持部6的顶部。The pan/tilt in the embodiment of the present invention may be a handheld pan/tilt or a non-handheld pan/tilt; the pan/tilt may be mounted on a mobile device such as a drone or a vehicle. When the pan/tilt is a hand-held pan/tilt, the pan/tilt further includes a holding part 6 and the yaw axis motor is fixedly connected to the top of the holding part 6.
如图2所示,本发明实施例提供一种云台零位标定方法,所述方法可以包括如下步骤:As shown in FIG. 2, an embodiment of the present invention provides a method for zero calibration of a pan/tilt head. The method may include the following steps:
S201:在云台处于特定状态时,基于加速度计5获取云台的当前姿态;S201: when the pan/tilt is in a specific state, obtain the current attitude of the pan/tilt based on the accelerometer 5;
本实施例中,云台的当前姿态即为负载的实时姿态。In this embodiment, the current attitude of the pan/tilt is the real-time attitude of the payload.
基于加速度计5获取云台的当前姿态的过程具体包括:基于加速计,获得云台在俯仰轴和横滚轴上的实时重力加速度分量;根据重力加速度分量,确定对应轴的当 前姿态角;也即,根据云台在俯仰轴上的实时重力加速度分量,确定俯仰轴的当前姿态角,并根据云台在横滚轴上的实时重力加速度分量,确定横滚轴的当前姿态角。The process of obtaining the current attitude of the gimbal based on the accelerometer 5 specifically includes: obtaining the real-time gravitational acceleration components of the gimbal on the pitch axis and roll axis based on the accelerometer; determining the current attitude angle of the corresponding axis according to the gravitational acceleration component; also That is, the current attitude angle of the pitch axis is determined according to the real-time gravitational acceleration component of the pan/tilt on the pitch axis, and the current attitude angle of the roll axis is determined according to the real-time gravitational acceleration component of the pan/tilt on the roll axis.
如图3A所示,若云台的俯仰轴关节角和横滚轴关节角不存在零位偏差,则重力加速度与俯仰轴共线,并与横滚轴正交,云台在俯仰轴上的实时重力加速度分量Ax=0,云台在横滚轴上的实时重力加速度分量Ay=g(g即为重力加速度),此时,俯仰轴的姿态角为0度,横滚轴的姿态角也为0度;如图3B所示,若云台的俯仰轴关节角和横滚轴关节角均存在零位偏差,则重力加速度与俯仰轴不共线,并与横滚轴非正交,Ax≠0,且Ay≠0,并且,Ax=gsinα,Ay=gcosα,即可确定α大小,根据α,即可进一步确定俯仰轴的当前姿态角以及横滚轴的当前姿态角。As shown in Figure 3A, if there is no zero deviation between the pitch axis joint angle and the roll axis joint angle of the gimbal, the acceleration of gravity is collinear with the pitch axis and orthogonal to the roll axis, and the gimbal is on the pitch axis. The real-time gravitational acceleration component Ax=0, the real-time gravitational acceleration component of the gimbal on the roll axis Ay=g (g is the gravitational acceleration), at this time, the attitude angle of the pitch axis is 0 degrees, and the attitude angle of the roll axis is also As shown in Figure 3B, if the pitch axis joint angle and the roll axis joint angle of the gimbal have zero deviation, the acceleration of gravity is not collinear with the pitch axis, and is not orthogonal to the roll axis, Ax ≠0, and Ay≠0, and Ax=gsinα, Ay=gcosα, the size of α can be determined, and according to α, the current attitude angle of the pitch axis and the current attitude angle of the roll axis can be further determined.
特定状态可以为非水平状态,也可以为水平状态。本实施例中,特定状态为水平状态,减少非水平状态对云台零位标定的影响,从而提高云台零位标定的精度。可选的,特定状态包括:云台放置在水平面上,且云台处于姿态回中模式。该水平面可以为一个绝对水平的水平台面,这为理想状态下的水平面,可以理解,当水平台面的与水平面夹角小于预设角度阈值(如0.5度)时,也可认为该水平台面为水平面。将云台放置在水平面上,有利于云台处于静止状态,减少云台的计算量,从而加快云台零位标定的速度。当然,若云台处于匀速运动状态,也可进行云台的零位标定,与云台处于静止状态相比,若在云台处于匀速运动状态时,对云台进行零位标定,云台需要在零位标定确定的俯仰轴关节角和横滚轴关节角的基础上,减去对应轴在匀速运动时的关节角变化,再判断对应轴的关节角是否存在零位偏差。The specific state can be a non-horizontal state or a horizontal state. In this embodiment, the specific state is the horizontal state, which reduces the influence of the non-horizontal state on the zero calibration of the gimbal, thereby improving the accuracy of the zero calibration of the gimbal. Optionally, the specific state includes: the pan/tilt is placed on a horizontal surface, and the pan/tilt is in the attitude centering mode. The horizontal plane can be an absolutely horizontal horizontal plane, which is an ideal horizontal plane. It can be understood that when the angle between the horizontal plane and the horizontal plane is less than the preset angle threshold (such as 0.5 degrees), the horizontal plane can also be considered a horizontal plane. . Placing the gimbal on a horizontal surface will help the gimbal stay in a static state, reduce the calculation amount of the gimbal, and speed up the zero calibration of the gimbal. Of course, if the gimbal is moving at a constant speed, it can also be calibrated to its zero position. Compared with the gimbal at a static state, if the gimbal is moving at a constant speed, the gimbal needs to be calibrated to zero. On the basis of the joint angle of the pitch axis and the joint angle of the roll axis determined by the zero calibration, subtract the joint angle change of the corresponding axis during uniform motion, and then judge whether the joint angle of the corresponding axis has a zero deviation.
另外,云台处于姿态回中模式时,云台各轴的姿态角均为0度,且各轴电机的关节角也为0度,从而加快零位标定的速度。当然,在进行云台零位标定时,云台也可不处于姿态回中模式,云台在零位标定时确定的俯仰轴关节角和横滚轴关节角的基础上,减去对应轴的初始关节角,再判断对应轴的关节角是否存在零位偏差。In addition, when the gimbal is in the attitude return mode, the attitude angle of each axis of the gimbal is 0 degree, and the joint angle of each axis motor is also 0 degree, thus speeding up the zero calibration. Of course, during the zero calibration of the gimbal, the gimbal may not be in the attitude return mode. The joint angle of the pitch axis and the joint angle of the roll axis determined by the gimbal during the zero calibration are subtracted from the initial value of the corresponding axis. Joint angle, and then judge whether the joint angle of the corresponding axis has zero deviation.
如上所述,特定状态可进一步包括:云台处于静止状态,以减少云台的计算量,从而加快云台零位标定的速度。As described above, the specific state may further include: the pan/tilt is in a static state, so as to reduce the amount of calculation of the pan/tilt, thereby speeding up the zero calibration of the pan/tilt.
可选的,基于触发方式触发云台进行零位标定,也即,可以基于用户需求来触发云台进行零位标定。本实施例中,云台零位标定方法还包括:在云台处于特定状态之后,基于加速度计5获取云台的当前姿态之前,检测到零位标定触发信号。零位标定触发信号可基于不同的方式产生,比如,在某些实施例中,零位标定触发信号由外部设备发送,该外部设备可以为能够控制云台工作的遥控器、能够与云台进行通信的控制终端(如手机、平板电脑等)或其他能够与云台进行通信的智能设备(如智能手环)等等。在某些实施例中,零位标定触发信号由云台的按键被触发而产生,可以理解,云台也可设有其他类型的控制部,用户通过操作控制部而产生零位标定触发信号,该控制部不限于按键,也可为旋钮或其他类型。当云台为手持云台时,控制部可设于 手持云台的握持部6上,方便用户操作。Optionally, the pan/tilt is triggered to perform zero calibration based on the trigger mode, that is, the pan/tilt may be triggered to perform zero calibration based on user requirements. In this embodiment, the method for zero calibration of the PTZ further includes: after the PTZ is in a specific state, before the current posture of the PTZ is acquired based on the accelerometer 5, detecting the zero calibration trigger signal. The zero calibration trigger signal can be generated in different ways. For example, in some embodiments, the zero calibration trigger signal is sent by an external device. The external device can be a remote control that can control the operation of the pan/tilt, and can communicate with the pan/tilt. Communication control terminals (such as mobile phones, tablet computers, etc.) or other smart devices (such as smart bracelets) that can communicate with the pan/tilt. In some embodiments, the zero calibration trigger signal is generated by the button of the pan/tilt. It is understood that the pan/tilt may also be provided with other types of control parts, and the user generates the zero calibration trigger signal by operating the control part. The control unit is not limited to buttons, but can also be a knob or other types. When the pan/tilt is a handheld pan/tilt, the control unit can be arranged on the grip 6 of the handheld pan/tilt, which is convenient for the user to operate.
可选的,云台在检测到其处于特定状态时,自动进入云台零位标定的程序。Optionally, when the pan-tilt detects that it is in a specific state, it automatically enters the zero calibration procedure of the pan-tilt.
S202:根据云台的当前姿态,确定云台的俯仰轴关节角和/或横滚轴关节角的偏移量;S202: Determine the offset of the pitch axis joint angle and/or roll axis joint angle of the gimbal according to the current attitude of the gimbal;
可选的,根据云台的当前姿态,确定俯仰轴关节角的偏移量,再根据俯仰轴关节角的偏移量来判断俯仰轴关节角是否存在零位偏差;可选的,根据云台的当前姿态,确定横滚轴关节角的偏移量,再根据横滚轴关节角的偏移量来判断横滚轴关节角是否存在零位偏差;可选的,根据云台的当前姿态,确定俯仰轴关节角的偏移量和横滚轴关节角的偏移量,再根据俯仰轴关节角的偏移量和横滚轴关节角的偏移量来判断对应轴关节角是否存在零位偏差。Optionally, determine the offset of the pitch axis joint angle according to the current attitude of the gimbal, and then determine whether the pitch axis joint angle has zero deviation according to the offset of the pitch axis joint angle; optionally, according to the gimbal Determine the offset of the roll axis joint angle, and then determine whether the roll axis joint angle has zero deviation according to the offset of the roll axis joint angle; optionally, according to the current posture of the pan/tilt, Determine the offset of the pitch axis joint angle and the offset of the roll axis joint angle, and then judge whether the corresponding axis joint angle has zero position according to the offset of the pitch axis joint angle and the offset of the roll axis joint angle deviation.
可以理解,若特定状态为水平状态,且时,俯仰轴关节角的偏移量即为俯仰轴关节角的零位偏移量,横滚轴关节角的偏移量即为横滚轴关节角的零位偏移量;若特定状态为非水平状态,俯仰轴关节角的偏移量、横滚轴关节角的偏移量则为非零位时对应轴的偏移量。It can be understood that if the specific state is horizontal, the offset of the pitch axis joint angle is the zero offset of the pitch axis joint angle, and the offset of the roll axis joint angle is the roll axis joint angle. If the specific state is non-horizontal, the offset of the joint angle of the pitch axis and the offset of the joint angle of the roll axis are the offset of the corresponding axis when it is non-zero.
图4为S202的一种具体实现过程,如图4所示,S202的具体实现过程可以包括:Figure 4 is a specific implementation process of S202. As shown in Figure 4, the specific implementation process of S202 may include:
S401:根据云台的当前姿态,确定云台的当前俯仰轴关节角和/或当横滚轴关节角;S401: Determine the current pitch axis joint angle and/or current roll axis joint angle of the gimbal according to the current attitude of the gimbal;
本实施例中,根据现有的姿态角与关节角之间的转换关系,将当前俯仰轴姿态角转换成当前俯仰轴关节角,和/或将当前横滚轴姿态角转换成当横滚轴关节角。In this embodiment, according to the existing conversion relationship between the attitude angle and the joint angle, the current pitch axis attitude angle is converted into the current pitch axis joint angle, and/or the current roll axis attitude angle is converted into the roll axis Joint angle.
S402:确定当前俯仰轴关节角与第一预设阈值的第一偏移量和/或当前横滚轴关节角与第二预设阈值的第二偏移量;S402: Determine the first offset between the current pitch axis joint angle and the first preset threshold and/or the second offset between the current roll axis joint angle and the second preset threshold;
通常,云台未进行零位标定前,云台处于零位时的俯仰轴零位关节角、横滚轴零位关节角均为0度。因此,本实施例中,若云台为第一次零位标定,则第一预设阈值、第二预设阈值均为0度;也即,第一偏移量=当前俯仰轴关节角,第二偏移量=当前横滚轴关节角。Normally, before the gimbal is calibrated, the pitch axis zero joint angle and roll axis zero joint angle when the gimbal is in the zero position are all 0 degrees. Therefore, in this embodiment, if the gimbal is performing the first zero calibration, the first preset threshold and the second preset threshold are both 0 degrees; that is, the first offset = the current pitch axis joint angle, The second offset = current roll axis joint angle.
然而,在某些实施例中,云台未进行零位标定前,云台处于零位时的俯仰轴零位关节角、横滚轴零位关节角并非0度,则云台在第一次零位标定时,第一预设阈值为俯仰轴零位关节角,第二预设阈值为横滚轴零位关节角;也即,第一偏移量=当前俯仰轴关节角-云台未进行零位标定前,云台处于零位时的俯仰轴零位关节角,第二偏移量=当前横滚轴关节角-云台未进行零位标定前,云台处于零位时的横滚轴零位关节角。However, in some embodiments, before the gimbal is zero-calibrated, the pitch axis zero joint angle and roll axis zero joint angle when the gimbal is in the zero position are not 0 degrees. During zero calibration, the first preset threshold is the pitch axis zero joint angle, and the second preset threshold is the roll axis zero joint angle; that is, the first offset = current pitch axis joint angle-pan/tilt Before zero calibration, the pitch axis zero joint angle when the gimbal is at the zero position, the second offset = the current roll axis joint angle-the gimbal before zero calibration, the horizontal when the gimbal is at zero Roller zero joint angle.
此外,若云台非第一次零位标定,则第一预设阈值为云台最近一次进行零位标定所确定的云台的俯仰轴零位关节角,第二预设阈值为云台最近一次进行零位标定所 确定的云台的横滚轴零位关节角;也即,第一偏移量=当前俯仰轴关节角-云台最近一次进行零位标定所确定的云台的俯仰轴零位关节角,第二偏移量=当前横滚轴关节角-云台最近一次进行零位标定所确定的云台的横滚轴零位关节角。In addition, if the gimbal is not the first zero calibration, the first preset threshold is the pitch axis zero joint angle of the gimbal determined by the last zero calibration of the gimbal, and the second preset threshold is the nearest The roll axis zero joint angle of the gimbal determined by one zero calibration; that is, the first offset = the current pitch axis joint angle-the tilt axis of the gimbal determined by the last zero calibration of the gimbal Zero joint angle, the second offset = current roll axis joint angle-the gimbal's roll axis zero joint angle determined by the last zero calibration of the gimbal.
S303:若第一偏移量满足预设的零位偏差条件,则根据第一偏移量,确定云台的俯仰轴关节角的偏移量,和/或,若第二偏移量满足预设的零位偏差条件,则根据第二偏移量,确定云台的横滚轴关节角的偏移量。S303: If the first offset meets the preset zero deviation condition, determine the offset of the pitch axis joint angle of the pan/tilt according to the first offset, and/or if the second offset meets the preset Set the zero deviation condition, then determine the offset of the roll axis joint angle of the pan/tilt according to the second offset.
第一偏移量满足预设的零位偏差条件,表明云台的俯仰轴关节角存在零位偏差,需要对俯仰轴关节角进行零位补偿;第二偏移量满足预设的零位偏差条件,表明云台的横滚轴关节角存在零位偏差,需要对横滚轴关节角进行零位补偿。The first offset meets the preset zero deviation condition, indicating that the pitch axis joint angle of the gimbal has a zero deviation, and zero compensation is required for the pitch axis joint angle; the second offset meets the preset zero deviation The conditions indicate that there is a zero deviation in the roll axis joint angle of the pan/tilt, and zero compensation is required for the roll axis joint angle.
零位偏差条件可根据需要设定,例如,在某些实施例中,第一偏移量满足预设的零位偏差条件可以包括:第一偏移量的绝对值大于预设的第一偏移阈值。以云台非第一次零位标定为例,若|当前俯仰轴关节角-云台最近一次进行零位标定所确定的云台的俯仰轴零位关节角|>第一偏移阈值,则判断云台的俯仰轴关节角存在零位偏差;也即,在当前俯仰轴关节角-云台最近一次进行零位标定所确定的云台的俯仰轴零位关节角>第一偏移阈值,或者,当前俯仰轴关节角-云台最近一次进行零位标定所确定的云台的俯仰轴零位关节角<第一偏移阈值的相反数时,判断云台的俯仰轴关节角存在零位偏差。而在某些实施例中,第一偏移量满足预设的零位偏差条件可以包括:第一偏移量的绝对值大于或等于预设的第一偏移阈值。The zero deviation condition can be set as required. For example, in some embodiments, the first offset satisfying the preset zero deviation condition may include: the absolute value of the first offset is greater than the preset first deviation Shift threshold. Taking the non-first zero calibration of the gimbal as an example, if |the current pitch axis joint angle-the pitch axis zero joint angle of the gimbal determined by the last zero calibration of the gimbal|>the first offset threshold, then It is judged that the pitch axis joint angle of the gimbal has a zero deviation; that is, the current pitch axis joint angle-the pitch axis zero joint angle of the gimbal determined by the last zero calibration of the gimbal> the first offset threshold, Or, when the current pitch axis joint angle-the pitch axis zero joint angle of the gimbal determined during the last zero calibration of the gimbal <the opposite of the first offset threshold, it is judged that the pitch axis joint angle of the gimbal has zero position deviation. In some embodiments, the first offset meeting the preset zero deviation condition may include: the absolute value of the first offset is greater than or equal to the preset first offset threshold.
在某些实施例中,第二偏移量满足预设的零位偏差条件可以包括:第二偏移量的绝对值大于预设的第二偏移阈值。同样以云台非第一次零位标定为例,若|当前横滚轴关节角-云台最近一次进行零位标定所确定的云台的横滚轴零位关节角|>第二偏移阈值,则判断云台的横滚轴关节角存在零位偏差;也即,在当前横滚轴关节角-云台最近一次进行零位标定所确定的云台的横滚轴零位关节角>第二偏移阈值,或者,当前横滚轴关节角-云台最近一次进行零位标定所确定的云台的横滚轴零位关节角<第二偏移阈值的相反数时,判断云台的横滚轴关节角存在零位偏差。而在某些实施例中,第二偏移量满足预设的零位偏差条件可以包括:第二偏移量的绝对值大于或等于预设的第二偏移阈值。In some embodiments, the second offset satisfying the preset zero deviation condition may include: the absolute value of the second offset is greater than the preset second offset threshold. Also take the non-first zero calibration of the gimbal as an example, if|the current roll axis joint angle-the gimbal's roll axis zero joint angle determined by the last zero calibration of the gimbal|>second offset Threshold value, it is judged that there is a zero deviation in the roll axis joint angle of the pan/tilt; that is, the current roll axis joint angle-the gimbal's roll axis zero joint angle determined by the last zero calibration of the gimbal> The second offset threshold, or the current roll axis joint angle-the gimbal's roll axis zero joint angle determined by the last zero calibration of the gimbal <the opposite of the second offset threshold, the gimbal is judged There is a zero deviation in the joint angle of the roll axis. In some embodiments, the second offset satisfying the preset zero deviation condition may include: the absolute value of the second offset is greater than or equal to the preset second offset threshold.
其中,第一偏移阈值、第二偏移阈值的大小可根据需要设定。进一步的,第一偏移阈值与第二偏移阈值的大小可相等,也可不相等。例如,在一实施例中,第一偏移阈值=第二偏移阈值=0.5度。Among them, the size of the first offset threshold and the second offset threshold can be set as required. Further, the magnitude of the first offset threshold and the second offset threshold may be equal or not equal. For example, in one embodiment, the first offset threshold=the second offset threshold=0.5 degrees.
在根据第一偏移量,确定云台的俯仰轴关节角的偏移量时,可选的,在某些实施例中,将第一偏移量设定为云台的俯仰轴关节角的偏移量,即云台的俯仰轴关节角的偏移量=第一偏移量;在某些实施例中,云台的俯仰轴关节角的偏移量根据第一偏移量和第一预设经验值确定,如云台的俯仰轴关节角的偏移量=第一偏移量*第一预设经 验值;可以理解,根据第一偏移量,确定云台的俯仰轴关节角的偏移量的实现方式并不限于上述列举的两种方式,还可以采用其他方式。When determining the offset of the pitch axis joint angle of the gimbal according to the first offset, optionally, in some embodiments, the first offset is set to the pitch axis joint angle of the gimbal. The offset, that is, the offset of the pitch axis joint angle of the gimbal = the first offset; in some embodiments, the offset of the pitch axis joint angle of the gimbal is based on the first offset and the first offset. The preset empirical value is determined, such as the offset of the pitch axis joint angle of the gimbal = the first offset * the first preset empirical value; it can be understood that the pitch axis joint angle of the gimbal is determined according to the first offset The implementation of the offset of is not limited to the two methods listed above, and other methods can also be used.
在根据第二偏移量,确定云台的横滚轴关节角的偏移量时,可选的,在某些实施例中,将第二偏移量设定为云台的横滚轴关节角的偏移量,即云台的横滚轴关节角的偏移量=第二偏移量;在某些实施例中,云台的横滚轴关节角的偏移量根据第二偏移量和第二预设经验值确定,如云台的横滚轴关节角的偏移量=第二偏移量*第二预设经验值;可以理解,根据第二偏移量,确定云台的横滚轴关节角的偏移量的实现方式并不限于上述列举的两种方式,还可采用其他方式。When determining the offset of the roll axis joint angle of the pan/tilt according to the second offset, optionally, in some embodiments, the second offset is set to the roll axis joint of the pan/tilt. Angle offset, that is, the offset of the roll axis joint angle of the pan/tilt head = the second offset; in some embodiments, the offset of the roll axis joint angle of the pan/tilt head is based on the second offset The amount and the second preset empirical value are determined, such as the offset of the roll axis joint angle of the pan/tilt = the second offset * the second preset empirical value; it is understandable that the pan/tilt is determined according to the second offset The implementation of the offset of the joint angle of the roll axis is not limited to the two methods listed above, and other methods may also be used.
在某些实施例中,将第一偏移量设定为云台的俯仰轴关节角的偏移量,并将第二偏移量设定为云台的横滚轴关节角的偏移量。In some embodiments, the first offset is set to the offset of the pitch axis joint angle of the pan/tilt, and the second offset is set to the offset of the roll axis joint angle of the pan/tilt. .
S203:根据云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定云台的俯仰轴零位关节角和/或横滚轴零位关节角。S203: Determine the pitch axis zero joint angle and/or roll axis zero joint angle of the pan/tilt according to the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt.
可选的,根据云台的俯仰轴关节角的偏移量,确定云台的俯仰轴零位关节角;可选的,根据云台的横滚轴关节角的偏移量,确定云台的横滚轴零位关节角;可选的,根据云台的俯仰轴关节角的偏移量,确定云台的俯仰轴零位关节角,并根据云台的横滚轴关节角的偏移量,确定云台的横滚轴零位关节角。Optionally, determine the pitch axis zero joint angle of the gimbal according to the offset of the pitch axis joint angle of the gimbal; optionally, determine the pitch axis joint angle of the gimbal according to the offset of the roll axis joint angle of the gimbal. Roll axis zero joint angle; optionally, determine the pitch axis zero joint angle of the gimbal according to the offset of the pitch axis joint angle of the gimbal, and according to the offset of the roll axis joint angle of the gimbal To determine the zero joint angle of the roll axis of the gimbal.
在根据云台的俯仰轴关节角的偏移量,确定云台的俯仰轴零位关节角时,可选的,在某些实施例中,在云台重新上电时,获取云台重新上电时的俯仰轴关节角;根据云台重新上电时的俯仰轴关节角与云台的俯仰轴关节角的偏移量,确定云台的俯仰轴零位关节角。其中,云台重新上电时的俯仰轴关节角的确定方式与S301中确定云台的当前俯仰轴关节角的方式相同,此处不再赘述。进一步可选的,云台的俯仰轴零位关节角为云台重新上电时的俯仰轴关节角与云台的俯仰轴关节角的偏移量的差值,也即,云台的俯仰轴零位关节角=云台重新上电时的俯仰轴关节角-云台的俯仰轴关节角的偏移量的差值。可以理解,云台的俯仰轴零位关节角的计算方式并不限于此,还可以为其他计算方式,例如,云台的俯仰轴零位关节角=(云台重新上电时的俯仰轴关节角与云台的俯仰轴关节角的偏移量的差值)*第一经验系数。When determining the pitch axis zero joint angle of the gimbal according to the offset of the pitch axis joint angle of the gimbal, optionally, in some embodiments, when the gimbal is re-powered on, the gimbal is obtained Pitch axis joint angle during power-up; determine the pitch axis zero joint angle of the gimbal according to the offset between the pitch axis joint angle when the gimbal is powered on again and the pitch axis joint angle of the gimbal. The method for determining the joint angle of the pitch axis when the gimbal is re-powered is the same as the method for determining the joint angle of the current pitch axis of the gimbal in S301, which will not be repeated here. Further optionally, the pitch axis zero joint angle of the gimbal is the difference between the pitch axis joint angle of the gimbal when the gimbal is powered on again and the pitch axis joint angle of the gimbal, that is, the pitch axis of the gimbal Zero joint angle = the pitch axis joint angle when the gimbal is powered on again-the difference between the offset of the pitch axis joint angle of the gimbal. It can be understood that the calculation method of the pitch axis zero joint angle of the gimbal is not limited to this, and other calculation methods can also be used, for example, the pitch axis zero joint angle of the gimbal = (the pitch axis joint when the gimbal is powered on again The difference between the angle and the offset of the pitch axis joint angle of the gimbal) * the first empirical coefficient.
在根据云台的横滚轴关节角的偏移量,确定云台的横滚轴零位关节角时,可选的,在云台重新上电时,获取云台重新上电时的横滚轴关节角;根据云台重新上电时的横滚轴关节角与云台的横滚轴关节角的偏移量,确定云台的横滚轴零位关节角。其中,云台重新上电时的横滚轴关节角的确定方式与S301中确定云台的当前横滚轴关节角的方式相同,此处不再赘述。进一步可选的,云台的横滚轴零位关节角为云台重新上电时的横滚轴关节角与云台的横滚轴关节角的偏移量的差值,也即,云台的横滚轴零位关节角=云台重新上电时的横滚轴关节角-云台的横滚轴关节角的偏移量。可以理解,云台的横滚轴零位关节角的计算方式并不限于此,还可以为其他计算方式,例如, 云台的横滚轴零位关节角=(云台重新上电时的横滚轴关节角-云台的横滚轴关节角的偏移量)*第二经验系数。When determining the gimbal's roll axis zero joint angle according to the offset of the gimbal's roll axis joint angle, optionally, when the gimbal is re-powered on, the roll when the gimbal is re-powered Axis joint angle: Determine the roll axis zero joint angle of the gimbal according to the offset between the roll axis joint angle of the gimbal when the gimbal is re-powered on and the roll axis joint angle of the gimbal. The method of determining the joint angle of the roll axis when the pan/tilt is re-powered is the same as the method of determining the joint angle of the current roll axis of the pan/tilt in S301, which will not be repeated here. Further optionally, the zero joint angle of the roll axis of the gimbal is the difference between the joint angle of the roll axis when the gimbal is re-powered and the offset of the joint angle of the roll axis of the gimbal, that is, the gimbal The zero joint angle of the roll axis = the joint angle of the roll axis when the gimbal is powered on again-the offset of the joint angle of the roll axis of the gimbal. It can be understood that the calculation method of the zero joint angle of the roll axis of the gimbal is not limited to this, and other calculation methods can also be used. For example, the zero joint angle of the roll axis of the gimbal = (the horizontal axis when the gimbal is re-powered). Roller joint angle-the offset of the roll shaft joint angle of the gimbal) * The second empirical coefficient.
本发明实施例的云台零位标定方法,利用云台上的加速度计5确定云台的俯仰轴关节角和/或横滚轴关节角的偏移量,再根据偏移量标定对应轴的零位关节角,即利用加速度计5检测的大地重力方向估计出云台的俯仰轴关节角和/或横滚轴关节角的偏移量,补偿对应轴的关节角的偏差,采用这种方式估算的偏移量精度较高,从而提高了关节角零位标定的精度,防止了云台横滚轴出现歪斜的情况,同时也解决了云台零位标定过分依赖治具结构精度的问题。In the method for calibrating the zero position of the gimbal in the embodiment of the present invention, the accelerometer 5 on the gimbal is used to determine the offset of the pitch axis joint angle and/or the roll axis joint angle of the gimbal, and then calibrate the corresponding axis according to the offset Zero joint angle, that is, estimate the offset of the pitch axis joint angle and/or roll axis joint angle of the gimbal using the direction of gravity detected by the accelerometer 5, and compensate for the deviation of the joint angle of the corresponding axis. This method is adopted The estimated offset has a high accuracy, which improves the accuracy of the joint angle zero calibration, prevents the tilt of the pan/tilt roll axis, and also solves the problem that the gimbal zero calibration depends excessively on the accuracy of the fixture structure.
对应于上述实施例的云台零位标定方法,结合图1及图5,本发明实施例还提供一种云台,所述云台可包括俯仰轴组件1、横滚轴组件2、加速度计5以及处理器7。其中,俯仰轴组件1用于搭载负载,并能够绕俯仰轴转动;横滚轴组件2能够绕横滚轴转动,带动所述俯仰轴组件1和所述负载绕横滚轴转动;加速度计5用于检测所述负载的姿态;处理器7与所述俯仰轴组件1、所述横滚轴组件2以及所述加速度计5分别电连接,本实施例的处理器7与俯仰轴电机12、横滚轴电机22电连接。Corresponding to the gimbal zero calibration method of the above-mentioned embodiment, in conjunction with FIG. 1 and FIG. 5, an embodiment of the present invention also provides a gimbal. The gimbal may include a pitch axis assembly 1, a roll axis assembly 2, an accelerometer 5 and processor 7. Among them, the pitch axis assembly 1 is used to carry a load and can rotate around the pitch axis; the roll axis assembly 2 can rotate around the roll axis to drive the pitch axis assembly 1 and the load to rotate around the roll axis; accelerometer 5 Used to detect the posture of the load; the processor 7 is electrically connected to the pitch axis assembly 1, the roll axis assembly 2 and the accelerometer 5, respectively. The processor 7 of this embodiment is electrically connected to the pitch axis motor 12, The roll axis motor 22 is electrically connected.
具体的,处理器7用于执行如下操:在所述云台处于特定状态时,基于所述加速度计5获取所述云台的当前姿态;根据所述云台的当前姿态,确定所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量;根据所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定所述云台的俯仰轴零位关节角和/或横滚轴零位关节角。Specifically, the processor 7 is configured to perform the following operations: when the pan/tilt is in a specific state, obtain the current attitude of the pan/tilt based on the accelerometer 5; determine the cloud/tilt based on the current attitude of the pan/tilt The offset of the pitch axis joint angle and/or the roll axis joint angle of the platform; determine the pitch axis of the platform according to the offset of the pitch axis joint angle and/or the roll axis joint angle of the platform Zero joint angle and/or roll axis zero joint angle.
本发明实施例的处理器7可以实现如本发明图1、图4所示实施例的云台零位标定方法,具体可参见上述实施例的云台零位标定方法的相应部分,此处不再赘述。The processor 7 of the embodiment of the present invention can implement the zero calibration method of the pan/tilt head as shown in the embodiments shown in Figs. Repeat it again.
本实施例的处理器7可包括一个或多个,一个或多个处理器7单独地或共同地被配置成用于实现如本发明图1、图4所示实施例的云台零位标定方法。The processor 7 in this embodiment may include one or more, and one or more processors 7 are individually or collectively configured to implement the zero calibration of the pan/tilt head as shown in the embodiments shown in FIGS. 1 and 4 of the present invention. method.
应当理解,本发明实施例中,处理器7可以是中央处理器(central processing unit,CPU)。该处理器7还可以是其它通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(application-specific integrated circuit,ASIC)、现场可编程逻辑门阵列(field-programmable gate array,FPGA)或者其它可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器7也可以是任何常规的处理器等。It should be understood that in the embodiment of the present invention, the processor 7 may be a central processing unit (CPU). The processor 7 may also be other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), application-specific integrated circuit (ASIC), field-programmable gate array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. The general-purpose processor may be a microprocessor or the processor 7 may also be any conventional processor or the like.
进一步的,云台还包括偏航轴组件3,该偏航轴组件3与处理器7电连接,本实施例的偏航轴电机与处理器7电连接。Furthermore, the pan/tilt head further includes a yaw axis assembly 3 which is electrically connected to the processor 7, and the yaw axis motor of this embodiment is electrically connected to the processor 7.
此外,本发明实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现本发明图1所对应实施例中描述的云台零位标定方法,在此不再赘述。In addition, an embodiment of the present invention also provides a computer-readable storage medium on which a computer program is stored. When the program is executed by a processor, the pan/tilt zero calibration method described in the embodiment corresponding to FIG. 1 of the present invention is implemented. This will not be repeated here.
所述计算机可读存储介质可以是前述任一实施例所述的云台的内部存储单元,例如硬盘或内存。所述计算机可读存储介质也可以是云台的外部存储设备,例如所述设备上配备的插接式硬盘、智能存储卡(Smart Media Card,SMC)、SD卡、闪存卡(Flash Card)等。进一步的,所述计算机可读存储介质还可以既包括云台的内部存储单元也包括外部存储设备。所述计算机可读存储介质用于存储所述计算机程序以及所述云台所需的其他程序和数据,还可以用于暂时地存储已经输出或者将要输出的数据。The computer-readable storage medium may be the internal storage unit of the pan/tilt head described in any of the foregoing embodiments, such as a hard disk or a memory. The computer-readable storage medium may also be an external storage device of the pan-tilt, such as a plug-in hard disk, a smart media card (SMC), an SD card, a flash card (Flash Card), etc. equipped on the device . Further, the computer-readable storage medium may also include both an internal storage unit of the pan-tilt 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 pan/tilt, 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)等。A person of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiments can be implemented by instructing relevant hardware through a computer program. The program can be stored in a computer readable storage medium. During execution, it may include the procedures of the above-mentioned method embodiments. Wherein, the storage medium may be a magnetic disk, an optical disc, a read-only memory (Read-Only Memory, ROM), or a random access memory (Random Access Memory, RAM), etc.
以上所揭露的仅为本发明部分实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。The above-disclosed are only some embodiments of the present invention, which of course cannot be used to limit the scope of rights of the present invention. Therefore, equivalent changes made according to the claims of the present invention still fall within the scope of the present invention.

Claims (31)

  1. 一种云台零位标定方法,所述云台包括加速度计,用于检测搭载在所述云台上的负载的姿态;其特征在于,所述方法包括:A method for calibrating the zero position of a gimbal, the gimbal includes an accelerometer for detecting the posture of a load carried on the gimbal; the method is characterized in that the method includes:
    在所述云台处于特定状态时,基于所述加速度计获取所述云台的当前姿态;When the pan/tilt is in a specific state, acquiring the current posture of the pan/tilt based on the accelerometer;
    根据所述云台的当前姿态,确定所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量;Determining the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt according to the current posture of the gimbal;
    根据所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定所述云台的俯仰轴零位关节角和/或横滚轴零位关节角。According to the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt, the pitch axis zero joint angle and/or the roll axis zero joint angle of the pan/tilt head are determined.
  2. 根据权利要求1所述的方法,其特征在于,所述根据所述云台的当前姿态,确定所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,包括:The method according to claim 1, wherein the determining the pitch axis joint angle and/or the offset of the roll axis joint angle of the pan/tilt based on the current posture of the pan/tilt includes:
    根据所述云台的当前姿态,确定所述云台的当前俯仰轴关节角和/或当横滚轴关节角;Determine the current pitch axis joint angle and/or current roll axis joint angle of the pan/tilt according to the current posture of the gimbal;
    确定所述当前俯仰轴关节角与第一预设阈值的第一偏移量和/或所述当前横滚轴关节角与第二预设阈值的第二偏移量;Determining a first offset between the current pitch axis joint angle and a first preset threshold and/or a second offset between the current roll axis joint angle and a second preset threshold;
    若所述第一偏移量满足预设的零位偏差条件,则根据所述第一偏移量,确定所述云台的俯仰轴关节角的偏移量,和/或,若所述第二偏移量满足预设的零位偏差条件,则根据所述第二偏移量,确定所述云台的横滚轴关节角的偏移量。If the first offset satisfies the preset zero deviation condition, determine the offset of the pitch axis joint angle of the pan/tilt according to the first offset, and/or if the first offset If the second offset satisfies the preset zero deviation condition, the offset of the joint angle of the roll axis of the pan/tilt head is determined according to the second offset.
  3. 根据权利要求2所述的方法,其特征在于,若所述云台为第一次零位标定,则所述第一预设阈值、所述第二预设阈值均为0。The method according to claim 2, wherein if the pan-tilt is the first zero calibration, the first preset threshold and the second preset threshold are both zero.
  4. 根据权利要求2所述的方法,其特征在于,若所述云台非第一次零位标定,则所述第一预设阈值为所述云台最近一次进行零位标定所确定的云台的俯仰轴零位关节角,所述第二预设阈值为所述云台最近一次进行零位标定所确定的云台的横滚轴零位关节角。The method according to claim 2, wherein if the pan/tilt is not the first zero calibration, the first preset threshold is the pan/tilt determined by the most recent zero calibration of the pan/tilt The second preset threshold is the zero joint angle of the roll axis of the pan/tilt which is determined by the last zero calibration of the pan/tilt.
  5. 根据权利要求2所述的方法,其特征在于,所述第一偏移量满足预设的零位偏差条件,包括:所述第一偏移量的绝对值大于预设的第一偏移阈值。The method according to claim 2, wherein the first offset satisfies a preset zero deviation condition, comprising: the absolute value of the first offset is greater than a preset first offset threshold .
  6. 根据权利要求2所述的方法,其特征在于,所述第二偏移量满足预设的零位偏差条件,包括:所述第二偏移量的绝对值大于预设的第二偏移阈值。The method according to claim 2, wherein the second offset satisfies a preset zero deviation condition, comprising: the absolute value of the second offset is greater than a preset second offset threshold .
  7. 根据权利要求2所述的方法,其特征在于,所述根据所述第一偏移量,确定所述云台的俯仰轴关节角的偏移量,包括:The method according to claim 2, wherein the determining the offset of the pitch axis joint angle of the pan/tilt according to the first offset comprises:
    将所述第一偏移量设定为所述云台的俯仰轴关节角的偏移量;和/或Setting the first offset as the offset of the pitch axis joint angle of the pan/tilt; and/or
    所述根据所述第二偏移量,确定所述云台的横滚轴关节角的偏移量,包括:The determining the offset of the roll axis joint angle of the pan/tilt according to the second offset includes:
    将所述第二偏移量设定为所述云台的横滚轴关节角的偏移量。The second offset is set as the offset of the joint angle of the roll axis of the pan/tilt.
  8. 根据权利要求2所述的方法,其特征在于,所述根据所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定所述云台的俯仰轴零位关节角和/或横滚轴零位关节角,包括:The method according to claim 2, wherein the pitch axis zero joint angle of the pan/tilt head is determined according to the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt head And/or roll axis zero joint angle, including:
    在所述云台重新上电时,获取所述云台重新上电时的俯仰轴关节角和/或横滚轴关 节角;When the pan/tilt head is powered on again, acquiring the pitch axis joint angle and/or roll axis joint angle when the pan/tilt head is powered on again;
    根据所述云台重新上电时的俯仰轴关节角与所述云台的俯仰轴关节角的偏移量,确定所述云台的俯仰轴零位关节角;和/或Determine the pitch axis zero joint angle of the gimbal according to the offset between the pitch axis joint angle of the gimbal when the gimbal is powered on again and the pitch axis joint angle of the gimbal; and/or
    根据所述云台重新上电时的横滚轴关节角与所述云台的横滚轴关节角的偏移量,确定所述云台的横滚轴零位关节角。The zero joint angle of the roll axis of the pan/tilt head is determined according to the offset between the joint angle of the roll axis of the pan/tilt head when the pan/tilt is re-powered on and the joint angle of the roll axis of the pan/tilt head.
  9. 根据权利要求8所述的方法,其特征在于,所述云台的俯仰轴零位关节角为所述云台重新上电时的俯仰轴关节角与所述云台的俯仰轴关节角的偏移量的差值。The method according to claim 8, wherein the pitch axis zero joint angle of the gimbal is the deviation of the pitch axis joint angle of the gimbal when the gimbal is re-powered on and the pitch axis joint angle of the gimbal. The difference in the amount of movement.
  10. 根据权利要求8所述的方法,其特征在于,所述云台的横滚轴零位关节角为所述云台重新上电时的横滚轴关节角与所述云台的横滚轴关节角的偏移量的差值。The method of claim 8, wherein the zero joint angle of the roll axis of the pan/tilt is the joint angle of the roll axis when the pan/tilt is re-powered on and the joint angle of the roll axis of the pan/tilt. The difference of the angular offset.
  11. 根据权利要求1所述的方法,其特征在于,所述特定状态包括:The method according to claim 1, wherein the specific state comprises:
    所述云台放置在水平面上,且所述云台处于姿态回中模式。The pan-tilt is placed on a horizontal surface, and the pan-tilt is in a posture centering mode.
  12. 根据权利要求11所述的方法,其特征在于,所述特定状态进一步包括:The method according to claim 11, wherein the specific state further comprises:
    所述云台处于静止状态。The pan-tilt is in a static state.
  13. 根据权利要求1所述的方法,其特征在于,所述云台处于特定状态之后,基于所述加速度计获取所述云台的当前姿态之前,所述方法还包括:The method according to claim 1, wherein after the pan/tilt is in a specific state, before acquiring the current posture of the pan/tilt based on the accelerometer, the method further comprises:
    检测到零位标定触发信号。The zero calibration trigger signal is detected.
  14. 根据权利要求13所述的方法,其特征在于,所述零位标定触发信号由外部设备发送,或者,所述零位标定触发信号由所述云台的按键被触发而产生。The method according to claim 13, wherein the zero calibration trigger signal is sent by an external device, or the zero calibration trigger signal is generated by triggering a button of the pan/tilt head.
  15. 根据权利要求1所述的方法,其特征在于,所述当前姿态为所述负载的实时姿态,所述基于所述加速度计获取所述云台的当前姿态,包括:The method according to claim 1, wherein the current posture is a real-time posture of the load, and the acquiring the current posture of the pan/tilt based on the accelerometer comprises:
    基于所述加速计,获得所述云台在俯仰轴和横滚轴上的实时重力加速度分量;Based on the accelerometer, obtaining real-time gravitational acceleration components of the gimbal on the pitch axis and the roll axis;
    根据所述重力加速度分量,确定对应轴的当前姿态角。According to the gravitational acceleration component, the current attitude angle of the corresponding axis is determined.
  16. 一种云台,其特征在于,所述云台包括:A pan-tilt, characterized in that the pan-tilt includes:
    俯仰轴组件,用于搭载负载,并能够绕俯仰轴转动;The pitch axis assembly is used to carry loads and can rotate around the pitch axis;
    横滚轴组件,能够绕横滚轴转动,带动所述俯仰轴组件和所述负载绕横滚轴转动;The roll axis assembly is capable of rotating around the roll axis to drive the pitch axis assembly and the load to rotate around the roll axis;
    加速度计,用于检测所述负载的姿态;以及An accelerometer for detecting the posture of the load; and
    处理器,与所述俯仰轴组件、所述横滚轴组件以及所述加速度计分别电连接,其中,所述处理器用于执行如下操:The processor is electrically connected to the pitch axis assembly, the roll axis assembly, and the accelerometer, respectively, wherein the processor is configured to perform the following operations:
    在所述云台处于特定状态时,基于所述加速度计获取所述云台的当前姿态;When the pan/tilt is in a specific state, acquiring the current posture of the pan/tilt based on the accelerometer;
    根据所述云台的当前姿态,确定所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量;Determining the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt according to the current posture of the gimbal;
    根据所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定所述云台的俯仰轴零位关节角和/或横滚轴零位关节角。According to the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt head, the pitch axis zero joint angle and/or the roll axis zero joint angle of the pan/tilt head are determined.
  17. 根据权利要求16所述的云台,其特征在于,所述处理器在根据所述云台的当前姿态,确定所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量时,具体用于:The pan/tilt head according to claim 16, wherein the processor determines the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt head according to the current attitude of the pan/tilt head When, specifically used for:
    根据所述云台的当前姿态,确定所述云台的当前俯仰轴关节角和/或当横滚轴关节 角;Determine the current pitch axis joint angle and/or current roll axis joint angle of the pan/tilt according to the current posture of the gimbal;
    确定所述当前俯仰轴关节角与第一预设阈值的第一偏移量和/或所述当前横滚轴关节角与第二预设阈值的第二偏移量;Determining a first offset between the current pitch axis joint angle and a first preset threshold and/or a second offset between the current roll axis joint angle and a second preset threshold;
    若所述第一偏移量满足预设的零位偏差条件,则根据所述第一偏移量,确定所述云台的俯仰轴关节角的偏移量,和/或,若所述第二偏移量满足预设的零位偏差条件,则根据所述第二偏移量,确定所述云台的横滚轴关节角的偏移量。If the first offset satisfies the preset zero deviation condition, determine the offset of the pitch axis joint angle of the pan/tilt according to the first offset, and/or if the first offset If the second offset satisfies the preset zero deviation condition, the offset of the joint angle of the roll axis of the pan/tilt head is determined according to the second offset.
  18. 根据权利要求17所述的云台,其特征在于,若所述云台为第一次零位标定,则所述第一预设阈值、所述第二预设阈值均为0。The pan/tilt head according to claim 17, wherein if the pan/tilt head is the first zero calibration, the first preset threshold and the second preset threshold are both zero.
  19. 根据权利要求17所述的云台,其特征在于,若所述云台非第一次零位标定,则所述第一预设阈值为所述云台最近一次进行零位标定所确定的云台的俯仰轴零位关节角,所述第二预设阈值为所述云台最近一次进行零位标定所确定的云台的横滚轴零位关节角。The pan/tilt head according to claim 17, wherein if the pan/tilt head is not zero-calibrated for the first time, the first preset threshold is the cloud determined by the most recent zero-calibration of the pan/tilt. The zero joint angle of the pitch axis of the platform, and the second preset threshold is the zero joint angle of the roll axis of the platform determined by the latest zero calibration of the platform.
  20. 根据权利要求17所述的云台,其特征在于,所述第一偏移量满足预设的零位偏差条件,包括:所述第一偏移量的绝对值大于预设的第一偏移阈值。The pan/tilt head according to claim 17, wherein the first offset satisfies a preset zero deviation condition, comprising: the absolute value of the first offset is greater than the preset first offset Threshold.
  21. 根据权利要求17所述的云台,其特征在于,所述第二偏移量满足预设的零位偏差条件,包括:所述第二偏移量的绝对值大于预设的第二偏移阈值。The pan/tilt head according to claim 17, wherein the second offset satisfies a preset zero deviation condition, comprising: the absolute value of the second offset is greater than the preset second offset Threshold.
  22. 根据权利要求17所述的云台,其特征在于,所述处理器在根据所述第一偏移量,确定所述云台的俯仰轴关节角的偏移量时,具体用于:The pan/tilt head according to claim 17, wherein the processor is specifically configured to: when determining the offset amount of the joint angle of the pitch axis of the pan/tilt head according to the first offset amount:
    将所述第一偏移量设定为所述云台的俯仰轴关节角的偏移量;和/或Setting the first offset as the offset of the pitch axis joint angle of the pan/tilt; and/or
    所述处理器在根据所述第二偏移量,确定所述云台的横滚轴关节角的偏移量时,具体用于:When the processor determines the offset of the joint angle of the roll axis of the pan/tilt according to the second offset, it is specifically configured to:
    将所述第二偏移量设定为所述云台的横滚轴关节角的偏移量。The second offset is set as the offset of the joint angle of the roll axis of the pan/tilt.
  23. 根据权利要求17所述的云台,其特征在于,所述处理器在根据所述云台的俯仰轴关节角和/或横滚轴关节角的偏移量,确定所述云台的俯仰轴零位关节角和/或横滚轴零位关节角时,具体用于:The pan/tilt head according to claim 17, wherein the processor determines the pitch axis of the pan/tilt head according to the offset of the pitch axis joint angle and/or the roll axis joint angle of the pan/tilt head. When the zero joint angle and/or roll axis zero joint angle, it is specifically used for:
    在所述云台重新上电时,获取所述云台重新上电时的俯仰轴关节角和/或横滚轴关节角;When the pan/tilt head is powered on again, acquiring the pitch axis joint angle and/or roll axis joint angle when the pan/tilt head is powered on again;
    根据所述云台重新上电时的俯仰轴关节角与所述云台的俯仰轴关节角的偏移量,确定所述云台的俯仰轴零位关节角;和/或Determine the pitch axis zero joint angle of the gimbal according to the offset between the pitch axis joint angle of the gimbal when the gimbal is powered on again and the pitch axis joint angle of the gimbal; and/or
    根据所述云台重新上电时的横滚轴关节角与所述云台的横滚轴关节角的偏移量,确定所述云台的横滚轴零位关节角。The zero joint angle of the roll axis of the pan/tilt head is determined according to the offset between the joint angle of the roll axis of the pan/tilt head when the pan/tilt is re-powered on and the joint angle of the roll axis of the pan/tilt head.
  24. 根据权利要求23所述的云台,其特征在于,所述云台的俯仰轴零位关节角为所述云台重新上电时的俯仰轴关节角与所述云台的俯仰轴关节角的偏移量的差值。The gimbal according to claim 23, wherein the pitch axis zero joint angle of the gimbal is the joint angle of the pitch axis when the gimbal is re-powered on and the joint angle of the pitch axis of the gimbal. The difference of the offset.
  25. 根据权利要求23所述的云台,其特征在于,所述云台的横滚轴零位关节角为所述云台重新上电时的横滚轴关节角与所述云台的横滚轴关节角的偏移量的差值。The pan/tilt head according to claim 23, wherein the zero joint angle of the roll axis of the pan/tilt head is the joint angle of the roll axis when the pan/tilt is re-powered and the roll axis of the pan/tilt head. The difference of the offset of the joint angle.
  26. 根据权利要求16所述的云台,其特征在于,所述特定状态包括:The pan/tilt head according to claim 16, wherein the specific status comprises:
    所述云台放置在水平面上,且所述云台处于姿态回中模式。The pan-tilt is placed on a horizontal surface, and the pan-tilt is in a posture centering mode.
  27. 根据权利要求26所述的云台,其特征在于,所述特定状态进一步包括:The pan/tilt head of claim 26, wherein the specific status further comprises:
    所述云台处于静止状态。The pan-tilt is in a static state.
  28. 根据权利要求16所述的云台,其特征在于,所述处理器在云台处于特定状态之后,基于所述加速度计获取所述云台的当前姿态之前,还用于:The pan/tilt head of claim 16, wherein the processor is further configured to: after the pan/tilt head is in a specific state, before acquiring the current attitude of the pan/tilt head based on the accelerometer:
    检测到零位标定触发信号。The zero calibration trigger signal is detected.
  29. 根据权利要求28所述的云台,其特征在于,所述零位标定触发信号由外部设备发送,或者,所述零位标定触发信号由所述云台的按键被触发而产生。The pan/tilt head according to claim 28, wherein the zero calibration trigger signal is sent by an external device, or the zero calibration trigger signal is generated by triggering a key of the pan/tilt head.
  30. 根据权利要求16所述的云台,其特征在于,所述当前姿态为所述负载的实时姿态,所述处理器在基于所述加速度计获取所述云台的当前姿态时,具体用于:The pan/tilt head according to claim 16, wherein the current attitude is a real-time attitude of the load, and the processor is specifically configured to: when acquiring the current attitude of the pan/tilt head based on the accelerometer:
    基于所述加速计,获得所述云台在俯仰轴和横滚轴上的实时重力加速度分量;Based on the accelerometer, obtain the real-time gravitational acceleration components of the gimbal on the pitch axis and the roll axis;
    根据所述重力加速度分量,确定对应轴的当前姿态角。According to the gravitational acceleration component, the current attitude angle of the corresponding axis is determined.
  31. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1至15任一项所述的云台零位标定方法的步骤。A computer-readable storage medium having a computer program stored thereon, wherein the program is executed by a processor to implement the steps of the pan/tilt zero calibration method according to any one of claims 1 to 15.
PCT/CN2019/088731 2019-05-28 2019-05-28 Zero calibration method for gimbal and gimbal WO2020237493A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201980009600.5A CN111684386A (en) 2019-05-28 2019-05-28 Cradle head zero calibration method and cradle head
PCT/CN2019/088731 WO2020237493A1 (en) 2019-05-28 2019-05-28 Zero calibration method for gimbal and gimbal

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/088731 WO2020237493A1 (en) 2019-05-28 2019-05-28 Zero calibration method for gimbal and gimbal

Publications (1)

Publication Number Publication Date
WO2020237493A1 true WO2020237493A1 (en) 2020-12-03

Family

ID=72433303

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/088731 WO2020237493A1 (en) 2019-05-28 2019-05-28 Zero calibration method for gimbal and gimbal

Country Status (2)

Country Link
CN (1) CN111684386A (en)
WO (1) WO2020237493A1 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112923894B (en) * 2021-01-21 2022-11-29 西安因诺航空科技有限公司 Mechanical angle automatic calibration method applied to holder
CN114962958B (en) * 2021-02-26 2024-04-09 智神信息(深圳)有限公司 Handheld cradle head
WO2023035106A1 (en) * 2021-09-07 2023-03-16 深圳市大疆创新科技有限公司 Gimbal leveling method, gimbal control apparatus, gimbal and storage medium
CN114485727A (en) * 2022-01-04 2022-05-13 中国煤炭科工集团太原研究院有限公司 Precision self-detection method and device for strapdown inertial navigation system

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103659806A (en) * 2012-09-06 2014-03-26 沈阳新松机器人自动化股份有限公司 Industrial robot zero position defining method
JP5569681B2 (en) * 2010-04-23 2014-08-13 国立大学法人 東京大学 POSITION ESTIMATION DEVICE AND POSITION ESTIMATION METHOD OF MOBILE BODY USING INDUCTION SENSOR, MAGNETIC SENSOR AND SPEED METER
CN107463187A (en) * 2017-09-21 2017-12-12 桂林师范高等专科学校 Head stability augmentation system
CN108513651A (en) * 2017-06-27 2018-09-07 深圳市大疆灵眸科技有限公司 Hand-held cradle head device and its control method and computer readable storage medium
CN108778932A (en) * 2017-12-29 2018-11-09 深圳市大疆创新科技有限公司 The method and apparatus of control holder reset, holder, unmanned vehicle
US10132932B1 (en) * 2015-06-25 2018-11-20 Horizon Hobby, LLC Geo-fencing systems and methods for aerial vehicles
CN108873946A (en) * 2018-06-04 2018-11-23 浙江大华技术股份有限公司 A kind of positioning mechanism of holder, localization method, positioning system and video camera

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2843903B2 (en) * 1996-03-04 1999-01-06 防衛庁技術研究本部長 Inertial navigation device
CN104469292B (en) * 2014-11-27 2017-09-19 国网上海市电力公司 A kind of posture self-correcting monopod video camera control device and its method
CN106569512A (en) * 2016-11-04 2017-04-19 极翼机器人(上海)有限公司 Holder calibration method
CN108496137B (en) * 2017-04-21 2022-05-31 深圳市大疆灵眸科技有限公司 Remote controller, holder and holder control method, device and system
CN109074103B (en) * 2017-12-23 2021-12-24 深圳市大疆创新科技有限公司 Cloud deck calibration method and cloud deck equipment

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5569681B2 (en) * 2010-04-23 2014-08-13 国立大学法人 東京大学 POSITION ESTIMATION DEVICE AND POSITION ESTIMATION METHOD OF MOBILE BODY USING INDUCTION SENSOR, MAGNETIC SENSOR AND SPEED METER
CN103659806A (en) * 2012-09-06 2014-03-26 沈阳新松机器人自动化股份有限公司 Industrial robot zero position defining method
US10132932B1 (en) * 2015-06-25 2018-11-20 Horizon Hobby, LLC Geo-fencing systems and methods for aerial vehicles
CN108513651A (en) * 2017-06-27 2018-09-07 深圳市大疆灵眸科技有限公司 Hand-held cradle head device and its control method and computer readable storage medium
CN107463187A (en) * 2017-09-21 2017-12-12 桂林师范高等专科学校 Head stability augmentation system
CN108778932A (en) * 2017-12-29 2018-11-09 深圳市大疆创新科技有限公司 The method and apparatus of control holder reset, holder, unmanned vehicle
CN108873946A (en) * 2018-06-04 2018-11-23 浙江大华技术股份有限公司 A kind of positioning mechanism of holder, localization method, positioning system and video camera

Also Published As

Publication number Publication date
CN111684386A (en) 2020-09-18

Similar Documents

Publication Publication Date Title
WO2020237493A1 (en) Zero calibration method for gimbal and gimbal
US7593627B2 (en) Angle correction for camera
WO2018120059A1 (en) Control method and system for cradle head, cradle head, and unmanned aerial vehicle
WO2019227384A1 (en) Pan-tilt control method and pan-tilt
CN111279113B (en) Handheld holder control method and handheld holder
US20200332944A1 (en) Control method for non-orthogonal gimbal, gimbal thereof, and storage device
WO2020042152A1 (en) Control method for handheld gimbal, handheld gimbal, and image acquisition device
US11381745B2 (en) Drift correction with phase and amplitude compensation for optical image stabilization
WO2020107292A1 (en) Control method for gimbal, gimbal, mobile platform, and computer readable storage medium
WO2021081843A1 (en) Gimbal system calibration method and apparatus, and gimbal system and computer-readable medium
WO2020042064A1 (en) Cradle head control method and device, cradle head system and unmanned aerial vehicle
US20220163166A1 (en) Handheld gimbal, gimbal control method and computer-readable storage medium
WO2020019260A1 (en) Calibration method for magnetic sensor, control terminal and movable platform
JP6142060B1 (en) smartphone
WO2020042159A1 (en) Rotation control method and apparatus for gimbal, control device, and mobile platform
WO2019227410A1 (en) Attitude conversion method, attitude display method, and pan-tilt system
WO2021134644A1 (en) Gimbal control method and gimbal
WO2022205207A1 (en) Gimbal, and configuration recognition method and apparatus therefor
WO2019205152A1 (en) Cradle head control method and cradle head
WO2021016855A1 (en) Handheld gimbal control method and device, handheld gimbal, and storage medium
TWI556156B (en) Method of adjusting image display direction and related device thereof
WO2021134643A1 (en) Method for controlling cradle head and cradle head
WO2021016857A1 (en) Handheld gimbal control method and device, handheld gimbal and storage medium
US11703856B2 (en) Moving body, steering system, control method, and program
US9270884B2 (en) Imaging apparatus and detecting apparatus

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

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

Country of ref document: EP

Kind code of ref document: A1