首页 / 专利库 / 物理 / 旋转轴 / 旋转角度控制方法、云台以及计算机可读的记录介质

旋转度控制方法、台以及计算机可读的记录介质

阅读:528发布:2023-03-10

专利汇可以提供旋转度控制方法、台以及计算机可读的记录介质专利检索,专利查询,专利分析的服务。并且一种旋转 角 度控制方法、 云 台以及计算机可读的记录介质,旋转角度控制方法包括:获得角度控制指令;根据角度控制指令,获得与旋 转轴 对应的关节角的目标关节角值;对所获得的目标关节角值进行校正,使得目标关节角值处于针对关节角的预留余量的给定关节角区间范围内;以及利用校正过的目标关节角值,控制绕 旋转轴 的旋转角度。,下面是旋转度控制方法、台以及计算机可读的记录介质专利的具体信息内容。

1.一种旋转度控制方法,包括:
获得角度控制指令;
根据所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值;
对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内;以及
利用校正过的所述目标关节角值,控制绕所述旋转轴的旋转角度。
2.根据权利要求1所述的旋转角度控制方法,其中,
根据所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值,包括:将所述角度控制指令表示的角度作为所述目标关节角值。
3.根据权利要求2所述的旋转角度控制方法,其中,
在体坐标系的Z轴为竖直的情况下,将所述角度控制指令表示的角度作为所述目标关节角值。
4.根据权利要求2所述的旋转角度控制方法,其中,
对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内,包括:在所获得的所述目标关节角值超过所述预留余量的给定关节角区间范围的情况下,对所获得的所述目标关节角值进行校正,使得所述目标关节角值为所述预留余量的给定关节角区间范围的上限值或下限值。
5.根据权利要求1所述的旋转角度控制方法,其中,
根据所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值,包括:
根据当前基座姿态和所述角度控制指令表示的角度值,计算目标外框架姿态;
根据当前基座姿态和计算出的所述目标外框架姿态,计算所述关节角的临时目标关节角值;
根据所述关节角的初始关节角值、所述角度控制指令表示的方向和计算出的所述临时目标关节角值,计算所述目标关节角值。
6.根据权利要求5所述的旋转角度控制方法,其中,
通过角度传感器测量得到所述初始关节角值,
根据加速度计和陀螺仪融合,并且利用相应角度传感器,得到所述基座姿态。
7.根据权利要求5所述的旋转角度控制方法,其中,
台上置、并且所述角度控制指令的方向为正的情况下,若所述临时目标关节角值大于所述初始关节角值,则使所述临时目标关节角值重复减去360度,直到所述临时目标关节角值小于等于所述初始关节角值,
将小于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
8.根据权利要求5所述的旋转角度控制方法,其中,
在云台上置、并且所述角度控制指令的方向为负的情况下,若所述临时目标关节角值小于所述初始关节角值,则使所述临时目标关节角值重复加上360度,直到所述临时目标关节角值大于等于所述初始关节角值,
将大于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
9.根据权利要求5所述的旋转角度控制方法,其中,
在云台下置、并且所述角度控制指令的方向为正的情况下,若所述临时目标关节角值小于所述初始关节角值,则使所述临时目标关节角值重复加上360度,直到所述临时目标关节角值大于等于所述初始关节角值,
将大于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
10.根据权利要求5所述的旋转角度控制方法,其中,
在云台下置、并且所述角度控制指令的方向为负的情况下,若所述临时目标关节角值大于所述初始关节角值,则使所述临时目标关节角值重复减去360度,直到所述临时目标关节角值小于等于所述初始关节角值,
将小于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
11.根据权利要求1至10中任一项所述的旋转角度控制方法,其中,
在所述角度控制指令的方向为正的情况下,从当前姿态顺时针运动到目标姿态,或者在所述角度控制指令的方向为负的情况下,从当前姿态逆时针运动到目标姿态。
12.根据权利要求1至10中任一项所述的旋转角度控制方法,其中,
所述角度控制指令表示在当前姿态的基础上绕世界的X轴、Y轴或Z轴中的至少一个轴继续旋转的角度值以及方向。
13.根据权利要求1至10中任一项所述的旋转角度控制方法,其中,
所述获得角度控制指令,包括:从用户或其他应用获得角度控制指令。
14.根据权利要求1至10中任一项所述的旋转角度控制方法,其中,
所述余量为0至10度,或者
所述余量为5至10度。
15.一种云台,包括:
输入单元,其用于输入角度控制指令;
驱动单元,其用于驱动底座旋转;和
控制单元,其用于控制所述驱动单元,
所述控制单元根据所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值,并且对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内,利用校正过的所述目标关节角值,经由所述驱动单元,控制所述底座绕所述旋转轴的旋转角度。
16.根据权利要求15所述的云台,其中,
所述控制单元将所述角度控制指令表示的角度作为所述目标关节角值。
17.根据权利要求16所述的云台,其中,
在所述云台的体坐标系的Z轴为竖直的情况下,所述控制单元将所述角度控制指令表示的角度作为所述目标关节角值。
18.根据权利要求16所述的云台,其中,
在所获得的所述目标关节角值超过所述预留余量的给定关节角区间范围的情况下,所述控制单元对所获得的所述目标关节角值进行校正,使得所述目标关节角值为所述预留余量的给定关节角区间范围的上限值或下限值。
19.根据权利要求15所述的云台,其中,
所述控制单元:
根据所述云台的当前基座姿态和所述角度控制指令表示的角度值,计算所述云台的目标外框架姿态;
根据所述云台的当前基座姿态和计算出的所述目标外框架姿态,计算所述关节角的临时目标关节角值;
根据所述关节角的初始关节角值、所述角度控制指令表示的方向和计算出的所述临时目标关节角值,计算所述目标关节角值。
20.根据权利要求15所述的云台,其中,还包括:
用于测量所述初始关节角值的角度传感器;以及
用于获得所述基座姿态的加速度计和陀螺仪。
21.根据权利要求15所述的云台,其中,
在云台上置、并且所述角度控制指令的方向为正的情况下,若所述临时目标关节角值大于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复减去360度,直到所述临时目标关节角值小于等于所述初始关节角值,
所述控制单元将小于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
22.根据权利要求15所述的云台,其中,
在云台上置、并且所述角度控制指令的方向为负的情况下,若所述临时目标关节角值小于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复加上360度,直到所述临时目标关节角值大于等于所述初始关节角值,
所述控制单元将大于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
23.根据权利要求15所述的云台,其中,
在云台下置、并且所述角度控制指令的方向为正的情况下,若所述临时目标关节角值小于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复加上360度,直到所述临时目标关节角值大于等于所述初始关节角值,
所述控制单元将大于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
24.根据权利要求15所述的云台,其中,
在云台下置、并且所述角度控制指令的方向为负的情况下,若所述临时目标关节角值大于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复减去360度,直到所述临时目标关节角值小于等于所述初始关节角值,
所述控制单元将小于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
25.根据权利要求15至24中任一项所述的云台,其中,
在所述角度控制指令的方向为正的情况下,所述底座从当前姿态顺时针运动到目标姿态,或者
在所述角度控制指令的方向为负的情况下,所述底座从当前姿态逆时针运动到目标姿态。
26.根据权利要求15至24中任一项所述的云台,其中,
所述角度控制指令表示在当前姿态的基础上绕世界的X轴、Y轴或Z轴中的至少一个轴继续旋转的角度值以及方向。
27.根据权利要求15至24中任一项所述的云台,其中,
所述输入单元从用户或其他模获得角度控制指令。
28.根据权利要求15至24中任一项所述的云台,其中,
所述余量为0至10度,或者
所述余量为5至10度。
29.一种用于云台的旋转角度控制方法,所述云台包括:
输入单元,其用于输入角度控制指令;
驱动单元,其用于驱动底座旋转;和
控制单元,其用于控制所述驱动单元,
所述方法包括:
所述控制单元根据所输入的所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值;
所述控制单元对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内;以及
所述控制单元利用校正过的所述目标关节角值,经由所述驱动单元,控制所述底座绕所述旋转轴的旋转角度。
30.根据权利要求29所述的旋转角度控制方法,其中,
所述控制单元将所输入的所述角度控制指令表示的角度作为所述目标关节角值。
31.根据权利要求30所述的旋转角度控制方法,其中,
在所述云台的体坐标系的Z轴为竖直的情况下,所述控制单元将所述角度控制指令表示的角度作为所述目标关节角值。
32.根据权利要求30所述的旋转角度控制方法,其中,
在所获得的所述目标关节角值超过所述预留余量的给定关节角区间范围的情况下,所述控制单元对所获得的所述目标关节角值进行校正,使得所述目标关节角值为所述预留余量的给定关节角区间范围的上限值或下限值。
33.根据权利要求29所述的旋转角度控制方法,其中,
所述控制单元:
根据所述云台的当前基座姿态和所述角度控制指令表示的角度值,计算所述云台的目标外框架姿态;
根据所述云台的当前基座姿态和计算出的所述目标外框架姿态,计算所述关节角的临时目标关节角值;
根据所述关节角的初始关节角值、所述角度控制指令表示的方向和计算出的所述临时目标关节角值,计算所述目标关节角值。
34.根据权利要求33所述的旋转角度控制方法,其中,
通过角度传感器测量得到所述初始关节角值,
根据加速度计和陀螺仪融合,并且利用相应角度传感器,得到所述基座姿态。
35.根据权利要求33所述的旋转角度控制方法,其中,
在云台上置、并且所述角度控制指令的方向为正的情况下,若所述临时目标关节角值大于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复减去360度,直到所述临时目标关节角值小于等于所述初始关节角值,
所述控制单元将小于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
36.根据权利要求33所述的旋转角度控制方法,其中,
在云台上置、并且所述角度控制指令的方向为负的情况下,若所述临时目标关节角值小于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复加上360度,直到所述临时目标关节角值大于等于所述初始关节角值,
所述控制单元将大于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
37.根据权利要求33所述的旋转角度控制方法,其中,
在云台下置、并且所述角度控制指令的方向为正的情况下,若所述临时目标关节角值小于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复加上360度,直到所述临时目标关节角值大于等于所述初始关节角值,
所述控制单元将大于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
38.根据权利要求33所述的旋转角度控制方法,其中,
在云台下置、并且所述角度控制指令的方向为负的情况下,若所述临时目标关节角值大于所述初始关节角值,则所述控制单元使所述临时目标关节角值重复减去360度,直到所述临时目标关节角值小于等于所述初始关节角值,
所述控制单元将小于等于所述初始关节角值的所述临时目标关节角值作为所述目标关节角值。
39.根据权利要求29至38中任一项所述的旋转角度控制方法,其中,
在所述角度控制指令的方向为正的情况下,所述底座从当前姿态顺时针运动到目标姿态,或者
在所述角度控制指令的方向为负的情况下,所述底座从当前姿态逆时针运动到目标姿态。
40.根据权利要求29至38中任一项所述的旋转角度控制方法,其中,
所述角度控制指令表示在当前姿态的基础上绕世界的X轴、Y轴或Z轴中的至少一个轴继续旋转的角度值以及方向。
41.根据权利要求29至38中任一项所述的旋转角度控制方法,其中,
所述输入单元从用户或其他模块获得角度控制指令。
42.根据权利要求29至38中任一项所述的旋转角度控制方法,其中,
所述余量为0至10度,或者
所述余量为5至10度。
43.一种计算机可读的记录介质,存储有可执行指令,该指令被处理器执行时使该处理器执行权利要求1至14中任一项或权利要求29至42中任一项所述的旋转角度控制方法。

说明书全文

旋转度控制方法、台以及计算机可读的记录介质

技术领域

[0001] 本发明涉及旋转角度控制方法、云台以及计算机可读的记录介质。

背景技术

[0002] 为了满足其他模如导航(全景模式)等对云台角度控制的需求,为了提供给用户对云台进行二次开发的需要,云台开放给其他模块受控设备控制角度的协议,方便其他模块控制云台角度。然而,云台无法保证收到的指令的合理性,错误的指令数据会使得云台非常快速撞到限位,并且有可能一直怼着而无法结束角度控制模式,有烧坏电机险,并且影响用户体验。
[0003] 为了克服上述问题,防止烧坏电机,例如在现有的手持云台上的限位保护方式采用的是温度保护策略,也就是当检测到电机输出饱和超过一定时间时,认为电机堵转,此时进入保护模式,云台软掉不出。虽然该方法可以减少烧坏电机的风险,但是也非常影响用户体验,这种用着用着就云台软掉无法正常运行的场景也会让用户感到困惑。

发明内容

[0004] 本发明鉴于上述的情况而研发,目的在于提供一种旋转角度控制方法、云台以及计算机可读的记录介质,在根据从外界(例如,其他模块、其他应用、用户)获得的角度控制指令进行旋转时能够规避撞限位,此外能够解决云台在收到不合理的外界控制指令时由于堵转而软掉无力的问题。
[0005] 为了解决上述的至少部分问题,本发明的一个方面提供了一种旋转角度控制方法,包括:获得角度控制指令;根据所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值;对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内;以及利用校正过的所述目标关节角值,控制绕所述旋转轴的旋转角度。
[0006] 此外,本发明的另一个方面提供了一种云台,包括:输入单元,其用于输入角度控制指令;驱动单元,其用于驱动底座旋转;和控制单元,其用于控制所述驱动单元,所述控制单元根据所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值,并且对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内,利用校正过的所述目标关节角值,经由所述驱动单元,控制所述底座绕所述旋转轴的旋转角度。
[0007] 此外,本发明的另一个方面提供了一种用于云台的旋转角度控制方法,所述云台包括:输入单元,其用于输入角度控制指令;驱动单元,其用于驱动底座旋转;和控制单元,其用于控制所述驱动单元,所述方法包括:所述控制单元根据所输入的所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值;所述控制单元对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内;以及所述控制单元利用校正过的所述目标关节角值,经由所述驱动单元,控制所述底座绕所述旋转轴的旋转角度。
[0008] 此外,本发明的另一个方面提供了一种计算机可读的记录介质,存储有可执行指令,该指令被处理器执行时使该处理器执行上述的旋转角度控制方法。
[0009] 根据本发明,在根据从外界(例如,其他模块、其他应用、用户)获得的角度控制指令进行旋转时,通过由所获得的角度控制指令,获得目标关节角的值,并且进行校正使得目标关节角的值处于预留余量的关节角区间范围内,利用校正过的目标关节角控制旋转角度,从而能够规避撞限位,在将本发明应用于云台时,能够解决云台在收到不合理的外界控制指令时由于堵转而软掉无力的问题。附图说明
[0010] 本发明的上述和/或附加的方面和优点从结合下面附图对实施方式的描述中将变得明显和容易理解。
[0011] 图1是示意性示出根据本发明实施方式的手持云台的立体图。
[0012] 图2是示出根据本发明实施方式的旋转角度控制方法的流程图
[0013] 图3是示出根据本发明实施方式的用于根据角度控制指令获得目标关节角的方法的流程图。
[0014] 图4是示出根据本发明实施方式的云台的示例框图

具体实施方式

[0015] 下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
[0016] 下文的公开提供了许多不同的实施方式或实施例用来实现本发明的不同结构。为了简化本发明的公开,下文中对特定例子的部件和设置进行描述。当然,它们仅仅为示例,并且目的不在于限制本发明。
[0017] 除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
[0018] 本发明总体上提出了一种旋转角度控制方法、云台以及计算机可读的记录介质。
[0019] 大体上,本发明的技术思想在于在根据从外界(例如,其他模块、其他应用、用户等)获得的角度控制指令进行旋转时,通过由所获得的角度控制指令,获得与旋转轴对应的关节角的目标关节角值,并且对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内,利用校正过的所述目标关节角值,控制绕所述旋转轴的旋转角度,从而能够规避撞限位,在将本发明应用于云台时,能够解决云台在收到不合理的外界控制指令时由于堵转而软掉无力的问题。
[0020] 其中,所谓关节角,指的是关节空间内的旋转角度,能够通过角度传感器测量来获得关节角。例如,在云台上,在关节处安装角度传感器(例如,霍尔传感器),传感器反馈的关节角的值即为关节角的测量值。在根据角度控制指令对旋转角度进行控制时,所针对的关节角是与旋转轴对应的关节角。具体的是在体坐标系上与旋转轴对应的关节角。
[0021] 此外,所谓给定关节角区间范围,指的是相应关节角在关节空间内能够达到的角度区间范围。对于关节角区间范围,首先在设计上会有一个设计的限位范围,在此基础上考虑一定的制造误差、安装误差等,可以定义出厂为良品的限位范围区间,此外,优选将良品限位范围区间的最小范围值作为限位区间的范围。
[0022] 例如,在将本发明的旋转角度控制方法应用于云台时,例如,手持云台,可以针对绕偏航(yaw)轴、俯仰(pitch)轴和横滚(roll)轴中的至少任一个轴的旋转,来应用本发明的旋转角度控制方法。
[0023] 下面结合附图,对本发明的一些实施方式进行详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。
[0024] 作为本发明的一个实施方式,下面,针对将本发明应用于手持云台并且针对偏航轴进行控制的情况为例进行说明。
[0025] 图1是示意性示出根据本发明实施方式的手持云台的立体图。如图1所示,本发明的手持云台100可以包括以下部件:用于固定摄像单元的底座110、增稳执行组件120、以及用于支承增稳执行组件120的手柄(也称为基座)130。增稳执行组件120从外至内依次包括外框架、中框架和内框架。本实施例中,所述底座110即为内框架,所述内框架为俯仰(pitch)轴框架,所述中框架为横滚(roll)轴框架,而所述外框架为偏航(yaw)轴框架。可以理解的是,所述底座110也可以是与增稳执行组件120直接连接的摄影相机。
[0026] 首先,考虑到手持云台100缺乏绝对的航向参考,按照一般的北东地坐标系即NED(North East Down)坐标系定义,当yaw轴角度为0时指向的应该是正北方向,而手持云台100并不知道哪里是北面。并且正是因为没有航向参考,因此增稳执行组件120的姿态会因为陀螺仪漂移(bias)一直在漂,即使期望达到的目标姿态不变,但是运动实际到达的姿态与期望到达的姿态之间会有差距,且该差距与运动的距离和时间有关,距离越长,时间越长,该差距越大,从而yaw轴的绝对姿态角度是不可信的。针对该问题,在本发明中定义了一种绝对模式,绝对模式下的输入指令为带有正负的关节角的值,运动到指定关节角的位置,规划运动到目标姿态位置,其中,关节角的正负表示旋转的方向,例如“正”表示顺时针方向,“负”表示逆时针方向。
[0027] NED坐标系也可以简称为n坐标系,也称为导航坐标系,是在导航时根据导航系统工作的需要而选取的用于导航结算的参考坐标系。
[0028] 其中,NED坐标系各轴的定义:
[0029] N——北轴指向地球北;
[0030] E——东轴指向地球东;
[0031] D——地轴垂直于地球表面并指向上方。
[0032] 也就是说按照一般的协议定义,如果在绝对模式下,yaw轴角度输入为0的时候,增稳执行组件120应该正对到正北的位置。但是由于手持时缺乏绝对航向参考(比如说飞机会有指南针可以表明北方),姿态的传感器来源只有加速度计和陀螺仪,陀螺仪由于存在漂移,因此时间越长,姿态角漂的越厉害,同样的姿态角度,在不同的时间可能实际上这个时候指的是北,过一段时间指的就是南了,因此没有参考的意义。而在本发明中,使用与旋转轴对应的关节角来作为绝对参考,而且例如一般进行全景拍摄时,摄像单元是放在底座110上进行拍摄的,此时世界坐标系和体坐标系基本重合,这种情况下从位置A运动到位置B,可以表示为|关节角A-关节角B|。
[0033] 在本发明中,绝对模式例如可以考虑如下两种不同的实现方式。
[0034] 实现方式一,以基座姿态为绝对参考,若希望绕基座姿态正方向旋转a角度,则输入为+a角度;
[0035] 实现方式二,输入直接是关节角,考虑到一般而言手柄是正放的或者倒放的,体坐标系的Z轴基本上也是竖直的,关节角与姿态角的值大致相等(不考虑正负号)。
[0036] 在本发明中,手柄正放时,也称为云台正放、云台上置;手柄倒放时,也称为云台倒放、云台下置。
[0037] 当采用实现方式一时,可以根据基座姿态+绕基座姿态旋转的角度来计算增稳执行组件120的目标姿态,按照和后述的增量模式(offset模式)大致相同的方式,根据目标姿态来计算目标关节角。根据限位范围限制在可行范围内,再根据修正后的目标关节角来计算目标姿态。
[0038] 当采用实现方式二时,可以将输入作为目标关节角,根据目标关节角范围限制在限位范围内。
[0039] 例如,给定关节角区间范围即关节角限位范围是[-220,65]度,若留5度余量,则控制可达范围就是[-215,60]度,若输入角度是100度,则限制在可达范围内,即修正为60度。
[0040] 此外,在本发明中,可以定义增量模式(offset模式),考虑到一般用户可能无法理解欧拉角的含义,比如说,用户输入:以当前为基准,运动到300度的位置。其实是希望增稳执行组件120能够向右转到300度的位置,然而,如果真的运动到欧拉角300度的位置,实际上增稳执行组件120会向左转到-60度的位置(300=-60+360,表示同一个方位)。因此,在本发明的实施方式中定义:输入为在当前姿态的基础上绕世界的Z轴继续旋转的角度值,因此yaw轴角度命令为正时意味着顺时针方向的旋转,不管输入的角度大小是多少,当云台100正放时增稳执行组件120均会向右运动。
[0041] 在本发明中,在上述两种模式定义下,对所获得的角度控制指令进行校正,控制增稳执行组件120转到任意可达的地方。
[0042] 在绝对模式下,由于输入为关节角,所以规避限位的方式很简单,只要限制目标关节角在可达关节角范围内即可。
[0043] 在增量模式下,根据当前关节角和目标关节角的差来设置速度的方向。在本发明中考虑:
[0044] 云台上置(正放):绕世界的Z轴正方向旋转,姿态的yaw角增加,关节角减小;
[0045] 云台下置(倒放):绕世界的Z轴正方向旋转,姿态的yaw角增加,关节角增加;
[0046] 云台上置的时候,目标关节角大于当前关节角的时候,姿态yaw应该往负方向去运动,给负方向的速度;目标关节角<当前关节角时,姿态yaw往正方向运动,给正方向的速度;
[0047] 云台下置的时候,目标关节角小于当前关节角的时候,姿态yaw应该往负方向去运动,给负方向的速度;目标关节角>当前关节角时,姿态yaw往正方向运动,给正方向的速度。
[0048] 图2是示出根据本发明实施方式的旋转角度控制方法的流程图。如图2所示,在本发明的一个实施方式的旋转角度控制方法中包括:步骤S201,获得角度控制指令;步骤S202,根据所获得的角度控制指令,获得与旋转轴对应的关节角的目标关节角值;步骤S203,对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内;以及步骤S204,利用校正过的所述目标关节角值,控制绕所述旋转轴的旋转角度。
[0049] 在本发明定义的绝对模式下,可以将角度控制指令表示的角度作为目标关节角值。进一步,优选在体坐标系的Z轴为竖直的情况下,将角度控制指令表示的角度作为目标关节角值。
[0050] 在本发明中,可以在所获得的目标关节角值超过预留余量的给定关节角区间范围的情况下,对所获得的目标关节角值进行校正,使得目标关节角值为预留余量的给定关节角区间范围的上限值或下限值。
[0051] 图3是示出根据本发明实施方式的用于根据角度控制指令获得目标关节角的方法的流程图。在本发明定义的绝对模式和/或增量模式下,如图3所示,根据角度控制指令获得目标关节角的值,包括:步骤S301,根据当前基座姿态和角度控制指令表示的角度值,计算目标外框架姿态;步骤S302,根据当前基座姿态和目标外框架姿态,计算临时目标关节角值;和步骤S303,根据初始关节角值、角度控制指令表示的方向和临时目标关节角值,计算目标关节角值。
[0052] 具体而言,开始的时候记录初始关节角值joint_angle_init,关节角的值可以通过角度传感器测量来得到。在相关的关节处,安装有角度传感器,例如霍尔传感器或者磁编码器,从传感器可以获得到角度的测量值。根据加速度计和陀螺仪融合,并且利用相应角度传感器,得到基座姿态、目标外框架姿态。
[0053] 根据目标外框架姿态q(tar_outer_arm)、基座姿态Q(atti_handle)以及输入的yaw轴角度命令(带有方向),计算目标关节角q(tar_joint_angle[euler_y])的值。
[0054] 若基座姿态已知,目标外框架姿态已知,则根据Q(atti_handle)*q(tar_joint_angle[euler_y])=q(tar_outer_arm),可求得q(tar_joint_angle[euler_y]),该四元数表示绕瞬时z轴的旋转,可解得旋转角度,该角度与关节角的值是相等的。即为临时目标关节角值tar_joint_angle_tmp[euler_y]。
[0055] 在本发明中,根据加速度计和陀螺仪融合能够得到增稳执行组件120的测量姿态,通过角度传感器测量能够得到增稳执行组件120的各个关节角的关节角值。从手持云台100的基座(也即手柄)姿态到增稳执行组件姿态经过了三次旋转,从基座姿态沿着基座的Z轴旋转外框架的关节角值joint_angle[frame_out]可以得到外框架的姿态,外框架沿着外框架的X轴旋转中框架的关节角值joint_angle[frame_mid]可以得到中框架的姿态,中框架沿着中框架的Y轴旋转中框架的关节角值[frame_inn]可以得到内框架的姿态,内框架的姿态即为增稳执行组件120的姿态。反之,若已知增稳执行组件120的姿态,已知外框架、中框架和内框架的关节角,则可以得到基座的测量姿态,即基座姿态。
[0056] 在本发明的一个实施方式中,外框架目标姿态的yaw也就是根据用户输入计算出来的姿态目标。
[0057] 如果用的是NED模式定义,以基座姿态为绝对参考,若希望绕基座姿态正方向旋转a角度,则输入为+a角度,假设基座当前姿态yaw是yaw_handle,用户输入角度是a,则增稳执行组件120的目标姿态yaw即为a+yaw_handle;此也即增稳执行组件120的外框架的目标姿态。
[0058] 如果输入是目标关节角,则不用经过此运算,可以直接得到目标关节角tar_joint_angle等于用户输入。
[0059] 如果用的是offset模式,则假设增稳执行组件120的当前姿态为yaw_camera,用户输入角度是b,则增稳执行组件120的目标姿态为offset+yaw,此也即增稳执行组件120的内框架的目标姿态。
[0060] 在云台上置的情况下,yaw轴命令角度为正的时,用户想要从当前姿态顺时针运动到目标姿态,则目标关节角tar_joint_angle应该<初始关节角joint_angle_init;若计算得到的临时目标关节角tar_joint_angle_tmp>joint_angle_init,则tar_joint_angle_tmp-2PI一直减到小于等于joint_angle_init为止。然后再将tar_joint_angle限制在关节角区间范围内。
[0061] 云台上置情况下:yaw轴命令角度为负的时,用户想要从当前姿态逆时针运动到目标姿态,则tar_joint_angle应该>joint_angle_init;若计算得到的tar_joint_angle_tmp<joint_angle_init,tar_joint_angle_tmp+2PI一直加到大于等于joint_angle_init为止。然后再将tar_joint_angle限制在关节角区间范围内。
[0062] 云台下置的时候:yaw轴命令角度为正的时,用户想要从当前姿态顺时针运动到目标姿态,则tar_joint_angle应该>joint_angle_init;若计算得到的tar_joint_angle_tmp<joint_angle_init,tar_joint_angle_tmp+2PI一直加到大于等于joint_angle_init为止。然后再将tar_joint_angle限制在关节角区间范围内。
[0063] 云台下置的时候:yaw轴命令角度为负的时,用户想要从当前姿态逆时针运动到目标姿态,则tar_joint_angle应该<joint_angle_init;若计算得到的tar_joint_angle_tmp>joint_angle_init,tar_joint_angle_tmp-2PI一直减到小于等于joint_angle_init为止。然后再将tar_joint_angle限制在关节角区间范围内。
[0064] 此外,在本发明中,优选进行校正使得所述目标关节角值处于预留余量的给定关节角区间范围内。
[0065] 此外,在本发明中,优选在所获得的目标关节角值超过预留余量的给定关节角区间范围的情况下,进行校正使得目标关节角值为预留余量的给定关节角区间范围的上限值或下限值。
[0066] 此外,在本发明中,所述余量优选为0至10度,更优选为5至10度。
[0067] 此外,在本发明中,优选在角度控制指令的方向为正的情况下,从当前姿态顺时针运动到目标姿态。
[0068] 此外,在本发明中,优选在角度控制指令的方向为负的情况下,从当前姿态逆时针运动到目标姿态。
[0069] 此外,在本发明中,优选角度控制指令表示在当前姿态的基础上绕世界的X轴、Y轴或Z轴中的至少一个轴继续旋转的角度值以及方向。
[0070] 图4是示出根据本发明实施方式的云台的示例框图。如图4所示,根据本发明实施方式的云台400包括:输入单元401,其用于输入角度控制指令;驱动单元402,其用于驱动底座旋转;和控制单元403,其用于控制所述驱动单元,所述控制单元403根据所述角度控制指令,获得与旋转轴对应的关节角的目标关节角值,并且对所获得的所述目标关节角值进行校正,使得所述目标关节角值处于针对所述关节角的预留余量的给定关节角区间范围内,利用校正过的所述目标关节角值,经由所述驱动单元402,控制所述底座绕所述旋转轴的旋转角度。
[0071] 根据本发明,根据计算得到的目标关节角来控制增稳执行组件运动到指定的位置,即可保证若当指令是合法的,会按照用户/其他模块需求运动到指定的位置;若该指令不合法,或者在运动过程中由于手柄运动该姿态从可达变成不可达,也可以运动到限位附近处停止,不会仍然一直运动造成堵转,从而增稳执行组件软掉不可控。
[0072] 此外,根据本发明,用户不用理解关节角和欧拉角的相应含义,只需要了解增稳执行组件会按照用户给的角度值去进行对应方向对应角度的旋转就可以。因此,能够大幅提高用户的使用体验。
[0073] 此外,本发明不仅能够应用于手持云台,还能够适用于有陀螺仪作为传感器的监控系统云台。对于固定的监控系统云台而言,可视作手柄固定不动的手持云台,为了便于控制以及考虑云台性能,这种情况下可以不需要采用本发明中的offset模式,因为手柄不动,只需要在关节空间进行控制即可,不一定需要姿态进行反馈,但是刚好可以采用本发明中的绝对模式。此外,本发明也能够应用于飞行器云台等,而对于具有指南针的飞机、飞行器而言,可以应用本发明中的绝对模式。
[0074] 此外,在上述实施方式中,求解姿态利用了四元数法,但是还可以利用欧拉角(三参数)、方向余弦法(九参数)等来表示姿态,只要适当改变计算方法即可。
[0075] 以上所述仅为本发明的实施方式、实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
相关专利内容
标题 发布/更新时间 阅读量
旋转轴密封装置 2020-05-13 431
旋转轴组件 2020-05-11 468
旋转轴密封结构 2020-05-12 428
旋转轴装置 2020-05-11 622
一种专用旋转轴 2020-05-11 774
旋转轴装置 2020-05-11 785
旋转轴锁紧装置 2020-05-12 309
旋转轴液封装置 2020-05-13 289
旋转轴油封 2020-05-11 735
旋转轴密封件 2020-05-13 929
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈