纵横摇三轴稳定平台使用说明书2.2版.doc

三 轴 稳 定 平 台 使用说明书 (VERSION 2.2) 上 海 英 硕 自 动 化 科 技 有 限 公 司 目录 一．概述 2 二．基本硬件设计 3 三．控制策略设计 5 四．伺服控制器软件设计 7 五．操作流程 8 六．常规故障判断及处理 12 七．紧急情况处理步骤 13 一．概述 本系统采用“自主式”稳定平台的设计思路，采用动态倾角测量仪对俯仰横滚轴进行惯性稳定控制，使平台稳定地保持在俯仰和横滚的双轴水平位置。 本系统采用交流伺服电机驱动平台负载，高效率，高可靠性，无刷伺服电机免维护运行。系统有伺服控制箱面板可实现两种功能： 随动稳定控制功能； 手动点动双向运动控制，并可实现安全锁定； 二．基本硬件设计 本系统在稳定平台的内框架上，沿俯仰和横滚轴向布置一套动态倾角测量设备，实时测量外界波浪扰动信号对俯仰和横滚轴向产生的水平角度扰动，交由PCC伺服控制器，经过控制解算，通过2套对应的伺服电机，实时矫正俯仰、横滚的运动角度，依靠倾角偏差，可通过伺服电机对平台俯仰横滚角度进行修正，最终获得平台内框双轴向的水平稳定。 以下是系统的结构示意图： 以下是系统的主要技术指标： 俯仰最大范围：+/-15° 横滚最大范围：+/-15° 扰动周期：5-8 s 测量精度：0.1° 控制精度：1° 工作温度：-40℃--70℃ 平台的俯仰、横滚和方位控制驱动，拟采用交流伺服电机方案，这主要基于如下考虑： 1）无刷交流伺服技术成熟可靠； 2）采用无刷电机，利于实现电机的长寿命，免维护设计； 3）良好的频矩特性，保障低速出力均匀。 伺服系统的运动控制主要指标： 额定扭矩：约1Nm以上，配合i=64的行星减速机，出力接近100Nm； 运动速度：减速电机不低于10rpm转速（参考+/-15°，最大1Hz的扰动频率考虑）。 三个电机选配安全制动器，当系统失电时，或是在锁定控制命令时，电机制动器合上，从高速端抱死电机轴，以实现该方向运动的机械锁定。 该系统伺服控制器选用我公司的一套可编程计算机PCC控制器实现，该控制器具有下列显著优点，利于实现平台系统优异的控制性能： 所有硬件均采用模块化结构，便于灵活接入平台系统的各式模拟信号及数字式信号； 软件上基于嵌入式实时操作系统之上设计，采用模块化多任务结构，设计灵活高效，调试便捷； 采用高级语言编程（C，BASIC），在线式调试开发，效率很高； 体积紧凑功能强，对外可实现毫秒级的数据采集与实时控制，保证平台随动稳定控制的品质。 三．控制策略设计 本平台俯仰横滚轴向的稳定伺服控制采用速度及位置双环路控制策略： 内环基于动态倾角传感器位置反馈信号，对驱动俯仰、横滚轴向运动的伺服电机进行速度P控制，以对消有害的扰动作用，维持平台在惯性空间的稳定。 外环基于倾角位置反馈信号，对驱动俯仰、横滚轴向运动的伺服电机进行速度的PI控制，使平台稳定收敛于俯仰、横滚轴向的水平位置。 控制策略框图如下： 平台内框架的方位控制部分未在上图中描述出来，其控制方式较为简单，根据对方位电子罗盘反馈的方位信息，对方位电机直接做做PI控制即可实现方位角度的定位控制。 四．伺服控制器软件设计 本伺服系统的控制器采用可编程计算机控制器PCC搭建，借助于其实时多任务操作系统的支持，可将整个伺服系统的控制软件划分为如下多任务模块，交由操作系统并行调度，共同完成对外的数据采集，内部运算及对外控制功能： 五．操作流程 （一）通电使用前操作。 检测所有稳定平台的连线是否正确，所有航插按照标识都一一对应准确插入。包括三个方向电机的航插，集线盒两侧的航插以及控制箱背后的航插等。 图-1 备注：请勿将不同方向电机插头交换插，错误操作将导致设备损坏。 检查面板白色开关是否处于向下的位置（所有方位锁定），检查黄色锁定按钮是否处于弹起的状态。 备注：白色开关向上状态表示解锁，在此状态开机后会出现俯仰、横滚、方位无动作的情况出现，重新拨到向下的位置锁定再解锁，可以正常工作。 黄色锁定按钮弹起表示解锁，按下表示锁定。请勿在正常工作中按下，会导致电机工作锁定，导致电机损坏。需要紧急锁定请使用面板白色拨动开关。 （二）工作使用及相关故障现象说明 加载电源，正常通电 使用后面板的白色拨动开关给控制箱加载电源。当控制箱通电正常后，面板上24V工作指示灯点亮。如图-2所示： 图-2 打开抱闸（解锁） 在正常通电后10秒且一切准备工作都操作无误后，拨动白色开关使之处于向上的位置，此状态表示电机抱闸解锁，可观察到控制箱右侧的三个指示灯点亮。 当根据面板上的文字，可以将按钮与指示灯的关系一一对应。 正常工作（本控模式） 进入本控模式 将本控按钮按下，本控绿色指示灯点亮，进行本控操作，该模式由人工调节观测。 俯仰方向控制 按下俯仰上限位按钮，相应的绿色指示灯闪烁，平台向俯仰方向沿