1 / 12
文档名称:

全向轮运动平台分析.doc

格式:doc   大小:32KB   页数:12页
下载后只包含 1 个 DOC 格式的文档,没有任何的图纸或源代码,查看文件列表

如果您已付费下载过本站文档,您可以点这里二次下载

分享

预览

全向轮运动平台分析.doc

上传人:Bonnacon 2023/3/21 文件大小:32 KB

下载得到文件列表

全向轮运动平台分析.doc

文档介绍

文档介绍:该【全向轮运动平台分析 】是由【Bonnacon】上传分享,文档一共【12】页,该文档可以免费在线阅读,需要了解更多关于【全向轮运动平台分析 】的内容,可以使用淘豆网的站内搜索功能,选择自己适合的文档,以下文字是截取该文章内的部分文字,如需要获得完整电子版,请下载此文档到您的设备,方便您编辑和打印。全向轮运动平台分析
全轮转向式小车
一、坐标系与位置表示
图1地理坐标系与体坐标系
定义如图所示的坐标系,地理坐标系{????,????},体坐标系
{????,????},坐标之间夹角为θ,P点位置描述为??ε??=????????
由地理坐标转为体坐标的映射由正交旋转矩阵完
成????????????????0??ε??=??(??)
ε??=???????????????????0????????001??反方向变换矩阵如
下???????????????0??(??)????=??????????????????0??001
二、运动学模型与控制律

图2轨迹跟踪示意图
坐标系参照图2,对于地理坐标中的位置指
令????=(????????????)和速度指令????=(????????)将对应的误差在
体坐标系中表示出
来????????????????????0???????????=????????=???????????????????0?????????????????001???????对上式求导的到
[1]:????=(?????????)?????????(???????)??????????+(?????????)????????+(???????)??????????=???????(????????????+????????????)+??????????????????????+?????———————————————————————————————————————————————
?????????????????=???????????+????cos(???????)
=???????????+????cos????????=?(?????????)?????????(???????)??????????+(?????????)?????????(???????)??????????=???????+(?????????????????????????)???????????????????????+??????????????????????=????????????+????sin????
将上式合并写出得到位置误差微分方
程???????????????+????cos??????=??????????????+????sin??????????=?????????????????
设李雅普诺夫函数为1??????)(????+????+????求其导数如下,
当渐进稳定时导数小于0;
=????????????+????????+????????????==?????????????=?????????,????=?????????,????
,李雅普诺夫函
数的导数小于零,系统渐进稳定代入微分方程得到控制律如
下:????=??????+????cos????+????????????=???????+????sin????+??????????=????+????????
差动轮与全向轮的区别是,全向轮小车速度方向与四个轮子的共
同朝向相同可为任意方向,而差动轮小车的切向速度方向与X轴重合,
故方程中????=0,微分方程如
下:?????????????+????cos??????=?????????+????sin??????????=?????????????????
选择Lyapunov函数如下:1??1??)????=(????+????+(1???????????)———————————————————————————————————————————————
对上式沿求导:
1sin????????=????????+????????+????=????(?????????+????cos????)+????(???????+????sin????)1+(???????)sin????11=???????+????????cos????+????????sin????+????sin???????sin????11=???????+????????cos????+????????sin????+????sin???????sin????选择如下速度控制输
入:??=????cos????+????????
??=????+????(??????+??????????????)将上式
代入Lyapunov函数导数得到:????????=??????????????????????????
?0,故以上Lyapunov函数选择正确。当上式系数为正时,????
由此得到基于运动学模型的轨迹跟踪速度控制律为
[2]:????cos????+??????????????=??????????+????(??????+??????????????)
其中,??,????,????为控制器参数。

将控制律代入微分方程得下
式:????????(????+????(??????+??????????????))???????????=???????(????+????(??????+??????????????))+????sin??????????=???????????(??????+??????????????)????上式在零点附近线性化,忽略高次项
得????=A?????????????00??????A=???????0??????????????????
系数值与角速度和速度指令值共同决定系统根,当系数为正是所
有根为负数。
———————————————————————————————————————————————

仿真系统结果图如下:
图3轨迹跟踪结构图
图中q=(vω)T,v、ω分别为移动机器人的线速度和角速度,ε??=(xyθ)T,对于差动机器人运动学方程可表示
为:????????????0??
ε??=????????=??????????0??????=J??????01??????????????0图中J=??????????0??;????=????????;????=??;
????01
对于全向轮机器人运动学方程可表示为:
?????????????????????????0????????????=??????????????????0?
?????????=??(??)??????????????001????,仿真结果如下图:
图4圆形轨迹跟踪仿真图
图中×点线为差动轮跟踪轨迹,О点线为全向轮跟踪轨迹。
三、全向轮平台的设计
对全向轮采用如下图所示的结构时,进行系统分析与设计
图5互补型全向轮(omniwheels)

运动学模型
图6全向轮式移动机器人运动学模型
移动坐标?????????固定在机器人重心上,而质心正好位于几何———————————————————————————————————————————————
中心上。机器人P点在全局坐标系的位置坐标为:(x,y,θ),三个全
向轮以3号轮中心转动轴反方向所为机器人的X轴。假设三个全向
轮完全相同,三个全向轮中心到车体中心位置的距离L。在移动坐
标?????????的速度用????????????表示。
由文献[3]可得三个全向轮的速度与其在移动坐标和全局坐标系
下的速度分量之间的关系分别为以下二式:1???????sin
(60)cos(60)??????????????????????????=???sin
(60)cos(60)??????????????=??1???????????????????????0?1??????????????=Ta?????????????????????sin(60???)????????=???sin(60+??)????????????cos(60???)cos(60+??)???????????????????????????????
在移动坐标?????????中,设机器人在沿轴????和????方向上收到
的力分别为FXe

FYe第1、2、3号驱动轮提供给机器人的驱动力分别为f1、f2、
f3,机器人惯性转矩为M,根据牛顿第二定律可得到如下的动力学方
程:
????????????cos(30)?cos(30)??=??????????=??sin(30)????????sin(30)???????????0??0???????????1??????????=?????????????1????????????????
????=Tb?????????????????
在地理坐标系X—Y下的方程如下:??????cos(30+??)?cos
———————————————————————————————————————————————
(30???)??????????????=????????=??sin(30+??)sin
(30???)???????????????????????????????????????????????
如上式所示,基于机器人动力学模型的控制方案,直接根据机器人的动力学模型设计运动控制器,控制器的输出为机器人上驱动电机的驱动电压。基于动力学模型的控制方案,不需对驱动电机进行底层的速度控制,消除了底层速度控制带来的延时。
由动力学方程:????????????????=????????==Tb??
?????????????????????????????可知在体坐标系中各个方向上的控制输入输出是独立的并且相互之间无耦合;于是可在体坐标中对各个控制量分别进行控制。
当以各个电机电压作为控制量U时,对体坐标系中各个方向上的控制量UF经过Ta?????变换后得到各个电机的控制量:
U=Ta?????UF
先对输入UF到体坐标各个方向上速度V的系统等效参数????′??′??进行辨识,
得到由控制量UF到体坐标速度V的传递函数;然后设计UF的控制器,经过变换后得到各电机的电压U;
速度控制指令??????????????由第2节控制律求得。

圆弧模型在文献[4]中介绍机器人里程计圆弧模型是把移动机器人在运动过程中的实际轨迹通过圆弧去逼近。
图7平台样品示意图[5]
———————————————————————————————————————————————
图8采样期间的圆弧运动轨迹
图中A(????,????,????)和B(????????,????????,????????)分别为在采样时间间隔内起始点与终点的位姿坐标,AB为采样期间的圆弧轨迹,利用图中几何关系可以得到运动轨迹为圆弧时的推算公式如下:??(???+???)?????????????????=????+??sin??????+?????????????
??????(???+???)???????????????=???????cos??????+????????????????
??????????????=??+
??????????
当???????????较小时可采用直线模型
(???+???)?????????????????=????+cos??????+????(???+???)??????????
?????=????+sin??????+???????????????=??+??????????随着移动距离的增加,误差逐渐加大,其误差的来源主要包括系统误差和非系统误差。系统误差跟实际采用的器件的精度和测量上的误差等方面产生的;非系统误差是在移动过程中随机发生的误差,主要包括:测位轮子的打滑、路况等。
由于非系统误差不容易消除,因此,这里将通过实验的方法来校准机构的安装精度,减小因系统误差对定位精度产生较大影响。
影响测量误差的主要参数是编码器输出一个脉冲对应轮子运动的距离??和两个定位轮之间的距离L,??和L精度校正的具体方法和实现步骤如下:
编码器一个脉冲代表定位轮运行的距离??校正方法:使两个定位轮在室内平面上沿着一条5米长度的直线运行,编写软件程序,对———————————————————————————————————————————————
与定位轮同轴相连的两个自由编码器的输出脉冲进行计数,将该数值记录左右自由编码器输出脉冲个数NL和NR,根据公式5000??=????
求出每次测量计算得到??的值,再取平均值即可。经过多次测试实验结果列表。
定位轮之间的距离L校正方法:在平地上,使测位装置从某一起始位置出发,顺时针或逆时针旋转n周后再回到该出发位置,记下在该过程与左右定位轮相连的编码器输出的脉冲数分别为NL,NR,根据公式(?????)???L=求出每次测量计算得到L的值,再取平均值即可。经过多次测试两定位轮之间距离L校正实验列表。
四、Mecanum轮平台的设计
由于全向轮存在承重不高,小轮容易磨损的问题,顾在载重较高情况下可考虑Mecanum轮;Mecanum轮采用滚轮与轴线成45。夹角的结构,如下图所示:
图9麦克纳姆轮(Mecanumwheels)假设图中小辊子可沿径向自由滚动,而沿轴向与地面无滑动。

图10麦克纳姆轮移动机器人运动学原理图
由文献[6]可得四个轮的速度与其在移动坐标系下的速度分量之间的关系为以下式,其中W为车半宽,L为车半
长:????11??+??????????????????1?1??????????=??????????????=Ta??
?????????????????11??????????1?1??+??????
其逆变换如下:
———————————————————————————————————————————————
1??????11??????????=??1??1?1?1????????11????????1?1??????=
Tb????????????11??????????????Tb3?4?Ta4?3=I

在移动坐标?????????中,设机器人在沿轴????和????方向上收到
的力分别为FXe和FYe第1、2、3和4号驱动轮提供给机器人的驱动
力分别为f1、f2、f3和f4,机器人惯性转矩为M,根据牛顿第二定律
可得到如下的动力学方
程:????????1111????????????1????????1?11?1??????????=???????
???=??1??????=Tb????????????1?11????????????????????
上式驱动力逆变换
为????11??+??????????????????1?1??????????=????????=Ta???????????????11????????????????????1?1??+??????
,基于机器人动
力学模型的控制方案,直接根据机器人的动力学模型设计运动控制器,
控制器的输出为机器人上驱动电机的驱动电压。基于动力学模型的控
制方案,不需对驱动电机进行底层的速度控制,消除了底层速度控制
带来的延时。
速度控制指令??????????????由第2节控制律求得;速度控制器
设计如下:由动力学方程:????????????????????=??????????=Tb?????????????????????????????????
当以各个电机电压作为控制量U时,对体坐标系中各个方向上的
控制量UF经过Ta?????变换后得到各个电机的控制量:
———————————————————————————————————————————————
先对输入UF到体坐标各个方向上速度V的系统等效参
数????′??′??进行辨识,
得出由控制量UF到体坐标速度V的传递函数;并将其写为状态空间[A,B,C,D],然后将控制输入B*UF,变换为以各电机的电压U为输入量的传递函数B?Tb????????;以U为输入的状态空间形式为[A,B?Tb?????,C,D];这是个MIMOU=Ta?????UF(Multiple-InputMultiple-Output)多入多出系统,其输入为四轮各自电压,输出为体坐标XY轴速度和转动角速度。

圆弧模型在文献[5]中介绍机器人里程计圆弧模型是把移动机器人在运动过程中的实际轨迹通过圆弧去逼近。
图7平台样品示意图[6]
图8采样期间的圆弧运动轨迹
由于三轮全向机器人具有完整约束动力学特性,因此采用三个编码器才可以得到机器人平面运动的三自由
度信息,即机器人的坐标信息PcOccycA)。
图中A(????,????,????)和B(????????,????????,????????)分别为在采样时间间隔内起始点与终点的位姿坐标,AB为采样期间的圆弧轨迹,利用图中几何关系可以得到运动轨迹为圆弧时的推算公式如下:??(???+???)?????????????????=????+??sin??????+?????????????

最近更新

学校秋季招生工作计划(大全五篇) 3页

2024年精选关于我与企业共成长演讲稿参考范文.. 13页

管理基础领导与管理 32页

学校疫情防控工作方案 1 52页

纺织品的消费者心理与行为分析 24页

一个高职院校科研信息管理系统的设计与实现的.. 3页

北师大版六年级下册整册教案《小抄写员》教学.. 17页

北师大版二年级上册语文教案《语文天地》课后.. 27页

2022-2023学年英语周报九年级第40期答案及试题.. 1页

答案(浦土木)课件 26页

等离子发生器的工作原理 26页

初中语文使用导学案一等奖出现的问题及对策 31页

笔算除法(例2)问题解决展示课 23页

八年级语文上册《人民英雄永垂不朽》教案 28页

储运车间工艺技术员兼统计员岗位职责 33页

保安巡逻签到规定 26页

丑小鸭幼儿园中班语言教案 27页

《金色的秋天》PPT课件大班语言 27页

《诗两首我爱这土地乡愁》教案 26页

科技计划项目申报辅导 26页

大理沙龙会场婚礼策划方案相关7篇 13页

2024年大唐集团招聘笔试试题及答案新编 43页

2023年江苏省南京市中考道德与法治真题(含答案.. 9页

2022-2023年公共英语二级考试真题及答案 22页

眼镜验光员技能大赛试题及答案 22页

集体备课的基本流程 2页

2022年城区绿地认建认管活动方案 4页

心肺复苏试题及答案 7页

《多文本阅读课堂教学策略研究》中期研究报告.. 12页

富氢水与疾病治疗 ppt课件 60页