简易旋转倒立摆及控制(C题).doc

2013年全国大学生电子设计竞赛 （题） 【组】 20年9月日  简易旋转倒立摆及控制（题） 本系统以Kinetis系列K60单片机为控制核心，由步进电机模块、电机驱动电路模块、编码器模块以及OLED显示屏模块组成。采用欧姆龙200线双相编码器测量脉冲，用以计算倒立摆摆动时的动态角度，反馈到主控芯片K60弹性定时器（FTM），进行PWM信号的产生,用于精确控制步进电机动作。通过OLED显示屏实时显示倒立摆角度的变化。该系统是一个闭环的控制系统，数据处理中用到了经典PID控制算法。 关键字：K60、编码器、步进电机、倒立摆 Abstract This system by freescale Kinetis series K60 single-chip microcomputer as the core to control the pace of step motor to realize the motion of the rocker. By stepper motor module, motor drive circuit module, encoder module, the infrared device and OLED display circuit module of the peripheral circuit. The omron 200 line bipolar pulse encoder，measurement, to calculate the inverted pendulum swing when the dynamic Angle, feedback to the K60 elastic timer (FTM), PWM signal generation to achieve precise control stepping motor movements. Through the OLED display real-time display of the inverted pendulum Angle change. The system is a closed-loop control system, the data processing to the classic PID control algorithm is used. Keywords: K60, encoder, stepping motor, inverted pendulum 一、系统方案选择与论证 1.1、控制器选择 方案1：采用51系列单片机，该类单片机的抗干扰能力较强，上手容易，应用比较广泛，但其I\O口比较有限，而系统的实现程序量较大，所需的I\O口资源较多，51单片机在这一点上难以胜任。 方案2:使用基于ARM Cortex-M4内核的kinetis系列K60单片机，它有多通道高精度模数ADC转换器，1*8电机控制/通用PWM定时器，使用方便且低功耗。 方案论证：由于 51单片机I/O口比较少功能模块资源比较单一，且运行速率较低，对本系统来说，用51很难控制本系统的正常运行，故本系统采用飞思卡尔公司出的K60系列芯片做为主控芯片；K60单片机有丰富的I/O口数量和FTM定时器等多种外设资源，这样剩去了一些外围器件，并且可以利用官方给出的构件，这样程序上减少了很多麻烦，利于操作。 1.2、电机的选择 方案1：直流无刷电机，以PWM控制电机步调，改变驱动正负极即可改变电机的转动方向，来进行控制摆杆摆动幅度的大小。 方案2：步进电机，采用直接控制方式，将电脉冲信号转变为角位移或线位移的开环控制元步进电机件，可以通过控制脉冲个数来控制角位移量，从而达到准确定位的目的；同时可以通过控制脉冲频率来控制电机转动的速度和加速度，从而达到对倒立摆目标调整。 方案3：使用舵机控制，该方案控制简单灵活，每一个脉冲便有一个方向角，舵机转动的角度和脉宽成比例，通过改变脉冲的宽度便可以灵活的控制舵机的转角，可操作性较好，且功耗较小。 方案论证：直流无刷电机控制精度高些，调节灵活，但无刷电机需要特定的驱动器而且不易控制，另外多级比较小巧，控制简单，但本系统体积较大，考虑到舵机带负载的能力较小，故舍去舵机方案，而步进电机扭矩大，可以精确控制相位和速度，反应灵活迅速，故本系统采用步进电机控制方案。 1.3、角度测量 方案1：采用陀螺仪测量摆杆转动的角速度，动态响应快，测量灵敏。但陀螺仪测量的值会随时间，经过几分钟甚至几秒钟定会累积出误差将位移转换成周期性的电信号，再把这个电信号转变成计数脉冲，用脉冲的个数表示的大小测量的值会随时间，L298芯片发热量大，若不注意散热及电路保护极容易烧毁，故不太稳定，为了达到精确的控制，且在电机运