CN110770671A - 云台及其控制方法、可移动平台 - Google Patents
云台及其控制方法、可移动平台 Download PDFInfo
- Publication number
- CN110770671A CN110770671A CN201880040630.8A CN201880040630A CN110770671A CN 110770671 A CN110770671 A CN 110770671A CN 201880040630 A CN201880040630 A CN 201880040630A CN 110770671 A CN110770671 A CN 110770671A
- Authority
- CN
- China
- Prior art keywords
- attitude
- holder
- joint angle
- manually
- real
- Prior art date
- Legal status (The legal status 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 status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 76
- 238000006243 chemical reaction Methods 0.000 claims abstract description 75
- 238000005259 measurement Methods 0.000 claims description 29
- 230000007704 transition Effects 0.000 claims description 8
- 238000013016 damping Methods 0.000 claims description 6
- 230000005611 electricity Effects 0.000 claims description 3
- 230000008569 process Effects 0.000 abstract description 15
- 230000000007 visual effect Effects 0.000 abstract description 3
- 238000001514 detection method Methods 0.000 description 14
- 230000008859 change Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 238000004590 computer program Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 210000003811 finger Anatomy 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 210000003813 thumb Anatomy 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- 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
- G05D3/20—Control of position or direction using feedback using a digital comparing device
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Studio Devices (AREA)
- Accessories Of Cameras (AREA)
Abstract
一种云台及其控制方法、可移动平台,方法包括:获取云台的工作参数,云台的工作参数包括云台的期望姿态(S201);若检测到工作参数与预设的人力掰动云台条件相匹配,则根据期望姿态和人力掰动云台时云台的实时姿态,确定云台的姿态转换速度(S202);按照人力掰动云台的方向和姿态转换速度,控制期望姿态为实时姿态(S203)。本方法在云台发生人力掰动时,可以按照人力掰动云台的方向以及根据期望姿态和人力掰动云台时云台的实时姿态所确定的姿态转换速度控制期望姿态趋向于实时姿态,使得云台停留在人力掰动云台时云台的实时姿态对应的位置,操作过程简单直观,定位精度高,且云台的姿态转换速度可实时调整,有利于避免云台运动至上述实时姿态时来回摆动的情况。
Description
技术领域
本发明涉及云台控制领域,尤其涉及一种云台及其控制方法、可移动平台。
背景技术
相关技术中,通常通过遥控器控制云台的运动,遥控器上设置有摇杆或者波轮,用户通过操控摇杆或者波轮,向云台发出运动指令,云台根据接收到的运动指令,驱动电机带动相应轴臂进行旋转、位移等。但是,由于用户操控摇杆或者波轮的力度不稳定,通常一次操作难以控制云台运动到期望姿态,可能需要反复操作进行调整,操作比较繁琐,定位精度也不够高。
发明内容
本发明提供一种云台及其控制方法、可移动平台。
具体地,本发明是通过如下技术方案实现的:
根据本发明的第一方面,提供一种云台控制方法,所述方法包括:
获取所述云台的工作参数,所述云台的工作参数包括所述云台的期望姿态;
若检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度;
按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态。
根据本发明的第二方面,提供一种云台,包括:惯性测量单元IMU以及处理器,所述处理器与所述惯性测量单元IMU分别电连接,所述处理器用于:
获取所述云台的工作参数,所述云台的工作参数包括所述云台的期望姿态;
若检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度;
按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态。
根据本发明的第三方面,提供一种可移动平台,包括:云台及处理器,所述云台包括惯性测量单元IMU,所述处理器与所述惯性测量单元IMU电连接,所述处理器用于:
获取所述云台的工作参数,所述云台的工作参数包括所述云台的期望姿态;
若检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度;
按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态。
由以上本发明实施例提供的技术方案可见,本发明实施例在检测到云台的工作参数与预设的人力掰动云台条件相匹配时,按照人力掰动云台的方向以及根据期望姿态和人力掰动云台时云台的实时姿态所确定的姿态转换速度控制期望姿态趋向于上述实时姿态使得云台停留在人力掰动云台时云台的实时姿态对应的位置,与现有通过遥控器控制云台期望姿态的方式相比,操作过程简单直观,定位精度高;并且,根据期望姿态和人力掰动云台时云台的实时姿态所确定的姿态转换速度控制期望姿态趋向于实时姿态的方式,能够让云台更加顺畅地跟随人力掰动云台时云台的运动而运动,且云台的姿态转换速度可进行实时调整,有利于避免云台运动至上述实时姿态时来回摆动的情况,用户体验更佳。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是一种三轴云台的工作原理示意图;
图2是本发明一实施例中的云台控制方法的方法流程图;
图3是本发明一实施例中的云台控制方法一具体的方法流程图;
图4A是本发明一实施例中的云台控制方法第一实现方式的方法流程图;
图4B是本发明一实施例中的云台控制方法第一实现方式的另一方法流程图;
图5A是本发明一实施例中的云台控制方法第二实现方式的方法流程图;
图5B是本发明一实施例中的云台控制方法第二实现方式的另一方法流程图;
图6A是本发明一实施例中的云台控制方法第三实现方式的方法流程图;
图6B是本发明一实施例中的云台控制方法第三实现方式的另一方法流程图;
图7是本发明一实施例中的云台控制方法另一具体的方法流程图;
图8是本发明一实施例中的云台一具体的结构框图;
图9是本发明一实施例中的可移动平台的结构框图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
下面结合附图,对本发明的云台及其控制方法、可移动平台进行详细说明。在不冲突的情况下,下述的实施例及实施方式中的特征可以相互组合。
本发明实施例中的云台可以是手持云台,也可以是由可移动平台携带的云台。可移动平台可以包括诸如无人机、无人车、无人船等。上述云台通常包括轴臂和电机,电机用于驱动轴臂转动。电机可包括以下至少一种:偏航轴电机、俯仰轴电机和横滚轴电机,轴臂对应包括偏航轴轴臂、俯仰轴轴臂和横滚轴轴臂中的至少一种。以常见的三轴云台为例,三轴云台包括三个轴臂,以及分别驱动三个轴臂转动的电机,其中,三个轴臂分别为俯仰轴轴臂,横滚轴轴臂,以及偏航轴轴臂。
在控制上述云台改变期望姿态时,可以带动搭载于云台上的负载,如摄像设备、射击装置、探测装置等。例如,云台带动照相机或者摄像机在一个或者多个方向上运动,从而实现大范围拍摄。现有技术中,使用者通过遥控设备,例如遥控器摇杆或者波轮等,控制云台改变期望姿态,其操作过程比较繁琐,定位精度不够高。因此本发明实施例中,提供使用者通过人力掰动云台的方式,从而使云台可以快速准确地运动到期望姿态。
下面结合附图对本发明实施例进行详细说明。
实施例一
参见图1,为一种三轴云台的工作原理示意图。图1所示的一种三轴云台包括:处理器,三轴电机,三轴轴臂,IMU(Inertial Measurement Unit,惯性测量单元),以及积分器。上述三轴云台可以通过组成IMU的陀螺仪作为反馈元件,三轴电机作为输出元件,形成闭环PI(比例、积分)控制***。
一般来说,通过IMU获得云台的测量姿态(即实时姿态),测量姿态与期望姿态之间的偏移量作为控制偏差,处理器根据输入的控制偏差,控制三轴电机的输入电流大小,从而驱动三轴电机工作,三轴电机工作过程中输出扭矩带动三轴轴臂转动,在转动过程中云台的测量姿态进一步发生变化,通过上述反馈控制过程,使得云台运动到期望姿态。也即,云台可以周期性循环检测,并能够使得当前的测量姿态为期望姿态。其中,期望姿态可以由用户输入或预先设置。
本发明实施例中,由于人力掰动的原因,希望借助于人力掰动时的便利性,使得云台可以由用户推哪停哪,即测量姿态先于期望姿态。由此,与上述内容相反的是,本发明实施例是通过测量姿态与期望姿态之间的偏移量使得当前的期望姿态为人力掰动云台时的测量姿态。也即,本发明实施例中,是将测量姿态作为当前控制云台转动的期望姿态,而将云台的期望姿态(即人力掰动云台前,上一次闭环时的期望姿态)作为当前控制云台转动的测量姿态。其中,在控制期望姿态为实时姿态的过程中,其姿态转换速度可以与控制偏差相匹配,如,姿态转换速度与控制偏差可以为正相关。
图2是本发明一实施例中的云台控制方法的方法流程图。参见图2,本实施例的云台控制方法包括但不限于如下步骤:
步骤S201:获取云台的工作参数,云台的工作参数包括云台的期望姿态;
结合图1所示,本发明实施例中云台的工作参数还可以包括:电机的期望扭矩,或者云台的关节角误差。上述关节角误差和期望扭矩二个参数之间通常呈正相关关系。
本实施例中,电机的期望扭矩由期望姿态和实时姿态(人力掰动云台时云台的实时姿态)确定。具体的,电机的期望扭矩为云台由上述实时姿态运动至期望姿态电机所需输出的扭矩大小。
而云台的关节角误差也由期望姿态和实时姿态确定。具体的,关节角误差为期望姿态对应的关节角与实时姿态对应的关节角的差值,其中,实时姿态由云台上的惯性测量单元IMU检测获得。可以理解,在由姿态确定关节角时,若存在多解的情况,应确定一个唯一解为该姿态对应的关节角。
可以理解,云台可以为单轴、二轴或三轴云台。以云台为三轴云台为例,云台可以绕俯仰轴、横滚轴、偏航轴旋转,其姿态可以对应俯仰轴、横滚轴、偏航轴。如此,在计算关节角误差时,可以计算期望姿态与实时姿态中对应每一个轴的关节角误差,以确定云台中各轴对应的轴臂是否发生人力推动,再对各轴对应的轴臂进行相应的控制。
在本实施例中,期望姿态为云台人力掰动前的姿态,即若云台在人力掰动前为初始启动状态,则期望姿态为云台的初始姿态,若云台在人力掰动前已启动且进行转动,则期望姿态为上一次闭环时的期望姿态,也即上一次闭环结束后的实时姿态。可以理解,期望姿态可以发生变化。
步骤S202:若检测到工作参数与预设的人力掰动云台条件相匹配,则根据期望姿态和人力掰动云台时云台的实时姿态,确定云台的姿态转换速度;
需要说明的是,本发明实施例中,人力掰动云台时,云台的轴臂在人力掰动作用下已经到达人力掰动的位置,为避免云台回弹,故需要将期望姿态转换成实时姿态,姿态转换速度即为云台由期望姿态转换成实时姿态的转换梯度大小,实际上云台的轴臂不会再转动,实现了云台可以由用户推哪停哪的效果。
通常人力掰动云台与通过遥控器控制云台相比,检测到的工作参数的参数值会有较大差异,因此可以将工作参数作为判断人力掰动云台的依据。
首先,在人力掰动云台时,云台的工作参数通常大于通过遥控器控制云台时的工作参数;其次,在人力误触云台时,云台的工作参数通常也会大于通过遥控器控制云台时的工作参数,但人力误触云台与人力掰动云台的区别在于,检测到的前者的参数值的持续时间要小于后者。基于上述分析,根据工作参数的类型不同,可以分别采用如下可选的实现方式检测是否由人力掰动云台。
在第一实现方式中,参见图4A,步骤S201中的工作参数还包括期望扭矩,本实施例可检测期望扭矩的绝对值是否大于或者等于扭矩阈值,若期望扭矩的绝对值大于或者等于扭矩阈值,则可以确定检测到人力掰动云台;若期望扭矩的绝对值小于扭矩阈值,则可以确定当前非人力掰动云台。
具体的,在一些实施例中,将期望扭矩与扭矩阈值进行比较,若期望扭矩大于或者等于扭矩阈值时,则可以确定检测到期望扭矩的绝对值大于或者等于扭矩阈值。而在另一些实施例中,将期望扭矩与扭矩阈值的相反数(即扭矩阈值的负数)进行比较,若期望扭矩小于或等于扭矩阈值的相反数时,则可以确定检测到期望扭矩的绝对值大于或者等于扭矩阈值。
可选的,根据关节角误差的正负,即期望姿态对应的关节角和实时姿态对应的关节角的差值正负,进一步确定是将期望扭矩与扭矩阈值进行比较,还是将期望扭矩与扭矩阈值的相反数进行比较。在本实施例中,当关节角误差为正数时,将期望扭矩与扭矩阈值比较;当关节角误差为负数时,将期望扭矩与扭矩阈值的相反数比较。例如,在利用姿态计算关节角,且关节角能够唯一确定的情况下,若期望姿态对应的关节角为0°,实时姿态对应的关节角为5°,关节角误差则为-5°,关节角误差为负数,可以将期望扭矩与扭矩阈值的相反数比较。又如,期望姿态对应的关节角为0°,实时姿态对应的关节角为-5°,关节角误差则为5°,关节角误差为正数,可以将期望扭矩与扭矩阈值比较。
可选的,可以根据人力掰动云台的方向来确定是将期望扭矩与扭矩阈值进行比较,还是将期望扭矩与扭矩阈值的相反数进行比较。本实施例中,人力掰动云台的方向是根据期望姿态与实时姿态来确定的,假设期望姿态对应的姿态角和实时姿态对应的姿态角的差值为正数时,人力掰动云台的方向作为第一掰动方向,而期望姿态对应的姿态角和实时姿态对应的姿态角的差值为负数时,人力掰动云台的方向作为第二掰动方向。如此,当人力掰动云台的方向为第一掰动方向时,可以将期望扭矩与扭矩阈值比较;或/及,当人力掰动云台的方向为第二掰动方向时,可以将期望扭矩与扭矩阈值的相反数比较。
可以理解,在实际应用中,也可以不根据人力掰动云台的方向来确定期望扭矩与扭矩阈值的比较结果。例如,不确定人力掰动云台的方向,而是依次将期望扭矩与扭矩阈值、扭矩阈值的相反数进行比较,从而也可以确定期望扭矩是大于扭矩阈值,还是小于扭矩阈值的相反数,亦或是位于扭矩阈值与扭矩阈值的相反数之间,进而也可以检测到是否有人力掰动云台。
在人力掰动云台时,云台的扭矩值通常大于通过遥控器控制云台时的扭矩值。本实施例的扭矩阈值是根据电机的温度保护策略预设的,该扭矩阈值为用于判断人力掰动云台时的扭矩值的下限值。可选的,根据电机的温度保护策略预设了扭矩阈值后,扭矩阈值则不会再改变。在需要使用时,直接获取该预设的扭矩阈值即可。可选的,扭矩阈值是根据电机的温度保护策略实时调整的,即在人力掰动云台以控制云台的期望姿态的过程中,扭矩阈值是变化的,以满足不同的需求。
由于在人力误触云台时,云台的期望扭矩通常也会大于通过遥控器控制云台时的扭矩,但人力误触云台与人力掰动云台的区别在于,前者大于扭矩阈值的扭矩的持续时间要小于后者。因此本实施例中,为了避免检测到人力误触云台,可以预先设置一个时长,用于判断在一段连续的时间内,期望扭矩的绝对值是否持续大于或者等于扭矩阈值,从而避免将人力误触云台也确定为人力掰动云台,以此提高对人力掰动云台检测的准确性。
在本实施例中,可以检测预设的时长内期望扭矩的绝对值是否均大于或者等于扭矩阈值,若均大于或者等于扭矩阈值,则可以确定检测到人力掰动云台。参见图4B,若期望扭矩的绝对值大于或者等于扭矩阈值的持续时间超过预设的时长,则可以认为人力掰动云台。可以假设期望扭矩的检测周期为0.001秒/次,预设的时长为1s。若1s内,1000次检测到期望扭矩的绝对值大于或者等于扭矩阈值,在下1秒、第1001次检测时,若期望扭矩大于等于扭矩阈值,则认为人力掰动云台;但若期望扭矩小于扭矩阈值,则认为非人力掰动云台。若在下一次检测到期望扭矩的绝对值大于或者等于扭矩阈值,则开始重新计时。
可选的,在预设的时长内,当关节角误差均为正数时,判断该预设的时长内的期望扭矩是否均大于或者等于扭矩阈值,若均大于或者等于扭矩阈值,则可以确定检测到预设的时长内期望扭矩的绝对值均大于或者等于扭矩阈值。在预设的时长内,当关节角误差均为负数时,判断该预设的时长内的期望扭矩是否均小于或者等于扭矩阈值的相反数,若均小于或者等于扭矩阈值的相反数,则可以确定检测到预设的时长内期望扭矩的绝对值均大于或者等于扭矩阈值。其中,预设的时长可根据实际需求设定,例如,0.5秒、1秒、1.5秒、2秒、2.5秒、3秒等等。
可选的,当人力掰动云台的方向为第一掰动方向时,判断该预设的时长内的期望扭矩是否均大于或者等于扭矩阈值,若均大于或者等于扭矩阈值,则可以确定检测到预设的时长内期望扭矩的绝对值均大于或者等于扭矩阈值;或/及,当人力掰动云台的方向为第二掰动方向时,判断该预设的时长内的期望扭矩是否均小于或者等于扭矩阈值的相反数,若均小于或者等于扭矩阈值的相反数,则可以确定检测到预设的时长内期望扭矩的绝对值均大于或者等于扭矩阈值。
在第二实现方式中,参见图5A,步骤S201中的工作参数还包括关节角误差,本实施例可检测关节角误差的绝对值是否大于或者等于关节角阈值,若关节角误差的绝对值大于或者等于关节角阈值,则可以确定检测到人力掰动云台;若关节角误差的绝对值小于关节角阈值,则可以确定当前非人力掰动云台。其中,关节角误差可根据实际情况预设,例如,关节角阈值为1°,当关节角误差的绝对值大于或者等于1°时,确定检测到人力掰动云台;当关节角误差的绝对值小于1°时,确定人力误触云台或其他因素导致云台存在较小的关节角变化。
具体的,在一些实施例中,将关节角误差与关节角阈值进行比较,若关节角误差大于或者等于关节角阈值时,则可以确定检测到关节角误差的绝对值大于或者等于关节角阈值。而在另一些实施例中,将关节角误差与关节角阈值的相反数(即关节角阈值的负数)进行比较,若关节角误差小于或等于关节角阈值的相反数时,则可以确定检测到关节角误差的绝对值大于或者等于关节角阈值。
可选的,根据关节角误差的正负,即期望姿态对应的关节角和实时姿态对应的关节角的差值正负,进一步确定是将关节角误差与关节角阈值进行比较,还是将关节角误差与关节角阈值的相反数进行比较。在本实施例中,当关节角误差为正数时,将关节角误差与关节角阈值比较;当关节角误差为负数时,将关节角误差与关节角阈值的相反数比较。例如,在利用姿态计算关节角,且关节角能够唯一确定的情况下,若期望姿态对应的关节角为0°,实时姿态对应的关节角为5°,关节角误差则为-5°,关节角误差为负数,需要将关节角误差与关节角阈值的相反数比较。又如,期望姿态对应的关节角为0°,实时姿态对应的关节角为-5°,关节角误差则为5°,关节角误差为正数,需要将关节角误差与关节角阈值比较。
可选的,根据人力掰动云台的方向来确定是将关节角误差与关节角阈值进行比较,还是将关节角误差与关节角阈值的相反数进行比较。本实施例中,人力掰动云台的方向根据期望姿态与实时姿态来确定的,假设期望姿态对应的姿态角和实时姿态对应的姿态角的差值为正数时,人力掰动云台的方向作为第一掰动方向,而期望姿态对应的姿态角和实时姿态对应的姿态角的差值为负数时,人力掰动云台的方向作为第二掰动方向。如此,当人力掰动云台的方向为第一掰动方向时,将关节角误差与关节角阈值比较;或/及,当人力掰动云台的方向为第二掰动方向时,将关节角误差与关节角阈值的相反数比较。
可以理解,在实际应用中,也可以不根据人力掰动云台的方向来确定关节角误差与关节角阈值的比较结果。例如,不确定人力掰动云台的方向,而是依次将关节角误差与关节角阈值、关节角阈值的相反数进行比较,从而也可以确定关节角误差是大于关节角阈值,还是小于关节角阈值的相反数,亦或是位于关节角阈值与关节角阈值的相反数之间,进而也可以检测到是否有人力掰动云台。
由于在人力误触云台时,云台的关节角误差通常也会大于通过遥控器控制云台时的关节角,但人力误触云台与人力掰动云台的区别在于,前者大于关节角阈值的关节角的持续时间要小于后者。因此本实施例中,为了避免检测到人力误触云台,可以预先设置一个时长,用于判断在一段连续的时间内,关节角误差的绝对值是否持续大于或者等于关节角阈值,从而避免将人力误触云台也确定为人力掰动云台,以此提高对人力掰动云台检测的准确性。
在本实施例中,可以检测预设的时长内关节角误差的绝对值是否均大于或者等于关节角阈值,若均大于或者等于关节角阈值,则可以确定检测到人力掰动云台。参见图5B,若关节角误差的绝对值大于或者等于关节角阈值的持续时间达到预设的时长,则认为人力掰动云台。可以假设关节角误差的检测周期为0.001秒/次,预设的时长为1s。若1s内,1000次检测到关节角误差的绝对值大于或者等于关节角阈值,在下1秒、第1001次检测时,若关节角误差大于等于关节角阈值,则认为人力掰动云台;但若关节角误差小于关节角阈值,则认为非人力掰动云台。若在下一次检测到关节角误差的绝对值大于或者等于关节角阈值,则开始重新计时。
可选的,在预设的时长内,当关节角误差均为正数时,判断该预设的时长内的关节角误差是否均大于或者等于关节角阈值,若均大于或者等于关节角阈值,则可以确定检测到预设的时长内关节角误差的绝对值均大于或者等于关节角阈值。在预设的时长内,当关节角误差均为负数时,判断该预设的时长内的关节角误差是否均小于或者等于关节角阈值的相反数,若均小于或者等于关节角阈值的相反数,则可以确定检测到预设的时长内关节角误差的绝对值均大于或者等于关节角阈值。其中,预设的时长可根据实际需求设定,例如,0.5秒、1秒、1.5秒、2秒、2.5秒、3秒等等。
可选的,当人力掰动云台的方向为第一掰动方向时,判断该预设的时长内的关节角误差是否均大于或者等于关节角阈值,若均大于或者等于关节角阈值,则可以确定检测到预设的时长内关节角误差的绝对值均大于或者等于关节角阈值;或/及,当人力掰动云台的方向为第二掰动方向时,判断该预设的时长内的关节角误差是否均小于或者等于关节角阈值的相反数,若均小于或者等于关节角阈值的相反数,则可以确定检测到预设的时长内关节角误差的绝对值均大于或者等于关节角阈值。
在第三实现方式中,参见图6A,步骤S201中的工作参数还可以同时包括期望扭矩和关节角误差,本实施例可检测期望扭矩的绝对值是否大于或者等于扭矩阈值,且检测关节角误差的绝对值是否大于或者等于关节角阈值,若期望扭矩的绝对值大于或者等于扭矩阈值,且关节角误差的绝对值大于或者等于关节角阈值,则以确定检测到人力掰动云台。
进一步的,为了避免检测到人力误触云台,参见图6B,可以检测预设的时长内期望扭矩的绝对值是否均大于或者等于扭矩阈值,且检测预设的时长内关节角误差的绝对值是否均大于或者等于关节角阈值,若预设的时长内期望扭矩的绝对值均大于或者等于扭矩阈值,且关节角误差的绝对值均大于或等于关节角阈值,则可以确定检测到人力掰动云台。该实现方式可参见上述两种实现方式的具体说明,此处不再赘述。可以假设期望扭矩和关节角误差的检测周期为0.001秒/次,预设的时长为1s。若1s内,1000次检测到期望扭矩的绝对值大于或者等于扭矩阈值,并且1000次检测到关节角误差的绝对值大于或者等于关节角阈值,在下1秒、第1001次检测时,若期望扭矩大于等于扭矩阈值、并且关节角误差大于等于关节角阈值,则认为人力掰动云台;但若期望扭矩小于扭矩阈值、或者若关节角误差小于关节角阈值,则认为非人力掰动云台。在下一次检测到期望扭矩的绝对值大于或者等于扭矩阈值、并且关节角误差的绝对值大于或者等于关节角阈值,则开始重新计时。
此外,步骤S202中根据期望姿态和人力掰动云台时云台的实时姿态,确定云台的姿态转换速度时。具体的,根据期望姿态和人力掰动云台时云台的实时姿态,确定云台的关节角误差;根据关节角误差和预设系数,确定云台的姿态转换速度。其中,关节角误差的确定方式可参见上述实施例。本实施例中,预设系数由时间检测周期数以及增益系数确定。其中,时间检测周期数的大小可根据预设的时长设定,例如,预设的时长为1秒,时间检测周期数为1000,则1秒内有1000次检测,即0.001秒检测一次实时姿态。增益系数的大小可以根据具体的使用场景设定,一般来说,为了避免云台在执行步骤203后回弹(即向人力掰动云台的反方向偏移人力掰动云台时云台的实时姿态),增益系数可以较大,例如,增益系数可以为10。
步骤202确定出的云台的姿态转换速度为关节角速度,实际通过欧拉角速度控制云台的期望姿态的变化。可选的,可以将步骤202确定出的关节角速度直接作为云台的欧拉角速度。
可选的,为了实现对云台的精准控制,可以对关节角速度进行坐标转换,获得云台的欧拉角速度,并利用该转换后的欧拉角速度控制云台的期望姿态为实时姿态。具体的,参见图7,根据关节角误差和预设的时间系数,确定云台的姿态转换速度的过程具体包括:
步骤S701:根据关节角误差和预设系数,确定云台在云台关节角坐标系上的第一角速度;
具体的,第一角速度Wi=-关节角误差/预设系数,以上述实施例中的预设系数包括时间检测周期数以及增益系数为例,Wi=-关节角误差/时间检测周期数*增益系数。
步骤S702:根据云台关节角坐标系和云台本体坐标系之间的转换关系,将第一角速度转换成云台在云台本体坐标系上的第二角速度;
在该步骤中,第二角速度为Wb的计算公式如下:
Wb=Rj->b*Wi;
其中,Rj->b(雅克比矩阵)为云台关节角坐标系和云台本体坐标系之间的转换关系,Rj->b由云台的构型确定,云台的构型不同,Rj->b则不同。
以ZXY三轴云台构型为例,其中,假设Z为偏航轴,X为横滚轴,Y为俯仰轴,在该构型中Z为外框,X为中框,Y为内框,偏航轴电机用于驱动偏航轴轴臂转动,以驱动横滚轴电机和横滚轴轴臂、俯仰轴电机和俯仰轴轴臂以及拍摄装置转动,横滚轴电机用于驱动横滚轴轴臂转动,以驱动俯仰轴电机和俯仰轴轴臂以及拍摄装置转动,俯仰轴电机用于驱动俯仰轴轴臂转动,以驱动拍摄装置转动。三个关节角(偏航关节角、横滚关节角以及俯仰关节角)的坐标轴的旋转轴为:
Vinny=[0,1,0]
Vmidx=[1,0,0];
Voutz=[0,0,1]
其中,Vinny、Vmidx、Voutz分别为俯仰关节角、横滚关节角、偏航关节角的坐标轴的旋转轴。
将Vinny、Vmidx、Voutz分别转换至云台本体坐标系:
Vinny->b=Ry′*Vinny
Vmidx->b=Ry′*Rx′*Vmidx;
Voutz->b=Ry′*Rx′*Rz′*Voutz
其中,Ry′、Rx′、Rz′分别对应Ry、Rx、Rz的转置;Ry、Rx、Rz分别为关节角坐标系绕Y轴(即俯仰轴)、X轴(即横滚轴)、Z轴(即偏航轴)到参考坐标系的旋转矩阵。例如,Ry、Rx、Rz可分别如下:
其中,参考坐标系为关节角为0的坐标系,A为关节角坐标系到参考坐标系的转换角度。
云台关节角坐标系和云台本体坐标系之间的转换关系Rj->b的转换如下:
其中,inn_joint_rad为内框关节角,mid_jo int_rad为中框关节角。
针对两轴云台,云台关节角坐标系和云台本体坐标系之间的转换关系Rj->b的转换如下:
步骤S703:根据云台本体坐标系和欧拉坐标系之间的转换关系,将第二角速度转换成欧拉角速度;
在该步骤中,欧拉角速度为Wφ的计算公式如下:
Wφ=Rb->φ*Wb;
其中,Rb->φ为云台本体坐标系和欧拉坐标系之间的转换关系;
其中,inn_euler_rad为内框欧拉角,mid_euler_rad为中框欧拉角,内框欧拉角和中框欧拉角均为上一次闭环时云台的期望欧拉角,也即上一次闭环结束时云台的实时姿态。
在一具体实施中,依据上述转换关系,假设中框关节角为40度、内框关节角为40度,内框欧拉角为10,中框欧拉角为0,关节角速度(即第一角速度)为[0,0,1],若不经过上述坐标系之间的转换,则云台的欧拉角速度默认为关节角速度[0,0,1]。而经过上述坐标系之间的转换后,云台的欧拉角速度为[-0.3830,0.6428,0.6634]。如此可知,将第一角速度经由云台本体坐标系的转换,可以得到更为准确的姿态控制,可以更精准地使得云台停留在人力推动停止时的位置。
在另一具体实施中,当云台中对应预设轴的轴臂不需要进行姿态控制时,在将关节角速度转换得到的欧拉角速度后,可以控制欧拉角速度中对应预设轴的速度为预设值,例如0。其中,预设轴对应的轴臂为云台中不需要姿态控制的轴臂。如此,可以避免针对预设轴的轴臂的扭矩输出,以防止由于控制饱和而影响云台中其它轴臂的姿态控制。
在一些实施例中,云台未设有预设轴对应的轴臂,即上述预设轴对应的轴臂可以为云台中实际不存在的轴臂,如横滚轴。也即,由于计算欧拉角的原因,即使预设轴对应的轴臂不存在,预设轴对应的轴臂也可能会有欧拉角速度,但默认为预设值,以防止电机扭矩输出饱和。
云台可以为两轴云台,轴臂包括偏航轴轴臂、俯仰轴轴臂和横滚轴轴臂中的两个,在执行步骤S703之后,可以控制另外一个轴臂的欧拉角速度为0。其中,当轴臂包括偏航轴轴臂和仰轴轴臂时,另外一个轴臂是横滚轴轴臂;当轴臂包括偏航轴轴臂和横滚轴轴臂时,另外一个轴臂是俯仰轴轴臂;当轴臂包括俯仰轴轴臂和横滚轴轴臂时,另外一个轴臂是偏航轴轴臂。
步骤S704:将欧拉角速度确定为云台的姿态转换速度。
步骤S203:按照人力掰动云台的方向和姿态转换速度,控制期望姿态为实时姿态。
在检测到人力掰动云台后,可通过云台上的惯性测量单元IMU测量人力掰动云台时的掰动方向,然后在掰动方向上,按照步骤S202中确定的姿态转换速度控制期望姿态为实时姿态。如此,控制期望姿态趋向于实时姿态的速度与云台的期望姿态、人力掰动云台时云台的实时姿态之间的偏移量有关,且可以根据该偏移量得到实时调整,如此可以避免由于速度不可控而导致的云台的回弹及转动过程的不顺畅感(如在实时姿态对应的位置处产生的突突感),使得轴臂能够较为顺畅地停留在实时姿态,提升了用户体验。
例如,期望姿态中某一轴臂对应的欧拉角为A,实时姿态中该轴臂对应的欧拉角为B,若将A直接赋值为B,由于一个姿态可能对应多个关节角,则导致直接赋值后,云台中的相应轴臂并不确定该停留在哪个关节角,从而导致云台在人力推动结束后,可能无法实现停留在用户人力推动结束时的位置,例如,云台可能存在回转并撞击机械限位。而若将A根据姿态转换速度和转动方向逐渐转换为B,则可以有效解决上述问题。
进一步的,在控制云台的期望姿态为人力掰动云台时云台的实时姿态之后,若再次检测到工作参数与预设的人力掰动云台条件相匹配,则可以根据当前期望姿态、以及再次检测到的人力掰动云台时云台的实时姿态,确定云台的当前姿态转换速度,然后按照再次检测到的人力掰动云台的方向和云台的当前姿态转换速度,控制当前期望姿态为再次检测到的人力掰动云台的实时姿态。可选的,本实施例的云台的姿态转换速度可以由人力掰动云台的速度决定,云台的姿态转换速度的变化与人力掰动云台的速度变化呈正相关,例如,当人力掰动云台的速度由慢变快,则云台的姿态转换速度也由慢变快,云台的姿态转换速度的变化与人力掰动云台的速度变化一致,从而使得云台能够更顺畅的跟随人力掰动云台时云台的运动而运动。
在一些实施例中,步骤S203是在确定出云台处于过阻尼模式之后执行的。本实施例中,云台处于过阻尼模式下,云台跟随人力掰动云台时云台的运动而运动(即云台停留在用户手推云台时云台的实时姿态对应的位置);而在其他模式下,如欠阻尼模式下,在人力掰动云台之后,云台则会回弹至人力掰动云台前的位置。可根据用户实际需求来选择云台是处于过阻尼模式还是处于其他模式。
本发明实施例的云台控制方法,在检测到云台的工作参数与预设的人力掰动云台条件相匹配时,按照人力掰动云台的方向以及根据期望姿态和人力掰动云台时云台的实时姿态所确定的姿态转换速度控制云台来改变自身的期望姿态,使得云台运动至人力掰动云台时云台的实时姿态,与现有通过遥控器控制云台期望姿态的方式相比,操作过程简单直观,定位精度高;并且,根据期望姿态和人力掰动云台时云台的实时姿态所确定的姿态转换速度控制云台的方式,能够使得云台的姿态转换速度可调整,以让云台更加顺畅地跟随人力掰动云台时云台的运动而运动,用户体验更佳。
与本发明实施例一的云台控制方法相对应,本发明实施例二还提供了一种云台。
实施例二
参见图8,本发明实施例二提供一种云台,该云台可包括:惯性测量单元IMU1以及处理器2。
其中,处理器2与惯性测量单元IMU2电连接。本实施例的处理器2用于执行如图2至图7的云台控制方法。
具体的,处理器2用于:获取云台的工作参数,云台的工作参数包括云台的期望姿态;若检测到工作参数与预设的人力掰动云台条件相匹配,则根据期望姿态和人力掰动云台时云台的实时姿态,确定云台的姿态转换速度;按照人力掰动云台的方向和姿态转换速度,控制期望姿态为实时姿态。
处理器2的实现过程和工作原理可参见上述实施例一的云台控制方法的描述,此处不再赘述。
本实施例的处理器2可以是中央处理器(central processing unit,CPU)。处理器2还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(application-specificintegrated circuit,ASIC),可编程逻辑器件(programmable logic device,PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(complex programmable logic device,CPLD),现场可编程逻辑门阵列(field-programmable gate array,FPGA),通用阵列逻辑(genericarray logic,GAL)或其任意组合。
本实施例的云台可以为单轴云台、两轴云台、三轴云台或者其他云台。
本实施例的云台用于搭载射击装置,并用于调节射击装置的姿态(例如:改变射击装置的高度、倾角和/或方向)和使射击装置稳定保持在确定的姿态上。其中,云台也可以搭载其它负载,如拍摄装置,拍摄装置可以为相机,也可为图像传感器等。
实施例三
参见图9,本发明实施例还提供一种可移动平台,该可移动平台可包括处理器100及云台200,云台200包括惯性测量单元IMU,处理器100惯性测量单元IMU电连接。本实施例的处理器100用于执行如图2至图7的云台控制方法。
具体的,处理器100用于:获取云台200的工作参数,云台200的工作参数包括云台200的期望姿态;若检测到工作参数与预设的人力掰动云台200条件相匹配,则根据期望姿态和人力掰动云台200时云台200的实时姿态,确定云台200的姿态转换速度;按照人力掰动云台200的方向和姿态转换速度,控制期望姿态为实时姿态。
处理器100的实现过程和工作原理可参见上述实施例一的云台控制方法的描述,此处不再赘述。
在本实施例中,处理器100可以为可移动平台处理器、云台处理器,还可以为设于可移动平台上的其他控制器。可移动平台可以为无人飞行器如无人机,也可以为地面移动设备如遥控小车,还可以为水面移动设备如遥控船舶。当可移动平台为无人机时,处理器100可以为飞行控制器。
另外,本实施例的处理器100可以是中央处理器(central processing unit,CPU)。处理器100还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(application-specific integrated circuit,ASIC),可编程逻辑器件(programmablelogic device,PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(complexprogrammable logic device,CPLD),现场可编程逻辑门阵列(field-programmable gatearray,FPGA),通用阵列逻辑(generic array logic,GAL)或其任意组合。
本实施例的云台200可以为单轴云台、两轴云台、三轴云台或者其他云台。
本实施例的云台200用于搭载射击装置,并用于调节射击装置的姿态(例如:改变射击装置的高度、倾角和/或方向)和使射击装置稳定保持在确定的姿态上。其中,云台200也可以搭载其它负载,如拍摄装置,拍摄装置可以为相机,也可为图像传感器等。
此外,本发明实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器100执行时实现上述实施例一的云台控制方法的步骤。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。
以上所揭露的仅为本发明部分实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。
Claims (57)
1.一种云台控制方法,其特征在于,所述方法包括:
获取所述云台的工作参数,所述云台的工作参数包括所述云台的期望姿态;
若检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度;
按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态。
2.根据权利要求1所述的方法,其特征在于,所述根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度,包括:
根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的关节角误差;
根据所述关节角误差和预设系数,确定所述云台的姿态转换速度。
3.根据权利要求2所述的方法,其特征在于,所述根据所述关节角误差和预设的时间系数,确定所述云台的姿态转换速度,包括:
根据所述关节角误差和预设系数,确定所述云台在云台关节角坐标系上的第一角速度;
根据所述云台关节角坐标系和云台本体坐标系之间的转换关系,将所述第一角速度转换成所述云台在云台本体坐标系上的第二角速度;
根据所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述第二角速度转换成欧拉角速度;
将所述欧拉角速度确定为所述云台的姿态转换速度。
4.根据权利要求3所述的方法,其特征在于,所述根据所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述第二角速度转换成欧拉角速度之后,还包括:
控制所述欧拉角速度中对应预设轴的速度为预设值,所述预设轴对应的轴臂为所述云台中不需要姿态控制的轴臂。
5.根据权利要求4所述的方法,其特征在于,所述云台未设有所述预设轴对应的轴臂。
6.根据权利要求1所述的方法,其特征在于,所述根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度之后,还包括:
将人力掰动所述云台时所述云台的实时姿态确定为所述云台的当前期望姿态。
7.根据权利要求6所述的方法,其特征在于,所述按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态之后,还包括:
若再次检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述当前期望姿态、以及再次检测到的人力掰动所述云台时所述云台的实时姿态,确定所述云台的当前姿态转换速度;
按照再次检测到的人力掰动所述云台的方向和所述云台的当前姿态转换速度,控制所述当前期望姿态为再次检测到的人力掰动所述云台时所述云台的实时姿态。
8.根据权利要求1所述的方法,其特征在于,所述按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态之前,还包括:
确定出所述云台处于过阻尼模式。
9.根据权利要求1所述的方法,其特征在于,所述云台包括轴臂和电机,所述电机用于驱动所述轴臂转动;
所述云台的工作参数还包括:所述电机的期望扭矩和/或所述云台的关节角误差;
其中,所述电机的期望扭矩、所述云台的关节角误差均由所述期望姿态和所述实时姿态确定,所述实时姿态由所述云台上的惯性测量单元IMU检测获得。
10.根据权利要求9所述的方法,其特征在于,当所述工作参数还包括所述期望扭矩时,所述检测到所述工作参数与预设的人力掰动云台条件相匹配,包括:
检测到所述期望扭矩的绝对值大于或者等于扭矩阈值。
11.根据权利要求9所述的方法,其特征在于,当所述工作参数还包括所述关节角误差时,所述检测到所述工作参数与预设的人力掰动云台条件相匹配,包括:
检测到所述关节角误差的绝对值大于或者等于关节角阈值。
12.根据权利要求9所述的方法,其特征在于,当所述工作参数还包括所述期望扭矩和关节角误差时,所述检测到所述工作参数与预设的人力掰动云台条件相匹配,包括:
检测到所述期望扭矩的绝对值大于或者等于扭矩阈值,且检测到所述关节角误差的绝对值大于或者等于关节角阈值。
13.根据权利要求10或12所述的方法,其特征在于,所述扭矩阈值是根据所述电机的温度保护策略预设的。
14.根据权利要求13所述的方法,其特征在于,所述扭矩阈值是根据所述电机的温度保护策略实时调整的。
15.根据权利要求10或12所述的方法,其特征在于,所述检测到所述期望扭矩的绝对值大于或者等于扭矩阈值,包括:
检测到预设的时长内的所述期望扭矩的绝对值均大于或者等于所述扭矩阈值。
16.根据权利要求15所述的方法,其特征在于,所述检测到预设的时长内的所述期望扭矩的绝对值均大于或者等于所述扭矩阈值,进一步包括:
当人力掰动所述云台的方向为第一掰动方向时,检测到预设的时长内的所述期望扭矩均大于或者等于扭矩阈值;或/及
当人力掰动所述云台的方向为第二掰动方向时,检测到所述预设的时长内的所述期望扭矩均小于或者等于所述扭矩阈值的相反数。
17.根据权利要求11或12所述的方法,其特征在于,所述检测到所述关节角误差的绝对值大于或者等于关节角阈值,包括:
检测到预设的时长内的所述关节角误差的绝对值均大于或者等于关节角阈值。
18.根据权利要求17所述的方法,其特征在于,所述检测到预设的时长内的所述关节角误差的绝对值均大于或者等于关节角阈值,进一步包括:
当人力掰动所述云台的方向为第一掰动方向时,检测到预设的时长内的所述关节角误差大于或者等于关节角阈值;或/及
当人力掰动所述云台的方向为第二掰动方向时,检测到所述预设的时长内的所述关节角误差小于或者等于关节角阈值的相反数。
19.根据权利要求1所述的方法,其特征在于,所述按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态,包括:
通过所述云台上的惯性测量单元IMU测量人力掰动所述云台时的掰动方向;
在所述掰动方向上,按照所述姿态转换速度控制所述期望姿态为所述实时姿态。
20.一种云台,其特征在于,包括:惯性测量单元IMU以及处理器,所述处理器与所述惯性测量单元IMU电连接;所述处理器用于:
获取所述云台的工作参数,所述云台的工作参数包括所述云台的期望姿态;
若检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度;
按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态。
21.根据权利要求20所述的云台,其特征在于,所述处理器具体用于:
根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的关节角误差;
根据所述关节角误差和预设系数,确定所述云台的姿态转换速度。
22.根据权利要求21所述的云台,其特征在于,所述处理器具体用于:
根据所述关节角误差和预设系数,确定所述云台在云台关节角坐标系上的第一角速度;
根据所述云台关节角坐标系和云台本体坐标系之间的转换关系,将所述第一角速度转换成所述云台在云台本体坐标系上的第二角速度;
根据所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述第二角速度转换成欧拉角速度;
将所述欧拉角速度确定为所述云台的姿态转换速度。
23.根据权利要求22所述的云台,其特征在于,所述处理器根据所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述第二角速度转换成欧拉角速度之后,还用于:
控制所述欧拉角速度中对应预设轴的速度为预设值,所述预设轴对应的轴臂为所述云台中不需要姿态控制的轴臂。
24.根据权利要求23所述的云台,其特征在于,所述云台未设有所述预设轴对应的轴臂。
25.根据权利要求20所述的云台,其特征在于,所述处理器根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度之后,还用于:
将人力掰动所述云台时所述云台的实时姿态确定为所述云台的当前期望姿态。
26.根据权利要求25所述的云台,其特征在于,所述处理器按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态之后,还用于:
若再次检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述当前期望姿态、以及再次检测到的人力掰动所述云台时所述云台的实时姿态,确定所述云台的当前姿态转换速度;
按照再次检测到的人力掰动所述云台的方向和所述云台的当前姿态转换速度,控制所述当前期望姿态为再次检测到的人力掰动所述云台时所述云台的实时姿态。
27.根据权利要求20所述的云台,其特征在于,所述处理器按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态之前,还用于:
确定出所述云台处于过阻尼模式。
28.根据权利要求20所述的云台,其特征在于,所述云台包括轴臂和电机,所述电机用于驱动所述轴臂转动;
所述云台的工作参数还包括:所述电机的期望扭矩和/或所述云台的关节角误差;
其中,所述电机的期望扭矩、所述云台的关节角误差均由所述期望姿态和所述实时姿态确定,所述实时姿态由所述云台上的惯性测量单元IMU检测获得。
29.根据权利要求28所述的云台,其特征在于,当所述工作参数还包括所述期望扭矩时,所述处理器具体用于:
检测到所述期望扭矩的绝对值大于或者等于扭矩阈值,则确定所述工作参数与预设的人力掰动云台条件相匹配。
30.根据权利要求28所述的云台,其特征在于,当所述工作参数还包括所述关节角误差时,所述处理器具体用于:
检测到所述关节角误差的绝对值大于或者等于关节角阈值,则确定到所述工作参数与预设的人力掰动云台条件相匹配。
31.根据权利要求28所述的云台,其特征在于,当所述工作参数还包括所述期望扭矩和关节角误差时,所述处理器具体用于:
检测到所述期望扭矩的绝对值大于或者等于扭矩阈值,且检测到所述关节角误差的绝对值大于或者等于关节角阈值,则确定所述工作参数与预设的人力掰动云台条件相匹配。
32.根据权利要求29或31所述的云台,其特征在于,所述扭矩阈值是根据所述电机的温度保护策略预设的。
33.根据权利要求32所述的云台,其特征在于,所述扭矩阈值是根据所述电机的温度保护策略实时调整的。
34.根据权利要求29或31所述的云台,其特征在于,所述处理器具体用于:
检测到预设的时长内的所述期望扭矩的绝对值均大于或者等于所述扭矩阈值。
35.根据权利要求34所述的云台,其特征在于,所述处理器具体用于:
当人力掰动所述云台的方向为第一掰动方向时,检测到预设的时长内的所述期望扭矩均大于或者等于扭矩阈值;或/及
当人力掰动所述云台的方向为第二掰动方向时,检测到所述预设的时长内的所述期望扭矩均小于或者等于所述扭矩阈值的相反数。
36.根据权利要求30或31所述的云台,其特征在于,所述处理器具体用于:
检测到预设的时长内的所述关节角误差的绝对值均大于或者等于关节角阈值。
37.根据权利要求36所述的云台,其特征在于,所述处理器具体用于:
当人力掰动所述云台的方向为第一掰动方向时,检测到预设的时长内的所述关节角误差大于或者等于关节角阈值;或/及
当人力掰动所述云台的方向为第二掰动方向时,检测到所述预设的时长内的所述关节角误差小于或者等于关节角阈值的相反数。
38.根据权利要求20所述的云台,其特征在于,所述处理器具体用于:
通过所述云台上的惯性测量单元IMU测量人力掰动所述云台时的掰动方向;
在所述掰动方向上,按照所述姿态转换速度控制所述期望姿态为所述实时姿态。
39.一种可移动平台,其特征在于,包括:云台及处理器,所述云台包括惯性测量单元IMU,所述处理器与所述惯性测量单元IMU电连接,所述处理器用于:
获取所述云台的工作参数,所述云台的工作参数包括所述云台的期望姿态;
若检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度;
按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态。
40.根据权利要求39所述的可移动平台,其特征在于,所述处理器具体用于:
根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的关节角误差;
根据所述关节角误差和预设系数,确定所述云台的姿态转换速度。
41.根据权利要求40所述的可移动平台,其特征在于,所述处理器具体用于:
根据所述关节角误差和预设系数,确定所述云台在云台关节角坐标系上的第一角速度;
根据所述云台关节角坐标系和云台本体坐标系之间的转换关系,将所述第一角速度转换成所述云台在云台本体坐标系上的第二角速度;
根据所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述第二角速度转换成欧拉角速度;
将所述欧拉角速度确定为所述云台的姿态转换速度。
42.根据权利要求41所述的可移动平台,其特征在于,所述处理器根据所述云台本体坐标系和欧拉坐标系之间的转换关系,将所述第二角速度转换成欧拉角速度之后,还用于:
控制所述欧拉角速度中对应预设轴的速度为预设值,所述预设轴对应的轴臂为所述云台中不需要姿态控制的轴臂。
43.根据权利要求42所述的可移动平台,其特征在于,所述云台未设有所述预设轴对应的轴臂。
44.根据权利要求39所述的可移动平台,其特征在于,所述处理器根据所述期望姿态和人力掰动所述云台时所述云台的实时姿态,确定所述云台的姿态转换速度之后,还用于:
将人力掰动所述云台时所述云台的实时姿态确定为所述云台的当前期望姿态。
45.根据权利要求44所述的可移动平台,其特征在于,所述处理器按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态之后,还用于:
若再次检测到所述工作参数与预设的人力掰动云台条件相匹配,则根据所述当前期望姿态、以及再次检测到的人力掰动所述云台时所述云台的实时姿态,确定所述云台的当前姿态转换速度;
按照再次检测到的人力掰动所述云台的方向和所述云台的当前姿态转换速度,控制所述当前期望姿态为再次检测到的人力掰动所述云台时所述云台的实时姿态。
46.根据权利要求39所述的可移动平台,其特征在于,所述处理器按照人力掰动所述云台的方向和所述姿态转换速度,控制所述期望姿态为所述实时姿态之前,还用于:
确定出所述云台处于过阻尼模式。
47.根据权利要求39所述的可移动平台,其特征在于,所述云台包括轴臂和电机,所述电机用于驱动所述轴臂转动;
所述云台的工作参数还包括:所述电机的期望扭矩和/或所述云台的关节角误差;
其中,所述电机的期望扭矩、所述云台的关节角误差均由所述期望姿态和所述实时姿态确定,所述实时姿态由所述云台上的惯性测量单元IMU检测获得。
48.根据权利要求47所述的可移动平台,其特征在于,当所述工作参数还包括所述期望扭矩时,所述处理器具体用于:
检测到所述期望扭矩的绝对值大于或者等于扭矩阈值,则确定所述工作参数与预设的人力掰动云台条件相匹配。
49.根据权利要求47所述的可移动平台,其特征在于,当所述工作参数还包括所述关节角误差时,所述处理器具体用于:
检测到所述关节角误差的绝对值大于或者等于关节角阈值,则确定所述工作参数与预设的人力掰动云台条件相匹配。
50.根据权利要求47所述的可移动平台,其特征在于,当所述工作参数还包括所述期望扭矩和关节角误差时,所述处理器具体用于:
检测到所述期望扭矩的绝对值大于或者等于扭矩阈值,且检测到所述关节角误差的绝对值大于或者等于关节角阈值,则确定所述工作参数与预设的人力掰动云台条件相匹配。
51.根据权利要求48或50所述的可移动平台,其特征在于,所述扭矩阈值是根据所述电机的温度保护策略预设的。
52.根据权利要求51所述的可移动平台,其特征在于,所述扭矩阈值是根据所述电机的温度保护策略实时调整的。
53.根据权利要求48或50所述的可移动平台,其特征在于,所述处理器具体用于:
检测到预设的时长内的所述期望扭矩的绝对值均大于或者等于所述扭矩阈值。
54.根据权利要求53所述的可移动平台,其特征在于,所述处理器具体用于:
当人力掰动所述云台的方向为第一掰动方向时,检测到预设的时长内的所述期望扭矩均大于或者等于扭矩阈值;或/及
当人力掰动所述云台的方向为第二掰动方向时,检测到所述预设的时长内的所述期望扭矩均小于或者等于所述扭矩阈值的相反数。
55.根据权利要求49或50所述的可移动平台,其特征在于,所述处理器具体用于:
检测到预设的时长内的所述关节角误差的绝对值均大于或者等于关节角阈值。
56.根据权利要求55所述的可移动平台,其特征在于,所述处理器具体用于:
当人力掰动所述云台的方向为第一掰动方向时,检测到预设的时长内的所述关节角误差大于或者等于关节角阈值;或/及
当人力掰动所述云台的方向为第二掰动方向时,检测到所述预设的时长内的所述关节角误差小于或者等于关节角阈值的相反数。
57.根据权利要求39所述的可移动平台,其特征在于,所述处理器具体用于:
通过所述云台上的惯性测量单元IMU测量人力掰动所述云台时的掰动方向;
在所述掰动方向上,按照所述姿态转换速度控制所述期望姿态为所述实时姿态。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2018/109207 WO2020062298A1 (zh) | 2018-09-30 | 2018-09-30 | 云台及其控制方法、可移动平台 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110770671A true CN110770671A (zh) | 2020-02-07 |
Family
ID=69328600
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201880040630.8A Pending CN110770671A (zh) | 2018-09-30 | 2018-09-30 | 云台及其控制方法、可移动平台 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110770671A (zh) |
WO (1) | WO2020062298A1 (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113169630A (zh) * | 2020-10-27 | 2021-07-23 | 深圳市大疆创新科技有限公司 | 跟焦轮的控制方法、跟焦轮及存储介质 |
WO2021243527A1 (zh) * | 2020-06-01 | 2021-12-09 | 深圳市大疆创新科技有限公司 | 云台控制方法、手持云台及计算机可读存储介质 |
WO2022261907A1 (zh) * | 2021-06-17 | 2022-12-22 | 深圳市大疆创新科技有限公司 | 跟焦设备的控制方法、设备及存储介质 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3564574B1 (en) | 2016-12-30 | 2021-11-10 | SZ DJI Osmo Technology Co., Ltd. | Method and device for controlling cradle head, and cradle head |
WO2024060105A1 (zh) * | 2022-09-21 | 2024-03-28 | 深圳市大疆创新科技有限公司 | 控制方法、云台、云台*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100140413A1 (en) * | 2008-11-17 | 2010-06-10 | Bailey David A | Method for maximum data collection with a control moment gyroscope controlled satellite |
CN102707734A (zh) * | 2012-06-19 | 2012-10-03 | 上海大学 | 基于惯性姿态传感器的自稳定云台 |
CN107223220A (zh) * | 2016-12-30 | 2017-09-29 | 深圳市大疆灵眸科技有限公司 | 云台控制方法、装置及云台 |
CN108513610A (zh) * | 2017-04-21 | 2018-09-07 | 深圳市大疆灵眸科技有限公司 | 一种云台姿态估计方法、装置以及相应的云台 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102006048006A1 (de) * | 2006-10-09 | 2008-04-10 | Funkwerk Plettac Electronic Gmbh | Verfahren und Vorrichtung zur Steuerung einer schwenkbaren Kamera |
CN108549399B (zh) * | 2018-05-23 | 2020-08-21 | 深圳市道通智能航空技术有限公司 | 飞行器偏航角修正方法、装置及飞行器 |
-
2018
- 2018-09-30 CN CN201880040630.8A patent/CN110770671A/zh active Pending
- 2018-09-30 WO PCT/CN2018/109207 patent/WO2020062298A1/zh active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100140413A1 (en) * | 2008-11-17 | 2010-06-10 | Bailey David A | Method for maximum data collection with a control moment gyroscope controlled satellite |
CN102707734A (zh) * | 2012-06-19 | 2012-10-03 | 上海大学 | 基于惯性姿态传感器的自稳定云台 |
CN107223220A (zh) * | 2016-12-30 | 2017-09-29 | 深圳市大疆灵眸科技有限公司 | 云台控制方法、装置及云台 |
CN109885105A (zh) * | 2016-12-30 | 2019-06-14 | 深圳市大疆灵眸科技有限公司 | 云台控制方法、装置及云台 |
CN108513610A (zh) * | 2017-04-21 | 2018-09-07 | 深圳市大疆灵眸科技有限公司 | 一种云台姿态估计方法、装置以及相应的云台 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021243527A1 (zh) * | 2020-06-01 | 2021-12-09 | 深圳市大疆创新科技有限公司 | 云台控制方法、手持云台及计算机可读存储介质 |
CN113169630A (zh) * | 2020-10-27 | 2021-07-23 | 深圳市大疆创新科技有限公司 | 跟焦轮的控制方法、跟焦轮及存储介质 |
WO2022087828A1 (zh) * | 2020-10-27 | 2022-05-05 | 深圳市大疆创新科技有限公司 | 跟焦轮的控制方法、跟焦轮及存储介质 |
CN113169630B (zh) * | 2020-10-27 | 2022-07-19 | 深圳市大疆创新科技有限公司 | 跟焦轮的控制方法、跟焦轮及存储介质 |
WO2022261907A1 (zh) * | 2021-06-17 | 2022-12-22 | 深圳市大疆创新科技有限公司 | 跟焦设备的控制方法、设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
WO2020062298A1 (zh) | 2020-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110770671A (zh) | 云台及其控制方法、可移动平台 | |
CN108568814B (zh) | 机器人以及机器人的控制方法 | |
US11692668B2 (en) | Control device for a gimbal and method of controlling the same | |
JP6021470B2 (ja) | フリップ型運動を自動的に実行するための無人機の姿勢の動力学的制御方法 | |
JP5505138B2 (ja) | ロボット装置およびロボット装置による把持方法 | |
CN111230867B (zh) | 机器人运动控制方法、运动控制设备及机器人 | |
EP2868442A2 (en) | Robot control device and robot | |
EP3564574B1 (en) | Method and device for controlling cradle head, and cradle head | |
WO2018099198A1 (zh) | 无人机姿态控制方法、装置及无人机 | |
JP4947073B2 (ja) | ロボット装置及びその制御方法 | |
WO2017024759A1 (zh) | 一种手持放飞无人机的方法及装置 | |
JP5211944B2 (ja) | ロボット装置の制御方法及びロボット装置 | |
CN106293103B (zh) | 基于惯性传感器的四轴飞行器手势控制装置和控制方法 | |
CN108521777B (zh) | 云台的控制方法、云台以及无人飞行器 | |
WO2019134154A1 (zh) | 非正交云台的控制方法及其云台和存储装置 | |
CN111360838B (zh) | 一种机械臂控制方法、装置、机械臂及存储介质 | |
US10377043B2 (en) | Robot control apparatus, robot, and robot system | |
JP2015168053A (ja) | 教示作業を簡易化し、動作性能を向上させる機能を備えたロボット制御装置 | |
CN110832423B (zh) | 云台的控制方法、云台、移动平台和计算机可读存储介质 | |
CN110431507A (zh) | 一种云台控制方法及云台 | |
CN112219178A (zh) | 云台控制方法、云台及计算机可读存储介质 | |
US20240025039A1 (en) | Learning physical features from tactile robotic exploration | |
WO2018152827A1 (zh) | 无人机的远程控制方法、设备和*** | |
US11577391B2 (en) | Trajectory generation device, trajectory generation method, and robot system | |
US12030192B2 (en) | Motion model calculation device, control device, joint mechanism, and motion model calculation method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200207 |
|
WD01 | Invention patent application deemed withdrawn after publication |