DSP在平行双轮电动车控制系统中的应用.docx

《DSP在平行双轮电动车控制系统中的应用.docx》由会员分享，可在线阅读，更多相关《DSP在平行双轮电动车控制系统中的应用.docx（8页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、DSP在平行双轮电动车控制系统中的应用zhangting导语：2001年，美国创造家Kamen创造了一种新型的方便快捷的两轮交通工具“Segway，行走平衡控制技术成为全球机器人控制技术的研究热门。1、引言2001年，美国创造家Kamen创造了一种新型的方便快捷的两轮交通工具“Segway，行走平衡控制技术成为全球机器人控制技术的研究热门。以平行双轮电动车作为挪动平台为机器人的研究提供了技术支持，同时由于他的行为与火箭飞行和两足机器人有很大的相似性，因此对其运动平衡控制研究具有重大的理论和实际意义。文献2介绍了平行双轮电动车的控制器电路，以C8051F020单片机为控制核心通过调整车体平台的运

2、行位置，进而使车体平台始终保持平衡状态。然而其并没有考虑载人、载物的因素以及转向和特殊路面、打滑等方面。再者，作为一种交通工具，由于没有考虑初始自平衡的设计，将会给以后的产业化进程提出新的挑战。因此需要寻找控制方法、原理均不同的其他控制理论来设计，如模糊控制、智能控制等。一般的单片或者多片微处理器不能知足复杂、先进的控制算法时，DSP成为这种应用场合的首选器件。TI公司推出的面向运动控制、电动机控制的TMS320x24xx系例DSP控制器，把一个16位的定点DSP核和用于控制的外设、大容量的片上存储器集成在单一芯片上，可以实现软件包括电动机状态值的采样与计算，控制算法的施行以及PWM信号的输出

3、，此外还包括故障检测与保护、数据交换与通讯等。与单片机相比，在电机控制系统设计中，采用TMS320LF2407A具有更有效的控制才能，进而减小整个系统的本钱。2、平行双轮电动车的组成平行双轮电动车像倒立摆一样本身不能自然保持稳定，必须施加适当的手段才能使之稳定。他主要由车体平台，两只带光电编码器的小型无刷直流电机，左、右车轮和只有在静止状态才起作用的两只保护导向轮组成。两只无刷直流电机安装在车体平台的下面，通过齿轮减速机构分别独立驱动左、右车轮运动，具有尺寸小、操纵灵敏、节省能源等优点。平行双轮电动车的行走机构如图1所示，是一种两轮同轴左右平行布置、独立驱动的构造，其行走机构控制的关键是两轮行

4、走机构在行走经过中的平衡控制。平行双轮电动车行走机构要求具有如下优点：1可以实现零半径转弯，具有极强的灵敏性。由于只有两个轮子，因此构造尺寸可以做得较小，转弯时占用的空间也相对较小。这一特点使他适用在狭窄和挪动中需经常转弯的空间如仓库等。2三轮或者四轮车辆在爬坡时重心会发生倾斜，因此对坡度有限制。平行双轮电动车在爬坡时上体姿态和走平路时一样，重心不发生倾斜，所以平行双轮电动车可适应更大的爬坡的坡度。3、TMS320LF2407ATI公司的DSP产品TMS320LF2407A对电机的数字化控制非常有用。他将几种先进外设集成在芯片内，以形成真正的单芯片控制器，进而将DSP的高速运算才能与面向电机的

5、高效控制才能集于一体，是目前最具竞争力的数字电机控制器。TMS320LF2407A主要特点：1采用高性能静态CMOS技术，使得供电电压降为3.3V，减小了控制器的功耗；30MIPS的执行速度使得指令周期缩短到33ns30MHz，进而进步了控制器的实时控制才能。2片内有高达32kB的FLASH程序存储器，高达1.5kB的数据程序RAM，544B双口RAMDARAM和2kB的单口RAMSARAM。3两个事件治理器模块EVA和EVB，分别提供两个16位通用定时器；8个16位的脉宽调制PWM通道；3个捕捉单元；10位的16通道AD转换器。他们可以实现：三相反相器控制；PWM的对称和非对称波形的输出；当

6、外部引脚PDPINTx出现低电平时快速关闭PWM通道；可编程的PWM死区控制以防止上下桥臂同时输出触发脉冲；片内光电编码器接口电路用于对光电编码器信号进展正反向计数。时间治理器模块适用于控制沟通感应电机、无刷直流电机、开关磁阻电机、步进电机、多级电机和逆变器。4、无刷直流电动机的DSP控制策略图2是三相无刷直流电动机调速控制框图。给定转速与速度反应量形成偏向，经速度调节后产生电流参考值，他与电流反应量的偏向经电流调节后控制PWM脉冲的占空比，实现电动机的速度控制。电流的反应是通过测量电阻的压降来实现，速度反应那么是通过霍尔位置传感器输出的位置量，经过计算得到的。位置传感器输出的位置还用于控制换

7、相。5、平行双轮电动车的控制原理以TMS320LF2407A为控制核心的运动控制器，根据光电编码器和姿态传感器检测到的平台运行的位移和姿态信号，通过一定的控制策略计算出控制量，再经PWM控制及驱动器放大后驱动无刷直流电动机运转，随时调整车体平台的运行速度，进而使车体平台始终保持平衡状态。控制器电路主要由TMS320LF2407A、电机驱动芯片、电池模块以及外围电路组成。其控制电路原理框图如图3所示。采用微硅陀螺仪和倾角传感器的组合构成姿态传感器来检测车体平台的运行姿态。其中，微硅陀螺仪检测的是平台绕转动轮轴转动的角速率，倾角传感器检测的是平台相对于程度面的倾角。控制板收集来自倾角和角速度传感器

8、的信号并对信号进展调理消波、整形、偏移，然后将信号传送到TMS320LF2407A的ADCIN00和ADCIN01通道中，经过DSP的运算处理控制算法由电动车系统的数学模型推导而出，通过DSP的两路PWM将控制信号发出，再经过电机驱动模块驱动电机运转，控制小车保持平衡状态。6、检测电路的工作原理考虑到来自输入的噪声干扰等因素，要对传感器的输出电压进展调理。一样的输入电路共有8路1路为倾角传感器输入电路；1路为角速度传感器输入电路；1路为小车驾驶者的转弯信号输入保存功能；1路为电池电量检测；其余4路为预留电路，下面仅就其中1路加以讲明。电路图如图4所示。其中U4C为多端输入的电压并联负反应电路，

9、假设偏置电压与传感器输入电压分别为V1，V2，那么：由此得：这里取R31=R15=R16，所以有V8=-V1+V2，即：根本运算电路中的反相加法电路。然后将其输出电压V8再经过反向放大器U4D进展放大，调节W18使输出为02.4V，其中D15与D16为过电压保护电路。图5为偏置电压产生电路，VREF1P，VREF1N为图4中的偏置电压的输入端，由于偏置电压值要求比拟高，所以选用TL074对CPUREF这个精度比拟高的电压进展放大来提供。7、软件设计软件设计框图如图6所示，包括初始化局部、数据处理和转换局部、闭环控制算法以及控制量输出局部等。初始化程序设置用户要求的变量和系统初始状态，主要完成设

10、置系统存放器初值、建立中断、外围局部初始化的工作。数据处理和转换局部完成对输入信号进展数据收集并进展平滑滤波处理。闭环控制算法根据闭环极点配置算法进展编程。8、行走仿真经过对控制参数的屡次调整，样车终于可以比拟平稳的行走。样车在平衡状态下速度初始值为零收集到有关数据，通过软件处理后生成样车在直线行走时的速度变化折线图，如图7所示。样车平台绕轮轴的倾角变化折线图如图8所示。由图7可以看出，速度曲线首先从零点向正方向变化，且变化的速度很快，然后很快下降到零点，在零点保持一段时间后，速度曲线又很快向负方向变化，然后迅速变化到零点，保持一段时间后，速度曲线重新开场新的一个变化周期。对应于样车，即样车向

11、一个方向很快运动，然后迅速停顿，保持一定时间后，又向另一个方向很快运动，然后迅速停顿，保持一定时间后，再开场一个新的运动周期。由图8可以看出，倾角首先从零点上升到最大点，然后下降到最低点，再从最低点上升到最高点，如此周而复始，其最高点和最低点倾角绝对数值都比拟小。从速度、倾角变化折线图可以看出：样车在保持平衡状态下，其直线行走的速度在一个比拟窄的范围内绕零点周期性地变动，也就是讲，样车在有规律地做往返振荡运动；样车绕轮轴的倾角围绕零点在一个较小的范围内做有规律的波动。从上面的变化规律可以看出，样车处于一个动平衡的状态，因此可以得出这样的结论：控制系统的建模和控制器的设计是公道有效的，完全可以通过一系列的控制手段，较好地实现平行双轮电动车的行走。9、结语本文针对平行双轮电动车的技术要求和详细特点，以美国TI公司消费的TMS320LF2407A作为控制核心，将DSP芯片运用于平行双轮电动车的控制系统设计中，可以实现硬件体积小、系统抗干扰才能强、响应速度快、控制方案灵敏等特点。对其后续的研究工作，如电机的控制可以引入多种控制策略，以求得到更好的控制性能、精度和转矩的平稳性，具有深远的意义。0