基于卡尔曼滤波和双闭环PID控制的平衡车控制系统设计

基于MATLAB的汽车运动控制系统设计仿真

课程设计 题目汽车运动控制系统仿真设计学院计算机科学与信息工程学院班级2010级自动化班 姜木北：2010133*** 小组成员 指导教师吴

2013 年12 月13 日 汽车运动控制系统仿真设计 10级自动化2班姜鹏 2010133234 目录 摘要 (3) 一、课设目的 (4) 二、控制对象分析 (4) 2.1、控制设计对象结构示意图 (4) 2.2、机构特征 (4) 三、课设设计要求 (4) 四、控制器设计过程和控制方案 (5) 4.1、系统建模 (5) 4.2、系统的开环阶跃响应 (5) 4.3、PID控制器的设计 (6) 4.3.1比例（P）控制器的设计 (7) 4.3.2比例积分（PI）控制器设计 (9) 4.3.3比例积分微分(PID)控制器设计 (10) 五、Simulink控制系统仿真设计及其PID参数整定 (11) 5.1利用Simulink对于传递函数的系统仿真 (11) 5.1.1 输入为600N时，KP=600、KI=100、KD=100 (12) 5.1.2输入为600N时，KP=700、KI=100、KD=100 (12) 5.2 PID参数整定的设计过程 (13) 5.2.1未加校正装置的系统阶跃响应： (13) 5.2.2 PID校正装置设计 (14) 六、收获和体会 (14) 参考文献 (15)

摘要 本课题以汽车运动控制系统的设计为应用背景，利用MATLAB语言对其进行设计与仿真.首先对汽车的运动原理进行分析，建立控制系统模型，确定期望的静态指标稳态误差和动态指标搬调量和上升时间，最终应用MATLAB环境下的.m 文件来实现汽车运动控制系统的设计。其中.m文件用step函数语句来绘制阶跃响应曲线，根据曲线中指标的变化进行P、PI、PID校正；同时对其控制系统建立Simulink进行仿真且进行PID参数整定。仿真结果表明，参数PID控制能使系统达到满意的控制效果，对进一步应用研究具有参考价值，是汽车运动控制系统设计的优秀手段之一。 关键词：运动控制系统 PID仿真稳态误差最大超调量

线控两轮平衡车的建模与控制研究

线控两轮平衡车的建模 与控制研究 文稿归稿存档编号：[KKUY-KKIO69-OTM243-OLUI129-G00I-FDQS58-

线性系统理论 上机实验报告 题目：两轮平衡小车的建模与控制研究 完成时间：2016-11-29 1.研究背景及意义 现代社会人们活动范围已经大大延伸，交通对于每个人都十分重要。交通工具的选择则是重中之重，是全社会关注的焦点。 随着社会经济的发展，人民生活水平的提高，越来越多的小汽车走进了寻常百姓家。汽车快捷方便、省时省力，现代化程度高，种类繁多的个性化设计满足了不同人的需求。但它体积大、重量大、污染大、噪声大、耗油大、技术复杂、使用不便、价格贵、停放困难，效率不高，而且还会造成交通拥堵并带来安全隐患。相比之下，自行车是一种既经济又实用的交通工具。中国是自行车大国，短距离出行人们常选择骑自行车。自行车确实方便，但在使用之前需要先学会骑车，虽然看似简单，平衡能力差的人学起来却很困难，容易摔倒，造成人身伤害。另外，自行车毕竟不适宜长距离的行驶，遥远的路程会使人感到疲劳。 那么，究竟有没有这样一种交通工具，集两者的优点于一身呢？既能像汽车一样方便快捷又如自行车般经济简洁，而且操作易于掌握，易学又易用。两轮自平衡车概念就是在这样的背景下提出来的。 借鉴目前国内外两轮自平衡车的成功经验，本文提出的研究目标是设计一款新型的、结构简单、成本低的两轮自平衡车，使其能够很好地实现自平衡功能，同时设计结果通过MATLAB进行仿真验证。

2.研究内容 自平衡式两轮电动车是一个非线性、强耦合、欠驱动的自不稳定系统，对其控制策略的研究具有重大的理论意义。我们通过分析两轮平衡车的物理结构以及在平衡瞬间的力学关系，得到两轮车的力学平衡方程，并建立其数学模型。运用MATLAB 和SIMULINK 仿真系统的角度θ、角加速度? θ、位移x 和速度的? x 变化过程，对其利用外部控制器来控制其平衡。 3.系统建模 两轮平衡车的瞬时力平衡分析如图1所示。下面将分析归纳此时的力平衡方程[1-3]，并逐步建立其数学模型。 对两轮平衡车的右轮进行力学分析，如图2所示。 依据图2对右轮进行受力分析，并建立其平衡方程： =R R R R M X f H ? - (1) R R R R J C f R ??? =- (2) 同理，对左轮进行受力分析，并建立其平衡方程： =R L L L M X f H ? - (3) L L L L J C f R ??? =- (4) 两轮平衡车摆杆的受力分析如图3所示，由图3可以得到水平和垂直方向的平衡方程以及转矩方程。 水平方向的平衡方程： H H x R L p m +=? ? (5) 其中θsin L x x m p +=，则有：

基于单片机的两轮自平衡车控制系统设计

基于单片机的两轮自平衡车控制系统设计 摘要 两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本质不稳定是两轮小车的特性，必须施加有效的控制手段才能使其稳定。本文提出了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器MPU-6050检测小车姿态，使用互补滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用STC 公司的8位单片机STC12C5A60S2为主控制器，根据从传感器中获取的数据，经过PID算法处理后，输出控制信号至电机驱动芯片TB6612FNG，以控制小车的两个电机，来使小车保持平衡状态。 整个系统制作完成后，小车可以在无人干预的条件下实现自主平衡，并且在引入适量干扰的情况下小车能够自主调整并迅速恢复至稳定状态。通过蓝牙，还可以控制小车前进，后退，左右转。 关键词：两轮自平衡小车加速度计陀螺仪数据融合滤波 PID算法 Design of Control System of Two-Wheel Self-Balance Vehicle based on Microcontroller Abstract Two-wheel self-balance vehicle is a kind of highly unstable two-wheel robot. The characteristic of two-wheel vehicle is the nature of the instability as traditional inverted pendulum, and effective control must be exerted if we need to make it stable. This paper presents a design scheme of two-wheel self-balance vehicle. We need using gravity accelerometer

pid控制器设计

目录一设计任务与要求 二系统校正的基本方法与实现步骤 三PID的控制原理与形式模型 四设计的原理 五设计方法步骤及设计校正构图 六设计总结 七致谢 八参考文献

一 设计任务与要求 校正对象： 已知单位负反馈系统，开环传递函数为：s s s s G 1047035.87523500 )(23++=，设 计校正装置，使系统满足： （1）相位稳定裕量o 45≥γ （2）最大超调量%5≤σ 二 系统校正的基本方法与实现步骤 系统校正就是在自动控制系统的合适位置加入适当的装置，以改善和提高系统性能。按照校正装置在自动控制系统中的位置，可分为串联校正，反馈校正和顺馈补偿。 顺馈补偿方式不能独立使用，通常与其他方式同时使用而构成复合控制。顺馈补偿装置满足一定条件时，可以实现全补偿，但前提是系统模型是准确的，如果所建立的系统模型有较大误差，顺馈补偿的效果一般不佳。 反馈校正主要是针对系统中的敏感设备——其参数可能随外部环境条件发生变化，从而影响自动控制系统的性能——给敏感设备增加局部负反馈支路以提高系统的抗扰能力。由于负反馈本身的特性，反馈校正装置通常比较简单，只有比例（硬反馈）和微分（软反馈）两种类型。 串联校正是最基本也是最常用的校正方式，根据校正装置是否使用独立电源，可分为有源校正装置和无源校正装置；根据校正装置对系统频率特性的影响，可分为相位滞后、相位超前和相位滞后－超前校正装置；根据校正装置的运算功能，可分为比例（P ）校正、比例微分（PD ）校正、比例积分（PI ）校正和比例积分微分（PID ）校正装置。

三 PID 控制的原理与形式模型 具有比例-积分-微分控制规律的控制器，称PID 控制器。这种组合具有三种基本规律各自的特点，其运动方程为： dt t de dt t e t e t m K K K K K d p t i p p )()()()(0++=? 相应的传递函数为： ??? ? ? ? + +=S S s K K K G d i p c 1)( S S S K K K d i p 12++ ?= PID 控制的结构图为： 若14

汽车智能照明控制系统设计

毕业设计（论文） 汽车智能照明控制系统 学生姓名： 学号： 所在系部： 专业班级： 指导教师： 日期：二〇一七年五月

学位论文原创性声明 本人郑重声明：所呈交的学位论文是本人在导师的指导下独立进行研究所取得的研究成果。除了文中特别加以标注引用的内容外，本论文不包含任何其他个人或集体已经发表或撰写的成果作品。本人完全意识到本声明的法律后果由本人承担。 作者签名：年月日 学位论文版权使用授权书 本学位论文作者完全了解学院有关保管、使用学位论文的规定，同意学院保留并向有关学位论文管理部门或机构送交论文的复印件和电子版，允许论文被查阅和借阅。 本人授权省级优秀学士学位论文评选机构将本学位论文的全部或部分内容编入有关数据库进行检索，可以采用影印、缩印或扫描等复制手段保存和汇编本学位论文。 本学位论文属于 1、保密□，在年解密后适用本授权书。 2、不保密□。 （请在以上相应方框内打“√”） 作者签名：年月日 导师签名：年月日

摘要 在当今社会，人们生活得到了极大的提高，汽车拥有量也在不断增加。汽车作为快捷方便的交通工具，给我们的生活带来了诸多方便，同时也带来不少的交通安全问题。汽车照明系统作为现代汽车的必备安全系统之一，在安全性方面有很多值得改进的地方。大部分的汽车的照明系统目前还是以传统手动操作为主，因此，实现汽车照明的智能控制是非常有必要的。 本文首先对汽车智能照明控制系统的研究背景和国内外概况作了简要介绍，给出了设计任务要求和总体设计方案，并根据实际情况做了硬件设计。硬件设计部分包括主控部分、电源设计部分、数据采集部分和模拟车灯控制部分。本设计是通过STM32单片机对传感器采集到的数据进行分析后对模拟车灯进行控制，控制的具体步骤通过软件编程实现。本文还对实物模型的制作流程作了简单介绍，并给出了实物图。最后对现阶段的研究进行总结并得出了结论，最终结论表明该系统在实际应用中是可行的。 关键词：汽车车灯;STM32F103C8T6;传感器

双轮自平衡小车机器人系统设计与制作

燕山大学 课程设计说明书题目：双轮自平衡小车机器人系统设计与制作 学院（系）：机械工程学院 年级专业：12级机械电子工程 组号：3 学生： 指导教师：史艳国建涛艳文史小华庆玲 唐艳华富娟晓飞正操胡浩波 日期： 2015.11

燕山大学课程设计（论文）任务书院（系）：机械工程学院基层教学单位：机械电子工程系

摘要 两轮自平衡小车是一种非线性、多变量、强耦合、参数不确定的复杂系统，他体积小、结构简单、运动灵活，适合在狭小空间工作，是检验各种控制方法的一个理想装置，受到广大研究人员的重视，成为具有挑战性的课题之一。 两轮自平衡小车系统是一种两轮左右并行布置的系统。像传统的倒立一样，其工作原理是依靠倾角传感器所检测的位姿和状态变化率结合控制算法来维持自身平衡。本设计通过对倒立摆进行动力学建模，类比得到小车平衡的条件。从加速度计和陀螺仪传感器得出的角度。运用卡尔曼滤波优化，补偿陀螺仪的漂移误差和加速度计的动态误差，得到更优的倾角近似值。通过光电编码器分别得到车子的线速度和转向角速度，对速度进行PI控制。根据PID控制调节参数，实现两轮直立行走。通过调节左右两轮的差速实现小车的转向。 制作完成后，小车实现了在无线蓝牙通讯下前进、后退、和左右转向的基本动作。此外小车能在正常条件下达到自主平衡状态。并且在适量干扰下，小车能够自主调整并迅速恢复稳定状态。 关键词：自平衡陀螺仪控制调试

前言 移动机器人是机器人学的一个重要分支，对于移动机器人的研究，包括轮式、腿式、履带式以及水下式机器人等，可以追溯到20世纪60年代。移动机器人得到快速发展有两方面原因：一是其应用围越来越广泛；二是相关领域如计算、传感、控制及执行等技术的快速发展。移动机器人尚有不少技术问题有待解决，因此近几年对移动机器人的研究相当活跃。 近年来，随着移动机器人研究不断深入、应用领域更加广泛，所面临的环境和任务也越来越复杂。机器人经常会遇到一些比较狭窄，而且有很多大转角的工作场合，如何在这样比较复杂的环境中灵活快捷的执行任务，成为人们颇为关心的一个问题。双轮自平衡机器人概念就是在这样的背景下提出来的。两轮自平衡小车是一个高度不稳定两轮机器人，是一种多变量、非线性、强耦合的系统，是检验各种控制方法的典型装置。同时由于它具有体积小、运动灵活、零转弯半径等特点，将会在军用和民用领域有着广泛的应用前景。因为它既有理论研究意义又有实用价值，所以两轮自平衡小车的研究在最近十年引起了大量机器人技术实验室的广泛关注。 本论文主要叙述了基于stm32控制的两轮自平衡小车的设计与实现的整个过程。主要容为两轮自平衡小车的平衡原理，直立控制，速度控制，转向控制及系统定位算法的设计。通过此设计使小车具备一定的自平衡能力、负载承载能力、速度调节能力和无线通讯功能。小车能够自动检测自身机械系统的倾角并完成姿态的调整，并在加载一定重量的重物时能够快速做出调整并保证自身系统的自我平衡。能够以不同运动速度实现双轮车系统的前进、后退、左转与右转等动作，同时也能够实现双轮自平衡车系统的无线远程控制操作

数字PID控制器设计

数字PID控制器设计 实验报告 学院电子信息学院 专业电气工程及其自动化学号 姓名 指导教师杨奕飞

数字PID控制器设计报告 一．设计目的 采用增量算法实现该PID控制器。 二．设计要求 掌握PID设计方法及MATLAB设计仿真。 三．设计任务 设单位反馈系统的开环传递函数为： 设计数字PID控制器，使系统的稳态误差不大于，超调量不大于20%，调节时间不大于。采用增量算法实现该PID控制器。 四．设计原理 数字PID原理结构图 PID控制器的数学描述为：

式中，Kp为比例系数；T1为积分时间常数；T D为微分时间常数。 设u(k)为第K次采样时刻控制器的输出值，可得离散的PID表达式为:? 使用模拟控制器离散化的方法,将理想模拟PID控制器D(s)转化为响应的理想数字PID控制器D(z).采用后向差分法,得到数字控制器的脉冲传递函数。

2.增量式PID控制算法 u(k)=u(k-1)+Δu(k) 增量式PID控制系统框图 五．Matlab仿真选择数字PID参数 利用扩充临界比例带法选择数字PID参数，扩充临界比例带法是以模拟PID调节器中使用的临界比例带法为基础的一种数字PID参数

的整定方法。其整定步骤如下 1)选择合适的采样周期T：，因为Tmin<1/10 T,选择采样周期为； 2)在纯比例的作用下,给定输入阶跃变化时,逐渐加大比例作用 Kp(即减小比例带δ),直至系统出现等幅震荡,记录比例增益 Kr,及振荡周期Tr 。Kr成为临界振荡比例增益(对应的临界比 例带δ),Tr成为临界振荡周期。 在Matlab中输入如下程序? G=tf(1,[1/150,36/150,185/150,1]); p=[35:2:45]; for i=1:length(p) Gc=feedback(p(i)*G,1); step(Gc),hold on end; axis([0,3,0,]) 得到如下所示图形： 改变其中的参数P=[35:2:45]为p=[40:1:45]得到下图曲线，得Kr约为43，Tr

实验七-对汽车控制系统的设计与仿真

实验七 对汽车控制系统的设计与仿真 一、实验目的： 通过实验对一个汽车运动控制系统进行实际设计与仿真，掌握控制系统性能的分析和仿真处理过程，熟悉用Matlab 和Simulink 进行系统仿真的基本方法。 二、实验学时：4 个人计算机，Matlab 软件。 三、实验原理： 本实验是对一个汽车运动控制系统进行实际设计与仿真，其方法是先对汽车运动控制系统进行建摸，然后对其进行PID 控制器的设计，建立了汽车运动控制系统的模型后，可采用Matlab 和Simulink 对控制系统进行仿真设计。 注意：设计系统的控制器之前要观察该系统的开环阶跃响应，采用阶跃响应函数step( )来实现，如果系统不能满足所要求达到的设计性能指标，需要加上合适的控制器。然后再按照仿真结果进行PID 控制器参数的调整，使控制器能够满足系统设计所要求达到的性能指标。 1. 问题的描述 如下图所示的汽车运动控制系统，设该系统中汽车车轮的转动惯量可以忽略不计，并且假定汽车受到的摩擦阻力大小与汽车的运动速度成正比，摩擦阻力的方向与汽车运动的方向相反，这样，该汽车运动控制系统可简化为一个简单的质量阻尼系统。 根据牛顿运动定律，质量阻尼系统的动态数学模型可表示为： ? ??==+v y u bv v m & 系统的参数设定为：汽车质量m =1000kg ， 比例系数b =50 N ·s/m ， 汽车的驱动力u =500 N 。 根据控制系统的设计要求，当汽车的驱动力为500N 时，汽车将在5秒内达到10m/s 的最大速度。由于该系统为简单的运动控制系统，因此将系统设计成10％的最大超调量和2％的稳态误差。这样，该汽车运动控制系统的性能指标可以设定为： 上升时间：t r <5s ； 最大超调量：σ％<10％； 稳态误差：e ssp <2％。 2、系统的模型表示

根据SIMULINK的PID自动控制控制器设计与仿真

基于SIMULINK的PID控制器设计与仿真 1.引言 MATLAB是一个适用于科学计算和工程用的数学软件系统，历经多年的发展，已是科学与工程领域应用最广的软件工具。该软件具有以下特点：数值计算功能强大；编程环简单；数据可视化功能强；丰富的程序工具箱；可扩展性能强等。Simulink是MATLAB下用于建立系统框图和仿真的环境。Simulink环境仿真的优点是：框图搭建方便、仿真参数可以随时修改、可实现完全可视化编程。 比例-积分-微分（Proporitional-Integral-Derivative,PID）是在工业过程控制中最常见、应用最广泛的一种控制策略。PID控制是目前工程上应用最广的一种控制方法，其结构简单，且不依赖被控对象模型，控制所需的信息量也很少，因而易于工程实现，同时也可获得较好的控制效果。 2.PID控制原理 当我们不能将被控对象的结构和参数完全地掌握，或者是不能得到精确的数学模型时，在这种情况下最便捷的方法便是采用PID 控制技术。为了使控制系统满足性能指标要求，PID 控制器一般地是依据设定值与实际值的误差，利用比例（P）、积分（I）、微分（D）等基本控制规律，或者是三者进行适当地配合形成相关的复合控制规律，例如，PD、PI、PID 等。 图2-1 是典型PID 控制系统结构图。在PID 调节器作用下，对误差信号 分别进行比例、积分、微分组合控制。调节器的输出量作为被控对象的输入控制量。

图2-1典型PID 控制系统结构图 PID 控制器主要是依据给定值r （t ）与实际输出值y （t ）构成控制偏差，用公式表示即e （t ）=r （t ）-y （t ），它本身属于一种线性控制器。通过线性组合偏差的比例（P ）、积分（I ）、微分（D ），将三者构成控制量，进而控制受控对象。控制规律如下： 1 01() ()[()()]p d i de t u t K e t e t dt T T dt =++? 其传递函数为： ()1()(1)()p d i U s G s K T S E s T s = =++ 式中：Kp--比例系数； Ti--积分时间常数； Td--微分时间常数。 3.Simulink 仿真 3.1 建立数学建模 3.2 仿真实验 在传统的PID 调节器中，参数的整定问题是控制面临的最主要的问题，控制系统的关键之处便是将Kp 、Ti 、Td 三个参数的值最终确定下来。而在工业

汽车运动控制系统仿真

一、摘要 2 二、课程设计任务 3 1．问题描述 3 2．设计要求 3 三、课程设计内容 4 1、系统的模型表示 4 2、利用Matlab进行仿真设计 4 3、利用Simulink进行仿真设计 9 总结与体会 10 参考文献 10

本课题以汽车运动控制系统的设计为应用背景，利用MATLAB语言对其进行设计与仿真.首先对汽车的运动原理进行分析，建立控制系统模型，确定期望的静态指标稳态误差和动态指标搬调量和上升时间，最终应用MATLAB环境下的.m文件来实现汽车运动控制系统的设计。其中.m文件用step函数语句来绘制阶跃响应曲线，根据曲线中指标的变化进行P、PI、PID校正；同时对其控制系统建立Simulink进行仿真且进行PID参数整定。仿真结果表明，参数PID控制能使系统达到满意的控制效果，对进一步应用研究具有参考价值，是汽车运动控制系统设计的优秀手段之一。 关键词：运动控制系统 PID仿真稳态误差最大超调量

一、课程设计任务 1. 问题描述 如下图所示的汽车运动控制系统，设该系统中汽车车轮的转动惯量可以忽略不计，并且假定汽车受到的摩擦阻力大小与汽车的运动速度成正比，摩擦阻力的方向与汽车运动的方向相反，这样，该汽车运动控制系统可简化为一个简单的质量阻尼系统。 根据牛顿运动定律，质量阻尼系统的动态数学模型可表示为： ???==+v y u bv v m 系统的参数设定为：汽车质量m =1000kg ， 比例系数b =50 N ·s/m ， 汽车的驱动力u =500 N 。 根据控制系统的设计要求，当汽车的驱动力为500N 时，汽车将在5秒内达到10m/s 的最大速度。由于该系统为简单的运动控制系统，因此将系统设计成10％的最大超调量和2％的稳态误差。这样，该汽车运动控制系统的性能指标可以设定为： 上升时间：t r <5s ； 最大超调量：σ％<10％； 稳态误差：e ssp <2％。 2.设计要求 1．写出控制系统的数学模型。 2．求系统的开环阶跃响应。 3．PID 控制器的设计 （1）比例（P ）控制器的设计 （2）比例积分（PI ）控制器的设计 （3）比例积分微分（PID ）控制器的设计 利用Simulink 进行仿真设计。 二、课程设计内容 1.系统的模型表示

大学毕业设计---基于arm的两轮自平衡车模型系统设计课程

中北大学 课程设计说明书 学生姓名: *杰学号：* 学院: 仪器与电子学院 专业: * 题目: 基于ARM的两轮自平衡车模型系统设计 指导教师：李锦明职称: 副教授 2015 年1 月30 日

摘要 近年来，两轮自平衡车的研究与应用获得了迅猛发展。本文提出了一种两轮自平衡小车的设计方案，采用陀螺仪L3G4200以及MEMS加速度传感器MMA7260构成小车姿态检测装置，使用卡尔曼滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用飞思卡尔32位单片机Kinetis K60为控制核心，通过滤波算法实现车身控制，人机交互等。 整个系统制作完成后，各个模块能够正常并协调工作，小车可以在无人干预条件下实现自主平衡。同时在引入适量干扰情况下小车能够自主调整并迅速恢复稳定状态。 关键词：两轮自平衡陀螺仪姿态检测卡尔曼滤波数据融合

目录 1 课程设计目的 (1) 2 设计内容和要求 (1) 2.1 设计要求 (1) 2.2 研究意义 (1) 2.3 研究内容 (2) 3 设计方案及实现情况 (2) 3.1 两轮平衡车的平衡原理 (2) 3.2 系统方案设计 (3) 3.3 系统最终方案 (6) 3.4 系统软件设计 (9) 3.5 电路调试 (16) 4 课程设计总结 (18) 参考文献 (19) 附录 (20) 致谢 (21)

1 课程设计目的 （1）掌握嵌入式系统的一般设计方法和设计流程； （2）学习嵌入式系统设计，掌握相关IDE开发环境的使用方法； （3）掌握ARM的应用； （4）学习掌握嵌入式系设计的全过程； 2 设计内容和要求 2.1 设计要求 （1）学习掌握基于ARM Cortex-M4内核的Kinetis K60系列单片机的工作原理及应用；（2）学习掌握加速度计、陀螺仪的工作原理及应用； （3）设计基于PID控制的两轮自平衡车模型系统的工作原理图及PCB版图； 2.2 研究意义 近年来，随着电子技术的发展与进步，移动机器人的研究不断深入，成为目前科 学研究最活跃的领域之一，移动机器人的应用范围越来越广泛，面临的环境和任务也 越来越复杂，这就要求移动机器人必须能够适应一些复杂的环境和任务。比如，户外 移动机器人需要在凹凸不平的地面上行走，有时环境中能够允许机器人运行的地方比 较狭窄等。如何解决机器人在这些环境中运行的问题，逐渐成为研究者关心的问题[1]。 两轮自平衡机器人的概念正是在这样一个背景下提出来的，这种机器人区别于其 他移动机器人的最显著的特点是：采用了两轮共轴、各自独立驱动的工作方式(这种驱 动方式又被称为差分式驱动方式)，车身的重心位于车轮轴的上方，通过轮子的前后移 动来保持车身的平衡，并且还能够在直立平衡的情况下行驶。由于特殊的结构，其适 应地形变化能力强，运动灵活，可以胜任一些复杂环境里的工作。 两轮自平衡机器人自面世以来，一直受到世界各国机器人爱好者和研究者的关 注，这不仅是因为两轮自平衡机器人具有独特的外形和结构，更重要的是因为其自身 的本质不稳定性和非线性使它成为很好的验证控制理论和控制方法的平台，具有很高 的研究价值。

变速积分PID控制系统设计

课程设计报告设计题目变速积分PID控制系统设计课程名称计算机控制技术B 姓名苏丹学号2008100731 班级自动化0803 教师闫高伟

设计日期2011年7月5日 目录 摘要............................................................ 错误!未定义书签。Abstract .. (4) 第1章数字PID及变速积分简介.................................... 错误!未定义书签。 1.1 数字PID发展介绍 (1) 1.2 PID控制器工作原理 (2) 1.2.1 模拟式PID控制算法.................................. 错误!未定义书签。 1.2.2 数字式PID控制算法 (3) 1.3 变速积分简介............................................... 错误!未定义书签。第2章系统分析与设计............................................ 错误!未定义书签。 2.1 系统功能分析............................................... 错误!未定义书签。 2.1.1 对象整体分析 (5) 2.1.2系统分析与设计与系统开环增益 (6) 2.2计算机系统选择分析 (6) 2.2.1 8088CPU简介 (6) 2.2.2 其余模块的使用 (7) 2.3 软件设计分析 (12) 第3章硬件设计与软件编程 (12) 3.1 硬件设计 (12) 3.1.1 系统方框图 (12) 3.1.2 线路原理图 (12) 3.2 软件编程 (13) 3.2.1 软件流程图 (14) 3.2.2 程序源代码 (21) 第4章设计仿真与运行分析 (21) 4.1 结果分析 (21) 4.2 matlab仿真 (22) 总结.............................................................................错误!未定义书签。附录....... (26) 附录1 线路原理图 (28) 附录2 TDN-AC/ACS＋教学实验系统介绍 (28) 附录3 参考资料 (30)

Matlab汽车运动控制系统设计

1绪论 1.1选题背景与意义 汽车已经成为人们日常生活不可缺少的代步交通工具，在汽车发达国家，旅客运输的60％以上，货物运输的50％以上由汽车来完成，汽车工业水平和家庭平均拥有汽车数量已经成为衡量一个国家工业发达程度的标志。进行汽车运动性能研究时．一般从操纵性、稳定性和乘坐舒适性等待性着手。但近年来．随着交通系统的日趋复杂，考虑了道路环境在内的汽车运动性能开始受到关注。因此，汽车运动控制系统的研究也显得尤为重要，在文中，首先对汽车的运动原理进行分析，建立控制系统简化模型，确定期望的静态指针(稳态误差)和动态指针(超调量和上升时间)。然后对汽车运动控制系统进行设计分析。从而确定系统的最佳静态和动态指针。 2 论文基本原理分析 2.1.1汽车运动横向控制 （1）绝对位置的获得方法 汽车横向方向的控制使用GPS(全球定位系统)的绝对位置信息。GPS信息的精度与采样周期、时间滞后等有关。为提高GPS的数据精度和平滑数据．采用卡尔曼滤波对采样数据进行修正。GPS的采样周期为200ms相对应控制的周期采用50ms。另外考虑通信等的滞后、也需要进行补偿，采用航位推测法(dead reckoning)解决此问题。通过卡尔曼滤波和航位推测法推算出的值作为汽车的绝对位置使用来控制车速、横摆角速度等车辆的状态量。GPS 的数据通过卡尔曼滤波减少偏差、通过航位推测法进行误差和迟滞补偿．提高了位置数据推算的精度。 （2）前轮转角变化量的算出方法 这里对前轮目标转角变化量(?δ)的算出方法作简要说明，横方向控制采用预见控制，可以从现在汽车的状态预测经过时间t p秒后的汽车位置，由t p秒后的预测位置和目标路径

双轮自平衡车设计报告

双轮自平衡车设计报告 学院………….......... 班级…………………… 姓名………………..手机号…………………..姓名………………..手机号…………………..姓名………………..手机号…………………..

目录 一、双轮自平衡车原理 二、总体方案 三、电路和程序设计 四、算法分析及参数确定过程

一.双轮自平衡车原理 1.控制小车平衡的直观经验来自于人们日常生活经验。一般的人通过简单练习就可以让一个直木棒在手 指尖上保持直立。这需要两个条件：一个是托着木棒的手掌可以移动；另一个是眼睛可以观察到木棒的倾斜角度和倾斜趋势（角速度）。通过手掌移动抵消木棒的倾斜角度和趋势，从而保持木棒的直立。这两个条 件缺一不可，让木棒保持平衡的过程实际上就是控制中的负反馈控制。 图1 木棒控制原理图 2.小车的平衡和上面保持木棒平衡相比，要简单一些。因为小车是在一维上面保持平衡的，理想状态下，小车只需沿着轮胎方向前后移动保持平衡即可。 图2 平衡小车的三种状态 3.根据图2所示的平衡小车的三种状态，我们把小车偏离平衡位置的角度作为偏差；我们的目标是通过 负反馈控制，让这个偏差接近于零。用比较通俗的话描述就是：小车往前倾时车轮要往前运动，小车往后倾时车轮要往后运动，让小车保持平衡。 4.下面我们分析一下单摆模型，如图4所示。在重力作用下，单摆受到和角度成正比，运动方向相反的回复力。而且在空气中运动的单摆，由于受到空气的阻尼力，单摆最终会停止在垂直平衡位置。空气的阻尼力与单摆运动速度成正比，方向相反。 图4 单摆及其运动曲线

类比到我们的平衡小车，为了让小车能静止在平衡位置附近，我们不仅需要在电机上施加和倾角成正比的回复力，还需要增加和角速度成正比的阻尼力，阻尼力与运动方向相反。 5 平衡小车直立控制原理图 5.根据上面的分析，我们还可以总结得到一些调试的技巧：比例控制是引入了回复力；微分控制是引入了阻尼力，微分系数与转动惯量有关。 在小车质量一定的情况下，重心位置增高，因为需要的回复力减小，所以比例控制系数下降；转动惯量变大，所以微分控制系数增大。在小车重心位置一定的情况下，质量增大，因为需要的回复力增大，比例控制系数增大；转动惯量变大，所以微分控制系数增大。 二.总体方案 ■小车总框图

PID控制器设计

PID 控制器设计

PID 控制器设计 被控制对象的建模与分析 在脑外科、眼科等手术中，患者肌肉的无意识运动可能会导致灾难性的后果。为了保证合适的手术条件，可以采用控制系统自动实施麻醉，以保证稳定的用药量，使患者肌肉放松，图示为麻醉控制系统模型。 图1结构框图 被控制对象的控制指标 取τ=0.5，k=10,要求设计PID 控制器使系统调节时间t s ≤8s,超调量σ％不大于15％，并且输出无稳态误差。 控制器的设计 PID 控制简介 PID 控制中的积分作用可以减少稳态误差, 但另一方面也容易导致积分饱和, 使系统的超调量增大。 微分作用可提高系统的响应速度, 但其对高频干扰特别敏感, 甚至会导致系统失稳。 所以, 正确计算控制器的参数, 有效合理地实现 PID 控制器的设计,对于PID 控制器在过程控制中的广泛应用具有重要的理论和现实意义。 在PID 控制系统中, PID 控制器分别对误差信号e （t ）进行比例、积分与微分运算, 其结果的加权和构成系统的控制信号u （t ），送给对象模型加以控制。 PID 控制器的数学描述为 其传递函数可表示为: 1 1.0) 1.0(++s s k τ )1.0()15.0(1 2++s s 控制器 人 药物 输入 R(s ) 预期松弛程度 C(s) 实际松弛程度 + -

从根本上讲, 设计PID 控制器也就是确定其比例系数Kp 、积分系数T i 和微分系数T d , 这三个系数取值的不同, 决定了比例、积分和微分作用的强弱。控制系统的整定就是在控制系统的结构已经确定、控制仪表和控制对象等处在正常状态的情况下, 适当选择控制器的参数使控制仪表的特性和控制对象的特性相配合, 从而使控制系统的运行达到最佳状态, 取得最好的控制效果。下面介绍基于MATLAB 的 Ziegler-Nichols 算法PID 控制器设计。 原系统开环传递函数G(s)=)1.0)(15.0)(11.0(10 +++s s s 做原系统零极点图 图2原系统零极点图

基于PLC的小车自动往返运动控制系统2

第一章概述 1完成本次循环工作后，停止在最初位置。其运动路线示意图如下图1-1所示。 如图1-1 小车运动路线示意图 第二章硬件设计 2.1 主电路图 如图2-1为小车循环控制的主电路原理图。该电路图利用两个接触器的主触点KM1、KM2分别接至电机的三相电源进线中，其中相对电源的任意两相对调，即可实现电机的正反转，也可达到小车左右运行的目的。假设接通KM1为正转（小车右行），则接通KM2为反转（小车左行）。

图2-1小车循环控制的主电路原理 2.2 I/O地址分配 如表2-1为小车循环运动PLC控制的I/O分配表。在运行过程中，这些I/O口分别起到了控制各阶段的输入和输出的作用，并且也使小车的控制过程更清晰明了，动作与结果显示更加方便直接。 表2-1

2.3 I/O接线图 如图2-2为小车循环运动PLC控制的I/O接线图。在进行调试过程时，在PLC模块上，当I0.0有输入信号，即按下SQ1；当I0.1有输入信号，也即按下SQ2，以此类推，I/O接线图就是把实际的开关信号变成调试时的输入信号。同理，输出信号也是利用PLC模块把小车的实际运动用Q0.0、Q0.1的状态表现出来。 图2-2小车循环运动PLC控制的I/O接线图 2.4 元件列表 如表2-2为小车循环运动PLC控制的元件列表。在本次设计中就是利用这些元件，用若干导线连接起来组成了我们需要的原理图、I/O接线图。 表2-2

第三章软件设计 3.1 程序流程图 如图3-1为小车循环运动PLC控制的程序流程图。小车在一个周期内的运动由4段组成。设小车最初在左端，当按下启动按钮，则小车自动循环地工作，若按下停止按钮，则小车完成本次循环工作后，停止在最初位置。 首先小车位于初始位置，按下SB1启动后，小车向右行驶；当碰到行程开关SQ4，小车转向，向左行驶；碰到行程开关SQ2，小车再一次转向，向右行驶；碰到行程开关SQ3，小车又向左行驶，直到再次碰到SQ1，然后开始依次循环以上过程。若不按下停止按钮SB2则小车一直进行循环运动，若此时按下停止按钮SB2，小车又碰到行程开关SQ1，则小车回到初始位置。

电动汽车控制系统设计设计

电动汽车控制系统设计设计

摘要 在当前全球汽车工业面临金融危机和能源环境问题的巨大挑战的情况下，发展电动汽车，利用无污染的绿色能源，实现汽车能源动力系统的电气化，推动传统汽车产业的战略转型，在国际上已经形成了广泛共识。 本课题以电动汽车他励电机控制器为例，以实现电动汽车的加、减速，起、制动等基本功能以及一些特殊情况下的处理。以开发出高可靠性、高性能指标、低成本并且具有自主知识产权的电动汽车电机驱动控制系统为目的。主要包括硬件电路板的设计，以及驱动系统的软件部分的仿真调试。 在驱动系统硬件设计中，这里主控制芯片采用ATMEL公司的ATmega64芯片。功率模块采用多MOSFET并联的方 37

式，有效的节约了成本。电源模块采用基于UC3842的开关电源电路。选用IR 公司的IR2110作为驱动芯片，高端输出驱动电流可到1．9A，低端输出驱动电流可到2.3A，能够提供7个MOSFET并联时驱动电流。对于电流检测模块，本文没有采用电流传感器或者是康铜丝,而是采用了一种基于MOSFET管压降的电流检测电路，这种方式即节约了成本也保证了检测精度。 驱动系统的软件设计中，主要实现的功能为：开关量的检测处理，故障检测，串口通讯，励磁、电枢控制，报警功能等。针对他励电机电动汽车的控制特性，提出了节能控制算法和最大转矩控制算法，用于提高电动汽车的续航里程和加速性能。 他励直流电动机驱动系统能够很 37

好的运行在电动汽车上，性能可靠、结构简 单，并且节约了成本，使电动汽车的性价比大大提高，有利于电动汽车的普及。 关键词：电动汽车，ATmega64，他励直流电机，PID模糊控制 37

基于MATLAB的PID控制器设计说明

基于MATLAB的PID 控制器设计

基于MATLAB的PID 控制器设计 一、PID控制简介 PID控制是最早发展起来的经典控制策略, 是用于过程控制最有效的策略之一。由于其原理简单、技术成，在实际应用中较易于整定, 在工业控制中得到了广泛的应用。它最大的优点是不需了解被控对象精确的数学模型,只需在线根据系统误差及误差的变化率等简单参数, 经过经验进行调节器参数在线整定, 即可取得满意的结果, 具有很大的适应性和灵活性。 积分作用:可以减少稳态误差, 但另一方面也容易导致积分饱和, 使系统的超调量增大。 微分作用:可提高系统的响应速度, 但其对高频干扰特别敏感, 甚至会导致系统失稳。 所以, 正确计算控制器的参数, 有效合理地实现 PID控制器的设计,对于PID 控制器在过程控制中的广泛应用具有重要的理论和现实意义。 在PID控制系统中, PID控制器分别对误差信号e（t）进行比例、积分与微分运算, 其结果的加权和构成系统的控制信号u（t），送给对象模型加以控制。 PID控制器的数学描述为 其传递函数可表示为: 从根本上讲, 设计PID控制器也就是确定其比例系数Kp、积分系数T i 和微分系数T d , 这三个系数取值的不同, 决定了比例、积分和微分作用的强弱。控制系统的整定就是在控制系统的结构已经确定、控制仪表和控制对象等处在正常状态的情况下, 适当选择控制器参数使控制仪表的特性和控制对象的特性相配合, 从而使控制系统的运行达到最佳状态, 取得最好的控制效果。 二、MATLAB的 Ziegler-Nichols算法PID控制器设计。 1、PID控制器的Ziegler-Nichols参数整定 在实际的过程控制系统中, 有大量的对象模型可以近似地由一阶模型 来表示。这个对象模型可以表示为 sL - e sT 1 K G(s) + = 如果不能建立起系统的物理模型, 可通过试验测取对象模型的阶跃响应, 从而得到模型参数。当然, 我们也可在已知对象模型的情况下, 利用MATLAB，通过使用step ( ) 函数得到对象模型的开环阶跃响应曲线。在被控对象的阶跃响应中, 可获取K 、L 和T参数, 也可在MATLAB中由dcgain ( ) 函数求取 K值。

平衡车原理和扑街解释

平衡车原理和扑街解释 摘要: 说到仆街的原因或者原理，必须从平衡车的原理说起。本文为 buaa_dingo 原创一、自平衡基本原理所有前后方向具有自平衡功能的车辆，双轮或者独轮，都是基于倒立摆原理。自平衡车实际上是一个比较 ... 说到仆街的原因或者原理，必须从平衡车的原理说起。本文为buaa_dingo原创 一、自平衡基本原理 所有前后方向具有自平衡功能的车辆，双轮或者独轮，都是基于倒立摆原理。自平衡车实际上是一个比较简单的单级倒立摆系统，只是由于有驾驶员的操纵，为这个简单的单级倒立摆系统引入了一些非线性因素，但是也并不复杂。 简单文字描述如下： 1）最简单的自平衡车系统，包括控制器、姿态传感器和执行器（电机），以及必要的电源（电池）和结构零件（让小车组合在一起具备功能）。其中，控制器能够测量姿态传感器输出的姿态信息，并比较精确地控制电机运转；姿态传感器可以每秒输出100-500次姿态数据（俯仰、滚转、方向）；执行器（电机）可以提供整车运动的动力。 2）当驾驶者向前倾斜身体时，会带动车子向前倾斜。此时控制器可通过姿态传感器感知到这个倾斜，并命令电机向前旋转。这样，驾驶者前倾的时候，车子也会往前走，从而“追上”打算往前倾倒的驾驶者，保持动态平衡。 3）当驾驶者身体向后仰时，会带动车子向后倾斜。此时控制器可通过姿态传感器感知到这个倾斜，并命令电机向后旋转。这样，驾驶者后仰的时候，车子也会往后走，从而“追上”打算向后倾倒的驾驶者，保持动态平衡。 4）控制器每秒钟执行100-500次2、3的过程，不停地测量车子姿态，不停地调整电机的转动方向和转速。这样就保持一个动态的平衡。不管驾驶者往前还是往后倾斜，车子都会自动“追上”驾驶者，保持平衡。 参考文献：