登录
首页 » Others » 全向轮运动平台pdf

全向轮运动平台pdf

于 2020-06-06 发布
0 324
下载积分: 1 下载次数: 2

代码说明:

全向轮,全向移动2,3,4轮小车,变换矩阵。设李雅普诺夫函数为V1=;(x2+y2+0)求其导数如下,当渐进稳定时导数小于0Ⅵ1=xx+yy+ade =-kxre, yeke8上式系数为正时,李雅普诺夫函数的导数小于零,系统渐进稳定代入微分方程得到控制律如下:+ vr cos日a+k-xea+ v sin 8e t kyy+ke022差动轮直角坐标运动学方程差动轮与全向轮的区别是,全向轮小车速度方向与四个轮子的共同朝向相同可为仼意方向,而差动轮小车的切向速度方向与X轴重合,故方程中v=0微分方程如下v+v cos 0PRxet vr sin221差动轮直角坐标下控制律设计选择 Lyapunov函数如下:V2=(x2+y2)+(1k(-cosee对上式沿求导+-。sin6e cea-v+ vr cos ee)+yec-xew+ vr sin ge)D sin 0rev+xe vr cos 8e+yevr sin Be+rwr sin 0e -- sin 8 e11-Xev+xevr cos Be year sin 0e +Wrsin eeksinbe选择如下速度控制输入s。+kxxOrt vr(kye t kosine e)将上式代入 Lyapunov函数导数得到esin 2 0当上式系数为正时,V2≤0,故以上 Lyapunov函数选择正确。由此得到堪于运动学模型的轨迹跟踪速度控制律为2:os 8+lcV(kye t resin其中,k,kx,k为控制器参数。22.2控制器参数选取将控制律代入微分方程得下式(rt vr (lye t))xeRyexe(ar+ vr(kye t kesinee))+ vr sin Be-v (kye t kesinee)上式在零点附近线性化,忽略高次项得PR= ApA0Vrky -vr ke系数值与角速度和速度指令值共同决定系统根,当系数为正是所有根为负数。23对比仿真与结果仿真系统结果图如下ct(pea qle)p(7)elrorxPe, qe)图3轨迹跟踪结构图图中q(yo),v、o分别为移动机器人的线速度和角速度,ε1=(xy0)r,对于差动机器人运动学方程可表示为:COS日0Stn图中 J-sine0:pR=y):qa对于全向轮机器人运动学方程可表示为60sine cose ov=R(O)1 vy对角速度为0.2和线速度为5的圆形轨迹进行跟踪,仿真结果如下图:35302501510-5图4圆形轨迹跟踪仿真图图中×点线为差动轮跟踪轨迹,O点线为全向轮跟踪轨迹。、全向轮平台的设计对全向轮采用如下图所示的结构时,进行系统分析与设计图5互补型全向轮( omni wheels31运动学模型X图6全向轮式移动机器人运动学模型移动坐标X-Y固定在机器人重心上,而质心正好位于几何中心上。机器人P点在全局坐标系的位置坐标为:(x2y,0),三个全向轮以3号轮中心转动轴反方向所为机器人的ⅹ轴。假设三个全向轮完全相同,三个全向轮中心到车体中心位置的距离L。在移动坐标X-Y的速度用 1xe 1表示。由文献[3可得三个全间轮的速度与其在移动坐标和全局坐标系下的速度分量之间的关系分别为以下二式sin(60)xeV)=(-s(60os60)()=011-21-213×3ysin(60-0)Cos(60-6)sin(60+6)cos(60+6)Lysinecose32动力学模型在移动坐标X-Y中,设机器人在沿轴X2和Y方向上收到的力分别为Fx和Fyc第1、2、3号驱动轮提供给机器人的驱动力分别为f1、卫、3,机器人惯性转矩为M,根据牛顿第二定律可得到如下的动力学方程:3√3cos(30)-cos(30)01fFre=sin(30) sin (30)1ML2LTb22/2在地理坐标系X一Y下的方程如下:mxcos(30+0)-cos(30-0) sing 1fiFr= sin(30+0)sin(30-0)-cosefzL33基于动力学模型的控制器设计如上式所示,基于机器人动力学模型的控制方案,直接根据机器人的动力学模型设讣运动控制器,控制器的输出为机器人上驱动电机的驱动电压。基于动力学模型的控制方案,不需对驱动电机进行底层的速度控制,消除了底层速度控制带来的延时。由功力学方程:nmx3×3M」可知在休坐标系中各个方向上的控制输入输出是独立的并且相互之间无耦合;于是可在体坐标中对各个控制量分别进行控制。当以各个电机电压作为控制量U时,对体坐标系中各个方向上的控制量UF经过Ta3×3变换后得到各个电机的控制量UUF先对输入UF到体坐标各个方冋上速度V的系统等效参数[m′门进行辨识,得到由控制量UF到体坐标速度Ⅴ的传递函数:然后设计UF的控制器,经过变换后得到各电机的电压U;速度控制指令 1xe vye (l由第2节控制律求得。34基于编码器的位姿推算圆弧模型在文献L4中介绍机器人里程计圆弧模型是把移动机器人在运动过程中的实际轨迹通过圆弧去逼近234图7平台样品示意图YAYR11B(x12+11Un-1XAA(r()图8采样期间的圆弧运动轨迹图中A(xmy,0n)和B(xnx+1,yn+1,On+1)分别为在采样时问间隔内起始点与终点的位姿坐标,AB为采样期间的圆弧轨迹,利用图中儿何关系可以得到运动轨迹为圆弧时的推算公式如下L(△SR+△S少sin△SR-△Sn+1xn+6n+2(△sinenR△SL(ΔSR+△S△SYn+1=ynCOS+

下载说明:请别用迅雷下载,失败请重下,重下不扣分!

发表评论

0 个回复

  • SVPWM算法详解_已标注重点_
    详细的讲解了SVPWM的过程,及其仿真,很适合初学者或(37)即磁链空间矢量可以等效为电压空间矢量的积分,如果能够控制电压空间矢量的轨迹为如式(3.4)所示的圆形矢量,那么磁链空间矢量的轨迹也为圆形。这样,电动机旋转磁场的轨迹问题就可以转化为电压空间矢量的运动轨迹问题。进一步分析,由式(3.3)(3.5)(3.7)可以得到公式(3.8)∫-+yy(38)对电压积分,利用等式两边相等的原则有(39)其中,v为电机磁链的幅值,即为理想磁链圆的半径。y当供电电源保持压频比不变时,磁链圆半径v是固定的。在 SVPWM控制技术中,是取以y为半径的磁链圆为基准圆的。32逆变器电压的输出模式图32给出了电压源型PWM逆变器—异步电动机示意图14。昇步电动机定子绕组YY图3.2PWM逆变器电路(1~6为GBT)对于180°导电型的逆变器来说,三个桥臂的六个开关器件共可以形成8种开关模式。用分别标记三个桥臂的状态,规定当上桥臂器件导通时桥臂状态为1,下桥臂导通时桥臂状态为0,这样逆变器的八种开关模式对应八个电压空间矢量,其中为直流侧电压在逆变器的八种开关模式中,有六种开关模式对应非零电压空间矢量,矢量的幅值为一;有两种开关模式对应的电压矢量幅值为零,称为零矢量。当零矢量作用于电机时不形成磁链矢量;而当非零矢量作用于电机时,会在电机中形成相应的磁链矢量。对于每一个电压空间矢量,可由图32求出各相的电压值,再将各相的电压值代入式(3.3),可以求得电压空间矢量的位置。下面以开关状态)=(、0、0)为例,即开关导通,其余关断。逆变电路的形式可以变为B相和C相并连后再和A相串连的形式,易得将其数值代入式(33),可得采用同样的方法可以得到如表31所示的逆变器空间电压矢量。表31逆变器的不同开关状态对应的空间矢量表相电压矢量表达式定子电压开关状态(Us大小为空间矢量A相B相C相0000000101001110010111100由于 SVPWM控制的是逆变器的开关状态,在实际分析逆变器一电动机系统时,可以通过分析逆变器输出的电压空间矢量来分析电机定子电压的空间矢量,下面给出证明。设逆变器输出的三相电压为、,由图3.2可求出加到电机定子上的相电压为(310)其中,为电机定子绕组星接时中点0相对于逆变器直流侧点的电位。电机定子电压空间矢量为(311)而由三角函数运算知++因此,逆变器输出的电压空间矢量为(312)由式(3.12)可知,在PWM逆变器一电动机系统中,对电机定子电压空间矢量的分析可以转化为对逆变器输出电压空间矢量的分析。这时,在求解表3.1时,可以直接利用逆变器输出的电压合成得到,即A,B,C三相输出电压值只有一和-—两个值。当逆变器输出某一电压空间矢量时,电机的磁链空间矢量可表示为y =y3.13)其中,W为初始磁链空间矢量;△为的作用时间。当为某一非零电压矢量时,磁链空间矢量y从初始位置出发,沿对应的电压空间矢量方向,以为半径进行旋转运动,当为一零电压矢量时,W=y,磁链空间矢量的运动受到抑制。因此合理地选择六个非零矢量的施加次序和作用时间,可使磁链空间矢量顺时针或逆时针旋转形成一定形状的磁链轨迹。在电机控制当中尽量使磁链轨迹逼近正多边形或圆形。同时,在两个非零矢量之间按照一定的原则,比如开关次数最少,插入一个或多个零矢量并合理选择零矢量的作用时间,就能调节ψ的运动速度。33SWPM的具体实现方法在实际应用中,应当利用 SVPWM自身的特点找到控制规律,避开复杂的数学在线运算,从而较为简单的实现开关控制,本节将给出实现 SVPWM的具体方法。根据3.2节中给出的不同开关状态组合可以得到如图33的电压空间矢量图C图3.3 SVPWM矢量、扇区图通常在矢量控制的系统当中,根据控制策略,进行适当的巫标变换,可以给出两相静止坐标系即(a,B)坐标系电压空间矢量的分量,g,这时就可以进行 SVPWM的控制,具体要做以下三部分的工作如何选择电压矢量。2.如何确定每个电压矢量作用的时间。3.确定每个电压矢量的作用顺序3.3.1电压空间矢量的空间位置这里需要引入扇区的概念,将整个平面分为六个扇区。如图3.3所示,每个扇区包含两个基本矢量,落在某个扇区的电压空间矢量将由扇区边界的两个基本电压空间矢量进行合成。在确定扇区时,引入三个决策变量A,B,C。根据给出的待合成的空间矢量的两个分量,p来决定A,B,C的取值,有以下关系式所在扇区的位置为当N取不同的值对应的扇区位置如图3.3所示,这样给定一个空间电压矢量就可以确定其所在的扇区。33.2电压空间矢量的合成扇区确定之后,就可以利用扇区边界上的两个基本矢量合成所需的矢量在合成过程中应当使得两个基本矢量的合成效果接近于期望矢量的效果。于是采用伏秒平衡的原则,以图3.3所示的第Ⅲ扇区为例,以a尸轴为基准,将两个基本矢量向aB轴上投影,应当有轴:=||+尸轴其中,为对应电压矢量作用的时间(=),为采样周期,通常为PW的调制周期。且|=||=-。求解上面两式可以得到这两个基本矢量的作用时间如式3.14(314)通过上面的方法即可以确定基本矢量的作用时间,当需要合成的矢量位于各个不同的扇区时都存在如上的运算。通过对每个扇区基本矢量动作时间的求解不难发现它们都是一些基本时间的组合。所以给出几个基本的时间变量x,Y,Z。定义√(315)通过计算可以得到在每个扇区内的基本矢量动作时间,(由于五段和七段式的实现方法不同,所以这里没有考虑矢量的动作顺序,仅按照逆时针方向)。设每个刷区的两个基本矢量动作的时间为于是可以得到矢量动作时间表3,2表3.2的对应关系表扇区ⅣV在实际的应用中当给定的电压值太大时会出现过调制的情况,即+>。此情况出现时,还要对上述计算出来的电压矢量的作用时间进行调整,具体方法如式3.16所示。(316)即为调整后的动作时间。在一个P啊M周期内除了非零电压矢量的作用,还要有零电压矢量的作用,零电压矢量包括对于这两个矢量的作用时间,以及开关的动作顺序,取决于采用的SPwM是五段式还是七段式,3.3节将对这两种PWM形式进行详细的介绍3.4 SVPWM的硬件实现和软件实现TI公司的TM320LF2407A系列的DSP内部有硬件来实现 SVPWM,由于每个PWM周期被分为五段,因此也被称为五段式的 SVPWM。在每个PWM调制周期内,开关状态有五种,且关于周期中心对称。而七段式的SvPM在每个PWM调制周期内有七种开关状态,需要运用软件进行实现,因此也被称为 SVPWM的软件实现。需要注意的是,无论哪种方法,所遵循的基本原则是开关动作次数最少,每个开关在一个周期内最多动作两次。3.4.1五段式 SVPWM对于五段式的 SVPWM,只在PMM周期的中间插入零矢量,具体采用哪一个由硬件根据旋转方向和开关动作次数最少的原则自行决定。例如在第Ⅲ扇区内,如果旋转方向为逆时针时针,则先动作,后动作以此类推,动作时间可以直接采用表3.2中的数据即可,然后选择零矢量(硬件决定)即可使开关次数最少。对于五段式PWM而言,零矢量作用的时间可以表示为:根据上述的配置原则,在每个扇区内开关动作的示意图如图34所示202ⅣV/1Ⅵ图34每个扇区内的开关动作示意图每个TMS320LF2407A的事件管理器EV模块都具有十分简化的电压空间矢量PWM波形产生的硬件电路。编程时只需进行如下的配置2●设置 ACTRX寄存器用来定义比较输出引脚的输出方式,决定高电平还是低电平有效,正反转,所在扇区等。●设置COMC0Nx寄存器来使能比较操作和空间矢量PWM方式,并且把 CMPRX的重装条件设置为下溢●将通用定时器1或2,4或5设置成连续增/诚计数模式,并启动定时器。然后给据在两相静止(a6)坐标系下输入到电机的电压空间矢量,分解为,确定如下的参数●所期望的矢量所在的扇区。根据 SVPWM的调制周期计算出两个基本的空间矢量和零矢量作用的时间
    2020-12-06下载
    积分:1
  • costas锁相环matlab仿真
    一个关于科斯塔斯环的MATLAB仿真程序,,希望有人需要哈
    2021-05-06下载
    积分:1
  • LittlevGL中英文档
    LittlevGL是一个免费的开源图形库,提供了创建嵌入式GUI所需要的一切易于使用的图形元素,具有漂亮的视觉效果和低内存占用。具有功能强大的单元块,对输入设备支持较完善,同时具有低内存,采用C编写具有比较好的兼容性。中英文档是对LittlevGL文档的简单翻译,有利于快速了解LittlevGL各功能模块的应用。EXamde5.4 Button(v btn)............58Overview58Style usage...............59Notes59Example595.5 Button matrix(lv btnm)61Overview61Style usage.................,..................62Notes62Example625.6 Calendar( calendar)-……64OverviewStyle usage……看着翻Example655.7 Chart( ly chart)…67Overview..67Style usage.......:.:::::·::::::68Example…685.8 Check box lv cb)70Overview70Style usage…70Example705.9 Container(lv cont72Overview72Style usage……72NoExample735.10 Drop down list(lv ddlist)74Overview74Style usage ...74Example,…:::..:.:..:::::.aa是着着·目1着着,非着·着755.11 Gauge(Iv gauge7676Style usage76Example775.12mage(img)….,,,,,7878Style usage着看E着NotesExample795.13 Image button(| imgbtn).…………………281verview81Style usage…...,.,NotesExample,…815.14 Keyboard(Nkb)…83Style usageExample5.15List(|ist)…着着着D·音着着垂8585Style usage.........................85Notes86EXame865.16LED(l|ed)..,OverviewStyle usage....................89Notes89Example5.17Line(line)…91OverviewStyle usage.................,..................91NotesExample....................5.18 Line meter( Imeter)……93Overview..93Style usage…看着翻93Notes93Example945.19 Label (lv label)..96Overview96Style usage………………Notes97Example975.20 Message box(Iv mbox).......,,99OverviewStyle99Not100mp1005.21 Page(v page)........::::.:.:::102Overview…………,…102Style usage103Notes103Example1045.22 Preloader(lv preload):.::::::..105Overview105Style105Example1055.23 Roller(lv roller).......106Overview.…106Style usage…106ExampleE着1075.24 Slider (lv slider).108Overvie108Style usage108Notes108Example1095.25 Spinbox(Iv_ spinbox).111Overview……4111Style usage Notes111notes111Example....1115.26 Switch(lSW)…..112Overview.…4112Style usage…112Notes112Example1135.27 Tab view(Iv tabview)114Overview114Style usage…..114Notes…115Example1155.28 Text area(lvta)…116Overview116Style usage117Notes117Example1175.29 Window(lv window)119Overvie.119Style usage119Notes120camp内容表Welcome portingButton matrix (lv btnm欢迎移植Calendar (lv calendar)PC simulator ObjectsPC模拟器项目Chart(lv chart)Styles风格Check box (1v cb)Input devicesContainer(1v cont输入设备Drop down list(lv ddlist)Colors颜色Gauge(lv gauge)Fontmage (lv lmg字体Image button(lv imgbtn)Drawing绘画Keyboard (lv kb)List(lv listAnimations动画Led(lv led)Coding Style guideLine (1v line)Line meter(lv 1meter)Object typesArc(lv arc)Label(lv labe1)Bar (lv bar)Message box(1v mbox)Base object (lv obj)Page(lv pageButton(lv btn)Preloader(lv preload)Switch(lv sw)Roller (lv rollerTab view (lv tabview)Slider (lv sliderText area (lv ta)inbox (lv spinboXWindow (lv window)云图■xD62:ChecK Doeleica一Cekba check bpsELittleygl是一个免费的开源图形库,提供了创建嵌入式GU所需要的一切易于使用的图形儿素,只有漂亮的视觉效果和低内存占用。关键特性Powerful building blocks buttons, charts, lists, sliders, images, etc功能强大的单元块按钮、图表、列表、幻灯片、图片等Advanced graphics with animations, anti-aliasing, opacity, smooth scrolling先进的图形动画,反锯齿透明度,平滑滚动Various input devices touch pad, mouse, keyboard, encoder, buttons, etc各种输入设备触摸板、鼠标、键盘、编码器、按钮等。Multi-language support with UTF-8 encoding支持UTF-8编码的多语言Fully customizable graphical elements全可定制的图形元素Hardware independent to use with any microcontroller or display硬件独立于任何微控制器或显示器Scalable to operate with little memory (50 kB Flash, 10 kB RAM)可伸缩用于少量内存(50 kb flash,10 kb ram)的操作OS, External memory and GPU supported but not required支持O5、外部存储器和GPU,但也不强求Single frame buffer operation even with advances graphical effects即使有先进的图像特效,也可以进行单帧缓冲Written inc for maximal compatibility用C编写,从而具有最大的兼容性Simulator to develop on PC without embedded hardware没有嵌入式硬件的情况下也可以基于PC模拟器开发Tutorials, examples, themes for rapid development为快速丌发而准备的教程、例了及主题5
    2020-12-03下载
    积分:1
  • matlab做得马尔科夫仿真
    本程序做了一个完成的一阶马尔科夫仿真程序
    2020-12-06下载
    积分:1
  • EKF,UKF的matlab实现
    无迹卡尔曼滤波和扩展卡尔曼滤波的matlab仿真程序,验证后可用
    2020-12-12下载
    积分:1
  • DSP C6000结构原理与硬件设计PPT(北航)
    讲解的比较详细,适合各个层次的学习者。方便理解
    2020-12-01下载
    积分:1
  • C#标签设计打印序源码
    namespace MyPrint
    2020-12-09下载
    积分:1
  • 粒子群算法求解BP神经网络参数
    说明,这个matlab程序的目标是对BP神经网络中的神经元连接权和阈值构成的高维参数空间进行最优求解,试图用PSO算法求解神经网络中的参数,而不是用传统的误差反传算法。但由于经典粒子群算法存在局部最优的问题。该算法也存在同样的问题。该算法在迭代数较大时可以基本做到误差较大的函数拟合。但是通过该资源提供的图解和代码注释,用户可以很容易的学习到PSO算法的过程。至于如何突破局部最优,这个就有待各位PSO爱好者进行优化了。
    2020-12-06下载
    积分:1
  • 遗传算法求多元函数极值Matlab代码
    本资源为自己编写的遗传算法求多元函数极值的Matlab代码,共大家共同学习和研究。
    2020-12-06下载
    积分:1
  • 自适应滤波器MATLAB仿真
    自适应滤波器的设计以及使用MATLAB仿真实现
    2020-11-27下载
    积分:1
  • 696516资源总数
  • 106914会员总数
  • 0今日下载