云台的控制方法、云台、移动平台和计算机可读存储介质

文档序号:1472090 发布日期:2020-02-21 浏览:2次 >En<

阅读说明:本技术 云台的控制方法、云台、移动平台和计算机可读存储介质 (Control method of holder, mobile platform and computer readable storage medium ) 是由 范庆鹤 马天航 于 2018-11-28 设计创作,主要内容包括:一种云台(100)的控制方法、云台(100)、移动平台和计算机可读存储介质(400)。控制方法包括:在检测到指示云台(100)进入收纳模式的触发事件时,控制转轴结构(10)转动至设定位置,以使得云台(100)满足预设的收纳形态(01);控制转轴结构(10)在设定位置保持预设时长(02)。(A control method of a pan/tilt head (100), a mobile platform and a computer-readable storage medium (400). The control method comprises the following steps: when a trigger event indicating that the cradle head (100) enters the storage mode is detected, controlling the rotating shaft structure (10) to rotate to a set position so that the cradle head (100) meets a preset storage form (01); and controlling the rotating shaft structure (10) to be kept at the set position for a preset time (02).)

云台的控制方法、云台、移动平台和计算机可读存储介质

技术领域

本发明涉及云台技术领域,特别涉及一种云台的控制方法、云台、移动平台和计算机可读存储介质。

背景技术

云台在关机后会整机掉电,此时云台可能处于任意形态,用户若想将云台放入收纳盒中,需要用两只手先将云台的形态摆成预定形态,然后才能放进收纳盒中。这种做法操作困难,会浪费用户较长时间。

发明内容

本发明的实施方式提供一种云台的控制方法、云台、移动平台和计算机可读存储介质。

本发明实施方式的控制方法用于云台,所述云台包括至少一个转轴结构,所述方法包括:在检测到指示所述云台进入收纳模式的触发事件时,控制所述转轴结构转动至设定位置,以使得所述云台满足预设的收纳形态;控制所述转轴结构在所述设定位置保持预设时长。

本发明实施方式的云台包括至少一个转轴结构和处理器,所述处理器用于:在检测到指示所述云台进入收纳模式的触发事件时,控制所述转轴结构转动至设定位置,以使得所述云台满足预设的收纳形态;控制所述转轴结构在所述设定位置保持预设时长。

本发明实施方式的移动平台包括本体和上述云台,所述云台设置在所述本体上。

本发明实施方式的计算机可读存储介质,其上存储有计算机程序,所述计算机程序可被处理器执行以完成上述控制方法。

本发明实施方式提供了一种云台的控制方法、云台、移动平台和计算机可读存储介质。在云台的控制方法中,控制转轴结构转动至设定位置,以使得云台满足预设的收纳形态,从而用户无需摆动云台即可方便地将云台放入收纳盒中,能够节省用户收纳云台所需要的时间。

本发明的实施方式的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实施方式的实践了解到。

附图说明

本发明的上述和/或附加的方面和优点从结合下面附图对实施方式的描述中将变得明显和容易理解,其中:

图1是本发明某些实施方式的云台的控制方法的流程示意图;

图2是本发明某些实施方式的云台的结构示意图;

图3至图5是本发明某些实施方式的云台的控制方法的流程示意图;

图6是本发明某些实施方式的关节角闭环控制方式的示意图;

图7和图8是本发明某些实施方式的云台的控制方法的流程示意图;

图9是本发明某些实施方式的姿态闭环控制方式的示意图;

图10至图12是本发明某些实施方式的云台的控制方法的流程示意图;

图13是本发明某些实施方式的移动平台的示意图;

图14是本发明某些实施方式的云台和计算机可读存储介质的连接示意图。

主要元件符号附图说明:

飞行器 1000、云台 100、转轴结构 10、横滚转轴结构 11、俯仰转轴结构 12、偏航转轴结构 13、横滚轴电机 142、俯仰轴电机 144、偏航轴电机 146、横滚轴框架 152、俯仰轴框架 154、偏航轴框架 156、处理器 20、拍摄部 30、显示屏 40、手持部 50、收纳盒 200、本体 300、计算机可读存储介质 400。

具体实施方式

下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。

在本发明的描述中,需要理解的是,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个所述特征。在本发明的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。

在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接或可以相互通信;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。

下文的公开提供了许多不同的实施方式或例子用来实现本发明的不同结构。为了简化本发明的公开,下文中对特定例子的部件和设置进行描述。当然,它们仅仅为示例,并且目的不在于限制本发明。此外,本发明可以在不同例子中重复参考数字和/或参考字母,这种重复是为了简化和清楚的目的,其本身不指示所讨论各种实施方式和/或设置之间的关系。此外,本发明提供了的各种特定的工艺和材料的例子,但是本领域普通技术人员可以意识到其他工艺的应用和/或其他材料的使用。

下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。

请参阅图1和图2,本发明实施方式的控制方法可以用于云台100,云台100包括至少一个转轴结构10。方法包括:

01:在检测到指示云台100进入收纳模式的触发事件时,控制转轴结构10转动至设定位置,以使得云台100满足预设的收纳形态;

02:控制转轴结构10在设定位置保持预设时长。

请继续参阅图2,本发明实施方式的云台100包括至少一个转轴结构10和处理器20,处理器20用于:在检测到指示云台100进入收纳模式的触发事件时,控制转轴结构10转动至设定位置,以使得云台100满足预设的收纳形态;控制转轴结构10在设定位置保持预设时长。

也即是说,本发明实施方式的控制方法可以由本发明实施方式的云台100实现,其中,步骤01和步骤02可以由处理器20实现。

可以理解,图2中所示处理器的位置仅为示意性说明,并不进行限定,此处说明之后,在后面即不再重复限定。

可以理解,设定位置可以在云台100出厂前设定,也可以是由用户进行自定义设置。其中,当设定位置在由用户进行自定义设置时,可以使得云台100有多个不同的预设的收纳形态,以匹配不同的收纳盒200,用户可以根据使用需求选择相应的收纳盒200,并选择相应的预设的收纳形态。

本发明实施方式的云台100的控制方法和云台100,控制转轴结构10转动至设定位置,以使得云台100满足预设的收纳形态,从而用户无需摆动云台100即可方便地将云台100放入收纳空间内,能够节省用户收纳云台100所需要的时间。另外,控制转轴结构10在设定位置保持预设时长,从而使得在该预设时长内云台100维持预设的收纳形态,便于用户在该预设时长内将云台100放入收纳空间内。

在一个实施方式中,预设时长为5秒,如此,既可以满足用户收纳云台100的需要,又能降低云台100的功耗。当然,预设时长也可以为3秒、8秒、12秒、15秒等,还可以是根据用户需求进行自定义设置,在此不做具体限定。

请继续参阅图2,在某些实施方式中,云台100包括手持云台100。手持云台100例如还包括拍摄部30、显示屏40和手持部50,手持部50用于支撑拍摄部30,显示屏40设置在手持部50上。拍摄部30可以用于拍摄图像。为了保护手持云台100,在手持云台100使用后,可以将手持云台100放入收纳盒200中,若用户通过双手摆动手持云台100以将云台100放入收纳盒200中,这种做法操作困难,会浪费用户较长时间,并且若用户操作错误,容易导致手持云台100放入收纳盒200时造成损坏。因此,可以采用本发明实施方式的控制方法控制手持云台100以使得手持云台100满足预设的收纳形态,从而用户可以将云台100轻松地放入收纳盒200中,减少用户手动操作导致的错误,降低手持云台100损坏的风险。

请参阅图3,在某些实施方式中,在步骤02后,方法还包括:

03:控制云台100进入关机模式,或控制云台100进入待机模式。

以图2的手持云台100为例,在某些实施方式中,处理器20还用于在控制转轴结构10在设定位置保持预设时长后,控制云台100进入关机模式,或控制云台100进入待机模式。

也即是说,步骤03可以由处理器20实现。

具体地,云台100满足预设的收纳形态时,通常云台100不是处于工作状态,即云台100此时不工作(例如,此时拍摄部30可能不是面向外界进行拍摄)。因此,可以在预设时长后,控制云台100进入关机模式或进入待机模式,从而可以减少对云台100进行无意义的操作,降低云台100的功耗。

其中,在云台100在设定位置保持预设时长后,进入关机模式或进入待机模式可以在云台100出厂前设定,也可以由用户进行自定义设置,该自定义设置可以是在云台100到达设定位置之前设定,也可以是云台100在预设位置保持预设时长的过程中设定,此处不做具体限定。

请参阅图4,在某些实施方式中,步骤01包括:

011:控制转轴结构10转动至预设关节角;

步骤02包括:

021:控制转轴结构10在预设关节角保持预设时长。

以图2的手持云台100为例,在某些实施方式中,处理器20用于:控制转轴结构10转动至预设关节角;控制转轴结构10在预设关节角保持预设时长。

也即是说,步骤011和步骤021可以由处理器20实现。

具体地,可以通过控制转轴结构10的关节角来使得转轴结构10转动至设定位置,其中,关节角的控制可以通过关节角闭环控制方式实现,关节角闭环控制方式不受云台100的构型导致的万向节锁死限制,因此便于将转轴结构10调整到满足收纳需要的任意位置。

请参阅图5,在某些实施方式中,步骤011包括:

0112:确定转轴结构10的当前关节角与预设关节角之间的关节角偏差;

0114:根据关节角偏差控制转轴结构10转动至预设关节角。

以图2的手持云台100为例,在某些实施方式中,处理器20用于:确定转轴结构10的当前关节角与预设关节角之间的关节角偏差;根据关节角偏差控制转轴结构10转动至预设关节角。

也即是说,步骤0112和步骤0114可以由处理器20实现。

具体地,请参阅图6,在利用关节角闭环控制方式控制转轴结构10时,可以先确定转轴结构10的当前关节角和预设关节角。其中,当前关节角可以通过角度传感器获取,预设关节角为转轴结构10处于设定位置时的关节角,可以预先设置在云台100的存储元件中,然后计算当前关节角与预设关节角之间的关节角偏差,通过关节角偏差可以确定转轴结构10的工作电流和/或扭矩。根据该工作电流和/或该扭矩可以控制转轴结构10转动以将转轴结构10转动至预设关节角。如此,可以通过关节角闭环控制简单、快速且准确地将转轴结构10调整到设定位置。

请继续参阅图2,在某些实施方式中,至少一个转轴结构10包括被配置为绕横滚(roll)轴旋转的横滚转轴结构11、被配置为绕俯仰(pitch)轴旋转的俯仰转轴结构12和被配置为绕偏航(yaw)轴旋转的偏航转轴结构13中的至少一个。每个转轴结构10可以包括转轴电机和转轴框架,即横滚转轴结构11可以包括横滚轴电机142和横滚轴框架152,俯仰转轴结构12可以包括俯仰轴电机144和俯仰轴框架154,偏航转轴结构13可以包括偏航轴电机146和偏航轴框架156。

在某些实施方式中,转轴结构10还包括电子调速器(图未示),角度传感器包括磁环和磁编码器,磁环设置在转轴电机的转子上,磁编码器设置在电子调速器中,磁编码器可以获取磁环的转动位置,从而确定转子的位置以确定当前关节角。其中,在设置磁环时,由于磁环与转子之间的位置关系的不确定性,磁编码器获取磁环的转动位置和转子的转动位置之间一般存在一个偏置角度(offset),可以通过实验检测出该偏置角度并将该偏置角度保存在云台100的存储元件中,从而可以通过磁环的转动位置和该偏置角度确定转子的转动位置以确定当前关节角。

在某些实施方式中,当横滚轴、俯仰轴、偏航轴分别正交时,横滚转轴结构11的关节角为第一设定关节角,横滚转轴结构11对应的预设关节角与第一设定关节角的绝对差值为90度;和/或,当横滚轴、俯仰轴、偏航轴分别正交时,俯仰转轴结构12的关节角为第二设定关节角,俯仰转轴结构12对应的预设关节角与第二设定关节角的绝对差值为0度;和/或,当横滚轴、俯仰轴、偏航轴分别正交时,偏航转轴结构13的关节角为第三设定关节角,偏航转轴结构13对应的预设关节角与第三设定关节角的绝对差值为90度。

具体地,在某些实施方式中,当横滚轴、俯仰轴、偏航轴分别正交时,可以将第一设定关节角、第二设定关节角和第三设定关节角均视作0度,即横滚转轴结构11、俯仰转轴结构12和偏航转轴结构13均处于零位。

在本发明实施方式中,关节角为矢量,可以通过定义转轴结构10的一个旋转方向为正旋转方向,另一个旋转方向为反旋转方向,关节角为正时,说明旋转方向为正旋转方向,关节角为负时,说明旋转方向为反旋转方向。其中,各个转轴结构10均包括对应的正旋转方向和反旋转方向。横滚转轴结构11对应的预设关节角与第一设定关节角的绝对差值为90度,可以是横滚转轴结构11对应的预设关节角相对于第一设定关节角的差值为正90度,即横滚转轴结构11的预设关节角相对于第一设定关节角的方向为正旋转方向,角度为90度。俯仰转轴结构12对应的预设关节角与第二设定关节角的绝对差值为0度,即第二设定关节角即为俯仰转轴结构12对应的预设关节角。偏航转轴结构13对应的预设关节角与第三设定关节角的绝对差值为90度,可以偏航转轴结构13对应的预设关节角相对于第三设定关节角的差值为负90度,即偏航转轴结构13的预设关节角相对于第三设定关节角的方向为反旋转方向,角度为90度。如此,横滚转轴结构11、俯仰转轴结构12和偏航转轴结构13均相对收敛,使得云台100所占的体积最小,能够减少云台100所需的收纳空间。

当然,第一设定关节角、第二设定关节角和第三设定关节角也可以是其他设定值,例如20度、90度、125度等。横滚转轴结构11对应的预设关节角与第一设定关节角的绝对差值、俯仰转轴结构12对应的预设关节角与第二设定关节角的绝对差值、偏航转轴结构13对应的预设关节角与第三设定关节角的绝对差值,也可以根据需要进行设置,例如可以根据收纳盒200的收纳形状设置该绝对差值,从而可以使得各个转轴结构10转动至对应的预设关节角时,云台100能够便于放入收纳盒200中。

请参阅图2和图7,在某些实施方式中,云台100包括手持部50,至少一个转轴结构10设于手持部50上,步骤01包括:

012:控制转轴结构10转动至相对于手持部50为预设姿态;

步骤02包括:

022:控制转轴结构10在预设姿态保持预设时长。

以图2的手持云台100为例,在某些实施方式中,云台100包括手持部50,至少一个转轴结构10设于手持部50上,处理器20用于:控制转轴结构10转动至相对于手持部50为预设姿态;控制转轴结构10在预设姿态保持预设时长。

也即是说,步骤012和步骤022可以由处理器20实现。

具体地,可以通过控制转轴结构10的姿态来使得转轴结构10转动至设定位置,其中,姿态的控制可以通过姿态闭环控制方式实现或者通过关节角闭环实现,从而能够准确地将转轴结构10调整到设定位置。

其中,在通过关节角闭环来实现时,可以参考图4所示实施例以及图5所示实施例的内容,此处不再赘述。

请参阅图8,在某些实施方式中,姿态的控制通过姿态闭环控制方式实现,步骤012包括:

0122:确定转轴结构10相对于手持部50的当前姿态与转轴结构10相对于手持部50的预设姿态之间的姿态偏差;

0124:根据姿态偏差控制转轴结构10转动至相对于手持部50为预设姿态。

以图2的手持云台100为例,在某些实施方式中,处理器20用于:确定转轴结构10相对于手持部50的当前姿态与转轴结构10相对于手持部50的预设姿态之间的姿态偏差;根据姿态偏差控制转轴结构10转动至相对于手持部50为预设姿态。

也即是说,步骤0122和步骤0124可以由处理器20实现。

请参阅图9,具体地,在利用姿态闭环控制方式控制转轴结构10时,可以先确定转轴结构10相对于手持部50的当前姿态和预设姿态。

在某些实施方式中,转轴结构10相对于手持部50的当前姿态可以通过转轴结构10在欧拉坐标下的当前姿态确定,转轴结构10在欧拉坐标系下的当前姿态可以通过设置在云台100上的惯性测量单元(例如陀螺仪、加速度计)等测量获得。其中,预设姿态的确定方式如下:

qcam=qbase·qbase→out·qout→mid·qmidinn

其中,qcam为云台100上的负载在大地坐标系下的目标姿态,qbase为云台100的手持部50或云台基座在大地坐标下的姿态,qbase→out为手持部50或云台基座到云台100外框的旋转四元数,由外框对应的预设关节角构造而成,qout→mid为云台100外框到云台100中框的旋转四元数,由中框对应的预设关节角构造而成,qmid→inn为云台100中框到云台100内框的旋转四元数,由内框对应的预设关节角构造而成。

得到上述目标姿态后,可以将相应的转轴结构10的目标姿态转换到至云台本体坐标系下,得到转轴结构10相对于手持部50的预设姿态,同理,可以将转轴结构10的当前姿态转换至云台本体坐标系中,从而在云台本体坐标系下计算转轴结构10相对于手持部50的当前姿态和预设姿态之间的姿态偏差,基于姿态闭环控制方式,通过姿态偏差可以确定转轴结构10的工作电流和/或扭矩,根据该工作电流和/或该扭矩可以控制转轴结构10转动,以将转轴结构10转动至相对于手持部50为预设姿态。

在某些实施方式中,姿态的控制根据转轴结构10的关节角实现,步骤012包括:获取转轴结构10的当前关节角和预设关节角,根据当前关节角和预设关节角确定转轴结构10的期望关节角速度(可以根据当前关节角与预设关节角之间的偏差确定,可以根据需要进行大小调整),再通过坐标转换关系将转轴结构10的期望关节角速度转换为在欧拉坐标系下的期望欧拉角速度,从而可以根据该期望欧拉角速度获得对应的预设姿态,再根据该期望欧拉角速度控制转轴结构10转动至相对于手持部50为预设姿态。

以图2中所示的ZXY三个三轴云台100为例。其中,假设Z为偏航轴,X为横滚轴,Y为俯仰轴,在该构型中,偏航轴框架156为外框,横滚轴框架152为中框,俯仰轴框架154为内框,偏航轴电机146用于驱动偏航轴框架156转动,以驱动横滚轴电机142和横滚轴框架152、俯仰轴电机144和俯仰轴框架154以及搭载在云台100上的负载转动,横滚轴电机142用于驱动横滚轴框架152转动,以驱动俯仰轴电机144和俯仰轴框架154以及负载转动,俯仰轴电机144用于驱动俯仰轴框架154转动,以驱动负载转动。

其中,在将期望关节角速度转换为期望欧拉角速度的过程中,云台关节角坐标系和云台本体坐标系之间的转换关系与云台100的构型相关,云台的构型不同,其转换关系不同。

本实施例中,偏航轴关节角的坐标轴的旋转轴Voutz为[0,0,1],横滚轴关节角的坐标轴的旋转轴Vmidx为[1,0,0],俯仰轴关节角的坐标轴的旋转轴Vinny为[0,1,0]。将Voutz、Vmidx、Vinny分别转换至云台本体坐标系:

Voutz→b=Ry'*Rx'*Rz'*Voutz

Vmidx→b=Ry'*Rx'*Vmidx

Vinny→b=Ry'*Vinny

其中,Ry'、Rx'、Rz'分别对应Ry、Rx、Rz的转置,Ry、Rx、Rz分别为关节角坐标系绕Y轴(俯仰轴)、X轴(横滚轴)、Z轴(偏航轴)到参考坐标系的旋转矩阵。例如,Ry、Rx、Rz可分别如下:

Figure BDA0002313167810000071

Figure BDA0002313167810000073

其中,参考坐标系为关节角为0的坐标系,A为关节角坐标系到参考坐标系的转换角度。

具体的,期望本体角速度Wb的计算公式如下:

Wb=Rj→b*Wj

其中,Rj→b为云台关节角坐标系和云台本体坐标系之间的转换关系,如下所示:

Figure BDA0002313167810000074

其中,inn_joint_ang_rad为内框关节角,mid_joint_ang_rad为中框关节角。

针对两轴云台,云台关节角坐标系和云台本体坐标系之间的转换关系Rj→b的转换如下:

Figure BDA0002313167810000075

进一步的,可以依据期望本体角速度、云台本体坐标系和欧拉坐标系之间的转换关系,将期望本体角速度转换成期望欧拉角速度。其中,期望欧拉角速度

Figure BDA0002313167810000078

的计算公式如下:

Figure BDA0002313167810000076

其中,

Figure BDA0002313167810000077

为云台本体坐标系和欧拉坐标系之间的转换关系,具体如下:

Figure BDA0002313167810000081

其中,inn_euler_ang_rad为内框欧拉角,mid_euler_ang_rad为中框欧拉角,内框欧拉角和中框欧拉角均为上一次闭环时云台100的期望欧拉角,也即上一次闭环结束时云台100的实时姿态。

如此,通过上述流程,可以将期望关节角速度经由云台本体坐标系转换为期望欧拉角速度。并在确定期望欧拉角速度后,可以依据期望欧拉角速度和云台100的当前姿态,确定云台100的期望姿态。假设云台100的运动时长为t,期望姿态可如下所示:

Figure BDA0002313167810000082

其中,tar_euler_roll(t)为期望姿态中对应横滚轴的分量,tar_euler_pitch(t)为期望姿态中对应俯仰轴的分量,tar_euler_yaw(t)为期望姿态中对应偏航轴的分量,Wx为对应横滚轴的期望欧拉角速度,Wy为对应俯仰轴的期望欧拉角速度,Wz为对应偏航轴的期望欧拉角速度,tar_euler_roll_init为当前姿态中对应横滚轴的欧拉角,tar_euler_pitch_init为当前姿态中对应俯仰轴的欧拉角,tar_euler_yaw_init为当前姿态中对应偏航轴的欧拉角。

综上,根据云台100的运动时长t以及预设关节角,可获悉云台100在任意时刻的期望姿态,也即,云台100中各个框架对应的预设关节角。同时,可以根据当前姿态以及得到的期望姿态,可以利用姿态闭环实现对云台100的控制,以使得云台100中的转轴结构10相对于手持部50可以保持预设姿态,从而使得云台100符合预设的收纳形态。

在上述示例中偏航轴框架156为外框、横滚轴框架152为中框、俯仰轴框架154为内框,可以理解,在其他实施方式中,各个框架的连接关系也可以是其他,在此不作具体限定。

可以理解,在转轴结构10为多个时,可以根据每个转轴结构10的工作参数分别对各个转轴结构10进行对应的控制。例如转轴结构10包括横滚转轴结构11、俯仰转轴结构12和偏航转轴结构13,可以通过各个转轴结构10的角度传感器获取各个转轴结构10的当前关节角,再根据各个转轴结构10的当前关节角和预设关节角对转轴结构10进行关节角闭环控制。同理,也可以根据各个转轴结构10相对于手持部50的当前姿态和预设姿态对转轴结构10进行姿态闭环控制。其中,当前姿态和预设姿态应当理解为姿态分量,例如云台100的当前姿态(roll,pitch,yaw)为(A,B,C),则横滚转轴结构11的当前姿态分量为A,俯仰转轴结构12的当前姿态分量为B,偏航转轴结构13的当前姿态分量为C。

在某些实施方式中,当横滚轴、俯仰轴、偏航轴分别正交,且第一设定关节角、第二设定关节角和第三设定关节角均为0度时,则通过关节角闭环控制方式可以将转轴结构10转动至任意关节角,而在特殊构型的云台100(例如pitch-roll-yaw三轴正交的构型)中,由于姿态闭环控制方式存在万向节锁死的限制,则姿态闭环控制方式不能将横滚转轴结构11的关节角调整为正90度或负90度。因此,在上述情况下,若需要对横滚轴结构相对于0度的关节角进行正90度或负90度的调整,可以优先选择利用关节角闭环进行控制。而在其他实施方式中,当横滚轴、俯仰轴、偏航轴中存在非正交情况,或者在正交时不需要对横滚轴相对于0度的关节角进行正90度或负90度的调整时,可以选择关节角闭环或姿态闭环的方式进行控制,以使得云台100符合预设的收纳形态。

其中,对于转轴结构10的转动范围大于360度的情况而言,转轴结构10在同一姿态对应的预设关节角可以存在多个,例如,当横滚轴结构11相对于手持部50的姿态为预设姿态时,若横滚转轴结构11对应的预设关节角相对于第一设定关节角的差值可以为正90度,则在第一设定关节角为0度时,横滚转轴结构11对应的预设关节角还可以为90度+360度,90度+720度,90度-360度等。同样地,俯仰转轴结构12和偏航转轴结构13对应的关节角类似,在此不再赘述。而转轴结构10相对于手持部50的预设姿态是唯一的,例如横滚转轴结构11的横滚轴框架152所在的平面相对于手持部50倾斜45度为预设姿态,其对应的预设关节角可以为多个。

如此,可知,在当转轴结构10的转动范围大于360度的情况下,可以在多个预设关节角中进行选择,以选择有利于控制转轴结构10的预设关节角,例如,以减小转轴结构10的转动行程或转动时间为目的,在多个预设关节角中选择与当前关节角的差值最小的一个预设关节角作为进行姿态控制的关节角。

请参阅图10,在某些实施方式中,步骤01包括:

013:控制转轴结构10以预设速度转动至设定位置。

以图2的手持云台100为例,在某些实施方式中,处理器20用于控制转轴结构10以预设速度转动至设定位置。

也即是说,步骤013可以由处理器20实现。

具体地,控制转轴结构10时,转轴结构10可以以预设速度进行转动,该预设速度可以预先设置在云台100的存储元件中。预设速度例如为恒定值,如此,便于对转轴结构10进行控制。预设速度还可以具有先增大再减小的变化趋势,如此,可以先以较大的速度接近设定位置以减少转动至设定位置所需的时间,在接近设定位置后减小速度以防止撞到转轴结构10的限位,并且可以避免出现超过设定位置后再返回的情况。另外,预设速度还可以根据转轴结构10的当前位置与设定位置之间的差异确定,其中,当前位置与设定位置之间的差异可以是指关节角偏差或姿态偏差,如此,预设速度可以根据实际操作需要实时确定,例如在当前位置与设定位置之间的差异比较大时,预设速度可以比较大,在当前位置与设定位置之间的差异比较小时,预设速度可以比较小等,在此不做具体限定。

请参阅图11,在某些实施方式中,方法还包括:

04:在预设时长内判断是否发生开机事件;

05:在发生开机事件时,控制云台100退出收纳模式并切换至开机模式。

以图2的手持云台100为例,在某些实施方式中,处理器20还用于:在预设时长内判断是否发生开机事件;在发生开机事件时,控制云台100退出收纳模式并切换至开机模式。

也即是说,步骤04和步骤05可以由处理器20实现。

具体地,在云台100处于收纳模式时,通常云台100不是处于工作状态,因此,若在预设时长内判断发生开机事件,则可以控制云台100退出收纳模式并切换至开机模式。其中,在开机模式下转轴电机可以重新进行自检(例如自检是否撞限位)并完成开机所需要的整个流程。在预设时长内没发生开机事件时,则可以在预设时长后控制云台100进入关机模式或进入待机模式。

在某些实施方式中,触发事件和/或开机事件通过按下按钮、人的触控操作、人的生物特征验证、云台100的移动、云台100的状态改变中的一种或多种来触发。

在某些实施方式中,进入收纳模式的触发事件和/或开机事件通过按下按钮来触发,可以是:云台100上例如包括物理按钮(比如开关机按钮),云台100可以在处于开机模式时通过按下(短按或者长按)该开关机按钮进入收纳模式,云台100可以在处于关机模式或收纳模式时,通过按下(短按或者长按)该开关机按钮进入收纳模式。当然,在其他实施方式中,可以通过短按或者长按来控制云台100进入收纳模式还是进入正常的关机模式,也可以通过不同的按钮分别实现触发事件和开机事件。另外,还可以通过按下遥控器的按钮来触发进入收纳模式的触发事件和/或开机事件,其中,遥控器与云台100进行通信,在此不做具体限定。

可以理解,云台100的收纳模式与关机模式可以由一次触发事件来触发,例如,通过短按开关机按钮,可以进入收纳模式,并在预设时长后自动进入关机模式。同样地,云台100的收纳模式与待机模式也可以由一次触发事件来触发。

在某些实施方式中,按钮也可以是虚拟按钮,例如云台100上的触摸显示屏上的图标,可以通过人的触控操作来触发进入收纳模式的触发事件和/或开机事件。当然,该虚拟按钮也可以设于与云台100通信的遥控器上。

在某些实施方式中,触发事件和/或开机事件通过人的生物特征验证来触发,可以是:通过人脸识别、虹膜识别、指纹识别等方式来触发进入收纳模式的触发事件和/或开机事件,例如当通过指纹识别检测到用户的左手食指时,触发进入收纳模式的触发事件;当通过指纹识别检测到用户的左手大拇指时,触发开机事件。当然,该生物特征验证也可以通过与云台100通信的遥控器来实现。

在某些实施方式中,触发事件和/或开机事件通过云台100的移动来触发,可以是:在云台100满足预定的移动轨迹时触发进入收纳模式的触发事件和/或开机事件,例如当云台100的移动轨迹为向上移动时,触发进入收纳模式的触发事件;当云台100的移动轨迹为左右晃动时,触发开机事件。

在某些实施方式中,触发事件和/或开机事件通过云台100的状态改变来触发,可以是:根据云台100的转轴结构10的姿态变化来触发进入收纳模式的触发事件和/或开机事件,例如当用户摆动转轴结构10以使转轴结构10合拢时,触发进入收纳模式的触发事件;当用户摆动转轴结构10以使转轴结构10展开时,触发开机事件。

请参阅图12,在某些实施方式中,在控制转轴结构10转动至设定位置之前,方法还包括:

06:检测云台100是否满足预设的收纳形态;

07:若云台100不满足预设的收纳形态,则触发执行控制转轴结构10转动至设定位置,以使得云台100满足预设的收纳形态。

以图2的手持云台100为例,在某些实施方式中,处理器20还用于:检测云台100是否满足预设的收纳形态;若云台100不满足预设的收纳形态,则触发执行控制转轴结构10转动至设定位置,以使得云台100满足预设的收纳形态。

也即是说,步骤06和步骤07可以由处理器20实现。

具体地,在转动转轴结构10前,可以先检测云台100是否满足预设的收纳形态,即检测转轴结构10的当前位置是否为设定位置(例如检测当前关节角是否为预设关节角,或检测转轴结构10相对于手持部50的当前姿态是否为预设姿态),在转轴结构10的当前位置不是设定位置时,云台100不满足预设的收纳形态,此时可以转动转轴结构10以使转轴结构10转动至设定位置,从而云台100能够满足预设的收纳形态以方便放入收纳盒200中。

请再次参阅图12,在某些实施方式中,在步骤06之后,方法还包括:

08:若云台100满足预设的收纳形态,则控制云台100以预设的收纳形态保持预设时长。

以图2的手持云台100为例,在某些实施方式中,处理器20还用于若云台100满足预设的收纳形态,则控制云台100以预设的收纳形态保持预设时长。

也即是说,步骤08可以由处理器20实现。

如此,可以在检测到云台100满足预设的收纳形态时,直接控制云台100以预设的收纳形态保持预设时长,从而用户可以在该预设时长内将云台100放入收纳盒200中。另外,在检测到云台100满足预设的收纳形态时,可以避免对转轴结构10进行不必要的转动,从而可以降低云台100的功耗。

本发明实施方式的云台100可以应用于移动平台,也即是说,移动平台可以包括上述任意一种实施方式的云台100。另外,移动平台还可以包括本体,云台100设置在本体上。其中,当移动平台为手持云台时,移动平台的本体可以为手持云台的手持部。当然,移动平台可以例如包括小车、飞行器、机器人等,其本体上的云台100可以搭载有成像装置和/或射击装置和/或其它功能模块,同时,本体作为移动平台的机身,可以作为云台100的手持部。当然,在移动平台的本体上设有云台100时,除本体外,移动平台中任一处可手持的部分均可以作为云台100的手持部。

请参阅图13,本发明实施方式以移动平台为飞行器1000为例,飞行器1000包括云台100和本体300,本体300例如包括中心架、与所述中心架连接的机臂以及与所述机臂连接的动力单元等。

在一个实施例中,飞行器1000还开设有收纳槽(图未示),在检测到指示云台100进入收纳模式的触发事件时,控制转轴结构10转动至设定位置,从而使得云台100满足预设的收纳形态,进而可以将云台100收纳到收纳槽中。可以理解,移动平台的本体与移动平台的类型相对应,例如移动平台为小车时,本体为小车。

可以理解,飞行器1000也可以不设有收纳槽,通过控制云台100相对于本体的位置在预设时长内不变,也可以便于飞行器1000的收纳。

请参阅图14,本发明实施方式的计算机可读存储介质400包括计算机程序,所述计算机程序可被处理器20执行以完成上述任意一种实施方式的控制方法。

例如,请结合图1和图14,计算机程序可被处理器20执行以完成以下步骤所述的控制方法:

01:在检测到指示云台100进入收纳模式的触发事件时,控制转轴结构10转动至设定位置,以使得云台100满足预设的收纳形态;

02:控制转轴结构10在设定位置保持预设时长。

再例如,请结合图3和图14,计算机程序还可被处理器20执行以完成以下步骤所述的控制方法:

03:控制云台100进入关机模式,或控制云台100进入待机模式。

在本说明书的描述中,参考术语“一个实施方式”、“一些实施方式”、“示意性实施方式”、“示例”、“具体示例”、或“一些示例”等的描述意指结合所述实施方式或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施方式或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施方式或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施方式或示例中以合适的方式结合。

流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更多个用于执行特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本发明的优选实施方式的范围包括另外的执行,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本发明的实施例所属技术领域的技术人员所理解。

在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于执行逻辑功能的可执行指令的定序列表,可以具体执行在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。

应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来执行。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来执行。例如,如果用硬件来执行,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来执行:具有用于对数据信号执行逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。

本技术领域的普通技术人员可以理解执行上述实施方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。

此外,在本发明各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式执行,也可以采用软件功能模块的形式执行。所述集成的模块如果以软件功能模块的形式执行并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。

上述提到的存储介质可以是只读存储器,磁盘或光盘等。尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

23页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:竖向增稳机构及其控制方法以及可移动设备

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!