电设二报告模板-简易倒立摆设计报告(C题).docVIP

简易旋转倒立摆及控制装置（c题） （本科组） 摘 要 简易旋转倒立摆是由一台电动机作为唯一动力源，带动转臂旋转并达到对摆杆转动角度、倒立平衡、抗干扰等状态的控制。该装置机械部分由支架、步进电机、旋转臂、转轴和摆杆组成，控制部分由C8051F020单片机开发板、步进电机驱动模块和角度传感器组成；机械部分由42HD0403步进电机提供动力，在其他部件的共同作用下通过机械联动带动摆杆做出满足相应要求的动作，控制模块在C8051F020的主控下采用PID闭环控制，通过对摆动杆当前转动角度的检测和判断，控制并实时调整步进电机转向和转速来实现摆杆的起摆，倒立平衡以及应对干扰修正摆杆的位置。经测试，本装置能较好的完成对摆杆运动状态的控制。 关键词：摆杆 步进电机 角度传感器 PID闭环控制 1 系统方案 1.1方案比较与选择 1.1.1 控制器模块 方案一：采用瑞萨R5F100LEA作为系统的主控模块，瑞萨芯片的最短指令执行时间可在高速至超低速之间更改，内置8/10位分辨率A/D转换器，但实时性不好，难以实现本装置中控制所需完成的实时性复杂算法；另外，增加的外围电路数据转换速度慢。 方案二：采用Silicon Labs 公司的C8051F020单片机作为系统控制器。C8051F020系列单片机功耗低，具有处理能力强、速度高、编程灵活的优点。此外，它的开发环境方便高效，软件编程可以实现各种算法和逻辑控制，同时具有高性能的模拟技术和丰富的片上外围模块。且其系统工作稳定，具有很高的性价比。 为了满足题目中各项要求，在电动机需带动摆杆高速转动的情况下完成对转动状态的实时监测并处理控制，则整个传感器信息采集处理和控制都需要在高速数据处理和系统高度稳定的前提下完成因此我们选定方案二。 1.1.2电机的论证与选择 方案一：采用直流电机，利用直流电能直接驱动电机转动，控制电机的正转和反转达到控制目的，驱动模块简单，转速快。但是对于精确的速度和弧度控制难以实现，扭矩也较小。 方案二：采用步进电机，利用专用的驱动模块能够精确的实现角度以及速度控制，扭矩大，可以负载机械结构并提供足够的加速度,具有较大的静扭矩，无积累误差，在静态电流状态下能有效的锁定转动杆的位置，有利于精确控制转动杆旋转的位置。 综合两种电机的优缺点，最后选用步距角为1.8度的二相42电机和安川4015数控驱动。4.2HD0403电机能够提供足够大的力矩和足够精确的角度控制。 1.1.3 电机驱动的论证与选择 方案一：采用LM298驱动模块，LM298是一种二相和四相电机的专用驱动器，内部包含四通道的逻辑驱动电路，但是用在二相步进电机上时，程序控制要在控制速度方向的同时给四个逻辑输入端产生脉冲信号，增大控制的负担。 方案二：采用安川4015数控板，适配二相步进电机，可根据输入的脉冲及方向信号自动驱动电机转动，控制简单，并且可以实现精确至1/64步距的精确控制。电流可控，可通过拨码实现精确的电流和步距控制。 1.1.4 角度传感器的论证与选择 方案一：采用基于ADXL335芯片的GY-61三轴陀螺仪。GY-61固定安装在摆杆上，通过x-y轴的加速度变化来判断摆杆的转动角度。360度各个方向可测，质量很小，但需导线连接到控制系统，而且数字传感器易受杂波影响。 方案二：采用WDD35D4角度传感器。固定在转动杆一端，作为摆动杆的转轴，通过滑动电阻与总电阻之比计算偏移角度。优点是得到的是连续的数值，不易受干扰，而且摆杆上无电路，但是角度传感器存在断点，可测角度为0°-340°。 综合两种传感器的差别，最后决定采用WDD35D4，三轴陀螺仪需固定在摆杆上，陀螺仪引出的线路至单片机难以实现，且导线极易干扰摆杆的运动，对角度的实时测试结果造成巨大影响。 1.2 方案描述 根据题目要求，此装置主要分为控制模块、信号检测模块、受控模块。控制部分主要有控制器模块；信号检测模块主要是角度传感器的角度检测；受控模块的核心是带动旋转杆的步进电机；对于各关键模块的实现，我们经过反复地对比、论证，最终组合每一模块相对更合适的方案成为如下整体结构。 图1 系统整体结构框图 2 理论分析 长度一定的匀质轻杆作为摆杆和步进电机控制的旋转臂可以抽象为一个单摆系统，旋转臂为主动摆，摆杆为从动摆。摆杆具有固定的摆动频率，主动摆由电机控制绕圆周往复摆动，旋转臂在带动摆杆旋转的的时候，主动摆的震动频率与从动摆震动频率基本相同，从动摆的悬点受周期性变化的策动力的作用，从而产生摆动。 3电路与程序设计 3.1驱动电路设计 3.1.1 电机驱动设计 本系统要驱动一个步进电机，因此采用一片CA_4015作为电机的驱动。CA_4015的CP引脚接到单片机的P0.2，接入