澳诺吧 关注:24贴子:3,705
  • 9回复贴,共1

小型舞蹈机器人的驱动系统设计

只看楼主收藏回复

摘要:介绍了某型舞蹈机器人驱动系统的硬件设计过程,讨论了该系统中驱动信号的隔离以及驱动器件的选择原则,同时给出了舵机驱动、直流电机驱动以及稳压二极管并联型稳压电路的设计方法。 关键词:L298N;舵机;直流电机;隔离;并联型稳压 机器人舞蹈比赛是一项具有极强观赏性和趣味性的比赛。比赛规则要求参赛机器人在有限的场地和时间内,配合音乐完成动作。由于要求机器人既要充分利用场地,又不能超时和越界,因此,舞蹈机器人集成了多学科前沿技术,它的设计涉及了机电一体化技术、检测和传感技术、精密机械加工和精密机械传动技术、现代化控制技术和管理技术、计算机程序控制技术等多个方面。 舞蹈机器人之所以能完成各种流畅的动作,在于它身体各运动部位都装有相应的动力源(驱动电机)。目前在舞蹈机器人中常用的电机有三类:直流电机、舵机和步进电机。其中直流电机功耗低、力矩大,通常用于闭环控制系统;舵机控制精确、力矩较小;步进电机控制精确、功耗较大、力矩较小,通常用在开环控制系统。根据上述比赛规则要求,本文介绍的机器人选用了直流电机和舵机两类电机,文中重点讲述了这两类电机驱动系统的设计方法。


1楼2018-03-23 09:57回复
    1 系统构成 系统中,直流电机共有四路,分别用于机器人底盘、头部的转动以及身体的升降,舵机有两路,用于花瓣打开。本设计从实际出发对不同电机采取了不同的驱动方式。舵机驱动电流仅十几微安,可以直接使用单片机端口进行驱动,而直流电机工作电流较大,瞬态电流接近1A,因此需要采用专用电机驱动芯片。此外由于采用了3V与7V两种规格的直流电机,其中7V直流电机驱动信号直接采用驱动芯片输出,3V直流电机则需对驱动芯片输出作降压处理,因此,控制芯片选用了Atmel公司的AT89C52单片机。图1是本驱动系统的原理框图。


    2楼2018-03-23 09:58
    回复
      2 主要模块的硬件设计 本驱动系统主要由信号隔离模块、舵机驱动模块、直流电机驱动芯片和降压模块等部分组成。 2.1 信号隔离模块 常见的信号隔离方法有光电耦合和变压器隔离等,本系统采用光电耦合方式对电机控制信号进行隔离,以消除模拟信号对数字信号的干扰。使用的光耦型号为TLP521-2及TLP521-4。信号隔离最重要的一点就是将数字与模拟或强电与弱电部分在供电上要完全隔开,否则就不能达到真正意义上的隔离。实际中,光耦两侧使用了两组不同的电源。本系统需要隔离的信号为舵机控制信号、直流电机启停信号及其正/反转信号。其实现电路如图2所示。图中,VCC为光耦前的数字电路电源,VCC1是光耦后的数字电路电源,GND1是模拟地。


      3楼2018-03-23 09:58
      回复
        2.2 驱动模块 本系统有四路直流电机和两路舵机,由于两者的工作电流相差较大,故在硬件上将两者独立。 图2 由于舵机自身带电源(VCC)和地(GND)引脚,对其驱动只需给出控制信号即可,故可直接用单片机的端口作控制信号线,因而硬件十分简单,设计时只要通过P0.0和P0.1用光耦隔离输出便可直接控制两路舵机,图2中的521-2即用于实现这部分功能。 本系统共有四路直流电机,其中三路采用7V供电,一路采用3V供电,因而工作电流较大,瞬时值可达1A以上,为此,设计中选用了SGS公司的L298系列芯片来完成驱动。L298比较常见的是15脚Multi-watt封装的L298N,该芯片的额定工作电流为2A,内部包含4通道逻辑驱动电路,即一片可带两路直流电机,故该系统中使用了两片L298N。 图3是两路电机的驱动电路,为了节约单片机的端口资源,每路直流电机的正/反转信号控制线均通过一个反相器共用一条单片机口线。


        4楼2018-03-23 09:58
        回复
          2.3 稳压模块 由于本系统中3V直流电机的工作电流约为800mA,为了简化设计,降低成本,可以考虑直接使用L298N来驱动,而L298N的输出电压约为VDD系统中为+6V,因此必须将其降至3V才能直接驱动3V直流电机。本系统仅要求此直流电机单向转动,故可采用稳压二极管进行稳压处理。利用稳压二极管进行稳压时,多采用并联型稳压方式。


          5楼2018-03-23 09:58
          回复
            3 结束语 本系统是专为某型舞蹈机器人设计的,因此,软件的工作大部分是通过发送各种指令来驱动相应的电机以使其转动,从而实现预定编排的舞蹈动作。直流电机、舵机的控制均采用PWM方式,软件设计本文不作详解。 本系统在实际应用中具有可靠性高、控制到位、抗干扰性强的特点,由其构成的舞蹈机器人曾在全国舞蹈机器人大赛中一举夺冠。


            6楼2018-03-23 09:58
            回复
              线阵CCD测径系统电路设计
              在生产实际中,许多场合需要对一维尺寸进行测量,例如对带、管、条等的测。采取传统的先加工后测量的方法,劳动强度大,信息反馈慢,直接影响了线材的质量和生产效益。因此,必须有一套高精度的实时在线检测系统,一方面可使生产人员及时了解线径的大小及偏差,一方面给生产机构伺服系统提供正比于偏差的反馈量,实现反馈控制。 本课题研制了一套用线阵CCD对线材直径进行非接触实时测量的系统,可应用于工业生产中。


              7楼2018-03-23 09:59
              回复
                1 CCD电荷的产生、转移原理 CCD是由一系列排得很紧密的MOS电容器组成,每一个光敏像元就是一个MOS电容器。它的突出特点是以电荷用为信号,实现电荷的存储和电荷的转移。 1.1 CCD光电转换 当在MOS电容器的栅极上加上一个小的正电压时,半导体中的自由空穴被排斥到远离栅极的一边,在SiO2的表面下形成一层电子的耗尽区,当栅压继续增加,耗尽层将进一步向半导体内延伸,这一耗尽层对于带负电荷的电子而言是一个势能特别低的区域,因此也叫做势阱[1]。正栅压进一步增加,在界面上的电子层形成反型层。 当光入射到耗尽区时,因内光电效应将产生电子-空穴对(硅吸能量释放价电子,形成电子-空穴对),在耗尽区电场作用下,空穴流入衬底部,电子则积存于半导体表面,这样势阱中就积存了一定量的电荷,且势阱中积存的电荷量入射光强度成正比(CCD饱和的情况除外)。 1.2 CCD像素输出 CCD信号电荷的传输是通过控制各个像素上的电极电压,电荷就会从电压低的电极转移到电压高的电极下,使信号电荷随着电极电压的周期性变化在半导体表面或者体内做定向运动。 线阵CCD电荷包只单方向传递,每一个扫描周期,所有像素都沿着电极相继传递,进行像素的水平移动,直到所有像素全部输出。


                8楼2018-03-23 09:59
                回复
                  2 线阵CCD没径系统硬件设计 本测径系统具有以下特点: (1)采用CCD为EG%26;amp;G RETICON公司的RL512EC/17线阵传感器芯片; (2)采用高集成度的XC9572PC44芯片产生系统所需的驱动和控制时序逻辑; (3)由外部PC机编程实现对CCD积分、时间、大小和数据采集工作过程的控制; (4)应用了内带采样保持的8位高速并行输出A/D芯片TLC5510进行模数转换; (5)通过计算机串口实现对数据信息的传输。 系统结构原理框图如图1所示。系统具体的工作过程:由CPLD产生CCD传感器所需的工作时序,再经时钟驱动电路产生时序和偏置都满足CCD要求的信号,驱动CCD输出模拟视频信号;该信号经放大、A/D转换得到8位数字信号存储于CPLD中,再经芯片NS216C552和MAX202转换为串行数据,输入计算机进行显示。 CPLD芯片内部分为两部分:一部分是视频信号处理控制时序发生器,它提供CCD视频信号处理(如A/D转换、数字信号存取等)所需的各种同步控制时序;另一部分是CCD驱动时序发生器。 2.1时序信号发生电路 本文采用的CCD传感器为EG%26;amp;G RETICON公司的RL512EC/17线性传感器,具有512个有效像素,像素信号输出方式为串行视频输出。该传感器具有高分辨率、高灵敏度、低噪声、低功耗的特点,最大扫描频率10MHz。 RL512EC/17各驳动信号及输出信号时序如图2所示。 驱动CCD所需的信号由CPLD编程产生,本系统采用一片XC9572PC44F芯片实现时序发生器的功能。该系列芯片是Xilinx公司典型的可通过JTAG在线编程的CPLD器件[3]。 首先由CPLD产生符合时序要求的初始驱动信号TTL clk和TTL start,这两路信号必须经后面的偏置电路处理后才能得到最终的驱动信号s、φ1、2φ。因为TTL clk和TTL start均为TTL电平,低电平0V,高电平+5V,而CCD要求的驱动信号为低电平-7V,高电平+5V,必须进行电平转换:TTL start信号驱动三极管,该三极管发射极和集电极分别接+5V和-8V,得到CCD所需的高电平+5V,低电平-7V的开始信号s;同时TTL clk经74LS74触发的两路反相时钟通过DS0026芯片变换为高电平+5V、低电平-7V的两路时钟信号φ1、2φ。DS0026专用电平转换芯片,输出电平与外接电压电平一致,高低压差最大20V[4]。 直接驱动RL512EC/17的信号共有三个:开始信号s,互为反相的两路时钟信号φ1、2φ。开始信号s为低电平的时间就是传感器的曝光时间,由软件编程控制。S为高电平时进行电荷转移,此时每一个φ1、2φ周期CCD就向外电路输出一个像素,该像素值就是图2中的VIDEO信号。所有像素移出后,EOS信号输出一个低脉冲,该信号用于测试。 s脉冲用来初始化每一次扫描,两次s负脉冲之间的间隔就是一次扫描的时间tL,该时间必须满足(N+2)/?≤tL≤40ms,其中?s为扫描频率,N为像素数512。不大于40ms是为了保证积累的暗泄漏电荷不超过输出信号饱和值的1%(CCD输出电荷 的饱和值为4pC,泄漏电荷在室瀑下为1pA,经40ms积累得到0.04pC的泄漏电荷)。本文采用?s=2.5MHz,tL=40μs。 2.2视频信号放大、采样电路 CCD输出的视频模拟信号比较微弱,必需经过放大后才能进行A/D转换。由于CCD输出的信号电压为负值,在放大的同时要将其转换为正值,因此笔者将运算放大电路设计为反相放大的形式。另外,该CCD为电流输出,运放反相端的接地电阻必须较大,否则CCD输出的微弱电流将不会引起电压的明显变化。本系统采用的CCD要求运算放大器在扫描频率(本文为2.5MHz)时的闭环增益至少为40dB。在电路设计中,选 用了AD8009运算放大器[5]。 放大后的模拟信号必须进行模/数转换才能进行下一步的存储、显示。在该系统的设计中,选用8位高速并行的A/D芯片TLC5510完成A/D转换工作[6],其内部自带采样保持电路,这在一定程度上简化了外围电路的设计。TLC5510的转换速率(20MHz)完全可以满足CCD(2.5MHz)的工作要求。A/D转换的时钟信号和使能信号由CPLD产生。采样后的数据存储于CPLD中。


                  9楼2018-03-23 10:00
                  回复
                    2.3 I/O电路 考虑到本文使用的线阵CCD数据量较小、速率较低,采用串口与计算机进行通信能够满足CCD与计算机间的数据通信需要。NS16C552和MAX202芯片组成的串口电路与CPLD连接,将CPLD送出的并行数据转换为串行输出,像素住处便可传送至计算机进行处理、显示。 3 测试结果 在对该系统软硬件设计和测试成功后,将采集到的数据传入计算机,根据这些数据恢复出CCD传感器表面不同位置的亮度。光源分别在CCD遮盖半边、遮盖中间以及从CCD的一侧斜射的情况下照射,将采集的数据进行亮度仿真,具体的仿真结果如图3所示。 仿真结论: (1)仿真结果显示的明暗变化能够准确反映CCD表面的光照情况。 (2)在(a)、(b)两图中,部分与光照部分之间存在亮度过渡区。这是由于CCD本身的感光单元有一定间距,加上照明光源在视场内光强分布的不均匀性,CCD本身的光敏不均匀性(PRUN)、转移损失,以及光源在通过待测目标边缘时的衍射现象等原因,使得CCD输出包络的边缘必然带有明显的梯度。或者说,目标尺寸的两上边缘在CCD上成像的具体位置不可能十分确定,导致CCD输出信号波形在轮廓边缘处有一渐缓的过渡区,而且这一过渡区随着轮郭的视场中位置的变化而变化。 (3)证明了热噪声对CCD性能的影响十分明显。在系统刚通电和长时间通电后分别采集数据,发现长时间通电之后的仿真图像明显叠加了大量黑点,图像较模糊。这是由于CCD的绝大多数噪声来源于热噪声,随着通电时间加长,温度升高,噪声急剧增加。 本系统没有涉及到光学设备,另外CCD的噪声问题本文也没有详细讨论,如热噪声和复位噪声等对系统的性能有很大影响,这些问题的解决是笔者下一步要进行的工作。


                    10楼2018-03-23 10:00
                    回复