《智能小车直流电机控制控制系统设计(共33页).doc》由会员分享,可在线阅读,更多相关《智能小车直流电机控制控制系统设计(共33页).doc(33页珍藏版)》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、精选优质文档-倾情为你奉上燕山大学课 程 设 计 说 明 书题目: 智能小车直流电机控制控制系统设计 学院(系): 电气工程系 年级专业: 09自动化 学 号: 6 学生姓名: 黄雄丰 指导教师: 车海军 教师职称: 讲师 专心-专注-专业燕山大学课程设计(论文)任务书院(系):电气工程学院 基层教学单位:自动化系 学 号6学生姓名黄雄丰专业(班级)过控09-2设计题目智能小车直流电机控制控制系统设计设计技术参数1、 设计智能小车直流电机控制系统原理图;2、 直流电机驱动控制选用专用芯片;3、采用数字控制芯片实现。设计要求1、设计说明书和电气原理图必须按“电气图形符号”和“电气技术文字符号”的
2、国家标准,并规定主回路用粗实线、控制回路用细实线;2、设计说明书应包含封皮、目录、正文、参考文献等,字数要满足规定。3、元器件标明型号参数。工作量1、完成设计说明书一份(包括原理的简要说明和主要参数的计算过程);文稿用钢笔或圆珠笔书写,字迹应工整、清晰(打印也可);2、绘制电气原理图(包括主电路、控制回路)A2图纸一张,可用铅笔绘制或用计算机绘制打印,应符合相关制图标准;工作计划第一周1、查阅有关资料;2、分析并确定控制方案,完成操作、显示电路。3、主回路的设计、计算,并确定主要元器件(包括必要的保护环节);第二周1、转速、电流双闭环直流调速系统调节器参数的设计、计算。2、电气原理图设计3、撰
3、写设计说明书参考资料1、电力拖动自动控制系统 陈伯时 主编 (教材)2、电力电子变流技术 黄俊 主编(教材)3、电气传动自动化技术手册 4、电气控制李仁 主编(教材)5、智能小车有关资料指导教师签字车海军基层教学单位主任签字刘福才说明:此表一式四份,学生、指导教师、基层教学单位、系部各一份。2013-5-16摘要控制电机运动,例如转向、速度、角度的控制,是单片机在机电控制中的一个典型应用。本设计以MC9S12D Gl28单片机为核心,由路径识别、 车速检测、 舵机控制、直流电机、电机驱动芯片 L MD1 8200 和电压转换芯片 L M 7525 等模块组成, 并详细阐述了控
4、制系统的组成原理和软硬件设计。本次设计采用的直流电机是R S - 380S H 型直流电机。以及采用转速、电流双闭环直流调速系统对直流电机实行控制。本课题的核心是怎么样实行对智能小车发动机也就是直流电机的控制,直流电机的驱动本次是用了LMD1 8200电机驱动芯片,本文将详细的介绍LMD1 8200的驱动情况。关键词:单片机;直流电机;PWM控制技术目录第一章 智小车直流电机控制系统设计. 31.1课题背景31.2 智能小车驱动控制系统要求.41.3智能小车驱动电机控制系统分析.61.4直流电机控制系统硬件电路设计.61.4.1 PWM主电路设计.71.4.2 控制电路设计.71.4.2 智能
5、小车MC9S12DG128单片机系统81.4.2车速检测模块.10第二章 PWM控制系统设计.122.1全数字转速 直流双闭环调速系统设计.122.2数字电流调节器的设计. 132.2.1确定电流调节器时间常数 132.2.2电流调节器结构的选择142.2.3电流调节器参数的计算142.3数字转速调节器的设计.152.3.1转速调节器结构的选择 152.3.2转速调节器参数计算 152.4 PWM信号发生电路设计 .162.5 控制软件流程图.17参考文献.19第一章 智能小车系统的设计1.1 课题背景智能小车是轮式移动机器人研究领域的一项重要内容,涵盖了机械、汽车电子、电气、计算机、检测技术
6、、模式识别与智能控制等多个学科。它是陆地自主行驶车辆(AutonomousGroundVehicle,AGV)的一种。AGV在社会生活的各个领域都有着非常广阔的应用前景。在西方发达国家,移动式自主服务机器人已广泛应用于医疗福利服务、商场超市服务、家庭服务等领域;AGV在军事领域也有着重要的应用价值,美国军方把部分机器人技术视为未来战斗系统(FutureCombatSystem)的重要组成部分1。本文研究的智能小车主要采用专用赛道作为使用环境。智能小车的实现主要是控制其移动速度和方向。由路径识别、电机驱动、车速检测、方向舵机控制、电源管理及控制策略等功能模块组成。智能小车的采用直流电机,直流电机
7、采用高性能可控电力拖动的直流调速系统。它具有动态响应快、抗干扰能力强的优点。反馈闭环控制系统具有良好的抗扰性能,它对于被反馈环的前向通道上的一切扰动作用都能有效的加以抑制。采用转速负反馈和PI调节器的单闭环调速系统可以在保证系统稳定的条件下实现转速无静差。1.2 智能小车驱动控制系统要求智能小车控制系统结构如图 1 所示, 控制系统以单片机MC9S12D Gl28 为核心, 由电源管理模块、CCD 摄像头传感器路径识别模块、 直流电机驱动模块、 车速检测模块, 键盘与显示模块、 舵机控制模块等组成。(1)控制系统 16位MC9S12D Gl28单片机, 该单片机包含高速 A / D、P W M
8、、 硬件看门 狗、 电源监 控、 内部集成 P LL 锁相环等功能模块。采用上电自动复位方式, 时钟频率为 24 MHz。(2)路径识别是智能小车控制系统的关键模块之一, 路径识别方案的好坏, 直接关系到最终性能的优劣。通常采用的路径识别方案有红外光电传感器寻迹和 CCD 摄像头寻迹两种方案。本设计采用了面阵型 CCD 摄像头传感方案,标准供电电压为 5 V 。图像传感器输出 P A L 制式模拟信号, 模拟信号由复合同步信号、 复合消隐信号和视频信号组成。(3)电源部分的稳定对整个系统的可靠工作起着至关重要的作用, 智能小车系统根据各部件正常工作的需要, 对车模用 7. 2 V 2000 m
9、 Ah Ni - c d 蓄电池进行电压调节。(4)智能小车由直流电机驱动, 其精确的位置控制需采用转速闭环控制, 速度反馈常用的测量方法有光码盘、 编码 器 和 测 速 电机 三 种。设 计 中采 用E30S- 3 60- 3- 2 型旋转编码器。(5)智能小车的方向由舵机( 转向伺服电机) 控制,设计中采用 Fu ta b a S 3 010 型舵机, 该舵机可以输出力矩驱动智能小车转向。(6)车速控制采用美国国家半导体公司专用于直流电动机驱 动的 H 桥组件 L MD1 8200。L MD 18200提供双极性驱动方式和单极性驱动方式。本次课题主要研究设计智能小车的直流电机的驱动设计。键
10、盘显示CCD摄像头车速检测控制芯片MC9S12D Gl28舵机驱动FutabaS3010电源管理电机驱动RS-380SH图 1 控制系统结构框图1.3 智能小车驱动电机控制系统分析车速控制采用美国国家半导体公司专用于直流电动机驱 动的 H 桥组件 L MD1 8200。L MD 18200提供双极性驱动方式和单极性驱动方式。L MD 18200内部集成了四个DMOS管,组成一个标准的H型驱动桥。通过充电泵电路为上桥臂的2个开关管提供栅极控制电压,充电泵电路由一个300kHz左右的工作频率。可在引脚1、11外接电容形成第二个充电泵电路,外接电容越大,向开关管栅极输入的电容充电速度越快,电压上升的
11、时间越短,工作频率可以更高。引脚2、10接直流电机电枢,正转时电流的方向应该从引脚步到引脚10;反转时电流的方向应该从引脚10到引脚2。电流检测输出引脚8可以接一个对地电阻,通过电阻来输出过流情况。内部保护电路设置的过电流阈值为10A,当超过该值时会自动封锁输出,并周期性的自动恢复输出。如果过电流持续时间较长,过热保护将关闭整个输出。过热信号还可通过引脚9输出,当结温达到145度时引脚9有输出信号。单极性驱动方式是指在一个 P W M 周期内, 电动机电枢只承受单极性的电压, 电机的转大小只与 P WM 的占空比有关, 占空比越大, 转速越大。电机转向由L MD1820 0 的引脚 3 控制,
12、 引脚 3 输出高电平时, 电机正转, 引脚 3 输出低电平时, 电机反转。设计中采用单极性驱 、驱动方式, 为了散热方便, 采 用L MD1820 0 集成电路芯片, 全部驱动电路都集成在芯片中, 使整个驱动电路大为简化。考虑到智能小车在直线加速区间的末端可能会遇到突然出现的拐弯区间, 智能小车由直道高速进入弯道时需要急速降速和停车, 而 L MD18200 具有 制动的功能,在行驶过程中可以通过单片机的控制使直流电机紧急制动。1.3直流电机控制系统硬件电路设计1.3.1 PWM主电路设计直流电机调速系统总体电路设计由单片机产生控制PWM信号发生电路产生PWM信号的数据,控制直流电机调速电路
13、对电机进行调速。通过单片机给的PWM占空比的不同实现电机的调速控制,二在驱动方面通过单片机给定PWM再通过L MD18200H型桥式电路器件实现电机的驱动。本次设计的电机驱动电路如图2采用L MD18200,简单的介绍如下: VSDIR OUTPWM BootS 1CurrentS0 BootS 2ThermalS0 OUT 2BRAKE GNDPT5 3 3PWM3 5 89PT7 4C6210uFC6110uFMC63 220uFLMD 18200+7.2V图 2 L MD 18200 驱动电路L MD1 8200 驱 动 电 路 如 图 3 所 示, 单 片 机P W M 3 端 口 输
14、 出 的 P W M 控 制 信 号 输 入 到L MD18 200 引脚 5, 单 片机 P T5 端 口输出的 DI R 转向信号, 从 L MD 18200 引脚 3 输入。当智能小车需要减速制动或紧急停车时, 单片机 P T 7 端口输出的BR AK E 信号, 从 L MD18 200 引脚 4 输入。L MD18200根据 P W M 控制信 号的占空比来控制 直流电机的转速, 实现对智能小车的车速控制。智能小车的驱动电机采用 R S - 380S H 型直流电机。1.3.3 智能小车MC9S12D Gl28单片机系统目前,直流电动机调速系统数字化已经走向实用化,伴随着电子技术的高
15、度发展,促使直流电机调速逐步从模拟化向数字化转变,特别是单片机技术的应用,使直流电机调速技术又进入到一个新的阶段,智能化、高可靠性已成为它发展的趋势。单片机直流电机调速简介:单片机直流调速系统可实现对直流电动机的平滑调速。本系统以MC9S12DG128单片机为核心,通过单片机控制,C语言编程实现对直流电机的平滑调速。系统控制方案的分析:本直流电机调速系统以单片机系统为依托,根据PWM调速的基本原理,以直流电机电枢上电压的占空比来改变平均电压的大小,从而控制电动机的转速为依据,实现对直流电动机的平滑调速,并通过单片机控制速度的变化。端口介绍 T 和端口P 端口T被连接到内部定时器模块,8个外部引
16、脚均具有输入捕捉(IC,Input Capture)和输出比较(OC,Output Compare)功能,通过设置TIOS寄存器中的IOSX位可以在输入捕捉与输出比较功能之间切换。当ECT工作在输入捕捉工作模式下,端口T的8个输入捕捉通道中,PT7/IOC7PT4/IOC4四个通道为普通的输入捕捉通道。每发生一次输入捕捉,新的计数器值会覆盖输入捕捉锁存器中原来的内容。PT3/IOC3PT0/IOC0四个通道为带有缓冲的输入捕捉通道,由于其内部带有一个保持寄存器,因此,可以在不产生中断的条件下,连续记录两次自由计数器的值。端口P与片内的脉宽调制模块PWM和1个SPI模块相连,8个引脚与通用I/O
17、共享,既可以作为脉宽调制波形的输出引脚,也可以作为外部中断输入引脚。如果端口P作为PWM使用,则除了PP7可以作为PWM输入或输出外,其他引脚都只能是PWM输出通道。一旦PWM允许启用,对应引脚通用I/O功能被禁止。本次设计启用p端口PWM。XTAL1 PT0 PT1 PT2 PT3 PT4 PT5 PT6XTAL2 PT7RSTALEP1.0 PWM0 PWM1 P1.1 PWM2 PWM3P1.2 PWM4P1.3 PWM5 PWM6P1.4 PWM7P1.5P1.6C11nF C2CRYSTALVCCC3 1nFVCC 图3 MC9S12D Gl28单片机小车系统 1. 3.4 车速检测
18、模块 智能小车由直流电机驱动, 其精确的位置控制需采用转速闭环控制, 速度反馈常用的测量方法有光码盘、 编码 器 和 测 速 电机 三 种。设 计 中采 用E30S- 3 60-3- 2 型旋转编码器, 编码器的中轴上有一直径为 4 c m 的齿轮 1, 与智能小车驱动后轮同轴的传动齿 2 相咬合, 当直流驱动电机驱动后轮旋转时, 齿轮 2 和齿轮 1 将驱动旋转编码器转动产生脉冲。由于齿轮 1 和齿轮 2 的齿数比为 1: 1, 所以智能小车车轮转动一圈即可以用 36 0 个脉冲表示,只需要测量一定周期内累加器的数值就能准确地计算出车速。用旋转编码器作为车速检测器件, 不仅硬件电路简单, 而
19、且信号采集速度快。第二章 PWM控制系统的设计 2.1 全数字转速 直流双闭环调速系统设计根据设计要求,本系统设计为全数字式控制方式,因此要求微型计算机完成:电流环控制器运算、速度环控制器运算、位置环控制器运算,以及与它们相应的反馈信号的采样和数字信号处理。目前,需要高性能可控电力拖动的领域都采用直流调速系统。它具有动态响应快、抗干扰能力强的优点。反馈闭环控制系统具有良好的抗扰性能,它对于被反馈环的前向通道上的一切扰动作用都能有效的加以抑制。采用转速负反馈和PI调节器的单闭环调速系统可以在保证系统稳定的条件下实现转速无静差。所以本次直流电机才有转速直流双闭环调速系统。为了实现转速和电流两种负反
20、馈分别起作用,在系统中设置了两个调节器,分别调节转速和电流,二者之间实行串级连接,即把转速调节器的输出当作电流调节器的输入,再用电流调节器的输出去控制晶闸管整流器的触发装置。从闭环结构上看,电流调节环在里面,叫做内环;转速环在外面,叫做外环。这样就形成了转速、电流双闭环调速系统。 该双闭环调速系统的两个调节器ASR和ACR一般都采用PI调节器。因为PI调节器作为校正装置既可以保证系统的稳态精度,使系统在稳态运行时得到无静差调速,又能提高系统的稳定性;作为控制器时又能兼顾快速响应和消除静差两方面的要求。一般的调速系统要求以稳和准为主,采用PI调节器便能保证系统获得良好的静态和动态性能。ASRAC
21、RUPEMTU*n +IdUdnU*i图4 . 转速、电流双闭环直流调速系统结构 ASR转速调节器 ACR电流调节器 TG测速发电机 TA电流互感器 UPE电力电子变换器。2.2 数字电流调节器的设计反馈系数的确定:电枢电流是双极性的,A/D转换的结果为10位二进制数转速反馈系数:=1V.min/r电流反馈系数:=U*im/Idm=1023/(71.7*2)=14.4/A2.2.1确定电流调节器时间常数1)整流装置滞后时间常数Ts=0.0017s。2)电流滤波时间常数Toi:取Toi=0.5ms=0.0005s。3)电流环小时间常数之Ti近似处理,取Ti=Ts+Toi=0.0022s。4)电枢
22、回路电磁时间常数TlTlL/R0.781/52.30.0167s5)电力拖动系统时间常数TmTm=40ms0.04s6) Ks=Uc-(-Uc)/fpwm=2*296.01/(100*1000)=0.005922.2.2电流调节器结构的选择根据设计要求并保证稳态电流无差,可按典型I型系统设计电流调节器。电流环控制对象是双惯性型的,因此可用PI型电流调节器,其传递函数为WACR(S)=Ki(is+1)/isKi-电流调节器的比例系数;i-电流调节器的超前时间常数。检查对电源电压的抗干扰性能:Tl/TI=0.0167s/0.0022s=7.6,参照教材中表2-3的典型型系统动态抗扰性能,各项指标都
23、是可以接受的。ACR+-图5 电流环等效近似处理后校正成为典型I系统框图2.2.3电流调节器参数计算电流调节器超前时间常数:i=Tl=0.0167s电流环开环增益:要求i5时,查表得KITi=0.5,因此KI=0.5/0.0022s=227.3s-1于是,ACR的比例系数为:Ki=KIiR/Ks=227.30.002781.8/(0.0059214.4)13.34电流环采样角频率:Wsi=10Wci=2273s-1电流环采样时间:Ti=1/(Wsi/2pi)=0.028s2.3 数字转速调节器的设计2.3.1转速调节器结构的选择转速环开环传递函数应共有两个积分环节,所以应该设计成典型II系统,
24、系统同时也能满足动态抗扰性能好的要求。n(s)/a + _图6 转速环等效近似处理后校正成为典型II系统框图ASR也应该采用PI调节器,其传递函数为:WASR(s)=Kn(ns+1)/nsKn-转速调节器的比例系数;n-转速调节器的超前时间常数。2.3.2转速调节器参数计算按跟随和抗扰性能都较好的原则,取h=5,则ASR的超前时间常数为n=hTn=50.0044s=0.027s转速开环增益:KN=(h+1)/2h2Tn2=6/(2520.00542)=4115.2s-2ASR的比例系数为:Kn=(h+1)CeTm/2hRTn=614.40.12900.2015/(2511.80.0054)=2
25、3.10转速环采样角频率:Wsn=10Wcn=1111.1s-1电流环采样时间:Tn=1/(Wsn/2pi)=0.00565s2.4 PWM信号发生电路设计PWM波可以由具有PWM输出的单片机通过编程来得以产生,也可以采用PWM专用芯片来实现。当PWM波的频率太高时,它对直流电机驱动的功率管要求太高,而当它的频率太低时,其产生的电磁噪声就比较大,在实际应用中,当PWM波的频率在18KHz左右时,效果最好。在本系统内,采用了两片4位数值比较器4585和一片12位串行计数器4040组成了PWM信号发生电路。两片数值比较器4585,即图上U2、U3的A组接12位串行4040计数输出端Q2Q9,而U2
26、、U3的B组接到单片机的P1端口。只要改变P1端口的输出值,那么就可以使得PWM信号的占空比发生变化,从而进行调速控制。U3vcc p1.7 p1.6 p1.5 p1.4 p1.3 p1.2 p1.1 p1.0XTAL2GND p3.7AB A3 A2 A1 A0B3B2B1B0 A=B ABB3 ABB0AB A1 A0Q9Q8Q7 CLKQ6Q5Q4 RSTQ3Q2 4040PWMU2 图7 PWM生成电路图 2.5 控制软件流程图主程序主程序是一个循环程序,其主要思路是,先设定好速度初始值,这个初始值与测速电路送来的值相比较得到一个误差值,然后用PI算法输出控制系数给PWM发生电路改变波
27、形的占空比,进而控制电机的转速。其程序流程图如图所示。软件由1个主程序、1个中断子程序和1个PI控制算法子程序组成。主程序主程序是一个循环程序,其主要思路是由单片机P1口生数据送到PWM信号发生电路,然后用PI算法输出控制系数给PWM发生电路改变波形的占空比进而控制电机的转速。主程序流程图如图8所示:否否开始系统初始化按键是否按下是读取键值是正转是否反转加速否减速减速是否加速是是PWM启动调制PI口数值减小停机程序PWM启动调制PI口数值增加停机否否否是图8 控制软件流程图 参考文献 1 梁丽勤, 王岩, 张宝健. 基于 F reesca l e 单片机的智能赛 车设计 J . 机电产品开发与
28、创新, 20 10( 6) : 114 - 1 16. 2 周 泉, 王贵 勇, 贾现 广, 等. 基于 MC9S 12D G128B 的 智 能模型车设计 J . 昆明理工大学学报, 20 10( 5) : 37 - 40 . 3 葛广军, 董燕飞, 王 磊. 基于 STC12 C5410A D 的新 型摄 像摇臂云台控制器设计 J . 河南 城建学院 学报, 2011 ( 2 ) :63- 66 . 4 魏楠, 周斌. 基 于 S12 微 控制 器的智 能车 软件设 计 J .微计算机应 用, 2010( 1 1) : 28- 33. 5 袁东风, 韩冰, 曹志刚. Ra yl ei gh 衰落信道中多级编 码调制的不等错误保护 J . 电子 学报, 2001, 2 9( 4) : 495 - 49 8.6 电力拖动自动控制系统 陈伯时 主编 (教材)7 电力电子变流技术 黄俊 主编(教材)8 电气传动自动化技术手册 9 电气控制李仁 主编(教材)燕山大学课程设计评审意见表指导教师评语:成绩: 指导教师: 年 月 日答辩小组评语:成绩: 评阅人: 年 月 日课程设计总成绩:答辩小组成员签字:年 月 日