基于自由摆的平板控制系统设计报告.docx

1、基于自由摆的平板控制系统设计报告2011年全国大学生电子设计竞赛基于自由摆的平板控制系统（B题）【本科组】参赛学校：南京农业大学 参赛队编号：025181 参赛队员：顾林馨、王和声、张翔宇指导教师：沈明霞、徐进 2011年9月3日摘要：本系统采用STM32F103VE作为核心处理芯片，对自由摆角度信号进行实时采集和处理，从而实现平板控制。它采用增量式旋转编码器检测摆杆的旋转角度并将角度信号传送至STM32F103VE处理器，然后处理器根据角度信号控制伺服电机的旋转角度，最终使得平台上的硬币处于受力平衡状态或激光笔在屏幕上聚焦于一点，满足题目要求。关键词：STM32F103VE，增量式旋转编码器

2、，伺服电机Abstract ：The system uses STM32F103VE as the core processing chip, collecting and processing the signal of the angle sensor. Incremental rotary encoder detects the pendulum rod rotation angle and the angle signal is transmitted to the STM32F103VE processor, the processor controls servo motor ro

3、tation angle according to the angle signal , and makes the platform on the coin at the equilibrium condition of forces or laser pen on the screen to focus on one point, meeting the requirements of title.Key words: STM32F103VE, incremental rotary encoder, servo motor基于自由摆的平板控制系统（B题）1.系统方案1.1系统方案论证与选择

4、本系统主要由处理器模块、角度检测模块和电机模块组成，下面分别论证这几个模块的选择。此外，对于键盘输入模块和显示模块，因为结构简单，所以不再进行详细论证。1.1.1处理器模块的论证与选择方案一：采用AT89C51系列单片机作为控制的核心。51单片机应用广泛，品种繁多，按单纯的控制和数据处理是比较经济实惠的。但是冯诺依曼总线结构使51内核单片机运算速度较低。另外，几种常用的51单片机内部资源较少，完成系统功能较为困难。方案二：采用FPGA作为控制核心。FPGA速度快、稳定性高、扩展性能好、体积小，可以提供丰富的逻辑单元和I/O资源，采用并行的输入/输出方式，可以达到很高的速度。但是FPGA成本较高

5、，算术能力不强。方案三：采用STM32F103VE系列单片机作为控制核心。STM32是意法半导体公司生产的基于Cortex-M3内核的32位ARM嵌入式处理器。Cortex-M3核性价比更高,价格低,可以与8位单片机竞争。由于采用了最新的设计技术，它的门数更低，性能却更强，处理速度更快，完全满足了本设计所要求的很高的精密度和快速的处理速度。综合以上三种方案，选择方案三。1.1.2角度检测模块的论证与选择方案一：采用MMA7455加速度传感器检测平台倾角。其核心为飞思卡尔公司的MMA7455L数字三轴加速度传感器，它体积小，工作可靠。但其8位模式还是限制了其测量精度，在测量微小的角度变化上存在误

6、差。方案二：采用电位器检测摆杆倾角。用电阻分压方式可以实现电位器对角度变化的感应，但必须经过模数转换才能将信号传给处理器处理。此时，电位器的灵敏度和模数转换器的精度都会对测量结果产生直接影响，误差一般很大。方案三：采用增量式旋转编码器检测摆杆倾角。增量式旋转编码器的转轴旋转时，有相应的脉冲输出，其计数起点任意设定，可实现多圈无限累加和测量。需要提高分辨率时，可利用 90 度相位差的 A、B两路信号进行倍频或更换高分辨率编码器。2000线的编码器转轴旋转一周可以输出2000个脉冲，可以实现极高精度的角度检测。 综合以上三种方案，选择方案三。1.1.3电机模块的论证与选择方案一：采用步进电机控制平

7、台旋转。步进电机作为一种开环控制的系统，和现代数字控制技术有着本质的联系。在目前国内的数字控制系统中，步进电机的应用十分广泛。但是不经细分的步进电机控制精度不高，速度响应也较慢。方案二：采用伺服电机控制平台旋转。在伺服系统中控制机械元件运转的发动机是一种补助马达间接变速装置。伺服电机可控制速度,位置精度非常准确。它将电压信号转化为转矩和转速以驱动控制对象。伺服电机在控制精度、低频和矩频特性、过载能力、运行和速度响应性能等方面都优于步进电机。综合考虑采用方案二。1.2系统硬件结构设计图1 系统总体结构框图系统以STM32F103VE作为核心处理芯片，包括角度检测模块、键盘输入模块、电源模块、电机

8、模块、显示模块和声音提示模块等功能模块，该系统的总体结构框图如图1所示。各模块的具体功能如下:角度检测模块: 该模块利用增量式旋转编码器实现对摆杆倾斜角度的实时监测，并将信息反馈给处理器。键盘输入模块: 该模块利用键盘按键实现系统程序的切换。电机模块: 该模块利用伺服电机实现对旋转平台的实时控制。显示模块: 该模块利用LED灯实现信息的显示。2系统理论分析与计算2.1 系统建模与计算 图2 硬币不滑落的系统模型 图3 激光笔照射中心的系统模型2.1.1硬币不滑落的建模与计算如图2所示，设当摆杆倾角为时，平台与水平方向的夹角为。对硬币进行受力分析，其合力为自身重力与离心力这两个力的合力。若硬币不

9、掉，则平台平面与合力方向垂直。由此可建立平面几何模型，求得与的关系。具体计算如下：在ABC中，利用余弦定理求得AC= (mg)2+(m2)22m2g2cos1/2。其中，=d/dt。再利用正弦定理得=arcsinr2sin/(g2+2+2g2cos)1/2。由于平台转动角后水平，所以硬币不滑落的平台旋转角度为（）度。2.1.2激光笔照射中心线的建模与计算如图3所示，设当摆杆倾角为时，激光笔发射的激光光线与水平面的夹角（也是平台与水平面的夹角）为。由此可建立平面几何模型，求得与的关系。具体计算如下：在ABC中解得AC=2sin（/2）。在ACD中，利用余弦定理可解得CD=(17/4-2cos-3

10、sin)1/2。再由正弦定理得=arcsinACsin(/2) /CD= (1-cos)/ (17/4-2cos-3sin)1/2。由于平台转动角后水平，所以当转到靠近靶子一侧时平台转动角度为（+）度；当转到远离靶子一侧时平台转动角度为（）度。2.2 平台状态测量与控制方法2.2.1摆杆摆动角度的测量方法如图4所示，增量式旋转编码器固定在图中A处，编码器转轴与摆杆轴承相连，可以实时监测摆杆旋转角度。编码器转轴旋转一周产生2000个脉冲，处理器通过检测接受脉冲的个数测量摆杆旋转角度。2.2.2 平台旋转角度的控制方法如图4所示，伺服电机固定在图中B 图4 机械结构示意图处，电机转轴与平台中心轴相

11、连，可以实时控制平台旋转角度。伺服电机接受4000个脉冲旋转一周，电机通过处理器发送的脉冲个数控制平台的旋转角度。2.2.3 角度传感器向电机的信息传递如图5所示，因为编码器的检测与电机的控制都依靠脉冲的个数且前者与后者一 图5 信息传递过程周的脉冲比为1:2，所以只要控制好脉冲个数就能实现角度传感器向电机的信息传递。以两者同步等角旋转为例，处理器只需将接收到的编码器的脉冲个数乘以二发送给电机即可。3电路与程序设计3.1电路的设计3.1.1平台控制子系统框图和电路原理图图6 平台控制系统框图图7 平台控制系统框图3.1.2 系统输入和显示子系统电路原理图 图8 系统输入和显示子系统电路图3.2

12、程序的设计3.2.1程序功能描述与设计思路1、程序功能描述（1）实现摆杆摆动一个周期，平台旋转一周。（2）实现8枚硬币在摆动中不滑落。（3）实现摆动中激光笔照射中心线。2、程序设计思路（1）用按键控制三个程序的切换。（2）将处理器接收的脉冲经计算后传给电机。3.2.2程序流程图图9 程序主流程图4测试方案与测试结果4.1测试方案1、硬件测试：测试机械部分能否正常工作，各项参数是否准确。同时，检查电路焊接是否正确，各部分接线是否正确。2、软件仿真测试：用Multisim软件对电路进行仿真3、硬件软件联调：用实现的编程算法控制硬件系统进行工作。检测整个系统是否实现各项要求。4.2 测试条件与仪器测

13、试条件：检查多次，机械部分必须正常工作且参数正确。仿真电路和硬件电路必须与系统原理图完全相同，并且检查无误，硬件电路保证无虚焊。测试仪器：数字存储示波器、量角器、尺子、秒表。4.3 测试结果及分析4.3.1主要测试结果（1）摆杆摆动一周期平台旋转一周，经五周期后的角度偏差： （单位：度）试验次数第1次第3次第5次平均值角度偏差28201922表1（2）一枚硬币摆动1周期后挪动距离 （单位：毫米）最大角度30度35度40度45度平均距离1244表2（3）8枚硬币摆动5周期后的剩余个数： （单位：个）最大角度45度50度55度60度平均个数8877表3（4）固定角度激光笔照到中心线的时间： （单位

14、:秒）固定角度30度40度50度60度平均时间11121111表4（5）激光笔斑点与中心线的最大距离 （单位：毫米）起始倾角30度40度50度60度平均距离57910表54.3.2测试分析与结论根据上述测试数据可以认为，该系统满足各项要求。由此可以得出以下结论：1、增量式旋转编码器作为角度传感器使用方便准确，且线数越多，精度越高。2、伺服电机的性能远远优于普通电机，在精密控制上应用广泛。3、脉冲控制是现代检测技术的重要方法之一，在实现上需要高精密的仪器，可实现较为精细的算法。5参考文献1刘同法，肖志刚，彭继卫ARM Cortex-M3内核微控制器快速入门与应用M北京：北京航空航天大学出版社，2

15、009.62张茹，孙松林嵌入式系统技术基础M北京：北京邮电大学出版社，2006.13张志君，于海晨，宋彤现代检测与控制技术M北京：化学工业出版社，2007.14金伟，齐世清，王建国现代检测技术M北京：北京邮电大学出版社，2006.1附录1：主要元器件清单序号名称数量备注1STM32F103VE1ARM Contex-M3处理器2增量式旋转编码器H38S6-2000-3-2-241用作角度传感器3伺服电机HC-PQ131用作控制平台转动41602液晶显示屏1提供人机界面编码器H38S6附表1附录2：电路原理图附图1 附图2附录3：完整测试结果（1）摆杆摆动一周期平台旋转一周，经五周期后的角度偏差

16、： （单位：度）试验次数第1次第2次第3次第4次第5次第6次第7次第8次第9次角度偏差282520151920122014附表2（2）一枚硬币摆动1周期后挪动距离 （单位：毫米）最大角度第1次第2次第3次第4次第6次第7次30度01021135度20132340度32524145度355232附表3（3）8枚硬币摆动5周期后的剩余个数： （单位：个）最大角度第1次第2次第3次第4次第6次第7次45度88888850度87886855度76884760度467788附表4（4）固定角度激光笔照到中心线的时间： （单位:秒）固定角度第1次第2次第3次第4次第6次第7次30度131211131210

17、40度11121211121150度12111113141260度111011131211附表5（5）激光笔斑点与中心线的最大距离 （单位：毫米）起始倾角第1次第2次第3次第4次第6次第7次30度45276540度758108950度1271087960度912138910附表6附录4：主要源程序int main(void) RCC_Configuration(); /时钟初始化 GPIO_Configuration(); /IO口初始化 NVIC_Configuration(); /事件初始化 EXTI_Configuration(); /中断初始化 TIM_Configuration();

18、 /时钟初始化 ENC_Init(); /编码器接口初始化 while(1) t4 = TIM_GetCounter(TIM4); /获取编码器脉冲 D = t4*2000.00/90.00; /计算偏转角度 tt = t4; if(t4=0&t4=4000&t4=2) /正向偏转 a1 = t4; TIM1_Cmd(ENABLE); /打开PWM输出 t2 = TIM_GetCounter(TIM2); /PWM计数 if(t2=1) TIM1_Cmd(DISABLE); /关闭PWM输出 TIM_SetCounter(TIM2,0); /PWM计数清零 t2=0; continue; if

19、(a1-t4=2) /反向偏转 a1 = t4; TIM_Cmd(TIM5,ENABLE); t3 = TIM_GetCounter(TIM3); if(t3=1) TIM_Cmd(TIM5,DISABLE); TIM_SetCounter(TIM3,0); t3=0; continue; if(flag=2) /左半圈 flag=0; while(1) temp = 8000-TIM_GetCounter(TIM4); /左半圈计数取反 if(temp-a2=2) a2=temp; TIM_Cmd(TIM5,ENABLE); t3 = TIM_GetCounter(TIM3); if(t3=1) TIM_Cmd(TIM5,DISABLE); TIM_SetCounter(TIM3,0); t3=0; continue; if(a2-temp=2) a2=temp; TIM1_Cmd(ENABLE); t2 = TIM_GetCounter(TIM2); if(t2=1) TIM1_Cmd(DISABLE); TIM_SetCounter(TIM2,0); t2=0; continue;