专利名称：车载摄像稳定平台的制作方法
技术领域：
本发明涉及车载摄像稳定平台，适用于车载、轨道条件影视拍摄领域，并能根据用 户需求，拓展应用于地面侦查、雷达稳定、战车火炮稳定等领域，应用于海关、边防缉私取 证、移动指挥视频获取等。
背景技术：
车载、轨道条件影视拍摄在有效隔离运动载体对有效载荷造成的角运动干扰的同 时，实现对观测目标的跟踪、锁定。为了保证视轴稳定，陀螺稳定平台必须同时解决隔离载 体扰动和伺服跟踪的问题。为解决隔离载体扰动，目前车载、轨道条件影视拍摄均是采用陀螺作为测量装置 构成稳定回路，将平台校正回水平姿态，隔离载体扰动。固态速率陀螺由于其体积小、质量 轻、功耗小、成本低、瞬间启动及抗冲击力强等特点，广泛应用于车载、轨道条件影视拍摄。 由于固态速率陀螺漂移稳定性较差，短期稳定性在0.1° /s数量级，长期稳定性在1° /s 数量级，需要采取措施来消除其角度漂移，以满足在固定方向上连续拍摄的要求。针对陀螺 漂移这一问题，目前可利用的基准主要有重力矢量、光学目标及载体姿态等。以重力矢量为 参考的调平回路，采用加速度计测量重力加速度来调节平台倾角。在载体运动中，运动加速 度会叠加在重力加速度上，造成垂线测量误差，只能假设载体的平均运动加速度趋于零，所 以不适用于车载、轨道条件影视拍摄等载体运动不确定的场合。以光学目标为参考的目标 跟踪回路，采用图像处理和目标辨识来测量摄像机的角偏差，实现自动跟踪。目标跟踪回路 可以采用较快的回路，但从图像平稳角度考虑，仍应显著低于稳定回路的带宽。以载体姿态 为参考的姿态锁定回路，采用姿态角传感器测量平台相对载体的角度构成回路，可以抑制 因陀螺漂移造成的平台倾角的变化，解决了隔离载体扰动，可以满足在固定方向上连续拍 摄的要求，但是作为摄像稳定平台，需要根据拍摄需要和目标运动情况实时控制平台的姿 态，所以还必须解决伺服跟踪问题。针对伺服跟踪这一问题，现有的伺服跟踪方法一般是给出跟踪量，并将跟踪量叠 加在控制信号中。对于只依赖固态速率陀螺构成的稳定回路，保证操控性比较简单，只要叠 加在固态速率陀螺输出的角速度控制信号有足够的线性度和分辨率，配合手感良好的控制 手柄即可满足要求。对于采用锁定回路等复合回路的稳定平台，操纵控制信号会引起锁定 回路的响应，可能产生长达数分钟的调节后效，使摄像机难以指向给定目标，影响稳定平台 的操控性能，而且目前并没有很好的解决办法。跟踪量一般称为加矩指令，现有的加矩指令一般均由电脑等控制界面给出，操作 性不好。操作人员需要根据目标的运动状态不断地调节摄像稳定平台的角度，保持运动目 标处于视场内，长时间跟踪同一目标时，极大地增加了操作人员的工作量，并且不利于图像 的稳定。
发明内容
本发明的技术解决问题是克服现有技术的不足，提供一种能有效地隔离车载角运 动引起的干扰、抑制陀螺引起的漂移、提高系统的动态性能、易操作的车载稳定平台系统。本发明的技术解决方案是车载摄像稳定平台，包括车载摄像稳定装置、信号处理 装置、控制单元、陀螺、电位计、电机；电机包括俯仰力矩电机和方位力矩电机；电位计包括 俯仰轴电位计和方位轴电位计；陀螺安装在车载摄像稳定装置的左端罩内的左内轴上；俯仰力矩电机安装在车载 摄像稳定装置的右端罩内的右内轴和右外轴之间；方位力矩电机安装在车载摄像稳定装置 的方位内轴和方位外轴之间；俯仰轴电位计安装在右端罩内的俯仰轴齿轮连接板上，方位 轴电位计安装在车载摄像稳定装置的方位轴端组件的俯仰轴齿轮连接板上；陀螺、电位计、 电机分别用于敏感平台的角速率，测量平台的角度和驱动平台转动；信号处理装置、控制单 元放置在平台外，控制单元与信号处理装置连接后、由信号处理装置通过控制电缆连接在 车载摄像稳定装置上；控制单元采用图像跟踪方式实现对运动目标的手动锁定或自动跟 踪，信号处理装置、控制单元、陀螺、电位计和电机构成稳定回路和锁定回路，信号处理装置 将陀螺敏感的平台角速率和电位计测量的平台角度进行低通滤波、模数转换后，得到陀螺 速率信号和电位计角度信号，并将得到的信号输入给控制单元，控制单元对输入的陀螺速 率信号、电位计角度信号和待摄像目标的移动量进行处理，给出加矩指令即角速度控制信 号，并采用前馈控制进行加矩，输出控制信号送入电机，由电机控制平台动作，陀螺和电位 计重新输出平台角速率和平台角度，经信号处理装置处理后作为稳定回路和锁定回路的输 入，构成双闭环回路，实现对待摄像目标的跟踪。所述的控制单元包括功率�？�、稳定控制器、锁定控制器和两个前馈控制器；稳定 控制器、功率�？�、平台上的电机和陀螺以及信号处理装置构成系统的稳定回路；锁定控制 器、稳定回路、平台上的电机和电位计以及信号处理装置构成系统的锁定回路；待摄像目标 的移动量经过前馈控制器I进行比例运算后叠加在陀螺速率信号的同时，将待摄像目标的 移动量经过前馈控制器II进行比例、积分运算后得到平台需转动的角度叠加在电位计角度 信号上后输入给锁定控制器，经锁定控制器PID处理后与上述陀螺速率信号一起输入给稳 定控制器，经稳定控制器进行PID运算处理后生成控制量，并将控制量进行PWM调制后生成 PWM信号，该PWM信号经过功率�？榻泄怦罡衾牒颓笏腿肫教ㄉ系牡缁傻缁刂� 平台动作，陀螺和电位计重新输出平台角速率和平台角度，经信号处理装置处理后作为稳 定回路和锁定回路的输入，构成双闭环回路。所述的待摄像目标的移动量可以通过手动控制或自动跟踪给出，当通过手动控制 时，待摄像目标的移动量为光电码盘或操纵杆给出的加矩指令，该加矩指令是光电码盘输 出的角位置，码盘的转动角度与平台俯仰轴和方位轴的转动角度一一对应；当为自动跟踪 时，待摄像目标的移动量为目标脱靶量。所述的目标脱靶量由图像跟踪算法给出，算法处理流程如下第一步，对图像进行中值滤波去噪声；第二步，对滤波后的图像利用sobel边缘检测提取波门内目标边缘；第三步，二值化分割出目标边缘；第四步，组合利用匪I特征量和质心坐标偏移量作特征匹配搜索，得出当帧的目
6标位置，设匹配函数为 则整个特征匹配搜索过程即为求函数k(x，y)的极小值，此时(x，y)为目标在当帧 中的坐标，其相对与视场中心坐标的偏移坐标即为得到的目标脱靶量；其中波门大小为aXa，(x0, y0)为前一帧的波门坐标，(x，y)为当帧的波门坐标
(x0-a/2 ^ χ ^ Xo+a/2, y。_a/2 ^ y ^ y。+a/2) ； p(x0,y0)，匪I (x0, y0)分别为前一帧波门
(x。，y。)内目标质心的坐标向量和目标的匪I不变矩；？^，匪Γ (x，y)为当前帧搜索 区域波门(χ，y)内目标质心的坐标向量和匪I不变矩，X^x2为匹配权值，λ 1+λ 2 = 1。所述的锁定回路的带宽为稳定回路带宽的1/5 1/10。所述的两轴摄像稳定装置包括左端罩、陀螺座、左连接板、俯仰轴左侧轴端组件、 摄像机安装组件、俯仰轴右侧轴端组件、俯仰轴电位计组件、右端罩、U型支架、插座、俯仰挡 钉、插座安装板、方位挡钉、方位轴端组件、方位轴电位计组件、盖板；左端罩、右端罩分别固定连接在U型支架的左右两侧；左端罩内陀螺与陀螺座固 定连接，陀螺座通过左连接板与俯仰轴左侧轴端组件的左内轴固定连接；俯仰轴左侧轴端 组件的左外轴与U型支架固定连接；右端罩内的俯仰轴电位计组件通过俯仰轴电位计连接 板与俯仰轴右侧轴端组件的右外轴固定连接，右外轴与U型支架固定连接；摄像机安装组 件位于U型支架的内部，摄像机安装组件的摄像机固定螺钉悬挂于摄像机支架底部，连接 杆通过螺母固定于摄像机支架的左右侧板之间，摄像机支架的两侧分别与左内轴和右内轴 固定连接；俯仰挡钉固定在U型支架内部两侧，限制摄像机安装组件的俯仰转动；方位轴电 位计组件由方位轴电位计连接板通过支撑杆与方位轴端组件的方位外轴一端固定连接；方 位外轴的另一端与基座固定连接，插座安装板安装在U型支架的底部与方位轴端组件的方 位内轴固定连接，方位内轴与U型支架底部固定连接；方位挡钉固定连接在U型支架底部， 限制基座的方位转动；插座安装在基座一侧；盖板与基座底部固定连接。所述的俯仰轴右侧轴端组件包括右内轴、右轴外锁紧螺母、第二轴承、右外轴、右 轴内锁紧螺母、轴联器；第二轴承、俯仰力矩电机从左至右依次安装于右内轴和右外轴之 间，第二轴承的内外圈分别用右轴内锁紧螺母和右轴外锁紧螺母锁紧，俯仰力矩电机的定 子通过螺钉与右外轴固定连接，俯仰力矩电机转子通过轴联器和螺钉与右内轴固定连接。所述的俯仰轴电位计组件包括一个俯仰轴齿轮、俯仰轴齿轮连接板、俯仰轴电位 计、俯仰轴电位计连接板；俯仰轴齿轮通过螺钉与俯仰轴齿轮连接板固定连接；俯仰轴齿 轮连接板通过紧定螺钉与俯仰轴电位计固定连接；俯仰轴电位计组件由俯仰轴电位计连接 板通过支撑杆与右外轴固定连接，该俯仰轴齿轮与安装在俯仰轴联器上的俯仰轴齿轮互相 啮合。所述的方位轴端组件包括方位轴外锁紧螺母、第三轴承、方位外轴、方位轴内锁紧 螺母、方位内轴；一对第三轴承、方位力矩电机自上而下安装于方位内轴和方位外轴之间， 轴承的内外圈分别用方位轴内锁紧螺母和方位轴外锁紧螺母锁紧，方位力矩电机定子通过 螺钉与方位外轴固定连接，方位力矩电机转子通过螺钉与方位内轴固定连接。所述的方位轴电位计组件包括一个方位轴齿轮、方位轴齿轮连接板、方位轴电位计连接板、方位轴电位计；方位轴齿轮通过螺钉与方位轴齿轮连接板固定连接；方位轴齿 轮连接板通过紧定螺钉与方位轴电位计固定连接；方位轴电位计组件由方位轴电位计连接 板通过支撑杆与方位外轴固定连接，该方位轴齿轮与安装在方位轴连器上的方位轴齿轮互 相啮合。本发明与现有技术相比有益效果为(1)本发明采用稳定回路和锁定回路双闭环回路进行控制，锁定回路采用电位计 测量平台相对载体的角度，可以抑制因陀螺漂移造成的平台倾角的变化，有效隔离载体扰 动的同时，解决了陀螺漂移问题。在稳定回路和锁定回路中加入前馈控制，提高了稳定回 路和锁定回路的指令响应速度，使摄像机能够快速、准确对准目标，高目标跟踪的速度和精度。(2)本发明采用手动控制获取待摄像目标的移动量时，根据拍摄需要和目标运动 情况操作控制单元控制平台的姿态，可切换光电码盘或操纵杆两种控制方式，适应不同的 操纵需要。同时将图像自动跟踪功能弓丨入系统，对目标进行手动锁定后，实现目标的自动跟 踪，保证对运动目标的精确跟踪。(3)码盘的转动角度与平台俯仰轴和方位轴的转动角度一一对应，直观易操作。(4)本发明在质心跟踪方法的基础上结合利用了目标的匪I不变矩的旋转不变 性，缩放不变性，降低了由目标周围区域的背景噪声和非目标物体带来的干扰，实现对运动 目标的自动跟踪，极大地简化了操作人员的工作，并能有效保证获取稳定高质量的图像信 肩、o(5)本发明在向稳定回路加入角速度操作控制信号时，同步地向锁定回路加入相 应的角度控制信号，使锁定回路在运动中始终不偏离其收敛平衡状态，消除调节后效，保障 平台的操控性能。
图1为本发明平台结构框图2为本发明的组成简图3为本发明车载摄像稳定装置示意图4为本发明的控制键盘功能示意图5为本发明信号处理装置、控制单元实现框图
图6为本发明控制�？樵硗�7为本发明图像跟踪算法处理流程图8为本发明图像跟踪算法中匹配搜索示意图9位本发明的控制�？榈牡缏房蛲�。
具体实施例方式
如图1、2所示，为本发明结构框图，即本发明的基本形式，包括车载摄像稳定装 置、信号处理装置44、控制单元45、陀螺3 (本例中采用固态速率陀螺)、电位计、电机、有效 载荷42 ；电机包括俯仰力矩电机17和方位力矩电机；陀螺3安装在车载摄像稳定装置的左 端罩内的左内轴上；俯仰力矩电机17安装在车载摄像稳定装置的右端罩内的右内轴和右外轴之间；方位力矩电机安装在车载摄像稳定装置的方位内轴和方位外轴之间；俯仰轴电 位计21安装在右端罩内的俯仰轴齿轮连接板上，方位轴电位计安装在车载摄像稳定装置 的方位轴端组件43的方位轴齿轮连接板上；陀螺、电位计、电机分别用于敏感平台的角速 率，测量平台的角度和驱动平台转动。信号处理装置44、控制单元45放置在平台外，控制单 元45与信号处理装置44连接后、由信号处理装置44通过控制电缆连接在车载摄像稳定装 置上；下面详细介绍上述主要部分的实现过程。一、车载摄像稳定装置如图3所示，车载摄像稳定装置包括左端罩1、陀螺座2、左连接板4、俯仰轴左侧 轴端组件、摄像机安装组件、俯仰轴右侧轴端组件、俯仰轴电位计组件、右端罩23、U型支架 25、插座26、俯仰挡钉27、插座安装板28、方位挡钉29、方位轴端组件、方位轴电位计组件、 盖板42 ；
左端罩1、右端罩23分别固定连接在U型支架25的左右两侧；左端罩1内陀螺3 与陀螺座2固定连接，陀螺座2通过左连接板4与俯仰轴左侧轴端组件的左内轴5固定连 接；俯仰轴左侧轴端组件的左外轴7与U型支架25固定连接；右端罩23内的俯仰轴电位计 组件通过俯仰轴电位计连接板22与俯仰轴右侧轴端组件的右外轴15固定连接，右外轴15 与U型支架25固定连接；摄像机安装组件位于U型支架25的内部，摄像机安装组件的两侧 分别与左内轴5和右内轴12固定连接；俯仰挡钉27固定在U型支架25内部两侧，限制摄 像机安装组件的俯仰转动范围；方位轴电位计组件由方位轴电位计连接板40通过支撑杆 与方位轴端组件的方位外轴32 —端固定连接；方位外轴32的另一端与基座33固定连接， 插座安装板28安装在U型支架25的底部与方位轴端组件的方位内轴36固定连接，方位内 轴36与U型支架25底部固定连接；方位挡钉29固定连接在U型支架25底部，限制U型支 架25的方位转动范围；插座26安装在基座33 —侧；盖板42与基座33底部固定连接。所述的俯仰轴左侧轴端组件包括左内轴5、左轴内锁紧螺母6、左外轴7、第一轴承 8和左轴外锁紧螺母9 ；第一轴承8安装于左内轴5和左外轴7之间，第一轴承8的内外圈 分别用左轴内锁紧螺母6和左轴外锁紧螺母9锁紧。所述的摄像机安装组件包括摄像机支架10、连接杆11、摄像机固定螺钉24 ；摄像 机固定螺钉24悬挂于摄像机支架10底部，摄像机支架10的左右侧板通过连接杆11固定。所述的俯仰轴右侧轴端组件包括右内轴12、右轴外锁紧螺母13、第二轴承14、右 外轴15、右轴内锁紧螺母16、轴联器18 ；第二轴承14、俯仰力矩电机17从左至右依次安装 于右内轴12和右外轴15之间，第二轴承14的内外圈分别用右轴内锁紧螺母16和右轴外 锁紧螺母13锁紧，俯仰力矩电机17的定子通过螺钉与右外轴15固定连接，俯仰力矩电机 转子通过轴联器18和螺钉与右内轴12固定连接。所述的俯仰轴电位计组件包括一个俯仰轴齿轮19、俯仰轴齿轮连接板20、俯仰轴 电位计21、俯仰轴电位计连接板22 ；—个俯仰轴齿轮19通过螺钉与俯仰轴齿轮连接板20 固定连接；俯仰轴齿轮连接板20通过紧定螺钉与俯仰轴电位计21固定连接；俯仰轴电位 计组件由俯仰轴电位计连接板22通过支撑杆与右外轴15固定连接，另一个俯仰轴齿轮19 通过螺钉与俯仰轴联器18固定连接；两个俯仰轴齿轮19互相啮合。所述的方位轴端组件包括方位轴外锁紧螺母30、第三轴承31、方位外轴32、方位 轴内锁紧螺母34、方位内轴36 ；—对第三轴承31、方位力矩电机35自上而下安装于方位内轴36和方位外轴32之间，轴承31的内外圈分别用方位轴内锁紧螺母34和方位轴外锁紧 螺母30锁紧，方位力矩电机定子通过螺钉与方位外轴32固定连接，方位力矩电机转子通过 螺钉与方位内轴36固定连接。所述的方位轴电位计组件包括一个方位轴齿轮38、方位轴齿轮连接板39、方位轴 电位计连接板40、方位轴电位计41 ；一个方位轴齿轮38通过螺钉与方位轴齿轮连接板39固定连接；方位轴齿轮连接 板38通过紧定螺钉与方位轴电位计41固定连接；方位轴电位计组件由方位轴电位计连接 板40通过支撑杆与方位外轴32固定连接，另一个方位轴齿轮38通过螺钉与方位轴连器37 固定连接；两个方位轴齿轮38互相啮合。左端罩1、右端罩23、陀螺座2、左连接板4、摄像机支架10、轴联器18、俯仰轴齿轮 连接板20、俯仰轴电位计连接板22、插座安装板28、方位轴齿轮连接板39、方位轴电位计连 接板40、盖板42均采用铝合金材料制成。左内轴5、左轴内锁紧螺母6、左外轴7、左轴外锁 紧螺母9、右内轴12、右轴外锁紧螺母13、右外轴15、右轴内锁紧螺母16、方位轴外锁紧螺 母30、方位外轴32、方位轴内锁紧螺母34、方位内轴36、连接杆11、摄像机固定螺钉24、方 位挡钉29、采用不锈钢材料制成。U型支架25、基座33采用铝合金铸造。俯仰挡钉27采用 非金属材料制成。陀螺3、第一轴承8、第二轴承14、俯仰力矩电机17、俯仰轴齿轮19、俯仰轴电位计 21、插座26、第三轴承31、方位力矩电机35、方位轴齿轮38、方位轴电位计41均为目前常用 器件，可外购或自制。二、信号处理装置信号处理装置44放置在平台外，通过控制电缆连接在车载摄像稳定装置的插座 26上。信号处理装置44对陀螺敏感的平台角速率和电位计测量的平台角度由信号处理模 块依次进行低通滤波、模数转换后，得到陀螺速率信号和电位计角度信号，上述两个信号分 别作为稳定回路和锁定回路的输入。三、控制单元控制单元硬件包括三脚架和控制键盘，实现对两轴平台的加矩控制，控制键盘与 信号处理装置通过串口线连接，接口为RS422，三脚架与控制键盘连接，接口为编码器接口。 平台本体作为摄像机的载体，具有非常大的灵活性，可兼容安装不同尺寸的摄像机，控制键 盘上提供增益调节旋钮，可根据摄像机的重量，调节平台控制回路的增益，从而获得满意的 稳定精度。车载摄像稳定平台支持两种操作方式码盘控制和操纵杆控制，操作人员可以根 据实际情况自由选择。控制键盘功能示意图如图4所示。控制键盘由一个二维操纵杆、俯仰轴和方位轴 加矩角速度调节旋钮、俯仰轴和方位轴控制回路增益调节旋钮、俯仰轴和方位轴稳定闭合 按键、键盘/码盘切换开关、以及平台工作状态指示灯组成。二维操纵杆输出加矩角速度 量。控制键盘可单独使用。同时，控制键盘上留有编码器接口，可通过控制键盘上的键盘/ 码盘切换开关，将平台的控制切换到三脚架上的两个光电码盘。码盘输出平台俯仰轴和方 位轴的角位置，控制平台的俯仰轴和方位轴角度。码盘的转动角度与平台俯仰轴和方位轴 的转动角度一一对应。如图5、6所示，控制单元软件实现包括功率模块、稳定控制器、锁定控制器和两个前馈控制器；稳定控制器、功率�？�、平台上的电机和陀螺以及信号处理装置构成系统的稳 定回路；锁定控制器、稳定回路、平台上的电机和电位计以及信号处理装置构成系统的锁定 回路；锁定回路采用电位计作为姿态角传感器，采用比例加积分控制，锁定回路与稳定回路 共用DSP数字控制器，测量/控制周期为1毫秒。回路输入接口为16位逐次逼近A/D变换 器；输出数据叠加在陀螺输出数据上，在常值陀螺漂移作用下实现速率无静差控制。待摄像目标的移动量经过前馈控制器I进行比例运算后叠加在陀螺速率信号的 同时，将待摄像目标的移动量经过前馈控制器II进行比例、积分运算后得到平台需转动的 角度叠加在电位计角度信号上后输入给锁定控制器，经锁定控制器PID处理后与上述陀螺 速率信号一起输入给稳定控制器，经稳定控制器进行PID运算处理后生成控制量，并将控 制量进行PWM调制后生成PWM信号，该PWM信号经过功率�？榻泄怦罡衾牒颓笏腿� 平台上的电机，由电机控制平台动作，陀螺和电位计重新输出平台角速率和平台角度，经信 号处理装置处理后作为稳定回路和锁定回路的输入，构成双闭环回路。锁定回路是稳定回路的外回路，目的是使车载摄像稳定装置的相对转角跟踪输入 的指令角度。锁定回路的带宽设计应为稳定回路带宽1/5-1/10。 需要长时间自动跟踪某个运动目标时，启动图像跟踪功能，手动锁定目标，图像跟 踪器实时解算目标在视场中相对于视场中心的偏移量及脱靶量自动控制平台转动，始终将 目标锁定在视场的中心，实现对运动目标的自动跟踪。极大地简化了操作人员的工作，并能 有效保证获取稳定高质量的图像信息。待摄像目标的移动量可以通过手动控制或自动跟踪给出，当通过手动控制时，待 摄像目标的移动量为光电码盘或操纵杆给出的加矩指令，当为自动跟踪时，待摄像目标相 对视场中心的偏移量为目标脱靶量。目标脱靶量由图像跟踪算法给出，算法处理流程如图 7所示图像跟踪器对波门内的数字图像进行处理(设置以目标为中心的波门区域，波门 大小一般为2至4倍目标大小)，包括对图像进行中值滤波去噪声；对滤波后的图像利用 sobel边缘检测提取波门内目标边缘；自适应求阈值(该阈值可以由上述目标边缘的累加 和除以目标边缘个数得到)，根据该阈值再从波门内的数字图像中二值化分割出目标边缘， 然后根据分割出的全体目标象元位置数据和目标象元的总点数，计算出目标的质心，该质 心数据作为下一场波门的跟踪数据，其中噪声滤波采用中值滤波，边缘增强在这里作为提 取目标的特征，采用sobel算子提取目标的边缘。二值化的边缘图像的质心计算公式χ 分量质心坐标 y分量质心坐标 f(x，y)为灰度值；特征提取图像绕质心的转动惯量记为
归一化不变矩NMI
其中
图像质量，代表图像所有灰度值之和。匪I具有良好的缩放，旋转和平移不变性，因此可以作为物体的识别特 征。但由于噪声的影响，对目标周围区域搜索时，使得噪声图像与目标具有相同的质 心，但明显不是待识别的目标。匪I特征虽然具有良好的不变特征，但搜索区域中目 标的坐标不能确定，图像跟踪器的跟踪都是对二值化后的图像进行处理。组合利用 匪I特征量和质心坐标偏移量作特征匹配搜索，得出当帧的目标位置，设匹配函数为
其中波门大小为 aXa(上述
N = a), (x0, y0)为前一帧的波门坐标，(x, y)为当帧的波门坐标(x0-a/2彡χ彡x0+a/2, y0-a/2 ^ y ^ y0+a/2)，p(x0,y0)，匪I (x。，y0)分别为前一帧波门(x。，Y0)内目标质心的坐
标向量和目标的匪I不变矩，ρ'(υ),匪I (x，y)为当前帧搜索区域波门(x，y)内目标质心
的坐标向量和匪I不变矩，A1, A2为匹配权值，这里取λ工=0. 8，λ 2 = 0. 2。则整个特征 匹配搜索过程即为求函数k(x，y)的极小值，搜索过程如图8所示，此时(x，y)为目标在当 帧中的坐标，其相对视场中心坐标的偏移坐标即为得到的目标脱靶量。功率�？�3采用TOSHIBA公司的6附37芯片实现PWM信号光耦隔离，驱动�？椴� 用National Semiconductor公司的LMD18200芯片实现PWM信号驱动。如图6、9所示，控制�？椴捎肈SP+FPGA芯片实现，DSP选用TI公司的 TMS320F2407，执行核心的控制计算，其主要功能为1)执行数字控制系统的初始化、循环执行流程；2)通过与FPGA芯片相连的总线上得到各种传感器和外设数据；3)执行各控制律算法，即完成上述各个控制器的功能；4)输出电机驱动信号；DSP首先进行I/O、PWM等�？榈某跏蓟�、设定定时中断。定时中断周期为2ms，在 定时中断内循环执行各控制律算法的流程。通过片选信号、地址线的逻辑组合，DSP从数据 线上读取FPGA发出的各种数据。FPGA选用Altera公司的EPM7128，执行逻辑运算和外围电路的控制，其主要功能 为 1)陀螺和电位计A/D采集；2)接收控制单元的串行数据；3)通过与DSP芯片相连的总线，向DSP芯片传输各种数据；A/D选用7655芯片，FPGA给出逻辑信号控制A/D，得到陀螺和电位计的数字量，FPGA通过RS422差分串口芯片从控制单元得到加矩指令或目标脱靶量。通过片选信号、地 址线的逻辑组合，将数字量和串行数据通过数据线传给DSP进行控制。上述功能实现芯片说明书中都有介绍属于本领域技术人员的公知常识，这里不进 行详细说明。控制律算法在DSP中执行，包括俯仰轴和方位轴控制，基本原理均为稳定回路+锁 定回路的双闭环控制。稳定控制器的原理是利用陀螺作为角速率敏感元件，通过DSP+FPGA控制芯片运 算后驱动平台上的电机使平台转动，抵消干扰力矩引起的相机视轴晃动角速率，可以使视 轴在惯性空间内长时间保持指向不变。角速率稳定的目标是保持陀螺敏感的角速率为零，在陀螺零漂较小的情况下，可 得到很好的稳定效果。由于陀螺的零漂较大，在零漂系数未被补偿的情况下，较快的零位漂 移造成实际零位与设定零位的较大偏差，“误认为”平台正以某一角速率转动，因此会驱动 电机反向运动加以抵消，最后的结果就是造成视轴始终向一个方向转动。锁定控制器的原理是利用角度传感器敏感平台的相对转角，通过DSP控制电机 使相机与平台基座的相对姿态保持不变，消除陀螺零漂造成的视轴运动。以俯仰轴为例介 绍本发明的控制流程。1)稳定回路稳定控制器对输入的信号进行PID运算处理后生成控制量，并将控制量进行PWM 调制后生成PWM信号。要实现上述的功能，只需得到稳定回路的校正网络KnGn(s)即可。电 机转动惯量为J，陀螺标度因子为Kg，AD采样增益KAD，电机等价力矩系数为Km(Nm/LSB)，s 为拉普拉斯算子，则稳定回路的开环传递函数G。(s)为 本实施例中KgKADKm = 967Hz,由开环传递函数可知未校正之前系统的带宽过大，不 可能实现稳定的系统，必须通过调整增益降低带宽。理论上这一类型的稳定回路的带宽应 达到20 30Hz，才能具有较好的指令跟踪性能，所以加入一个比例环节Kn = 0. 02998，使 得系统的带宽实际为= 29Hz。调节增益后系统的剪切频率满足了带宽的要求，但是由于这一系统是基本I型系 统，开环幅频特性曲线的低频段的值较�。斐上低车牧馗斩炔还�。此外，相频曲线始终 为-90°，相位裕度太大，造成系统的响应速度较慢。所以需要加入校正网络改善其动态特 性。根据需要校正网络Gn(s)选用积分环节 2)锁定回路锁定回路是稳定回路的外回路，目的是使相机-平台基座的相对转角跟踪输入的 指令角度。角度锁定回路的带宽设计应为稳定回路带宽1/5 1/10，响应速度较慢，因此 此时稳定回路可被简化为一比例环节，其增益艮为l/(KADKg)。则锁定回路的开环传递函数为 Ka为角度传感器标度因子(V/rad)。本实施例中ly^I^ = 1. 91Hz，令角度锁定回 路的增益为1/3，则系统实际带宽为0. 637Hz，因此采用的积分校正网络为 3)前馈控制本系统响应外部指令的理想模式是当外部有输入角速率指令信号(待摄像目标 的移动量)时，稳定平台以一定的角速率旋转，一旦平台转动角度达到期望值时，外部输入 角速率指令信号，平台停止转动。外部输入角速率指令信号是指光电码盘或操纵杆给出的加矩指令，因为俯仰轴和 方位轴的光电码盘转动角度分别与俯仰轴和方位轴的的的转动角度一一对应。所以光电码 盘的转动角度就是平台需要转动的角度，直观易操作。如果只有稳定回路，跟踪外部的输入角速率指令，只需将指令信号与A/D采样后 的陀螺信号数字量叠加，平台就会以这一速率进行转动。平台转动的角速率《 = cocffld/ (KfflKg)，在一定时间T内转过的角度0 = coT，其中《。md是输入指令角速率，e为输入指 令角度。在稳定回路之外有锁定回路的情况下，通过上述方式，可以使平台的瞬时角速率 跟踪输入的指令角速率，由于稳定回路的响应速度远大于锁定回路，一段时间以后，锁定回 路才开始产生作用，于是又会将已经旋转了一个角度的平台再次锁回当初的零位，因此达 不到使稳定平台的输出角度改变的目的。此时，必须使锁定回路的锁定角度与由平台旋转 角速率，即输入角速率指令信号产生的旋转角度变化量同步。即外部输入信号通过前馈控 制器1向稳定回路加入角速率信号时，同步地通过前馈控制器2向锁定回路加入相应的角 度信号。根据上述分析，需要增加前馈控制器1和前馈控制器2进行前馈控制，前馈控制器 1为比例环节ksl= l/(KfflKg)。利用输入角速率指令产生同步的锁定角度指令，前馈控制器 2采用一个积分环节Ks2/s，则Ks2 = Ka/Kg。最后可得到平台需要转动的角度0 = (Ks2/Ka) co cmd T。本发明未详细说明部分属于本领域技术人员公知常识。
权利要求
车载摄像稳定平台，其特征在于包括车载摄像稳定装置、信号处理装置、控制单元、陀螺、电位计、电机；电机包括俯仰力矩电机和方位力矩电机；电位计包括俯仰轴电位计和方位轴电位计；陀螺安装在车载摄像稳定装置的左端罩内的左内轴上；俯仰力矩电机安装在车载摄像稳定装置的右端罩内的右内轴和右外轴之间；方位力矩电机安装在车载摄像稳定装置的方位内轴和方位外轴之间；俯仰轴电位计安装在右端罩内的俯仰轴齿轮连接板上，方位轴电位计安装在车载摄像稳定装置的方位轴端组件的俯仰轴齿轮连接板上；陀螺、电位计、电机分别用于敏感平台的角速率，测量平台的角度和驱动平台转动；信号处理装置、控制单元放置在平台外，控制单元与信号处理装置连接后、由信号处理装置通过控制电缆连接在车载摄像稳定装置上；控制单元采用图像跟踪方式实现对运动目标的手动锁定或自动跟踪，信号处理装置、控制单元、陀螺、电位计和电机构成稳定回路和锁定回路，信号处理装置将陀螺敏感的平台角速率和电位计测量的平台角度进行低通滤波、模数转换后，得到陀螺速率信号和电位计角度信号，并将得到的信号输入给控制单元，控制单元对输入的陀螺速率信号、电位计角度信号和待摄像目标的移动量进行处理，给出加矩指令即角速度控制信号，并采用前馈控制进行加矩，输出控制信号送入电机，由电机控制平台动作，陀螺和电位计重新输出平台角速率和平台角度，经信号处理装置处理后作为稳定回路和锁定回路的输入，构成双闭环回路，实现对待摄像目标的跟踪。
2.根据权利要求1所述的车载摄像稳定平台，其特征在于所述的控制单元包括功率 �？�、稳定控制器、锁定控制器和两个前馈控制器；稳定控制器、功率�？�、平台上的电机和 陀螺以及信号处理装置构成系统的稳定回路；锁定控制器、稳定回路、平台上的电机和电位 计以及信号处理装置构成系统的锁定回路；待摄像目标的移动量经过前馈控制器I进行 比例运算后叠加在陀螺速率信号的同时，将待摄像目标的移动量经过前馈控制器II进行 比例、积分运算后得到平台需转动的角度叠加在电位计角度信号上后输入给锁定控制器， 经锁定控制器PID处理后与上述陀螺速率信号一起输入给稳定控制器，经稳定控制器进行 PID运算处理后生成控制量，并将控制量进行PWM调制后生成PWM信号，该PWM信号经过功 率�？榻泄怦罡衾牒颓笏腿肫教ㄉ系牡缁傻缁刂破教ǘ鳎勇莺偷缥患浦� 新输出平台角速率和平台角度，经信号处理装置处理后作为稳定回路和锁定回路的输入， 构成双闭环回路。
3.根据权利要求1或2所述的车载摄像稳定平台，其特征在于所述的待摄像目标的 移动量可以通过手动控制或自动跟踪给出，当通过手动控制时，待摄像目标的移动量为光 电码盘或操纵杆给出的加矩指令，该加矩指令是光电码盘输出的角位置，码盘的转动角度 与平台俯仰轴和方位轴的转动角度一一对应；当为自动跟踪时，待摄像目标的移动量为目 标脱靶量。
4.根据权利要求3所述的车载摄像稳定平台，其特征在于所述的目标脱靶量由图像 跟踪算法给出，算法处理流程如下第一步，对图像进行中值滤波去噪声；第二步，对滤波后的图像利用sobel边缘检测提取波门内目标边缘；第三步，二值化分割出目标边缘；第四步，组合利用匪I特征量和质心坐标偏移量作特征匹配搜索，得出当帧的目标位置，设匹配函数为 则整个特征匹配搜索过程即为求函数k(x，y)的极小值，此时(x，y)为目标在当帧中的 坐标，其相对与视场中心坐标的偏移坐标即为得到的目标脱靶量；其中波门大小为aXa，(x0,。为前一帧的波门坐标，(X，y)为当帧的波门坐标 (x0-a/2 彡 χ 彡 x0+a/2,y0-a/2 彡 y 彡 y。+a/2) ;p(x0,y0),匪I (x。，y0)分别为前一帧波门(x0，y0)内目标质心的坐标向量和目标的匪I不变矩；P'(U)，匪I (χ，y)为当前帧搜索区域波门(χ，y)内目标质心的坐标向量和匪I不变矩，为匹配权值，λ 1+λ 2 = 1。
5 根据权利要求1所述的车载摄像稳定平台，其特征在于所述的锁定回路的带宽为 稳定回路带宽的1/5 1/10。
6.根据权利要求1所述的车载摄像稳定平台，其特征在于所述的两轴摄像稳定装置 包括左端罩(1)、陀螺座(2)、左连接板(4)、俯仰轴左侧轴端组件、摄像机安装组件、俯仰轴 右侧轴端组件、俯仰轴电位计组件、右端罩(23)、U型支架(25)、插座(26)、俯仰挡钉(27)、 插座安装板(28)、方位挡钉(29)、方位轴端组件、方位轴电位计组件、盖板(42)；左端罩(1)、右端罩(23)分别固定连接在U型支架(25)的左右两侧；左端罩(1)内陀 螺(3)与陀螺座(2)固定连接，陀螺座(2)通过左连接板(4)与俯仰轴左侧轴端组件的左 内轴(5)固定连接；俯仰轴左侧轴端组件的左外轴(7)与U型支架(25)固定连接；右端罩 (23)内的俯仰轴电位计组件通过俯仰轴电位计连接板(22)与俯仰轴右侧轴端组件的右外 轴(15)固定连接，右外轴(15)与U型支架(25)固定连接；摄像机安装组件位于U型支架 (25)的内部，摄像机安装组件的摄像机固定螺钉(24)悬挂于摄像机支架(10)底部，连接 杆(11)通过螺母固定于摄像机支架(10)的左右侧板之间，摄像机支架(10)的两侧分别与 左内轴(5)和右内轴(12)固定连接；俯仰挡钉(27)固定在U型支架(25)内部两侧，限制 摄像机安装组件的俯仰转动；方位轴电位计组件由方位轴电位计连接板(40)通过支撑杆 与方位轴端组件的方位外轴(32) —端固定连接；方位外轴(32)的另一端与基座(33)固定 连接，插座安装板(28)安装在U型支架(25)的底部与方位轴端组件的方位内轴(36)固定 连接，方位内轴(36)与U型支架(25)底部固定连接；方位挡钉(29)固定连接在U型支架 (25)底部，限制基座(33)的方位转动；插座(26)安装在基座(33) 一侧；盖板(42)与基座 (33)底部固定连接。
7.根据权利要求1所述的车载摄像稳定平台，其特征在于所述的俯仰轴右侧轴端组 件包括右内轴(12)、右轴外锁紧螺母(13)、第二轴承(14)、右外轴(15)、右轴内锁紧螺母 (16)、轴联器(18)；第二轴承(14)、俯仰力矩电机(17)从左至右依次安装于右内轴(12)和 右外轴(15)之间，第二轴承(14)的内外圈分别用右轴内锁紧螺母(16)和右轴外锁紧螺母 (13)锁紧，俯仰力矩电机(17)的定子通过螺钉与右外轴(15)固定连接，俯仰力矩电机转子 通过轴联器(18)和螺钉与右内轴(12)固定连接。
8.根据权利要求1所述的车载摄像稳定平台，其特征在于所述的俯仰轴电位计组件 包括一个俯仰轴齿轮(19)、俯仰轴齿轮连接板(20)、俯仰轴电位计(21)、俯仰轴电位计连 接板(22)；俯仰轴齿轮(19)通过螺钉与俯仰轴齿轮连接板(20)固定连接；俯仰轴齿轮连接板(20)通过紧定螺钉与俯仰轴电位计(21)固定连接；俯仰轴电位计组件由俯仰轴电位计连 接板(22)通过支撑杆与右外轴(15)固定连接，该俯仰轴齿轮(19)与安装在俯仰轴联器 (18)上的俯仰轴齿轮互相啮合。
9.根据权利要求1所述的车载摄像稳定平台，其特征在于所述的方位轴端组件包括 方位轴外锁紧螺母(30)、第三轴承(31)、方位外轴(32)、方位轴内锁紧螺母(34)、方位内轴(36)；一对第三轴承(31)、方位力矩电机(35)自上而下安装于方位内轴(36)和方位外轴 (32)之间，轴承(31)的内外圈分别用方位轴内锁紧螺母(34)和方位轴外锁紧螺母(30)锁 紧，方位力矩电机定子通过螺钉与方位外轴(32)固定连接，方位力矩电机转子通过螺钉与 方位内轴(36)固定连接。
10.根据权利要求1所述的车载摄像稳定平台，其特征在于所述的方位轴电位计组件 包括一个方位轴齿轮(38)、方位轴齿轮连接板(39)、方位轴电位计连接板(40)、方位轴电 位计(41)；方位轴齿轮(38)通过螺钉与方位轴齿轮连接板(39)固定连接；方位轴齿轮连接板 (39)通过紧定螺钉与方位轴电位计(41)固定连接；方位轴电位计组件由方位轴电位计连 接板(40)通过支撑杆与方位外轴(32)固定连接，该方位轴齿轮(38)与安装在方位轴连器(37)上的方位轴齿轮互相啮合。
全文摘要
车载摄像稳定平台，平台采用电位计作为锁定回路的反馈元件，通过陀螺敏感载体扰动的角速度控制电机运动，隔离了载体运动的干扰，抑制陀螺的漂移，实现了有效载荷相对惯性空间的稳定；控制单元采用光电码盘加矩，直观易操作，采用前馈控制进行加矩，提高了加矩的速度和精度；平台采用图像跟踪方式实现对运动目标的手动锁定和自动跟踪，简化了操作人员的工作，并能有效保证获取稳定高质量的图像信息。本发明有效地隔离了车载角运动引起的干扰，抑制了陀螺引起的平台漂移，提高了系统的动态性能，对影视拍摄等领域有重要的应用价值。
文档编号G01B7/30GK101872198SQ201010173348
公开日2010年10月27日 申请日期2010年5月10日 优先权日2010年5月10日
发明者丁楠, 丁祝顺, 朱娜, 高强 申请人:北京航天控制仪器研究所
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
