一种主动式防抖云台及其控制方法技术

本发明专利技术涉及一种主动式防抖云台及其控制方法。一种主动式防抖云台，包括机架组件、电机组件、拍摄设备以及控制组件，所述控制组件包括处理器和惯性传感器，所述惯性传感器检测所述拍摄设备的姿态信息，所述处理器根据所述姿态信息控制所述电机组件；其特征在于，所述电机组件为DD直驱电机，DD直驱电机连接机架组件，用于驱动机架组件相对所述拍摄设备转动。本发明专利技术的有益效果在于采用DD直驱电机，无需减速器、齿轮箱等连接结构，具有载重大、控制精度高、有效工作寿命长等优势；通过变参数PID控制算法达到进一步提高系统的响应速度和控制精度的目的。

An active anti shake pan and its control method

The invention relates to an active anti shake pan and its control method. An active shake-proof platform comprises a frame assembly, a motor assembly, a photographing device and a control component, the control component comprises a processor and an inertial sensor, the inertial sensor detects the attitude information of the photographing device, the processor controls the motor assembly according to the attitude information, and the control component is characterized in that it is characterized by The motor assembly is a DD direct drive motor, and the DD direct drive motor connects the frame assembly for driving the frame assembly to rotate relative to the photographing device. The invention has the advantages of heavy load, high control precision, long effective working life and the like, adopting DD direct drive motor, needing no connection structure such as reducer and gear box, and further improving the response speed and control precision of the system through variable parameter PID control algorithm.

【技术实现步骤摘要】
一种主动式防抖云台及其控制方法
本专利技术涉及摄影、照相和/或监测用的辅助装置领域，具体涉及一种主动式防抖云台及其控制方法。
技术介绍
在拍摄、监控、侦察等领域中，很多设备需要用到防抖云台，以便去获得相对稳定的环境而提供高质量的图像画面。飞行器、船舶、车辆等晃动的载体上装有防抖云台。城市监控中挂在高点上摄像机因强大风力作用下晃动而导致图像模糊，需要防抖云台。现有防抖云台技术与产品包括用在无人机与手机上的微型云台、用在飞机与船舶上的光电吊舱等。无人机云台通过控制无刷直流电机抵消抖动获取高清图像，而飞机、船舶光电吊舱采用重载磁同步电机。用在无人机、手机上的微型云台载重小，工作寿命时间短。飞机、船舶的光电吊舱虽载重大，能抵抗大的波动，但控制精度较低。申请号为CN201120476124.9的专利公开一种陀螺式动态自平衡云台，此专利采用电机组件作为原动力直接驱动云台的机架组件，电机优选为直流无刷电机。但是直流无刷电机必须配有相应的直流电机调速器才能工作，从成本上考虑，无刷电机的成本本身就比有刷电机高，而增加相应的直流电机调速器更进一步增加了系统的成本。另外因为增加了连接调速器的机械结构，从而带来了定位误差。
技术实现思路
为解决上述技术问题，本专利技术提供一种主动式防抖云台及其控制方法，使用的电机无需多余的连接结构，降低工作成本，减少了机械结构产生的定位误差。一种主动式防抖云台，包括机架组件、电机组件、拍摄设备以及控制组件，所述控制组件包括处理器和惯性传感器，所述惯性传感器检测所述拍摄设备的姿态信息，所述处理器根据所述姿态信息控制所述电机组件；所述电机组件为DD直驱电机，DD直驱电机连接机架组件，用于驱动机架组件相对所述拍摄设备转动。本专利技术使用惯性传感器检测拍摄设备的姿态信息。惯性传感器用来检测和测量加速度、倾斜、冲击、振动、旋转和多自由度运动，是解决导航、定向和运动载体控制的重要部件。惯性传感器一般包括加速度计和螺旋仪，处理器根据所述惯性传感器输出的姿态信息控制所述电机组件。本专利技术选用DD直驱电机作为电机组件，DD直驱电机由于其输出扭力大而能与载重物体直接连接，无需减速器、齿轮箱等连接结构。DD直驱电机配置了高解析度的编码器，比普通伺服高一个等级的精度，同时因无需减速器、齿轮箱等连接结构，降低工作成本，减少了机械结构产生的定位误差，进一步提升了控制精度。总得来说，DD直驱电机有载重大、控制精度高、24小时不间断工作寿命长等优势。进一步地，惯性传感器为六轴惯性传感器。基础的惯性传感器包括加速度计与角速度ω计。六轴惯性传感器，主要由三个轴加速度传感器以及三个轴的陀螺仪组成。一种主动式防抖云台的控制方法，所述主动式防抖云台采用上述主动式防抖云台实现，上述方法包括如下步骤：处理器预先设定目标角度；处理器解算惯性传感器的加速度计、陀螺仪数据得到姿态角度和角速度ω；处理器计算姿态角度与目标角度的角度差值e，将所述角度差值e与角速度ω作为输入量，通过PID控制算法计算出DD直驱电机的输出控制量；处理器将输出控制量传送至DD直驱电机，DD直驱电机根据输出控制量驱动机架组件。此方法中，加速度计、陀螺仪数据为姿态信息，处理器可以通过四元数互补滤波姿态解算姿态信息，得到姿态角度和角速度ω。处理器预先设定目标角度，姿态角度与目标角度的角度差值e与角速度ω作为输入量，通过PID控制算法计算出DD直驱电机的输出控制量。PID控制算法根据设定值即目标角度和实际输出值即姿态角度构成控制偏差，将偏差按比例、积分、微分通过线性组合构成控制量，对被控对象DD直驱电机进行控制,DD直驱机进而控制机架组件。进一步地，所述PID控制算法中的比例系数P、积分系数I和微分系数D与角度差值e的关系为：P(e(t))＝ap+bp(1-sech(cpe(t)))，其中P为比例参数，aP、bP、cP为正实常数，参数P取值范围为[aP，aP+bP]，cp为调整参数P变化速率；I(e(t))＝aIsech(cIe(t)))，其中I为积分参数，aI、cI为正实常数，参数I取值范围为(0，aI]，cI为调整参数I变化速率；当误差变化率ev小于或等于0时，D(e(t))＝aD+bD/(1+dDecp(cDe(t)))当误差变化率ev大于0时，D(e(t))＝aD+bD/(1+dDecp(-cDe(t)))，其中，D为微分参数，aD、bD、cD、dD为正实常数，参数D取值范围为(aD，aD+bD)，cD为调整参数D变化速率。本专利技术通过变参数PID(比例参数P、积分参数I、导数参数D)控制算法控制DD直驱电机。固定PID参数的控制存在稳定性和快速性之间的矛盾。用在无人机、手机上的微型云台载重轻，采用的串级PID算法中比例参数P、积分参数I、微分参数D固定不变。而城市高点监控摄像机，惯量比较大，对系统要求响应速度快、精度高，通过变参数PID控制算法控制DD直驱电机，以便达到更好的效果。本专利技术的PID控制算法采用变参数PID方式，根据误差的大小，改变比例、积分、微分的参数，从而在原来的基础上提高系统的响应速度和精度。在误差比较大的时候，可以不考虑系统的精度和超调量，为了系统加快响应速度，采用加大比例参数P作用，减小积分参数I和微分参数D作用。在误差比较小时，为了防止系统超调量过大，应减小比例参数P作用，加强积分参数I和微分参数D作用。当系统超调时，应加大微分参数D作用。根据以上变量规律，可以得出以上的串级PID控制算法中的比例系数P、积分系数I和微分系数D与角度差值e的关系。进一步地，还包括步骤：ap、bp、cp、aI、cI、aD、bD、cD、dD的数值经过粒子群优化算法优化。以上非线性函数中的系数，可以通过手动调试出比较好的系数，也可以通过粒子群优化算法对非线性函数中的系数进一步优化。本专利技术的有益效果在于采用DD直驱电机，无需减速器、齿轮箱等连接结构，具有载重大、控制精度高、有效工作寿命长等优势；通过变参数PID控制算法达到进一步提高了系统的响应速度和控制精度的目的。附图说明图1为本专利技术主动式防抖云台的控制方法流程图；图2是比例参数P变化曲线图；图3是积分参数I变化曲线图；图4是微分参数D变化曲线图。具体实施方式以下结合附图对本专利技术进行进一步说明。一种主动式防抖云台，包括机架组件、电机组件、拍摄设备以及控制组件，所述控制组件包括处理器和惯性传感器，所述惯性传感器检测所述拍摄设备的姿态信息，所述处理器根据所述姿态信息控制所述电机组件；所述电机组件为DD直驱电机，DD直驱电机连接机架组件，用于驱动机架组件相对所述拍摄设备转动。本专利技术使用惯性传感器检测拍摄设备的姿态信息。惯性传感器用于检测和测量加速度、倾斜、冲击、振动、旋转和多自由度运动，是解决导航、定向和运动载体控制的重要部件。惯性传感器一般包括加速度计和螺旋仪，优选地，惯性传感器为六轴惯性传感器。基础的惯性传感器包括加速度计与角速度ω计。六轴惯性传感器，主要由三个轴加速度传感器以及三个轴的陀螺仪组成。处理器根据所述惯性传感器输出的姿态信息控制所述电机组件。本专利技术选用DD直驱电机作为电机组件，DD直驱电机由于其输出扭力大而能载重物体直接连接，无需减速器、齿轮箱等连接结构。DD直驱电机配置了高解析度的编码器，比普通伺服高一个等级的本文档来自技高网...

【技术保护点】
1.一种主动式防抖云台，包括机架组件、电机组件、拍摄设备以及控制组件，所述控制组件包括处理器和惯性传感器，所述惯性传感器检测所述拍摄设备的姿态信息，所述处理器根据所述姿态信息控制所述电机组件；其特征在于，所述电机组件为DD直驱电机，DD直驱电机连接机架组件，用于驱动机架组件相对所述拍摄设备转动。

【技术特征摘要】
1.一种主动式防抖云台，包括机架组件、电机组件、拍摄设备以及控制组件，所述控制组件包括处理器和惯性传感器，所述惯性传感器检测所述拍摄设备的姿态信息，所述处理器根据所述姿态信息控制所述电机组件；其特征在于，所述电机组件为DD直驱电机，DD直驱电机连接机架组件，用于驱动机架组件相对所述拍摄设备转动。2.根据权利要求1所述的一种主动式防抖云台，其特征在于，所述惯性传感器为六轴惯性传感器。3.一种主动式防抖云台的控制方法，其特征在于，所述主动式防抖云台采用权利要求1所述的主动式防抖云台实现，上述方法包括如下步骤：处理器预先设定目标角度；处理器解算惯性传感器的加速度计、陀螺仪数据得到姿态角度和角速度ω；处理器计算姿态角度与目标角度的角度差值e，将所述角度差值e与角速度ω与作为输入量，通过PID控制算法计算出DD直驱电机的输出控制量；处理器将输出控制量传送至DD直驱电机，DD直驱电机根据输出控制量驱动机架组件。4.根据权利要求3所述的一种主动式防抖云台的控制方法，其...

【专利技术属性】
技术研发人员：顾义加，黄洪加，林慰然，郑志斌，黄仝宇，汪刚，宋一兵，侯玉清，刘双广，
申请(专利权)人：高新兴科技集团股份有限公司，
类型：发明
国别省市：广东,44