基于MC9S12DGl28单片机的快速位置伺服系统的设计

　　引言

　　本设计要求对某火炮的水平和高低角进行控制，达到快速位置伺服系统的要求。而这个火炮角度控制系统首先要求有快速性，它的反应时间大于或等于12°／s；角度转动控制精度小于或等于1’，水平角转动范围从一120°～+120°，高低角转动范围从0°～+85°；最后系统要有很好的稳定性和动态性能。

　　由于位置伺服系统一般是以足够的位置控制精度、位置跟踪精度和足够快的跟踪速度作为它的主要控制目标，系统运行时要求能以一定的精度随时跟踪指令的变化。所以对于这种快速位置伺服系统，要求整个系统各部分配合良好，其中的关键是控制器的选择，综合考虑高精度、抗干扰能力、灵活性、可靠性、实时性、性价比等各因素的情况下。选择了Frees—cale公司的MC9Sl2DGl28B作为控制器。MC9Sl2DGl28B芯片是一款16位的单片机，功能强大，性能优越。本文采用该型号的单片机保证了所设计系统的稳定可靠。

　　1 系统控制方案

　　由于设计的角度伺服系统的负载比较大，而且相对于工业控制要求而言系统精度和快速性要求高，所以整个系统采用混合闭环的控制结构，所谓混合闭环的控制结构，就是系统内同时存在半闭环和闭环。半闭环起到控制作用，而全闭环只用于稳态误差补偿，两者相结合可获得较高的位置控制精度和跟踪速度。包括：MJX40—14型光电编码器、90LCX一3直流伺服电机、12A8型PWM直流伺服电机驱动器、单片机控制系统。单片机控制系统由MC9Sl2DGl28B单片机实现，使用Code Warrior for HCl2 V4．6编译器，采用C语言编程。由于水平角和高低角的控制是一样的，而且共用一个单片机，以角度控制方框图（图1）来说明。

　　如图1所示，系统的任务是使光电编码器测得的炮架转动角度θ2与给出的指令θ1相等。当θ1≠θ2时，θ1一θ2的偏差信号在单片机里进行处理，放大后输入到PWM直流伺服电机驱动器，由PWM驱动器驱动直流伺服电机，伺服电机带动减速器，驱动炮架向着减少偏差的方向移动，直到θ1=θ2，电机停止转动，达到目标。同时，炮架要准确的跟踪目标，必须减少在跟踪过程中可能出现的速度变化（如风速等原因），因为直流伺服电机本身带有测速机端，可以把速度反馈信号进行负反馈输入到PWM伺服电机驱动器，这样使转动机械的转速度变化很小，起着稳速的作用。