简易旋转倒立摆及控制装置(题目解析)..

全国电子设计大赛报告 Hessen was revised in January 20212013年全国大学生电子设计竞赛简易旋转倒立摆及控制装置（C题）【本科组】摘要：通过对该测控系统结构和特点的分析，结合现代控制技术设计理念实现了以微控制器MC9S12XS128系列单片机为核心的旋转倒立摆控制系统。

通过采集的角度值与平衡位置进行比较，使用PD算法，从而达到控制电机的目的。

其工作过程为：角位移传感器WDS35D通过对摆杆摆动过程中的信号采集然后经过A/D采样后反馈给主控制器。

控制器根据角度传感器反馈信号进行PID数据处理，从而对电机的转动做出调整，进行可靠的闭环控制，使用按键调节P、D 的值，同时由显示模块显示当前的P、D值。

关键字：倒立摆、直流电机、MC9S12XS128单片机、角位移传感器WDS35D、PD算法目录一、设计任务与要求1 设计任务设计并制作一套简易旋转倒立摆及控制装置。

旋转倒立摆的结构如图1所示。

电动机A固定在支架B上，通过转轴F驱动旋转臂C旋转。

摆杆E通过转轴D固定在旋转臂C的一端，当旋转臂C在电动机A驱动下作往复旋转运动时，带动摆杆E在垂直于旋转臂C的平面作自由旋转。

如下图所示2 设计要求基本要求：①摆杆从处于自然下垂状态开始，驱动电机带动旋转臂作往复旋转使摆杆摆动，并尽快使摆角达到或超过﹣60°~+60°；②从摆杆处于下垂状态开始，尽快增大摆杆的摆动幅度，直至完成圆周运动；③在摆杆处于自然下垂状态下，外力拉起摆杆至接近165°位置，外力撤出同时，启动控制旋转臂使摆杆保持倒立状态时间不少于5s；期间旋转臂的转动不大于90°。

发挥部分：①从摆杆处于自然下垂状态开始，控制旋转臂作往复旋转运动，尽快使摆杆摆起倒立，保持倒立时间不少于10s；②在摆杆保持倒立状态下，施加干扰后摆杆能继续保持倒立或2s内回复倒立状态；③在摆杆保持倒立状态的前提下，旋转臂作圆周运动，并尽快使单方向转过角度达到或超过360°。

2015年全国大学生电子设计竞赛简易旋转倒立摆及控制装置（C题）【本科组】2013年9月6日目录1系统方案 (2)1.1电机及驱动方案的论证与选择 (2)1.2传感器采集模块的论证与选择 (2)1.3 控制系统的论证与选择 (2)2系统理论分析与计算 (3)2.1 XXXX的分析 (3)2.1.1 XXX (3)2.1.2 XXX (3)2.1.3 XXX (3)2.2 XXXX的计算 (3)2.2.1 XXX (3)2.2.2 XXX (3)2.2.3 XXX (3)2.3 XXXX的计算 (3)2.3.1 XXX (3)2.3.2 XXX (3)2.3.3 XXX (3)3电路与程序设计 (3)3.1电路的设计 (3)3.1.1系统总体框图 (3)3.1.2 XXXX子系统框图与电路原理图 (4)3.1.3 XXXX子系统框图与电路原理图 (4)3.1.4电源 (4)3.2程序的设计 (4)3.2.1程序功能描述与设计思路 (4)3.2.2程序流程图 (5)4测试方案与测试结果 (5)4.1测试方案 (5)4.2 测试条件与仪器 (5)4.3 测试结果及分析 (6)4.3.1测试结果(数据) (6)4.3.2测试分析与结论 (6)附录1：电路原理图 (7)附录2：源程序 (8)简易旋转倒立摆及控制装置（C题）【本科组】1系统方案本系统主要由电机及驱动模块、传感器采集模块、控制器模块、电源模块组成，下面分别论证这几个模块的选择。

1.1电机及驱动方案的论证与选择方案一：42BY系列混合式步进电机+LN298驱动方案此方案在最先想到以及调试的方案，用步进电机的有点就是正反转切换迅速，无堵转现象，转矩大，负载能力强。

但是42BY系列混合式步进电机响应一拍最小周期为2ms，此时处于电机为最大转速，执行周期长，也就造成系统控制周期长，但是本系统要求调节周期短（我们最终方案采用的是2ms），能够在极短时间内实现一个调节过程，故此方案不能达到预期的效果。

简易旋转倒立摆设计论文摘要：该系统有一个非常重要的性质——它是非线性不稳定的。

不稳定系统的控制问题是目前大多数控制系统需要克服的难点，有必要在实验室中研究，但是由于绝大多数的不稳定控制系统都存在着危险性，因此成了实验室研究的主要障碍。

而倒立摆系统却能很好地解决这一矛盾，它简单、安全并且具备了一个非稳定系统所具有的重要的动态特性，因此，本系统对控制系统的设计而言可以说是一个比较理想的研究模型。

倒立摆控制系统是一个复杂的、不稳定的非线性系统，是进行控制理论研究和实验的理想平台。

目前，亚洲、日本、韩国、俄罗斯、美国等多个国家都在进行这个领域的研究。

对于倒立摆控制的研究有着非常重大的现实意义，机器人的站立与行走类似双倒立摆系统，而机器人的行走控制至今仍未很好地解决。

对倒立摆系统的研究能有效地反应控制中的许多问题：如非线性问题、鲁棒性问题[1]、镇定问题及跟踪问题等。

通过对倒立摆的控制，可用来检测新的控制方法是否有较强的处理非线性和不稳定性问题的能力。

同时，其控制方法在军工、航天和一般工业过程领域中都有着广泛的用途，如火箭发射中的垂直度控制和卫星飞行过程中十分重要的姿态控制等。

倒立摆的种类很多，有悬挂式倒立摆、平行倒立摆、环形倒立摆、平面倒立摆等；根据级数也可以将其分为一级、二级、三级乃至多级。

本文主要就旋转平面的一级倒立摆系统进行研究，采用MC9S12XS128微控制器通过速度闭环和DIP算法控制使该倒立摆系统完成包括往复摆动直至完成圆周运动、保持倒立、倒立状态下的圆周运动以及抗干扰测试等一系列动作，主题思想是对摆杆的姿态进行实时的、精确的调整。

1 系统方案设计1.1 系统设计总方案本倒立摆系统主要由三大部分组成：电机驱动电路、倒立摆装置和微控制器。

倒立摆的工作原理为：通过数字电位计得到反馈电压，经转化得到摆杆的实际角度，微分后得到其速度，连杆的位置和速度可以通过电机编码器（200p/r）转换得到，MCU（微控制器）根据上述四个输入使用增量式PID算法，预调节PWM波脉宽以及驱动端口信号，来分别调节电机转速和转向，实现倒立摆的稳定控制。

简易旋转倒立摆及控制装置设计报告及总结摘要倒立摆系统机理的研究不仅具有重要的理论价值，而且具有重要的现实意义，是控制类中经久不衰的经典题型。

本题中，简易旋转倒立摆，在C8051F040单片机的基础上，使用ZGB42FM直流减速电机，BTN7971B电机驱动，可变电阻（角度传感器），机械摆杆等模块。

通过编写、烧入程序，调控硬件协调工作，使摆杆首先实现一定角度的转动，再完成圆周运动，以及保持竖直向上的倒立状态。

用以满足题目的基本要求,进而深一步探究倒立摆在保持运动姿态方面的发展与应用。

关键字：单片机，倒立摆，摆杆，可变电阻。

引言：本题整体上只由一个电机A 提供动力，电机直接控制旋转臂C 做往复旋转运动，而通过转轴D 连接在旋臂C 上的摆杆E 是非常灵活的。

旋臂C 转动一定角度时，摆杆E 由于向心力会使摆杆E 继续向上旋转，以达到E 杆转动一个角度的效果。

相似，当C 的转动速度比较快，停下后，E 下端处的速度和向心力都比较大，能够使E 杆完成圆周运动。

为了使摆杆能够倒立，就要求摆杆转动到上半圆周面时，要通过单片机控制电机A 不断的调整使旋转臂C 转动多个角度，尽量的使摆杆E 与竖直面的角度变小，并能够受力平衡，这样就可以保持一段时间的倒立状态。

为达到角度的调整，就要测量出E 杆与竖直面间的角度差，经过单片机的控制，使电机A 做出相应的旋转动作，减小这个角度差。

1、方案设计与讨论： 1.1结构框图1.2方案论证： 1.21控制器模块本题，单片机只要接收来自传感器的信号，向电机驱动输入信号处理后计算出的高低电平即可。

方案一：用ATMEL 公司生产的AT89S52单片机，低功耗，高性能CMOS 8位处理器，使用广泛,算法较为简单，但是在执行复杂动作时，处理速度不够高。

方案二:用宏晶公司生产的STC89C52RC 单片机，STC 的单片机性能与ATMEL 的单片机相似，但是价格相对便宜。

缺点是易受潮湿影响，在调用子程序是频繁出错。

2013年全国大学生电子设计竞赛简易旋转倒立摆及控制装置（C题）【1101003组】2013年9月7日简易旋转倒立摆及控制装置（C题）摘要本系统采用自制的简易旋转倒立摆及控制装置，以16 位单片机(STC89C51)作为旋转倒立摆的检测和控制核心，以额定电压12V的步进电机驱动，通过加速度传感器（ADXL345）转变的角度传感器测定摆杆角度变化来定位摆杆的位置。

系统采用角度传感器（ADXL345）探测在摆杆保持倒立状态的前提下，旋转臂作圆周运动前进；同时通过编码器及PID控制算法实现了步进电机的转速和转向进行调节，以准确找到平衡点位置。

控制器的设计是倒立摆系统的核心内容，主要用到典型的控制器设计理论有PID控制、根轨迹以及频率响应法、状态空间法、最优控制理论等。

本系统可在较短时间内完成摆杆从自然下垂状态，驱动电机带动旋转臂作往复旋转使摆杆摆动，寻找平衡点等任务。

关键词:角度传感器；旋转倒立摆；模糊控制；最优控制理论；目录1系统方案......................................................................................... 错误！未定义书签。

1.1电机方案的论证与选择 (1)1.2 控制系统方案的论证与选择 (2)1.3 角度测量方案的论证与选择 (2)2系统理论分析与计算 (2)2.1 角度检测模块的分析 (2)2.2 控制方法的理论 (3)2.3 设计思想理论分析 (4)2.4 理论计算 (4)3电路与程序设计 (6)3.1电路的设计 (6)3.1.1系统总体框图 (6)3.1.2 电机驱动模块设计 (7)3.1.3 角度传感器模块 (7)3.1.4电源模块 (7)3.2程序的设计 (7)3.2.1程序功能描述与设计思路 (7)3.2.2程序流程图 (8)4测试方案与测试结果 (8)4.1硬件测试 (8)4.2 测试条件与仪器 (9)4.3 测试结果 (9)4.3.1不同脉冲时间间隔对应速度测试 (9)4.3.2摆杆达到指定高度往复运动的时间测试 (10)4.3.3摆杆达到指定度数的测试 (10)4.3.4摆杆选择和配重平衡测试 (10)4.3.5摆杆完成圆周运动测试 (11)4.3.6基本功能（3）测试 (11)4.3.7测试分析与结论 (12)5结束语 (12)6参考文献 (12)附录1：电路原理图 (13)附录2：电机驱动原理图 (14)附录3：稳压模块原理图 (15)附录4：主程序 (16)附录5：角度传感器子程序 (18)简易旋转倒立摆及控制装置（C 题）【本科组】1系统方案本系统主要由系统模块、角度检测模块、电机驱动模块、电源模块组成。

2013年全国大学生电子设计竞赛设计报告题目名称：简易旋转倒立摆及控制装置【本科组C题】参赛队号：201302092013年9月7日2013年“瑞萨杯”全国大学生电子设计竞赛摘要：本系统以STC12C5A60S2单片机最小系统为核心，辅以角度传感器、姿态传感器、开关控制电路、LCD1602显示、电机驱动电路等组成。

该设计利用PWM 调制来控制旋转臂转速的变化，通过角度传感器和姿态传感器检测摆杆角度偏转信号，并将检测到的数值A/D转换后送入调速系统，经LCD1602显示屏进行显示。

也可通过拨码开关控制旋转臂的转速，从而改变摆杆的状态。

该系统实现了通过操作拨码开关控制旋转臂转速的大小，使摆杆状态按要求变化。

关键词：单片机最小系统角位移传感器 A/D转换2013年“瑞萨杯”全国大学生电子设计竞赛目录1.作品简介 (1)2.系统方案论证和比较 (1)2.1系统方案整体实验框图 (1)2.2方案论证与比较 (1)2.1.1输入模块选择 (1)2.1.2调制方式的选择 (2)2.1.3角度传感器的选择 (2)2.1.4显示系统的选择 (2)2.3理论分析与参数计算 (2)2.3.1控制电路 (2)2.3.2角度测量原理与控制算法 (3)3.电路与程序设计 (3)3.1硬件设计 (3)3.1.1角度传感器的设计 (3)3.2软件设计 (3)3.1.1软件主程序流程图 (3)3.1.2程序算法理论分析 (4)4.系统调试与结果分析 (5)4.1系统调试的方法与仪器 (5)4.2系统电路的调试 (5)4.2.1电机的性能测试 (5)4.2.2角度传感器的性能测试 (5)4.3注意事项及解决方案 (6)4.4调试结果分析与总结 (6)5．实验结果的分析与总结 (6)6．参考文献 (6)附录一：部分电路原理图 (1)附录二：程序源代码 (4)1.作品简介本次设计作品以单片机最小系统和角度传感器、姿态传感器为制作核心，同时运用A/D模数转换，PWM调制旋转臂转速、LED声光显示，拨码开关控制等,从摆杆方向上的角位移传感器接收到摆杆角度偏转的信号，经A/D模数转换后，LED显示器进行声光显示。

倒立摆系统的控制算法及仿真1．1 倒立摆控制算法1．1．1 倒立摆控制算法概述单级倒立摆的稳定控制，实际上是一单输入多输出系统的稳定控制。

此时系统输入是电机控制电压u，输出是倒立摆竖直方向角度θ和旋臂位置ϕ。

对方程(2.5)进行变形即得θ与u 之间的输入输出方程,很明显,它是一个不稳定的二阶系统。

控制倒立摆使之稳定的方法很多,当前已有的倒立摆控制规律可总结为:(1)PID控制,通过对倒立摆物理模型的分析，建立倒立摆的动力学模型,然后使用状态空间理论推导出其非线性模型，再在平衡点处进行线性化得到倒立摆系统的状态方程和输出方程，于是就可设计出PID控制器实现其控制；(2)状态反馈H∞控制，通过对倒立摆物理模型的分析,建立倒立摆的动力学模型,然后使用状态空间理论推导出状态方程和输出方程，于是就可应用H∞状态反馈和Kalman 滤波相结合的方法,实现对倒立摆的控制；(3)利用云模型实现对倒立摆的控制，用云模型构成语言值,用语言值构成规则,形成一种定性的推理机制。

这种拟人控制不要求给出被控对象精确的数学模型，仅仅依据人的经验、感受和逻辑判断，将人用自然语言表达的控制经验,通过语言原子和云模型转换到语言控制规则器中，就能解决非线性问题和不确定性问题；(4)神经网络控制，业已证明神经网络(NeuralNetwork ,NN) 能够任意充分地逼近复杂的非线性关系，NN 能够学习与适应严重不确定性系统的动态特性，所有定量或定性的信息都等势分布贮存于网络内的各种神经元，故有很强的鲁棒性和容错性，也可将Q学习算法和BP神经网络有效结合，实现状态未离散化的倒立摆的无模型学习控制；(5)遗传算法( Genetic Algorithms , GA)，高晓智在Michine 的倒立摆控制Boxes 方案的基础上，利用GA 对每个BOX 中的控制作用进行了寻优，结果表明GA可以有效地解决倒立摆的平衡问题；(6)自适应控制，主要是为倒立摆设计出自适应控制器；(7)模糊控制，主要是确定模糊规则，设计出模糊控制器实现对倒立摆的控制；(8)使用几种智能控制算法相结合实现倒立摆的控制，比如模糊自适应控制，分散鲁棒自适应控制等等，(9)采用GA 与NN 相结合的算法，首先建立倒立摆系统的数学模型，然后为其设计出神经网络控制器，再利用改进的贵传算法训练神经网络的权值，从而实现对倒立摆的控制，采用GA 学习的NN 控制器兼有NN 的广泛映射能力和GA 快速收敛以及增强式学习等性能。

控制专题训练阶段性报告旋转倒立摆设计学生姓名：2017年5月24日摘要本系统以由stm32f103单片机作为中心控制系统，由精密电位器、电机驱动模块、电源电路组成。

角度监测模块采用采用双向编码器，实时测量摆杆与垂直方向的夹角；电机驱动部分使用TB6612驱动芯片驱动直流电机较精确地控制摆杆的灵敏度；具有操作简单，控制界面直观、简洁，系统性能指标达到了设计要求，工作可靠，功耗低，具有良好的人机交互性能。

关键字：STM32f103RC 精密电位器TB6612目录一、系统方案 (1)1、摆架框架的论证与选择 (1)2、驱动电机的选择 (1)2、角度传感器的选择 1二、系统理论分析与计算 (1)1、电机型号选择 (1)2、摆杆状态监测 (1)3、算法控制 (1)（1）比例控制规律 (1)（2）比例积分控制规律 (1)（3）比例微分控制规律 (1)（4）比例积分微分控制规律 (1)三、电路与程序设计 (2)1、电路的设计 (2)（1）系统总体框图 (2)（2）PID算法子系统框图 (2)（3）主控制器模块设计 (2)（4）电源 (3)2、程序的设计 (3)（1）程序功能描述与设计思路 (3)（2）程序流程图 (3)四、测试方案与测试结果 (3)1、测试方案与论证 (3)2、测试条件与仪器 (4)3、测试结果及分析 (4)（1）测试结果(数据) (4)（2）测试分析与结论 (4)五、参考文献 (4)附录1：电路原理图 (5)附录2：源程序 (6)一、系统方案本题目要求设计一个简易旋转倒立摆及其控制装置，它由三部分构成，系统构成如图1-1：①摆架系统：支架，摆杆，底座，平板，旋转臂，旋转臂连接摆杆顶部固定在电机上；②驱动控制系统：单片机，直流电机，电机驱动器，电源，用以控制电机带动旋转臂转动；③检测系统：通过精密电位器检测出摆杆与垂直方向的倾角，将数据传给单片机。

1、摆架框架的选择方案一：采用木板做摆杆，材料方便，制作简单，质量较小，尽管在做旋转运动时，空气阻力对其有影响，木质材料的摆杆较轻，可以适当的加点配重，增加其惯性，更加方便电机对其旋摆随时的控制。