2013年全国大学生电子设计竞赛 C题.doc

2013年全国大学生电子设计竞赛 简易旋转倒立摆及控制装置（C 题） 【本科组】 2013年9月4Abstract: This paper describes a control based on TIs MSP430 microcontroller simple rotary inverted control system. The system uses the West An Jiusheng 57HS56 08 type two-phase four-wire stepper motor as the power source of the system. In WDS35D4 precision conductive plastic angular displacement sensor as the only sensor to realize the system E pendulum motion detection, and so the sensor feedback value as the amount of feedback through software algorithm to determine E pendulum motion by changing the stepper motor the steering and speed to control the state of motion of the pendulum E. Test results had showed that: the system can realize the E pendulum motion detection and control. And the system also has a simple structure, enabling strong, control and stability advantages. Keywords:Rotating balance handstand tepper motor angular displacement 一：系统方案 系统结构： 本系统主要由以下几部分构成，包括：MSP430单片机、液晶显示模块、矩阵键盘模块、角位移传感器、步进电机驱动模块以及步进电机。 其中，MSP430单片机作为主控制器实现对液晶显示模块、矩阵键盘模块的控制；其内部集成的12位ADC实现对角位移传感器的电压采样及转换；同时通过控制步进电机驱动模块实现对步进电机运动方向和运动步数的控制。 为实现主控制器对步进电机驱动模块的控制，需要通过电平匹配模块进行控制信号的电平转换和匹配；电平匹配模块由光耦实现。 本作品简易旋转倒立摆及控制装置的系统结构框图如下： 图1.1简易旋转倒立摆及控制装置系统结构框图 1.2 方案比较与选择： 方案一：由TI 公司的MSP430作为MCU，MSP430获取安装在E摆杆上的MPU6050陀螺仪传感器数据。MSP430经运算分析将控制信号输出至步进电机驱动器。驱动器控制步进电机的转速、步数、和旋转方向来控制C旋转臂以达到控制E摆杆运动状态的目的。 方案二：由TI 公司的MSP430作为MCU，MSP430获取作为D转轴的精密导电塑料角位移传感器的电压值来进行判断系统状态。MSP430经运算分析将控制信号输出至步进电机驱动器。驱动器控制步进电机的转速、步数、和旋转方向来控制C旋转臂以达到控制E摆杆运动状态的目的。 由于E摆杆需要做圆周运动，并且需要其状态稳定性高，如果采用方案一会对系统布线带来很大的困难，并且在E摆杆上安装传感器会使其质地不均匀，增大控制难度。方案二采用精密导电塑料角位移传感器将D轴和传感器合二为一。精度高，存在=3°测量死角，电路简单，布线方便。精密导电塑料角位移传感器测量死角问题可以通过机械结构将测量死角调节至不需要测量的位置，不需要陀螺仪极高的精确度，机械结构布线较为容易。 综合以上两种方案,选择方案二。 二：理论分析与计算 2.1电机选型： 方案一：采用直流减速电机。 直流减速具有推力大、传动刚度高、动态响应快、行程长度不受限制等特点。 方案二：采用伺服电机。 伺服电机是靠脉冲来定位的，电机接收到1个脉冲，会旋转1个脉冲对应的角度，同时电机本身发出一个脉冲与接收的脉冲相呼应，单片机则根据发出与接收到的脉冲对电机实现精确的转动。 方案三：采用步进电机。 步进电机是纯粹的数字控制电动机，它将电脉冲信号直接转换成角位移，在非超载的情况下，电机的转速、停止的位置只取决于脉冲信号的频率和脉冲数。其转角精确(采用128细分驱动可以实现0.014度的步进角控制)，扭矩大，角度控制易实现。 考虑题目的要求，由于需要对角度进行精确控制，并