[发明专利]一种基于陀螺仪的船载稳像控制方法有效
申请号: | 201510170010.4 | 申请日: | 2015-04-10 |
公开(公告)号: | CN104811588B | 公开(公告)日: | 2018-04-20 |
发明(设计)人: | 董辉;赖宏焕;王全强;黄胜;陈慧慧 | 申请(专利权)人: | 浙江工业大学;杭州晨安视讯数字技术有限公司 |
主分类号: | H04N5/21 | 分类号: | H04N5/21;H04N5/14 |
代理公司: | 杭州斯可睿专利事务所有限公司33241 | 代理人: | 王利强 |
地址: | 310014 浙江省*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 陀螺仪 船载稳像 控制 方法 | ||
1.一种基于陀螺仪的船载稳像控制方法,其特征在于:所述方法包括如下步骤:
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)对kp参数作出改变,对kp与error(k)建立基于指数函数的变化关系,实时改变系统的增益如下式(9)所示:
使用不完全微分的PD算法,在微分量ud(k)项中引入一阶低通滤波器,如式(10)所示:
ud(k)=kd(1-β)(error(k)-error(k-1)+βud(k-1))(10)
同时结合了目标角改变微分消除算法对θtarget改变时带来的微分量不代入计算,如式(11)所示:
ud(k)=ud(k)-kd*[θtarget(k)-θtarget(k-1)](11)
5)解算稳像系统在非平衡状态下,船体出现翻滚运动对稳像平台航向角的影响,通过控制方位角补偿该影响;如式(14)所示:
式中,是k时刻云台方位角,为k-1时刻云台方位角,θpitch(k)为k时刻的俯仰角,θroll(k)为k时刻的翻滚角,sin()为正弦运算,asin()为反正弦运算;
6)最后将计算结果传输到底层步进电机驱动器。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江工业大学;杭州晨安视讯数字技术有限公司,未经浙江工业大学;杭州晨安视讯数字技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201510170010.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种用于摄像头的控制电路
- 下一篇:无线通信设备