《两轮直立智能车设计说明》由会员分享，可在线阅读，更多相关《两轮直立智能车设计说明（17页珍藏版）》请在金锄头文库上搜索。
1、. . . . 计算机控制技术课程设计成绩评定表设计课题两轮直立代步车控制器设计 学院名称： 电气工程学院专业班级：学生：学号：指导教师：设计地点 ：31-503 设计时间 ：2012-06-112011-06-15指导教师意见：成绩: 签名： 年 月 日 / 计算机控制技术课程设计课程设计名称：两轮直立代步车控制器设计 专业班级：学生姓名：学号：指导教师：课程设计地点：31-503 课程设计时间：2011-06-112011-06-15 计算机控制技术 课程设计任务书学生专业班级学号题目两轮直立代步车控制器设计课题性质工程设计课题来源自拟指导教师臧海河主要容（参数）利用S12G128设计两轮
2、直立代步车控制系统，实现以下功能：1系统启动时，控制电机使系统保持平衡；2当按下前进或后退按钮时，系统保持一顶的倾角前进或后退；3按下左右方向按钮时，通过电机差速来调整方向；4按下停止按钮时，电机减速运行至停止，并保持系统直立；任务要求（进度）第1天：熟悉课程设计任务与要求，查阅技术资料，确定设计方案。第2天：按照确定的方案设计单元电路。要求画出单元电路图，元件与元件参数选择要有依据，各单元电路的设计要有详细论述。第3天：软件设计，编写程序。第4-5天：撰写课程设计报告。要求容完整、图表清晰、语言流畅、格式规、方案合理、设计正确，篇幅不少于6000字。主要参考资料1 迎新单片微型计算机原理、应
3、用与接口技术（第2版）M：国防工业，20042 熊志奇微机自动配料控制系统J电子技术应用，1997，(10)：30-324唐介，电机与拖动（第二版）M.：高等教育，20075阎石，数字电子技术基础（第五版）M.：高等教育，20056胡寿松，自动控制原理（第二版）M.：科学，2007审查意见系（教研室）主任签字： 年 月 日 目 录1 引言32 总体方案设计42.1硬件组成42.2整体电路框图42.3直立任务分解42.4平衡控制52.5角度和角速度测量52.4速度控制72.5方向控制93 硬件电路设计93.1 单片机与其外围电路93.2控制电路划分为如下子模块：104 系统软件设计134.1 主
4、程序设计134.2控制相关的软件函数：144.3中断服务程序155总结15参考文献15附录A 电路图161 引言两轮自平衡电动代步车是一种两轮左右并行布置结构的具有自平衡系统的电动车。利用倒立摆控制原理，使车体始终保持平衡。在车体嵌入式CPU的控制下，采集平衡传感器以与速度、加速度传感器的数据，通过建立的系统数学模型和控制算法，计算输出PWM信号，自动控制两个伺服电机的转矩，使车体保持平衡并能够根据人体重心的偏移，自动前进、后退与转弯。2 总体方案设计2.1硬件组成按两轮自平衡电动代步车控制系统的技术要求，控制系统的硬件应包括以下几部分：（1）控制器。作为控制系统的核心，采用S12G128单片
5、机控制各个模块。（2）速度检测通道。将运动量转换为数字量，送给单片机，直接读取当前速度。（3）控制输出通道。控制器输出的控制信号传送给电机，控制电机的正反转和速度。（4）加速度检测通道。将电机角加速度转换为电信号。（5）角度检测通道。将系统倾角转换为电信号。2.2整体电路框图图2.1 总体控制框图2.3直立任务分解（1）控制平衡：通过控制两个电机正反向运动保持车模直立平衡状态；（2）速度控制：通过调节车模的倾角来实现车模速度控制，实际上最后还是演变成通过控制电机的转速来实现车轮速度的控制。（3）控制方向：通过控制两个电机之间的转动差速实现车模转向控制。车的直立和方向控制任务都是直接通过控制车的
6、两个后轮驱动电机完成的。假设电机可以虚拟地拆解成两个不同功能的驱动电机，它们同轴相连，分别控制系统的直立平衡、左右方向。在实际控制中，是将控制直立和方向的控制信号叠加在一起加载电机上，只要电机处于线性状态就可以同时完成上面两个任务。速度是通过调节车模倾角来完成的。不同的倾角会引起车的加减速，从而达到对于速度的控制。2.4平衡控制重力场中使用细线悬挂着重物经过简化便形成理想化的单摆模型。直立着的车可以看成放置在可以左右移动平台上的倒立着的单摆。当物体离开垂直的平衡位置之后，便会受到重力与悬线的作用合力，驱动重物回复平衡位置。这个力称之为回复力，在偏移角度很小的情况下，回复力与偏移的角度之间大小成
7、正比，方向相反。在此回复力作用下，单摆便进行周期运动。在空气中运动的单摆，由于受到空气的阻尼力，单摆最终会停止在垂直平衡位置。空气的阻尼力与单摆运动速度成正比，方向相反。阻尼力越大，单摆越会尽快在垂直位置稳定下来。总结单摆能够稳定在垂直位置的条件有两个：（1）受到与位移（角度）相反的恢复力；（2）受到与运动速度（角速度）相反的阻尼力。通过类比倒立摆可得到了车直立的控制方案。控制车模直立稳定的条件如下：（1）能够精确测量车模倾角的大小和角速度的大小；（2）可以控制车轮的加速度。2.5角度和角速度测量（1）加速度传感器加速度传感器可以测量由地球引力作用或者物体运动所产生的加速度。MMA7260是一
8、款三轴低g半导体加速度计，可以同时输出三个方向上的加速度模拟信号，通过设置可以使得MMA7260各轴信号最大输出灵敏度为800mV/g，这个信号无需要在进行放大，直接可以送到单片机进行AD转换。只需要测量其中一个方向上的加速度值，就可以计算出倾角，比如使用Z轴方向上的加速度信号。车直立时，固定加速度器在Z轴水平方向，此时输出信号为零偏电压信号。当车发生倾斜时，重力加速度g便会在Z轴方向形成加速度分量，从而引起该轴输出电压变化。变化的规律为式中，g为重力加速度；为车模倾角；k为加速度传感器灵敏度系数系数。当倾角比较小的时候，输出电压的变化可以近似与倾角成正比。（2）角速度传感器-陀螺仪陀螺仪可以
9、用来测量物体的旋转角速度。竞赛允许选用村田公司出品的ENC-03系列的加速度传感器。它利用了旋转坐标系中的物体会受到科里奥利力的原理，在器件中利用压电瓷做成振动单元。当旋转器件时会改变振动频率从而反映出物体旋转的角速度。在车上安装陀螺仪，可以测量车模倾斜角速度，将角速度信号进行积分便可以得到车模的倾角。由于陀螺仪输出的是车的角速度，不会受到车体运动的影响，因此该信号中噪声很小。车的角度又是通过对角速度积分而得，这可进一步平滑信号，从而使得角度信号更加稳定。因此车控制所需要的角度和角速度可以使用陀螺仪所得到的信号。由于从陀螺仪角速度获得角度信息，需要经过积分运算。如果角速度信号存在微小的偏差和漂
10、移，经过积分运算之后，变化形成积累误差。这个误差会随着时间延长逐步增加，最终导致电路饱和，无法形成正确的角度信号，为了消除这个累积误差一种简单的方法就是通过上面的加速度传感器获得的角度信息对此进行校正。通过对比积分所得到的角度与重力加速度所得到的角度，使用它们之间的偏差改变陀螺仪的输出，从而积分的角度逐步跟踪到加速度传感器所得到的角度。如图2.2所示：图2.2加速度计陀螺仪采集框图（3）双加速度传感器获得角度和角速度加速度传感器Z轴信号除了由于重力加速度引起的输出之外，还包括有车模的角加速度和移动加速度产生的信息。在车模现有的参数基础上，这些信号在幅值、频率等方面没有太大差异，它们叠加在一起无
11、法将它们分开。如果在车模上另外再增加一个加速度传感器，两个加速度传感器安装的高度不同，那么就可以通过这两个信号的差值求出车模的角加速度。通过上下两个加速度传感器输出信号相减，便可以得到车模倾角加速度。对于这个信号进行两次积分，便可以的获得车模倾角的角速度和角度。对于积分所可能带来的积分漂移问题仍然可以采用上面的重力加速度计补偿的方法进行消除。可以得到如下角度控制方案框图2.3所示。图2.3 角度控制方案框图2.4速度控制对于直立车速度的控制相对于普通车的速度控制则比较复杂。由于在速度控制过程中需要始终保持车的平衡，因此车速度控制不能够直接通过改变电机转速来实现。具体实现需要解决三个问题：（1）
12、如何测量车速度？（2）如何通过车模直立控制实现车倾角的改变？（3）如何根据速度误差控制车倾角？第一个问题可以通过安装在电机输出轴上的光码盘来测量得到车的车轮速度。利用控制单片机的计数器测量在固定时间间隔速度脉冲信号的个数可以反映电机的转速。第二个问题可以通过角度控制给定值来解决。给定车直立控制的设定值，在角度控制调节下，车模将会自动维持在一个角度。通过前面车直立控制算法可以知道，车模倾角最终是跟踪重力加速度Z轴的角度。因此车的倾角给定值与重力加速度Z轴角度相减，便可以最终决定车的倾角。控制框图如图2.4所示。图2.4 倾角控制框图第三个问题介意在前两个问题的基础上增加微分控制，控制框图如图2.
13、5所示。图2.5 速度闭环控制框图2.5方向控制车的方向控制可在直立和速度闭环的基础上，给电机叠加上方向电信号，实现电机差速，从而实现方向的改变。在车模控制中的直立、速度和方向控制三个环节中，都使用了比例微分（PD）控制，这三种控制算法的输出量最终通过叠加通过电机运动来完成。（1）车模直立控制：使用车模倾角的PD（比例、微分）控制；（2）车模速度控制：使用PD（比例、微分）控制；（3）车模方向控制：使用PD（比例、微分）控制。3 硬件电路设计3.1 单片机与其外围电路微控制器采用S12G128。MC9S12DG128有8KB RAM，128KB FLASH，4KB EEPROM ,8路PWM，
14、16路8位、10位AD，8路ECT，总线频率25MHZ，串行口有2个SCI，2个SPI，3个CAN总线模块。系统的输入输出包括：（1） AD转换接口（至少5路）方向检测：左右两路，用于测量左右两个控制器电压。陀螺仪：两路。一路用于检测车倾斜角速度，一路用于检测车转动角速度。加速度计：一路，测量加速度Z轴输出电压。辅助调试：（备用）1到3路，用于车调试、设置作用。（2） PWM接口（4路）控制左右两个电极双方向运行。由于采用单极性驱动，需要四路PWM接口。如果采用双极性驱动，可以使用两路。（3）定时器接口（2路）测量两个电机转速，需要两个定时器脉冲输入端口。（4）通讯接口（备用）SCI（UART）：一路，用于程序下载和调试接口；（5） IO接口（备用）4到8路输入输出，应用车运行状态显示，功能设置等。图3.1 单片机最小系统板外围电路3.2控制电路划分为如下子模块：DSC处理器，程序下载调试接口等；方向检测：包括两路一样的电压信号放大与检波电路如图3.3所示：图3.2 检波电路陀螺仪与加速度计：包括三个姿态传感器信号放大滤波电路；图3.3 陀螺仪与加速度计检测电路速度检测：检测电机光电码盘脉冲频率，实际上只包括了两个光电码盘的
