基于单片机的风洞模型姿态控制系统设计

　　程序入口：传感器编号存于A中。

　　程序出口：α角度存于51H、β角度存于53H。

　　部分程序如下：

　　MS: CLR EA ;关中断

　　MOV R2,A ;暂存传感器编号

　　MOV SCON,#50H ;设置串口方式

　　MOV RCAP2H,#0FFH ;自动装载值

　　MOV RCAP2L,#0D9H ;

　　MOV TH2,#0FFH

　　MOV TL2,#0D9H

　　MOV T2CON,#34H ;启动波特率发生器

　　…… …… ;发送采集命令、进制转换

　　LCALL FCIV ;调浮点数运算

　　…… …… ;进制转换、存数据

　　SETB EZ ;开中断

　　RET

　　图3 角度测量流程图

　　2.2.2 角度控制程序设计

　　风洞中模型姿态的控制分两部分，一个是当前姿态的测量，一个是计算步进电机需转过的角度，角度的控制是在精确地测量当前姿态的基础上完成的，程序框图如图4所示。

　　和角度测量相似，模型姿态需要改变的角度放在累加器中，需要改变的方向放在22H单元中，符号放在23H单元中，通过计算得到驱动模型转动给定角度所需要的脉冲数，以及该方向电机的控制端口。

　　部分程序如下：

　　DJRUN: JZ AOVER

　　MOV R2,A ; 待转角度存于A中

　　MOV A,22H ; 模型变化方向