云台姿态控制方法、装置、设备及存储介质与流程

摘要: 本技术涉及云台控制,尤其涉及一种云台姿态控制方法、装置、设备及存储介质。背景技术:1、三轴云台通常以偏航、横滚、俯仰三个电机串联承载相机,增稳时以相机的水平姿态...
云台姿态控制方法、装置、设备及存储介质与流程

本技术涉及云台控制,尤其涉及一种云台姿态控制方法、装置、设备及存储介质。

背景技术:

1、三轴云台通常以偏航、横滚、俯仰三个电机串联承载相机,增稳时以相机的水平姿态角作为控制目标。惯性测量单元与相机固定安装,姿态解算给出相机相对水平面的姿态角。横滚方向的增稳取姿态角中的横滚分量作为反馈量,目标值固定设为0°,位置环据此驱动横滚电机,将相机的横滚倾角维持在0°附近。

2、然而当机身竖放、倒置或大角度侧倾时,上述单一水平基准不再适用。机身侧倾90°时,相机要维持水平,横滚轴需反方向转过90°,而便携云台的横滚轴行程由于受结构包络限制,横滚轴单侧可达行程仅约42°,转动需求超出可达行程,横滚轴持续转动至限位处停止,位置环误差长期不收敛,输出持续处于上限,堵转保护随后判定异常并卸力,造成增稳功能整体退出。

3、因此如何使云台处于不同倾斜角度时,仍能正常增稳,适应不同工况,是本领域亟需解决的技术问题。

技术实现思路

1、本技术的主要目的在于提供一种云台姿态控制方法、装置、设备及存储介质,旨在解决如何使云台处于不同倾斜角度时,仍能正常增稳,适应不同工况的技术问题。

2、为实现上述目的,本技术提供一种云台姿态控制方法,包括:

3、获取云台机身横滚角、当前云台基准档位、相机俯仰倾角和俯仰关节角;

4、根据所述相机俯仰倾角和所述俯仰关节角进行相机竖直判定,得到相机竖直判定结果;

5、在所述相机竖直判定结果为相机未进入竖直状态的情况下,根据所述当前云台基准档位对应的角度和所述云台机身横滚角,得到云台偏离量;

6、根据所述云台偏离量进行换挡判定,若所述云台偏离量的绝对值大于等于换挡阈值,则将所述当前云台基准档位进行档位切换,得到目标云台基准档位;

7、根据所述目标云台基准档位确定横滚水平目标角度,以完成云台姿态控制。

8、在一实施例中,所述获取云台机身横滚角、当前云台基准档位、相机俯仰倾角和俯仰关节角之后,还包括:

9、根据所述相机俯仰倾角和俯仰关节角,得到机身俯仰角;

10、根据所述机身俯仰角进行机身竖直判定,若所述机身俯仰角的绝对值大于第一机身竖直角度阈值,则机身进入机身竖直状态;

11、在所述机身进入机身竖直状态下,控制横滚轴和俯仰轴退出水平闭环。

12、在一实施例中,所述根据所述机身俯仰角进行机身竖直判定之后,还包括:

13、若所述机身俯仰角的绝对值小于等于第一机身竖直角度阈值且大于等于第二机身竖直角度阈值,则机身状态维持不变,所述第一机身竖直角度阈值大于第二机身竖直角度阈值;

14、根据所述机身俯仰角进行机身竖直判定,若所述机身俯仰角的绝对值小于等于第二机身竖直角度阈值,则机身进入机身水平状态;

15、在所述机身进入机身水平状态下,控制横滚轴和俯仰轴恢复水平闭环,以完成后续云台姿态控制动作。

16、在一实施例中,所述根据所述相机俯仰倾角和所述俯仰关节角进行相机竖直判定,得到相机竖直判定结果之后,还包括:

17、若所述相机俯仰倾角的绝对值落入进入窗口内,或所述俯仰关节角的绝对值大于关节进入阈值,则相机进入竖直状态;

18、在相机进入竖直状态下,冻结当前云台基准档位,并控制横滚轴退出水平闭环。

19、在一实施例中,所述相机进入竖直状态之后,还包括:

20、根据所述相机俯仰倾角、所述俯仰关节角进行相机竖直状态退出判定,若所述相机俯仰倾角的绝对值不落入退出窗口的范围内,且所述俯仰关节角的绝对值小于关节退出阈值,则相机退出竖直状态;

21、在相机退出竖直状态下,控制横滚轴恢复水平闭环,以完成后续云台姿态控制动作。

22、在一实施例中,所述获取云台机身横滚角和当前云台基准档位之后,还包括:

23、根据所述当前云台基准档位进行倒装判定,若所述当前云台基准档位的绝对值大于倒装判据阈值,则判定云台处于倒装工况;

24、在云台处于倒装工况下,将所述相机俯仰倾角进行折算,得到反馈俯仰倾角;

25、根据所述反馈俯仰倾角控制俯仰轴,以完成后续云台姿态控制动作。

26、在一实施例中,所述根据所述云台偏离量进行换挡判定之后,还包括:

27、若所述云台偏离量的绝对值小于换挡阈值,则维持所述当前云台基准档位不变;

28、根据所述当前云台基准档位确定横滚水平目标角度,以完成云台姿态控制。

29、此外,为实现上述目的,本技术还提供一种云台姿态控制装置,包括:

30、获取模块,用于获取云台机身横滚角和当前云台基准档位;

31、竖直判定模块,用于获取相机俯仰倾角和俯仰关节角,并根据所述相机俯仰倾角和所述俯仰关节角进行相机竖直判定,得到相机竖直判定结果;

32、计算模块,用于在所述相机竖直判定结果为相机未进入竖直状态的情况下,根据所述当前云台基准档位对应的角度和所述云台机身横滚角进行偏离计算,得到云台偏离量;

33、换挡判定模块,用于根据所述云台偏离量进行换挡判定,若所述云台偏离量的绝对值大于等于换挡阈值,则将所述当前云台基准档位进行档位切换,得到目标云台基准档位;

34、结果模块,用于根据所述目标云台基准档位确定横滚水平目标角度,以完成云台姿态控制。

35、此外,为实现上述目的,本技术还提出一种云台姿态控制设备,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现如上文所述的云台姿态控制方法的步骤。

36、此外,为实现上述目的,本技术还提出一种存储介质,所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如上文所述的云台姿态控制方法的步骤。

37、本技术由于采用了获取云台机身横滚角、当前云台基准档位、相机俯仰倾角和俯仰关节角、根据相机俯仰倾角和俯仰关节角进行相机竖直判定得到相机竖直判定结果、在相机竖直判定结果为相机未进入竖直状态的情况下根据当前云台基准档位对应的角度和云台机身横滚角得到云台偏离量、在云台偏离量的绝对值大于等于换挡阈值时将当前云台基准档位切换至相邻档位以得到目标云台基准档位、并根据目标云台基准档位确定横滚水平目标角度的技术手段,使横滚水平目标不再固定为单一0°,而是在相机未进入竖直状态时随机身横滚角在多个离散基准档位之间自动切换,横滚轴的转动需求不再随机身侧倾角增大而持续增大,而是在偏离量达到换挡阈值时随基准档位的切换回落至档距与换挡阈值之差以内,从而始终落在其可达行程内,避免了横滚轴持续转动至限位处停止、堵转保护判定异常并卸力导致增稳功能整体退出的情况,进而解决了现有技术以单一0°为横滚水平基准、在机身竖放、倒置或大角度侧倾时横滚轴转动需求超出可达行程、导致云台在非正立工况下无法正常增稳的技术问题,与现有技术相比,使云台在机身处于不同倾斜角度时仍能正常增稳,提升了云台在非正立工况下的工况适应性。