飞思卡尔智能车电机资料
飞思卡尔智能车光电资料(doc 8页)
飞思卡尔智能车光电资料(doc 8页)基于光耦传感器的控制方法-从离散量到连续量康世胤1,李长城2,莫一林3,顾全全4,陆耿5(1. 清华大学自动化系,北京 100084;2. 清华大学自动化系,北京 100084;3. 清华大学自动化系,北京 100084;4. 清华大学自动化系,北京 100084;5. 清华大学自动化系,北京 100084)摘要: 第一届“飞思卡尔”杯全国大学生智能车邀请赛要求对高速行驶的小车进行实时控制,使其巡线完成比赛赛道。
针对这种要求,我们选择了最成熟的PID控制,尝试了由离散的不完全微分的PD控制到相对连续PD控制的过渡,通过采集光耦传感器输出的模拟量,采用对称求位置法得到连续性较好的位置信息,利用双排传感器计算角度,对位置和角度同时进行PD控制,经过细致调试确定相应参数,并合理利用分段、设置死区等方法,最终小车可以获得较好的稳定性和在高速情况对赛道中心线的跟随特性。
关键词:道路寻迹;PID控制;对称定位;离散;连续Control Method Based on Photoelectric Coupling Device – fromDiscrete Signal to Continual SignalKANG Shiyin1,LI Changcheng2,MO Yilin3,GU Quanquan4,LU Geng5(1. Automation, Tsinghua University, Beijing 100084, China;2. Automation, Tsinghua University, Beijing 100084, China;3. Automation, Tsinghua University, Beijing 100084, China;4. Automation, Tsinghua University, Beijing 100084, China;5. Automation, Tsinghua University, Beijing 100084, China;)Abstract: In the coming FREESCALE College Student Smart Car Competition ’06, real time control strategies are required to be applied in the high-speed model car which to make sure the car tracking the unknown road and finishing 2 laps of game. Based on the requirement we select one of the most well applied proportion-integration-deviation (PID) method. Much works are carried out including trying varies of strategy from initial discrete PD to final continual PD. In the current strategy analog output of photoelectric coupling devices are sampled and converted from A to D. Symmetric positioning method is applied to obtain precise direction information. Furthermore by applying dual sensor array the turning angle is calculated. PD method is applied on location and angle. After careful modification the corresponding parameters are decided empirically. In addition by using some other methods such as track segmentation and dead area presetting, the model car can obtain better status including good stability and fine tracking character in high speed.Key words: Road Tracking, Proportion-Integration-Deviation Control, Symmetric Positioning, Discrete, Continual第一届“飞思卡尔”杯全国大学生智能车邀请赛的赛题是控制比赛小车,使其按要求用尽可能短的时间完成比赛赛道,比赛允许选手自行设计传感器和控制电路,并编写控制程序,禁止改动舵机和轮胎等小车结构。
飞思卡尔智能车电机资料上课讲义
3.1.6驱动电机介绍驱动电机采用直流伺服电机,我们在此选用的是RS-380SH型号的伺服电机,这是因为直流伺服电机具有优良的速度控制性能,它输出较大的转矩,直接拖动负载运行,同时它又受控制信号的直接控制进行转速调节。
在很多方面有优越性,具体来说,它具有以下优点:(1)具有较大的转矩,以克服传动装置的摩擦转矩和负载转矩。
(2)调速范围宽,高精度,机械特性及调节特性线性好,且运行速度平稳。
(3)具有快速响应能力,可以适应复杂的速度变化。
(4)电机的负载特性硬,有较大的过载能力,确保运行速度不受负载冲击的影响。
(5)可以长时间地处于停转状态而不会烧毁电机,一般电机不能长时间运行于停转状态,电机长时间停转时,稳定温升不超过允许值时输出的最大堵转转矩称为连续堵转转矩,相应的电枢电流为连续堵转电流。
图3.1为该伺服电机的结构图。
图3.2是此伺服电机的性能曲线。
图3.1 伺服电机的结构图图3.2 伺服电机的性能曲线3.1.7 舵机介绍舵机是一种位置伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。
其工作原理是:控制信号由接收机的通道进入信号调制芯片,获得直流偏置电压。
它内部有一个基准电路,产生周期为20ms,宽度为1.5ms的基准信号,将获得的直流偏置电压与电位器的电压比较,获得电压差输出。
最后,电压差的正负输出到电机驱动芯片决定电机的正反转。
当电机转速一定时,通过级联减速齿轮带动电位器旋转,使得电压差为0,电机停止转动。
舵机的控制信号是PWM信号,利用占空比的变化改变舵机的位置。
一般舵机的控制要求如图3.3所示。
图3.4为舵机的控制线。
图3.3 舵机控制要求图3.4 舵机的控制线控制线输入一个周期性的正向脉冲信号,这个周期性脉冲信号的高电平时间通常在1ms-2ms之间。
而低电平时间应在5ms到20ms间,并不很严格。
下表3.3表示出一个典型的20ms周期性脉冲的正脉冲宽度与微型伺服马达的输出臂的位置的关系:表3.3脉冲宽度与舵机位置表考虑到舵机安装的位置与舵机的响应速度有关,在设计中我把舵机安装在较高的位置,使转向拉杆加长,使得在舵机转动相同的角度时前轮(即方向轮)转动的角度加大,转向灵敏。
飞思卡尔智能车简介
智能车制作F R E E S C A L E学院:信息工程学院班级:电气工程及其自动化132 学号:6101113078姓名:李瑞欣目录:1. 整体概述2.单片机介绍3.C语言4.智能车队的三个组5.我对这门课的建议一、整体概述智能车的制作过程包括理论设计、实际制作、整车调试、现场比赛等环节,要求学生组成团队,协同工作。
内容涵盖自动控制、模式识别、传感技术、电子、电气、计算机、机械与汽车等多学科多专业。
下面是一个智能车的模块分布:总的来说智能车有六大模块:信号输入模块、控制输出模块、数据处理模块、信息显示模块、信息发送模块、异常处理模块。
1、信号输入模块:智能车通过传感器获知赛道上的路况信息(直道,弯道,山坡,障碍物等),同时也通过传感器获取智能车自身的信息(车速,电磁电量等)。
这些数据构成了智能车软件系统(大脑)的信息来源,软件系统依靠这些数据,改变智能车的运行状态,保证其在最短的时间内按照规定跑完整个赛道。
2、控制输出模块:智能车在赛道上依靠转向机构(舵机)和动力机构(电机)来控制运行状态,这也是智能车最主要的模块,这个模块的好坏直接决定了你的比赛成绩。
电机和舵机都是通过PWM控制的,因此我们的软件系统需要根据已有的信息进行分析计算得到一个合适的输出数据(占空比)来控制电机和舵机。
3数据处理模块:主要是对电感、编码器、干簧管的数据处理。
信号输入模块得到的数据非常原始,有杂波。
基本上是不能直接用来计算的。
因此需要有信号处理模块对采集的数据进行处理,得到可用的数据。
4信息显示模块:智能车调试过程中,用显示器来显示智能车的部分信息,判断智能车是否正常运行。
正式比赛过程中可关闭。
主流的显示器有:Nokia 5110 ,OLED模块等,需要进行驱动移植。
5信息发送模块智能车的调试过程中,我们需要观察智能车的实时状态(采集的信号是否正常,输出是否正常),这个时候就需要用到信息发送模块,将智能车运行时的数据发送到电脑上就行分析处理。
飞思卡尔智能车光电资料
基于光耦传感器的控制方法-从离散量到连续量康世胤1,李长城2,莫一林3,顾全全4,陆耿5(1. 清华大学自动化系,北京 100084;2.清华大学自动化系,北京100084;3. 清华大学自动化系,北京 100084;4. 清华大学自动化系,北京100084;5.清华大学自动化系,北京 100084)摘要: 第一届“飞思卡尔”杯全国大学生智能车邀请赛要求对高速行驶的小车进行实时控制,使其巡线完成比赛赛道。
针对这种要求,我们选择了最成熟的PID控制,尝试了由离散的不完全微分的PD控制到相对连续PD控制的过渡,通过采集光耦传感器输出的模拟量,采用对称求位置法得到连续性较好的位置信息,利用双排传感器计算角度,对位置和角度同时进行PD控制,经过细致调试确定相应参数,并合理利用分段、设置死区等方法,最终小车可以获得较好的稳定性和在高速情况对赛道中心线的跟随特性。
关键词:道路寻迹;PID控制;对称定位;离散;连续Control MethodBased on Photoelectric Coupling Device – from DiscreteSignal to Continual Signal KANG Shiyin1,LIChangcheng2,MOYilin3,GU Quanquan4,LU Geng5(1.Automation, TsinghuaUniversity, Beijing100084, China;2. Automation, Tsinghua University, Beijing 100084,China;3.Automation, TsinghuaUniversity, Beijing 100084, China;4. Automation, Tsinghua University,Beijing 100084,China;5.Automation,Tsinghua University, Beijing 100084,China;)Abstract:Inthe comingFREESCALE College StudentSmartCar Competition ’06, realtime cont rol strategiesare requiredto be appliedin the high-speedmodelcar which to make sure the cartracki ngthe unknown road and finishing 2 laps of game. Based ontherequirement we select oneof themost well applied proportion-integration-deviation (PID)method. Much works are carried out includingtrying variesof strategy from initial discrete PDto final continual PD. In the current strategy anal og output of photoelectric coupling devicesaresampledand converted fromA to D.Symmetric pos itioningmethod is applied toobtain precisedirection information. Furthermore byapplying dual sensorarraythe turning angleiscalculated. PDmethod is appliedon locationand angle. After careful modification thecorrespondingparameters are decided empirically. In additionby using some other methods such astracksegmentation and deadarea presetting,the model car can obta inbetter status includinggood stability andfine tracking character in high speed.Key words:Road Tracking,Proportion-Integration-Deviation Control,Symmetric Positioning, Discrete,Continual第一届“飞思卡尔”杯全国大学生智能车邀请赛的赛题是控制比赛小车,使其按要求用尽可能短的时间完成比赛赛道,比赛允许选手自行设计传感器和控制电路,并编写控制程序,禁止改动舵机和轮胎等小车结构。
飞思卡尔智能车的直流有刷电机全桥驱动器 说明书
飞思卡尔智能车的直流有刷电机全桥驱动器
本驱动器性能非L298和MC33886等电机驱动芯片所能比,本驱动器注重电机启动速度,有效发挥电机功率。
能承受大电流过载。
电容电压均为25V。
1》》此驱动器具有的刹车功能可迅速将电机刹住,刹车迅速,制动明显,实现此效果简单容易操作。
经众多淘友使用评价要优于MC33886等驱动芯片和分立的驱动的刹车效果。
2》》本驱动器采用完整的全桥驱动芯片+极低内阻的MOSFET 组成。
完整的全桥驱动芯片可靠的驱动方式,使MOSFET的开关损耗降至最低。
提高电源利用率。
MOSFET驱动芯片自带硬件刹车功能和电能回馈功能。
3》》本驱动器优于功率芯片方案功率余量低和其他半桥组合方案中时序协调复杂问题和互补驱动问题。
4》》MOSFET采用耐电流冲击型,内阻为0.003欧,可快速使
MOSFET沟道打开,提高电机的加速曲率,同时也能迅速的为电机制动。
这可以使的的小车能迅速启动也能迅速杀车。
5》》本驱动器的自重6克,使你的智能车减轻自重优于对手。
驱动器可以工作在0%-100%的PWM调制占空比,也是普通驱动器无法做到的。
★性能参数:
额定电压:3V-15V,可扩展到24V无需增加费用。
额定电流:50A
峰值电流:100A
外形尺寸:4.4cm*2.7cm*1.2cm
安装方式:针脚孔是标准2.54mm间距,可与实验板直接插接。
飞思卡尔--智能车舵机讲解
飞思卡尔--智能车舵机讲解2.2 舵机的安装完成了玩具车的拆卸之后要做的第二步就是安装舵机,现在市场上卖的玩具车虽然也具有转向功能,但是前轮的转向多是依靠直流电机来驱动,无论向哪个方向转都是一下打到底,无法控制转过固定的角度,因此根据我们的设计需求,需要将原有的转向部分替换成现有的舵机,以实现固定转角的转向。
舵机的实物图如图 2.1所示。
需要说明的是由于小车系玩具车改装,在安装舵机是需要合理的利用小车的结构,将舵机安装牢固,同时还需注意合理利用购买舵机是附赠的齿轮,从而将舵机固定在合适的位置。
舵机的安装方式有俯式、卧式多种,不同的安装方法力臂长短、响应速度都有所不同,这一点请自己根据实际情况合理选择,图 2.2 为舵机的安装图。
5图 2.1 舵机实物图图 2.2 舵机安装图舵机安装过程中有一点需要尤其注意,由于舵机不是360°可转的,因此必须保证车轮左右转的极限在舵机的转角范围之内。
舵机安装完毕之后就可以对小车的转角进行控制了,但是由于玩具车的车体设计往往限制了小车的转角,因此可以对小车进行局部的“破坏”来增大前轮的转角,要知道在比赛中追求速度的同时一个大的转角对小车的可控性会有一个很大的提升,如图2.3 所示,就是对增加小车转角的一个改造,这是我在去年小车比赛中的用法。
将阻碍前轮转角的一部分用烙铁直接烫掉。
但是这种做法也有风险,由于你的改造会破坏小车的整体7结构,有可能会对小车的硬件结构造成破坏,因此如果你的小车在改造之后显得过于脆弱的话那你就要对你的小车采取些加固措施了。
3.4 舵机转向模块设计舵机是小车转向的控制机构,具有体积小、力矩大、外部机械设计简单、稳定性高等特点,无论是在硬件还是软件舵机设计是小车控制部分的重要组成部分,舵机的主要工作流程为:控制信号→控制电路板→电机转动→齿轮组减速→舵盘转动→位置反馈电位计→控制电路板反馈。
图 3.11 为舵机的实物图。
7图3.12 为舵机的内部结构图,舵机根据力矩划分有多种型号,价格也从几十到几百元不等,作为本文中介绍的智能小车的应用,实物如图 3.11 所示,价格在30元左右的舵机已经能够满足要求,但是在使用时应注意硬件连接,根据以往的情况来看舵机烧坏的情况也比较常见。
飞思卡尔智能车 电机PID - 云说风轻 - 博客园
比例、积分和微分的线性组合,构成控制量u(t),称为:比例(Proportional)分(Differentiation)控制,简称PID控制。
比例作用P只与偏差成正比,积分作用微分作用D是偏差的变化率。
用一句形象的比喻,比例P代表着现在,积分I代表着过去,而微分D则代表着未来。
公式如图: 具体于比例、积分和微分,网上有很多这方面的资料,我就不多说了。
下面是关于参数的调整,比例系数、积分系数和微分系数的合理调整时整个PID系统可以正常温度工作的关键。
而最好的寻找PID参数的办法是从系统的数学模型出发,从想要的反应来计算参数。
很多时候一个详细 Tyreus¡¡Luyben的整定值即减少了震荡的作用,而且增强了系统的稳定性。
理论上的就不多说了,我自己都懒得多看。
代码/****************************************************************Code Warrior 5.0Target : MC9S12XS128Crystal: 16.000Mhzby:庞辉芜湖联大飞思卡尔项目组******************************************************************///拨码开关选择脉冲const sint16 speed_arr1[253] = {37,37,37,85,85,85,37,37,37};const sint16 speed_arr2[253] = {38,38,38,90,90,90,38,38,38#define #definepang123hui的博客:博客园/pang123hui/ CSDN/pang123hui/。
飞思卡尔智能车
飞思卡尔智能车控制系统硬件设计硬件部分:电机舵机传感器车模电机:主要作用是产生驱动转矩,作为小车的动力源。
舵机:能够转舵并保持舵位的装置,也就是让小车拐弯的装置。
传感器:能感受规定的被测量并按照一定的规律转换成可用输出信号的器件或装置,在智能车中,最重要的传感器就是摄像头。
车模:智能车车架,包括底板、齿轮、车轮、电池等等。
主要内容:•MCU最小系统设计•电机及舵机驱动电路设计•光电检测电路原理与设计•图像检测原理与设计1.控制系统的构成一般控制系统由传感器、控制器和执行器组成。
智能车中主要体现:光电器件或器件构成的寻线传感器。
用于操纵小车行走和转向的执行器。
根据传感器信息控制执行器动作的控制器。
三者之间的关系可用如下的关系图描述:飞思卡尔杯规定了比赛用车模、控制器所使用的MCU、执行器、传感器的数量等,比赛中硬件设计所涉及的主要工作是:•设计可靠的MCU控制电路;•执行器驱动电路;•传感器电路;(进行硬件设计的工具很多,建议使用Protel99SE,该软件易上手、效率高,可满足一般电路设计要求。
)MC9S12DG128 的封装2 .MCU最小系统设计MCU最小系统设计分为供电系统设计、复位系统设计、时钟电路设计、BDM调试接口设计、串口通讯设计。
2.1 MCU供电系统设计MCU正常工作需要合理供电,为获取良好的抗干扰能力,电源设计很重要。
针对此次比赛使用的电池和MCU,在供电系统设计中要充分考虑以下因素的影响:1.系统供电电源为7.2V镍氢电池组,不能直接为MCU及其它TTL电路供电。
2.为保证较高的行驶速度,驱动电机需使用电池组直接驱动,故电源电压波动较大。
3.转向用舵机工作电压为5V,其启动电流较大,如与MCU共用5V电源,会引入较大的干扰。
4.采用三端稳压器7805存在效率低、抗干扰能力差的缺点。
采用三端稳压器的电源设计:升降压开关稳压电路•MCU供电飞思卡尔S12系列单片机采用了若干组电源,必须很好的对这些供电电源进行良好的滤波,才能设计出抗干扰能力强的控制器。
飞思卡尔光电组套件智能车XS128K60介绍
此智能车模,配套的电机型号为RN260-CN-2875。智能车的控制采用的是双后轮驱动方案。智能车的外形大致如下:
智能汽车外形图
2.2
车模中的传感器包括有:速度传感器,车模姿态传感器(陀螺仪、加速度计)以及线形CCD。下面分别介绍这些传感器的安装。
2.2.1
速度编码器我们采用了编码器,安装方法如下:
为了保护模型车传感器支架,在车模机械设计的时候,增添了防撞保护装置,使一旦车模倾倒或者失控,防撞保护装置可保护车模机械的安全性,保证小车状态的稳定性。
飞思卡尔光电组套件智能车XS128 K60介绍
智能汽车外形图
第一章
智能汽车系统总体设计思路,后面将整个系统分为机械结构、控制模块、控制算法等三部分对智能汽车控制系统进行深入的介绍。光电组用了线性ccd,但是由于需要镜头成像,所以会带来成像失真,静电干扰严重等问题。由于平衡车的特殊性,车身在循迹前进的过程中,必须保持车身的平衡。根据最基本保持车身平衡的基本原理,需要知道车身当前的角度和角速度。因此在保持车身平衡方面,以加速度计作为角度传感器,陀螺仪作为角速度传感器。
用十字扳手套筒将车的后轮拆卸后,安装编码器,固定编码器的固定件是根据
车得尺寸及与编码器的相对位置手工制作的连接固定件。
在安装完后轮后,在利用十字扳手套筒将后轮装上。
安装时应注意调整好齿轮间隙。齿轮传动机构对车模的驱动能力有很大的影响。齿轮传动部分安装位置的不恰当,会大大增加电机驱动后轮的负载,会严重影响最终成绩。调整的原则是:两传动齿轮轴保持平行, 齿轮间的配合间隙要合适,过松容易打坏齿轮,过紧又会增加传动阻力,浪费动力;传动部分要轻松、顺畅,不能有迟滞或周期性振动的现象。判断齿轮传动是否良好的依据是,听一下电机带动后轮空转时的声音。声音刺耳响亮,说明齿轮间的配合间隙过大,传动中有撞齿现象;声音闷而且有迟滞,则说明齿轮间的配合间隙过小,或者两齿轮轴不平行,电机负载变大。调整好的齿轮传动噪音很小,并且不会有碰撞类的杂音,后轮减速齿轮机构就基本上调整好了,动力传递十分流畅。如图所示。
飞思卡尔智能车培训之硬件篇概要
电机驱动
电机驱动
电机驱动——NMOS方案
电机驱动——BTN7971半桥
实物图
Байду номын сангаас
内部原理
电机驱动——BTN7971方案
电机驱动——驱动隔离
为什么要隔离?
电机是电感性器件,电流不容易轻易改变,当电机反转或者频 繁地启动停止时会产生反向电动势,这个反向电动势很大,一般有 电源电压的几倍甚至几十倍,如果对这个电压经过隔离,一旦反串 到单片机就会直接烧坏单片机。
电机驱动——驱动隔离
缓冲器74LS244
相当于一个缓冲池, 可以一定程度上隔离反 向电动势。
电机测速
通过检测脉冲数计算转速
将测得的转速 与设定值比较 调整,得到想 要的转速值。
电池
参数:
•电压:1.2×6=7.2 v •容量:2000mAh
放电曲线(在3A的大电流放电条件下得到的结果)
电源管理——电池使用注意事项
怎么隔离?
1、光耦隔离
2、用缓冲器74LS244隔离
电机驱动——驱动隔离
光耦隔离原理:
光耦隔离就是采用光耦合器进行隔离,光耦合器的结构相当于把发 光二极管和光敏(三极)管封装在一起。发光二极管把输入的电信号转换 为光信号传给光敏管转换为电信号输出,由于没有直接的电气连接,这 样既耦合传输了信号,又有隔离作用。
用个显示屏显示数据,建议:OLED12864
留几个按键用于调整参数和启动
用单片机AD口读取电位器电压值,方便参
数的调整 留出多余的接口
布线建议:
注意电源部分电源线和地线要加粗,不小
于40mil。 电机驱动模块信号和电源地分开,可以顶 层走信号线,底层走电源线,电源线和地 线同样要加粗,由于电机电流大,至少 100mil。 其他布线要尽量短,避免干扰。
飞思卡尔DSC电机控制产品方案介绍 - 告别C2000
• •
• •
TM
External Use
2
飞思卡尔电机控制的多种选择 飞思卡尔电机控制的多种选择
Production Planning
New 90nm
TM
External Use
7
Freescale DSC兼容性
56F84789/786 /587/585
256
128
56F84763 /462 56F84550 /451 56F84540 /441 56F82743 56F8255 56F8256 56F82746 56F8246 56F82736 56F82726 56F82316 44LQFP 48LQFP 64LQFP 56F84553 /452 56F84543 /442 56F8257 56F82748 56F8247 56F82738 56F82728
GPIO
DMA 增加处理器的吞吐量, 使得控制算法更高效
输入分主和次,功能有: 边沿,窗口,正交,带 符号,触发,级联,捕 获,比较
TM
External Use
6
Freescale DSC Roadmap
-成本与性能优化 …. 高级控制环算法 苛刻的实时应用 - 包括 高级电机控制 太阳能逆变 更多………..
56800E V3 Core 100MHz
JTAG/EOnCE
PLL
OSC 8Mhz / 32KHz 2 x PIT (RTC) Inter-Module CrossBar
飞思卡尔智能车S12XS128PWM控制程序编写
飞思卡尔智能车S12XS128PWM控制程序编写SeptStringS原创,转载请注明。
对于飞思卡尔智能车,电机和舵机的控制通常使⽤的都是以PWM脉冲宽度调制的⽅法实现的,其可⾏性基于电机可以由占空⽐控制转速,⽽舵机也由脉宽控制摆动。
PWM 调制波有 8 个输出通道,每⼀个输出通道都可以独⽴的进⾏输出。
每⼀个输出通道都有⼀个精确的计数器(计算脉冲的个数),⼀个周期控制寄存器和两个可供选择的时钟源。
每⼀个 PWM 输出通道都能调制出占空⽐从 0—100% 变化的波形。
PWM控制程序的编写⼀般按照以下的⼀种流程:1,禁⽌PWM模块;//这是由于改变周期和脉宽等操作需要在PWM禁⽌的情况下才能被设置2,PWM级联选择,是否级联通道67,45,23,01;//最多单独使⽤8个8位和级联使⽤4个16位3,给通道选择时钟源控制位;//0,1,4,5通道可选择ClockA和ClockSA;2,3,6,7通道可选择ClockB和ClockSB4,给时钟源A\B预分频;//可对总线时钟进⾏预分频,确定ClockA和ClockB,满⾜1,2,4,8,16,32,64,128这8个分频量5,根据时钟源A\B确定时钟源SA\SB;//由ClockA和ClockB、分频设值来确定ClockA和ClockB,满⾜1-255的分频量6,输出极性的选择;//也就是选择输出极性先低后⾼还是先⾼后低7,对齐⽅式的选择;//可设置为左对齐或者中间对齐⽅式8,实际通道频率的计算;//也就是周期的设定9,占空⽐寄存器的设置;//占空⽐常数的设定,可以以此决定占空⽐10,使能PWM模块。
//你已经⾸尾呼应了,有⽊有接下来通过寄存器的介绍,以上⾯流程为⼤纲,详细地说明⼀下该如何操作~~【PWME】寄存器PWME = (PWME~7 | PWME~6 | PWME~5 | PWME~4 | PWME~3 | PWME~2 | PWME~1 | PWME~0)将每⼀位设置为1即可使能该位,0对应的既是禁⽌。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
3.1.6驱动电机介绍
驱动电机采用直流伺服电机,我们在此选用的是RS-380SH型号的伺服电机,这是因为直流伺服电机具有优良的速度控制性能,它输出较大的转矩,直接拖动负载运行,同时它又受控制信号的直接控制进行转速调节。
在很多方面有优越性,具体来说,它具有以下优点:
(1)具有较大的转矩,以克服传动装置的摩擦转矩和负载转矩。
(2)调速范围宽,高精度,机械特性及调节特性线性好,且运行速度平稳。
(3)具有快速响应能力,可以适应复杂的速度变化。
(4)电机的负载特性硬,有较大的过载能力,确保运行速度不受负载冲击的
影响。
(5)可以长时间地处于停转状态而不会烧毁电机,一般电机不能长时间运行于
停转状态,电机长时间停转时,稳定温升不超过允许值时输出的最大堵转转矩称为连续堵转转矩,相应的电枢电流为连续堵转电流。
图3.1为该伺服电机的结构图。
图3.2是此伺服电机的性能曲线。
图3.1 伺服电机的结构图
图3.2 伺服电机的性能曲线
3.1.7 舵机介绍
舵机是一种位置伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。
其工作原理是:控制信号由接收机的通道进入信号调制芯片,获得直流偏置电压。
它内部有一个基准电路,产生周期为20ms,宽度为1.5ms的基准信号,将获得的直流偏置电压与电位器的电压比较,获得电压差输出。
最后,电压差的正负输出到电机驱动芯片决定电机的正反转。
当电机转速一定时,通过级联减速齿轮带动电位器旋转,使得电压差为0,电机停止转动。
舵机的控制信号是PWM信号,利用占空比的变化改变舵机的位置。
一般舵机的控制要求如图3.3所示。
图3.4为舵机的控制线。
图3.3 舵机控制要求
图3.4 舵机的控制线
控制线输入一个周期性的正向脉冲信号,这个周期性脉冲信号的高电平时间通常在1ms-2ms之间。
而低电平时间应在5ms到20ms间,并不很严格。
下表3.3表示出一个典型的20ms周期性脉冲的正脉冲宽度与微型伺服马达的输出臂的位置的关系:
表3.3脉冲宽度与舵机位置表
考虑到舵机安装的位置与舵机的响应速度有关,在设计中我把舵机安装在较高的位置,使转向拉杆加长,使得在舵机转动相同的角度时前轮(即方向轮)转动的角度加大,转向灵敏。
3.1.1 速度控制系统建模
控制系统的数学模型在控制系统的研究中有着相当重要的地位,要对系统进行仿真处理,首先需要知道系统的数学模型,而后才有可能对系统进行模拟。
速度控制系统的数学模型中最主要的部分就是直流电机的数学模型,下面首先着重对电机数学模型的建立进行论述,然后对系统其他部分数学模型作简单说明。
1. 直流电机的数学模型
本系统所使用的直流电机为大赛主委会统一规定的RS380-ST/3545型电机。
直流电机的物理模型如图3.2所示。
图3.2 直流电机的物理模型
图中所示参数的意义如下:
u a —电枢输入电压(V) Ra —电枢电阻(欧) La —电枢电感(H) E —感应电动势(V) Te —电机电磁转矩 (N ·m) J —转动惯量(kg ·㎡) B —粘性阻尼系数(N ·m ·s) i a —流过电枢的电流(A) w —电机输出的转角(rad/s )
根据基尔霍夫定律和牛顿第二定律对图3.2所示的直流电机列基本方程:
()
()()a a a a a a di t u t R i t L E dt
=++
e dw T J Bw dt
=+
a e E K w =
e T a T K I =
式中:K T 为电机的转矩常数(N ·m)A ;K e 为感应电动势常数(V ·S)rad 。
对公式3.1进行拉普拉斯变换,得:
()()()(
)a a a a a a U s R I s L sI s E s =++
()()()e T s Js s B s =Ω+Ω ()()a e E s K s =Ω ()()e T a T s K I s =
根据公式3.2,消去中间变量,可以求出永磁直流电动机的速度传递函数为:
2
()()()T
a a a a e T a s K U s L Js L B R J s K K R B Ω=++++ (公式3.3)
由公式3.3作出直流电机的框图如图3.3所示。
(公式3.1) (公式3.2)
图3.3 直流电机框图
图3.3中的e τ为电气时间常数,/e a a L R τ=。
为建立直流电机的数学模型,需要求的参数有电枢电阻a R 、电枢电感a L 、转矩常数T K 、阻尼系数B ,反电动势系数Ke 和总转动惯量J ,其中M L J J J =+,M J 为电动机转子的转动惯量,L J 为折合到电动机轴上的负载转动惯量。
为求得以上参数值,先给出电机RS380-ST/3545的技术指标(电压值为7.2V 常值),如表3.1所示。
表3.1 RS380-ST/3545技术指标
(1) 电枢电阻a R
由直流电机的稳态电压方程式:a a a a U E I R =+,两边都乘以a I 得
2
a a a a a a U I E I I R =+
(公式
3.4) 上式可以改写成
1M Cua P P p =+ (公式
3.5)
式中,1a a P U I =是从电源的输入电功率,M a a P E I =是电磁功率,转化为机械功率
e P T ωΩ=,2
Cua a a
p I R =是电枢回路总的铜损耗。
由表3.1中的最大功率栏可知,1a a P U I ==7.2V*8.61A=62W ,M P =26.68W ,
a I =8.61A ,因此a R =(62-26.68)/8.612
欧=0.476 欧。
(2) 电枢电感a L
使用万用表的电感档测得直流电机的电枢电感a L =0.2mH 。
则电气时间常数
/e a a L R τ==0.00042s 。
(3) 转矩常数T K
由于e T a T K I =,当a I =8.61A 时,e T =340 g ·cm=3.332×10-2N ·m ,则转矩常数
/T e a K T I ==3.332×10-2/8.61 N ·m/A=3.87×10-3
N ·m/A 。
(4) 阻尼系数B
由于e T a T K I B ω==,当e T =340 g ·cm=3.332×10-2N ·m 时,76502/60ωπ=⨯ rad/s=800.7 rad/s,所以阻尼系数/e B T =Ω=4.16×10-5N ·m/(rad ·s -1)。
(5) 反电动势系数Ke
由于直流电机在最大功率时,M a a P E I ==26.68W ,a I =8.61A ,则
a E =26.68/8.61V=3.1V 。
又由于a e E K w =,且76502/60ωπ=⨯rad/s=800.7rad/s ,所以计算得反电动势系数Ke =0.004V/(rad ·s -1)。
(6) 转动惯量J
由前可知,M L J J J =+,下面首先介绍直流电机转子转动惯量M J 的测量方法。
通过查阅相关资料,本系统采用了落重法测量M J ,如图3.3所示,将直流电机置于一高台上,轴端伸出台外在轴端上固定一个轻度圆盘,圆盘上绕数圈细绳,绳的一端悬挂一个已知质量的重物,另一端固定在圆盘上,然后让重物落下,记录重物数次落下所需时间,算出平均值t 。
按下式求取转子的转动惯量。
2
212M gt J mr h ⎛⎫=- ⎪⎝⎭
(公式
3.6)
图3.3 落重法测转动惯量
式中 M J ——转子的转动惯量,kg ·m 2
m —— 悬挂重物的质量,kg r —— 圆盘上缠绕细绳处的半径,m h —— 重物下降高度,m g —— 重力加速度,m/s 2
t —— 重物下降h 高度所需时间,s
本测试系统取h=0.8m ,m=40g=0.04kg ,r=3.9mm=0.0039m ,g=9.8 m/s 2,实验中测得的时间如表3.2所示。
由表求得平均时间t=0.85s ,因此由公式3.6求得直流电机转子转动惯量M J =2.08×10-6kg ·m 2。
表3.2 测试时间
下面求折合到电动机轴上的负载转动惯量L J ,由于智能车是沿着直线运动的,所以采用计算公式是物体沿直线运动时的折算转动惯量公式:
()2
2L J m L π= (公式3.7)
式中 L J ——智能车沿直线运动时的折算转动惯量,kg ·m 2 m ——智能车的质量,kg
L ——直流电机每转一转时智能车沿运动方向移动过的距离,m
智能车质量m =1.2kg ,L =0.037m ,计算得L J =4.2×10-5kg ·m 2。
所以总转动惯量M L J J J =+=4.4×10-5kg ·m 2。