稳定平台系统设计要点.pdf
《稳定平台系统设计要点.pdf》由会员分享,可在线阅读,更多相关《稳定平台系统设计要点.pdf(21页珍藏版)》请在三一文库上搜索。
1、技术论文 学校:南京理工大学队伍:7046 指导老师:李军 成员 1:雷杨成员 2:陈舒思成员 3:邝平 作品名称:高精度稳定平台控制系统 I 摘要 稳定平台能够隔离载体角运动, 在载体机动状态下建立稳定基准面,使安装 在平台上的光电设备不会因载体运动产生的抖动和滚动而丢失目标,保证光电设 备准确瞄准和跟踪目标,因此广泛应用于民用和军事领域。 设计的高精度稳定平台控制系统是以动力调谐陀螺仪为速度敏感元件,旋转 变压器为角度测量元件,DSP 控制器 TMS320F28335 为主控芯片,直流力矩电 机为被控对象的闭环控制系统。根据 所需关键器件的选型设计了系统的硬件电 路,包括速度和角度信号采样
2、电路、电机驱动电路、通信电路等。采用电流环和 位置环的双闭环控制方式实现系统载体静止时的伺服控制;采用电流环、 速度环 和位置环的三闭环控制方式实现系统在载体运动时的稳定控制。以上两种控制模 式下的角度控制精度都能够达到0.05mrad, 载体运动时系统稳定控制模式下隔离 扰动效果很好。 实测结果表明,该系统硬件结构简单,稳定性好,实时性强,具有良好的稳 态和动态性能,能够满足稳定平台系统的性能要求。 关键词:稳定平台DSP 陀螺仪伺服控制 II 目录 1. 作品创意 . 1 2. 方案设计与论证. 1 2.1 主控芯片的选择与论证 2 2.2 陀螺的选择与论证 . 3 2.3 力矩电机的选择
3、与论证 3 2.4 位置检测元件的选择与论证 3 3. 系统硬件与原理图设计. 4 3.1 最小系统外围电路 4 3.2 旋转变压器 -数字转换器电路. 5 3.3 滤波采样电路 6 3.4 电机驱动电路 7 3.5 通信电路 8 3.6 闭锁电路 9 3.7 电源隔离电路 9 4. 软件设计与流程 10 4.1 主程序框架 . 10 4.2 中断程序设计 10 5. 系统测试与分析 13 5.1 系统调试环境 . 13 5.2 系统静止状态下伺服控制调试结果. 13 5.3 系统运动状态下稳定控制调试结果. 15 6作品难点与创新 18 6.1 难点 18 6.2 创新点 18 1 1. 作
4、品创意 陀螺稳定平台作为稳定视轴或瞄准线的主要手段,多年来一直是国内外科研 机构的主要研究对象。从地面上的汽车、坦克到空中的飞机、卫星等,都可以看 到陀螺稳定平台的身影。 其主要作用是用来消除载体受到的干扰,使载体能够按 照既定的方向运动或者在惯性空间中保持稳定。 本作品设计了双轴稳定平台控制系统。控制系统可工作在两种不同的工作 模式:载体静止时的伺服控制和载体运动时的稳定控制。其中载体静止时系统工 作于伺服控制模式, 系统作用是使被稳定平台转角相对基座保持固定不变或跟随 指令信号进行跟踪运动, 采用旋转变压器作为角度反馈器件;载体运动时系统工 作于稳定控制模式, 控制系统主要功能是隔离载体运
5、动及平台受到的各种扰动信 号,保持平台相对于惯性空间稳定,以保证光电装置可以获得稳定的视场,采用 陀螺仪作为平台速度反馈器件。系统两种控制模式如图1.1、图 1.2 所示。 位置 校正 电流 校正 电流反馈 电流环节 位置反馈旋转变压器 i Ts1 1 电机 sJJ LM )( 1 s 1 L T 负载转矩 0 位置环节 0 图 1.1 载体静止时伺服控制框图 位置 校正 速率 稳定 电流 校正 电流反馈 电流环节 速度反馈平台陀螺 i Ts1 1 电机 sJJ LM )( 1 s 1 L T 负载转矩 0 速度环节位置环节 0 速度积分 w 图 1.2 载体运动时稳定控制框图 2. 方案设计
6、与论证 针对稳定平台的功能和用途,我们设计了系统控制方案,系统硬件结构如 图 2.1 所示,系统分为方位轴和俯仰轴两个自由度的控制电路设计,控制系统在 这两个方向上的结构基本一致, 主要可以分为信号采集、 电机驱动和信息交互三 部分。 2 控制过程为:陀螺敏感到平台在惯性空间的角速度信号,经过A/D 转换后 变为数字信号传送给DSP 主控制器,同时旋转变压器感应到的平台位置信号经 过轴角粗精通道编码后,也传送到DSP中,在 DSP 中经过信号处理和控制算法 处理后,产生控制力矩电机的信号,以抵消扰动力矩使平台稳定并跟踪目标。 图 2.1 方案整体设计图 2.1 主控芯片的选择与论证 TMS32
7、0F28335 型数字信号处理器TI 公司的一款TMS320C28X 系列浮点 DSP控制器。与以往的定点DSP 相比,该器件的精度高,成本低,功耗小,性 能高,外设集成度高,数据以及程序存储量大,A/D 转换更精确快速等。 TMS320F28335具有 150MHz 的高速处理能力, 具备 32 位浮点处理单元, 6 个 DMA 通道支持 ADC、McBSP 和 EMIF,有多达 18路的 PWM 输出,其中有 6 路为 TI 特有的更高精度的PWM 输出 (HRPWM) ,12 位 16 通道 ADC。得益 于其浮点运算单元, 用户可快速编写控制算法而无需在处理小数操作上耗费过多 的时间和
8、精力,与前代DSC 相比,平均性能提高50%,并与定点 C28x 控制器 软件兼容,从而简化软件开发,缩短开发周期,降低开发成本。与作用相当的 32 位定点技术相比,快速傅立叶转换(FFT)等复杂计算算法采用新技术后性能 提升了一倍之多。这些特点使得TMS320F28335 非常适合于本设计伺服控制系 统使用。 3 2.2 陀螺的选择与论证 本系统所采用的陀螺仪为动力调谐陀螺仪,与常用的输出位置信号的液浮 陀螺不同,该陀螺输出的是速率信号, 经过调研该型陀螺是目前国内同等体积下 精度较高的一款陀螺仪。 动力调谐陀螺仪是一种双自由度陀螺仪,它利用可以准 确补偿摩擦力矩的挠性支承悬挂陀螺转子,消除
9、了摩擦干扰力矩, 结构简单, 性 能可靠。外环的转子通过外扭杆与内环的平衡环相连,平衡环通过内扭杆与力矩 电机轴相连,转子可以绕内外轴线转动,是目前比较常用的一款陀螺仪 2.3 力矩电机的选择与论证 执行元件影响着被控对象的运动状况与系统精度。通常选用电机作为稳定 平台伺服控制系统的执行元件。目前使用的电机有: 直流伺服电动机、 交流伺服 电动机、步进电机以及直流力矩电机等。根据平台稳定系统低转速、 大转矩的工 作要求,选用直流力矩电机作为稳定平台伺服系统的执行元件。其主要特点是可 以长期在堵转状态下运行,和负载直接相连无需加装减速齿轮,避免了空回“除 此之外,力矩电机还具有反映快、精度高!藕
10、合刚度大、低转速、线性度好,体 积小等优点。 2.4 位置检测元件的选择与论证 平台的环架位置就是各个环的力矩电机所转动的角度,比较常用的获取电 机转角的装置主要有光电编码器和旋转变压器等。在工业生产中光电编码器的精 度可以做到很高,测量范围广,且很多数字控制器都有专用外设结构与其相匹配, 所以其使用更为广泛。 但在此处力矩电机的转动角度比较小,转速快慢变化范围 较大,并且由于系统使用环境存在大冲击等恶劣因素,电机角度采样装置除了需 要能精确地反映电机真实的转角外,还需要有较强的抗冲击和抗误差能力。旋转 变压器是在测角系统中广泛采用的一种高精度角度传感器,精度高、 动态性能好、 抗干扰能力强,
11、尤其适用于高温、严寒、潮湿、高速、振动等环境恶劣、旋转编 码器无法正常工作的场合。 它利用电磁感应原理将直线位移或转动角度精确地转 换成电信号, 按极对数可以分为单对极和多对极型。由于粗机(单对极旋转变压 器)测量范围大但精度低,精机(多对极旋转变压器)测量范围小但精度高,在 测量电机角度时一般都采用精机和粗机相组合的方式获取准确角度。 4 3. 系统硬件与原理图设计 3.1 最小系统外围电路 JTAG 接头是 DSP 与仿真器的接口,通过该接口可以很方便的对DSP 进行 仿针和调试,图 3.1 所示为无缓冲器的简易接法。需要注意的是当JTAG 接口与 DSP的距离大于 15cm时应当考虑增加
12、信号缓冲器。 图 3.1 JTAG 接口 TMS320F228335 的最高主频为 150MHZ,为了正常工作需要为其提供时钟 输入信号。 有两种时钟提供方式, 一种是直接使用外部振荡器提供,另一种是使 用 DSP 内部振荡器但需要外接石英晶振如图3.2 所示。 从易实现性和成本上考虑 使用后种方式来为DSP 提供时钟输入。 图 3.2 石英晶振电路 电源和复位电路如图3.3 所示。一路输出稳定3.3V 电压,另一路选择 1 R =18.2K,由式 3.1 可以得到输出电压为1.9V。两路电压通过 TPS3305-18来监 测电压稳定情况,在按下手动复位按键和电源电压不稳时复位DSP。 5 图
13、 3.3 电源和复位电路 3.2 旋转变压器 -数字转换器电路 图 3.4 中 S1,S2,S3,S4为旋转变压器输出信号, CDD0CSD11 为对应的 数字输出量。为了将所有输出位一次性送出, 需要将 BYSEL 信号至高或者悬空, INH 信号为模块的片选信号, 当需要读取输出数据时需要将其置低, EN 为数据 输出使能信号可以接控制器的 RD,BUSY 信号为模块转换完成标志,当转换完 成时输出一个高脉冲。 图 3.4 旋转变压器 -数字转换电路 其供电电源电路如图3.5 所示, 电源转换模块输入为26V 直流电, 输出 26V、 400HZ 交流电源。 图 3.5 26V 交流电源
14、6 3.3 滤波采样电路 如前所述,陀螺速率信号、操纵瞄准信号和漂移补偿信号等需要进行滤波 采样,几种信号的采样电路结构相似,以陀螺速率信号采样电路为例,如图3.6 所示,信号经过前置差分放大电路进行减噪处理后,通过RC 低通滤波器滤除速 度信号中的高频噪声干扰, 再经过电压跟随器进行前后级的隔离,最后通过模数 转换转换为对应数字量。 图 3.6 陀螺速率信号采样电路 系统需要采集的模拟量比较多,对应需要读取的信号线就多,但DSP 的数 据线和板卡面积有限, 而且对数字控制系统来说, 对信号量的读取是分时进行的。 因此从各方面考虑没有必要为每个读取的模拟量单独配置一个模数转换芯片,这 就要求必
15、须使用缓冲器件对信号进行锁存以便分时进行读取。以陀螺速率信号的 漂移补偿和零偏补偿电路为例,就使用了多路开关来分时选通补偿量进行补偿。 如图 3.7 所示,该多路开关最多可以选通8 路模拟信号,实际中只使用了4 路。 图 3.7 多路开关 对于并行数据,使用54HC541 为锁存缓冲器电路,如图3.8 所示。由于锁 存输出信号为 5V 电平标准,需要54ALVC16245 进行电平转换,如图3.9 所示。 7 图 3.8 锁存缓冲器电路 图 3.9 电平转换电路 3.4 电机驱动电路 如图 3.10 所示, DSP输出的两路 PWM 驱动信号经过光耦HCPL2601 隔离 后送至集成驱动器MC
16、33486 用以驱动电机, MC33486 的控制信号以及反馈信号 也通过光耦进行隔离。由7805 构成的电压转换电路给光耦位于电机侧信号提供 单独的 +5V 电源。 图 3.10 电机驱动电路 8 3.5 通信电路 CAN 通信和 SCI 串行通信电路如图3.11所示,本系统使用的CAN 通信速 率达到了 1Mb/s,SCI 串行通信采用了 115200bit/s的波特率,经过实际调试,两 路通信正常稳定,板卡间信息交互良好。 图 3.11 CAN 和 SCI 串行通信电路 对于 CAN 通信与 MRC 总线通信转接电路,由于使用的RAM 只有 4K,实 际只使用了 1K,而 DSP2833
17、5外设总线接口的 ZONE0 区,可以访问 8K 的地址 空间,所以其访问范围是足够的。在此使用28335 的 ZONE0 区访问信号线作为 该双向 RAM DSP 侧片选,另一侧接 MRC 总线控制器,其电路图如图 3.12所示, 设置 RAM 为字访问模式。 图 3.12 双向 RAM 应用电路 9 3.6 闭锁电路 稳定平台在断电情况下是无法正常工作的,为了使平台方位轴和俯仰轴在 断电情况下不随载体的运动颠簸作无规则运动,保护上反光镜和机械装置, 本系 统设置了闭锁保护电路用于在断电情况下锁定稳定平台。其工作电路如图3.13 所示,由于闭锁电机是大电流设备, 同样使用光耦对控制信号和功率
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 稳定 平台 系统 设计 要点
链接地址:https://www.31doc.com/p-5229255.html