[发明专利]一种基于陀螺仪的船载稳像控制方法

说明书

技术领域

本发明应用于自稳定的摄像控制系统领域，涉及一种适用于基于惯性传感器陀螺仪的船载稳像系统的实时控制方法。

背景技术

船载稳定摄像技术是稳像技术的一个衍生领域，涉及传感器数据采集、数据滤波融合、运动控制、电机驱动等多个相关的各类学科。

随着近几年安防监控行业的迅速发展，摄像机不仅在道路，楼宇等固定平台上大量使用，而且广泛的应用于船只、汽车和飞行器等多种运动的载体中。与此同时，应用于这些不稳定载体的摄像机监控都存在一个问题：由于安装的载体存在摇晃，无法保证摄像机视角持续瞄准载体以外的监控目标，并且这个问题在船舰上尤为突出。正是因为船舰监控及安全存在的问题，民用、商用的船舰对装备具有自稳定功能的监控云台的需求越来越强烈。

船舰上稳像技术实现一般有两种方式，其中一种是依靠将船载云台安装在额外添加的稳像平台上隔离船体运动干扰，以达到稳定摄像的效果。另外一种就是利用驱动摄像云台本身的电机以及对图像的处理消除船舰摇晃带来的图像摇晃问题。外加稳像平台的方式相对于直接控制云台电机的方式来说具有安装繁琐、体积庞大、增加成本等弊端。而通过处理图像来达到稳像目的的方式不适用于大角度摇晃的船舰上使用。并且处理方法复杂，对处理器要求很高，设备往往昂贵。一般采用电机运动补偿的控制处理方法太过简单，使用的稳像云台不是具有俯仰轴与方位轴的通用云台。扩展性较差。例如在授权公告号为CN203037261 U，发明名称是“一种小型陀螺仪稳像系统”的实用新型专利中，使用具有俯仰轴与翻滚轴的云台作为控制对象。并且处理方式过于简单，并没有对加速度计与陀螺仪的数据进行进一步处理，会导致精度不足。在步进电机控制方面，步进电机的运动方式是以步进角为最小运动单位θ_u运行的，也就是说，系统具有一个高频的噪声，这对于控制器的微分量u(D)是一个很强的干扰对造成系统的自激扰动。由于没有对步进电机加减速控制方式的优化，很容易造成步进电机的失步越步导致系统不稳定。

发明内容

为了克服现有的船载摄像技术的安装复杂、通用性差、精度不足、稳定性不够以及成本过高的不足，本发明提供了一种基于陀螺仪的船载稳像控制方法，在保证稳像控制的精度和系统稳定性性的同时，又具有体积小、通用性好、低成本等特点。

本发明解决上述技术问题是通过以下技术方案实现的：

一种基于陀螺仪的船载稳像控制方法，所述方法包括如下步骤：

1)使用具有俯仰轴与方位轴的基于步进电机的二自由度船载安防云台作为稳像平台；

2)利用加速度计和陀螺仪两种传感器分别获得云台的三轴加速度α_x，α_y，α_z及其三轴角速度ω_x、ω_y、ω_z；

3)将获得的这两种不同的俯仰轴上的数据α_x与ω_y进行对运算量以及内存优化的卡尔曼数据融合滤波，进而获得云台的精确俯仰角θ_pitch以及俯仰角速度ω_pitch，同样的方式求得云台的翻滚角θ_roll；

4)利用得到的俯仰角θ_pitch输入改进的PD控制器中，输出控制云台的俯仰轴电机的期望角速度值；

所述改进的PD控制器中，PD算法根据稳像云台的系统特点进行如下的改进步骤：

error(k)＝θ_pitch-θ_target(6)

将式(6)得到的采样序号为k时刻的偏差数据error(k)代入式(7)离散PD控制器中得到控制量输出值u(k)

式中，error(k-1)是采样序号为k-1时刻的偏差数据；

控制器限幅输出：

当PD控制器输出大于Max_U(k)时，系统输出Max_U(k)，同理当PD控制器输出大于Min_U(k)时，系统输出Min_U(k)；

根据不同的error(k)对k_p参数作出改变，对k_p与error(k)建立基于指数函数的变化关系，实时改变系统的增益如下式(9)所示：

使用不完全微分的PD算法，在原来的微分量u_d(k)项中引入一阶低通滤波器，如式(10)所示：