一种舵机云台的无速度反馈动态面控制方法技术

本发明专利技术公开了一种舵机云台的无速度反馈动态面控制方法，包括摄像机方位角和俯仰角的解算；舵机模型的构建和分析；高增益观测器设计；动态面控制输入电压设计；控制参数的设计与调节；根据仿真实验检验跟踪性能。该控制方法不需要增加额外的角速度硬件测量电路，控制输入设计简单，控制参数易调整，舵机控制精度高。

【技术实现步骤摘要】
一种舵机云台的无速度反馈动态面控制方法及控制器
本专利技术涉及自动控制
，具体涉及一种舵机云台的无速度反馈动态面控制方法及控制器。
技术介绍
通过将摄像机搭载在无人机或者地面机器人上面，可以实现对特定目标的监视，检测环境中的危险信号。由于无人机飞行或者地面机器人的移动和晃动，必须将摄像机安装在云台上。云台控制器可以调整摄像头的位置，使其始终对准监控目标。常见的两自由度全方位云台，它既能够左右旋转又能够上下俯仰偏转。按照驱动机构的不同，云台可以分为交流型和直流型。舵机云台本质上是一种直流型云台，它采用舵机作为驱动机构，具有结构简单、质量轻巧、控制灵活等优点。只要知道监控目标点的位置信息，结合移动机器人本体的位置信息，就能够计算出摄像机光轴矢量始终指向目标点的期望方位角和俯仰角指令。通过舵机驱动，改变摄像头的方向，快速跟踪期望角度，使得监控目标点始终位于图像平面的中心区域。近年来，许多先进控制方法被用在舵机云台的控制上面，其中包括PD控制、前馈补偿、最优控制方法等。动态面控制是一种新颖的控制技术，它设计过程简单，易于物理实现。在设计步骤中，每一步引入一个低通滤波器，克服反推控制方法存在的“微分爆炸”现象。并且，它不会有滑模控制方法的“抖颤”现象。现有的舵机云台的控制方法，大多需要用到舵机云台的转动角速度。获取转动角速度的方法有两种，一种是通过对转动的角度直接进行差分，存在较大的误差，导致跟踪调节时间变大；另外一种是通过角速度计，这会引入外围电路，增大云台的体积和重量，降低了系统的可靠性。
技术实现思路
为解决现有技术存在的不足，本专利技术公开了一种舵机云台的无速度反馈动态面控制方法及控制器，针对视频监控系统中的舵机云台，提出的不需要转动角速度测量的动态面控制方法，用于控制舵机云台快速精确地跟踪期望角度，在不需要转动角速度测量情况下，结合动态面控制技术和高增益观测器，实现舵机对期望角度的快速且精确跟踪。高增益观测器可以通过转动的角度信息，精确重构角速度信息，实现对转动角速度的软件测量。为实现上述目的，本专利技术的具体方案如下：一种舵机云台的无速度反馈动态面控制方法，包括：获取摄像装置的监控目标点在惯性系中的坐标信息并获取搭载舵机云台的无人机或者地面机器人在惯性系中的坐标信息，根据摄像装置的监控目标点在惯性系中的坐标信息及搭载舵机云台的无人机或者地面机器人在惯性系中的坐标信息，得到摄像机指令值；构建舵机模型，选取二阶传递函数表示舵机输入电压和输出转角的关系；通过舵机输出的转动角度信息，利用高增益观测器重构角速度，实现对舵机转动角速度的软件测量；根据摄像机指令值及利用高增益观测器测量的角速度信号，利用动态面控制方法计算得到控制器控制舵机的输入电压，继而控制舵机的转动速度，使摄像机跟踪指令值。所述在惯性系中的坐标信息是通过室内的红外传感器或者室外GPS获取的。所述得到摄像机指令值的过程为：根据坐标信息，计算出摄像机指向目标点的光轴矢量坐标Pe；然后通过坐标变换计算出光轴矢量Pe在移动机器人本体坐标系的坐标为Pb；最后根据Pb的坐标，解算出摄像机方位角指令值ψc和俯仰角指令值θc。舵机的期望跟踪角度x1d；针对水平方向偏转的舵机x1d＝ψc，若是俯仰方向的则有x1d＝θc。所述构建舵机模型是针对工作在线性区的舵机云台的执行机构舵机，选取二阶传递函数表示其输入电压和输出转角的关系，将二阶传递函数转化为状态空间表达式。所述利用动态面控制方法计算得到控制舵机的输入电压，包括的步骤为：设定摄像机方位角指令值与测量的摄像机方位角度相减得到误差S1，将虚拟控制输入一阶低通滤波器得到输出；高增益观测器测量的角速度信号和一阶低通滤波器的输出相减得到误差S2，得到舵机控制输入电压。所述利用动态面控制方法计算得到控制舵机的输入电压之后还包括控制参数的调整，包括：高增益观测器控制参数的调节，使得高增益观测器建立过程中系数矩阵A为Hurwitz矩阵，ε表征了观测误差的精度，通过减小ε来降低高增益观测器对角速度信号的观测误差，控制器参数的调节，若跟踪误差过大或者调整时间过长，不满足实时控制要求，则增大c1、c2或则减少τ1，一方面，增大c1、c2相当于增大控制输入的幅值和带宽；另一方面，减小τ1来提高系统的响应速度。在高增益观测器控制参数的调节及控制器参数的调节后进行仿真实验，使舵机在设定时间内稳定到期望值，且高增益观测器的观测误差小于设定值，若控制效果不能满足要求，继续调节控制参数，直到控制效果达到要求。一种舵机云台的无速度反馈动态面控制器，所述无速度反馈动态面控制器用于获取摄像装置的监控目标点在惯性系中的坐标信息并获取搭载舵机云台的无人机或者地面机器人在惯性系中的坐标信息，根据摄像装置的监控目标点在惯性系中的坐标信息及搭载舵机云台的无人机或者地面机器人在惯性系中的坐标信息，得到摄像机指令值；通过舵机输出的转动角度信息，利用高增益观测器重构角速度，实现对舵机转动角速度的软件测量；根据摄像机指令值、利用高增益观测器测量的角速度信号及构建的舵机模型，利用动态面控制方法计算得到控制舵机的输入电压，继而控制舵机的转动速度，使摄像机跟踪指令值。本专利技术的有益效果：本专利技术针对舵机云台，设计了一种无速度反馈动态面控制方法。在不需要转动角速度测量，实现了其高精度的角度控制。设计的控制方法，不需要增加额外的硬件电路，使得系统体积小，质量轻。采用动态面控制方法，避免了反复求导运算，参数调节简单。通过计算得到摄像机方位角指令值和俯仰角指令值之后，可以快速平滑地跟踪指令信号，使得监控目标位于图像中心区域。附图说明图1本专利技术实施步骤流程框图；图2本专利技术控制系统结构示意图；图3(a)本专利技术角度跟踪仿真示意图；图3(b)本专利技术角速度跟踪仿真示意图；图4本专利技术控制输入电压仿真示意图；图5(a)本专利技术角度观测误差仿真示意图；图5(b)本专利技术角速度观测误差仿真示意图。具体实施方式：下面结合附图对本专利技术进行详细说明：如图1所示，一种舵机云台的无速度反馈动态面控制方法，包括以下步骤：步骤1：摄像机方位角和俯仰角的解算通过红外传感器(室内)或者GPS(室外)获取监控目标点和搭载舵机云台的无人机或者地面机器人在惯性系中的坐标分别为P1＝[x1,y1,z1]T和P2＝[x2,y2,z2]T，则摄像机指向目标点的光轴矢量坐标为Pe为：Pe＝P1-P2(1)则光轴矢量在移动机器人本体坐标系中的坐标为Pb＝RPe＝[xc,yc,zc]T(2)这里R代表罗德里格斯旋转矩阵，其定义如下：向量[p,q,r]T代表了搭载舵机云台的无人机或者地面机器人相对于惯性坐标系的姿态角，可以通过传感器测量得到。C(·)和S(·)分别代表余弦和正弦函数,CpCrSpSqCqSr代表了相应下标的正弦值或余弦值。摄像机的俯仰运动通过执行范围为0度到90度的舵机完成，根据光轴矢量坐标计算出俯仰角指令值θc：zcxcyc是光轴矢量Pb的三个分本文档来自技高网...

【技术保护点】
一种舵机云台的无速度反馈动态面控制方法，其特征是，包括：获取摄像装置的监控目标点和搭载舵机云台的无人机或者地面机器人在惯性系中的坐标信息，根据在惯性系中的坐标信息，得到摄像机指令值；构建舵机模型，选取二阶传递函数表示舵机输入电压和输出转角的关系；通过舵机输出的转动角度信息，利用高增益观测器重构角速度，实现对舵机转动角速度的软件测量；根据摄像机指令值及利用高增益观测器测量的角速度信号，利用动态面控制方法计算得到控制器控制舵机的输入电压，继而控制舵机的转动速度，使摄像机跟踪指令值。

【技术特征摘要】
1.一种舵机云台的无速度反馈动态面控制方法，其特征是，包括：获取摄像装置的监控目标点在惯性系中的坐标信息并获取搭载舵机云台的无人机或者地面机器人在惯性系中的坐标信息，根据摄像装置的监控目标点在惯性系中的坐标信息及搭载舵机云台的无人机或者地面机器人在惯性系中的坐标信息，得到摄像机指令值；构建舵机模型，选取二阶传递函数表示舵机输入电压和输出转角的关系；通过舵机输出的转动角度信息，利用高增益观测器重构角速度，实现对舵机转动角速度的软件测量；根据摄像机指令值及利用高增益观测器测量的角速度信号，利用动态面控制方法计算得到控制器控制舵机的输入电压，继而控制舵机的转动速度，使摄像机跟踪指令值。2.如权利要求1所述的一种舵机云台的无速度反馈动态面控制方法，其特征是，所述在惯性系中的坐标信息是通过室内的红外传感器或者室外GPS获取的。3.如权利要求1所述的一种舵机云台的无速度反馈动态面控制方法，其特征是，所述得到摄像机指令值的过程为：根据坐标信息，计算出摄像机指向目标点的光轴矢量坐标Pe；然后通过坐标变换计算出光轴矢量Pe在移动机器人本体坐标系的坐标为Pb；最后根据Pb的坐标，解算出摄像机方位角指令值ψc和俯仰角指令值θc。4.如权利要求3所述的一种舵机云台的无速度反馈动态面控制方法，其特征是，舵机的期望跟踪角度x1d；针对水平方向偏转的舵机x1d＝ψc，若是俯仰方向的则有x1d＝θc。5.如权利要求1所述的一种舵机云台的无速度反馈动态面控制方法，其特征是，所述利用动态面控制方法计算得到控制舵机的输入电压，包括的步骤为：设定摄像机方位角指令值与测量的摄像机方位角度相减得到误差S1，将虚拟控制输入一阶低通滤波器得到输出；高增益观测器测量的角速度信号和一阶低通滤波器的输出相减得到误差S2，得到舵机控制输入电压。6.如权利要求...

【专利技术属性】
技术研发人员：冯华，金海，陈刚，钱平，韩磊，李冬松，张斌，谭树蕾，王化玲，
申请(专利权)人：国家电网公司，国网浙江省电力公司嘉兴供电公司，山东鲁能智能技术有限公司，
类型：发明
国别省市：北京;11