自由度工程机器人.docx
- 文档编号:30819511
- 上传时间:2024-01-30
- 格式:DOCX
- 页数:27
- 大小:736.90KB
自由度工程机器人.docx
《自由度工程机器人.docx》由会员分享,可在线阅读,更多相关《自由度工程机器人.docx(27页珍藏版)》请在冰豆网上搜索。
自由度工程机器人
吉林大学机械电子工程实验室的
3自由度工程机器人
吉林大学机械电子工程实验室的3自由度工程机器人如图1-1所示.它是在液压挖掘机工作装置的基础上,用单自由度的末端执行器替换挖掘机铲斗,再将回转体及相应部件安装在基座上,从而构成了一个3自由度串联关节型机械手.矚慫润厲钐瘗睞枥庑赖。
末端执行器由一对啮合齿轮、抓手、四连杆机构和驱动液压缸组成.通过驱动液压缸活塞杆的伸缩行控制抓手的开合.液压缸活塞杆带动四连杆机构并驱使主动齿轮啮合被动齿轮,以实现抓手的开合.这样的结构设计可保证抓手两边的抓取力相等.聞創沟燴鐺險爱氇谴净。
3自由度串联关节型机械手结构简图
3自由度串联关节型机械手结构简图如图1-2所示.
残骛楼諍锩瀨濟溆塹籟。
机械各个关节的自由度是由液压缸来改变的,从机构学的角度看,它们都是一个曲柄滑块机构.液压缸采用电液比例阀控制.酽锕极額閉镇桧猪訣锥。
3自由度串联关节型机械手液压系统
工程机器人以液压驱动为主,分别由四组直线液压缸来控制串联关节型机械手的四个自由度(包括手部自由度).整个液压系统由液压站、油路、电控比例换向阀、比例换向阀控制器和液压缸等组成,如图1–3所示.彈贸摄尔霁毙攬砖卤庑。
謀荞抟箧飆鐸怼类蒋薔。
3自由度工程机器人自主作业系统
3自由度工程机器人自主作业系统基本构成如图1–4所示.
厦礴恳蹒骈時盡继價骚。
3自由度工程机器人自主作业系统结构
3自由度工程机器人自主作业系统结构如图1–5所示.
茕桢广鳓鯡选块网羈泪。
3自由度工程机器人坐标系
3自由度工程机器人自主作业系统结构如图1–6所示.
鹅娅尽損鹌惨歷茏鴛賴。
图1-1所示工程机器人的连杆参数见表1-1
表1–13自由度连杆机器人的连杆参数
关节i
θi(°)
ai(mm)
i(°)
di(mm)
cosαi
sinαi
1
θ1
L1=350
90
0
0
1
2
θ2
L2=2014
0
0
1
0
3
θ3
L3=1400
0
0
1
0
4
θ4
L4=620
0
0
1
0
其中:
θi称为两条连杆之间的关节角;
ai代表连杆i的长度;
i称为两轴线zi与zi+1的交错角,即连杆Li的扭角;
di称为两条连杆之间的偏置;
第2章工程机器人自主作业系统
本章系统阐述工程机器人自主作业控制系统的工作原理与总体结构,并介绍各系统的功能及相互关系.
2.1工程机器人自主作业系统原理图
以立体视觉为基础,建立的工程机器人自主作业系统,其原理图如图2-1所示.摄像机在控制装置的作用下,像眼睛一样搜索目标物体,并抓拍目标物体的图像.图像处理系统根据目标物体的图像来计算目标物体的轮廓形状及相应的位置信息,并将这些信息规范化处理后送给工程机器人控制机.工程机器人将传送的物体坐标进行空间坐标变换,把物体坐标由摄象机空间坐标系转换为工程机器人坐标系,然后再进行运动学反解,计算出各关节角,最后控制工程机器人按路径规划靠近目标物体,并根据任务的要求,将目标物体放到指定位置,整个过程实现工程机器人对目标物体的自主抓取.在此过程中,本论文对图像处理系统不做研究,除此之外还需解决的关键问题如下:
籟丛妈羥为贍偾蛏练淨。
1.及时准确的将物体空间坐标由图像控制机传送到工程机器人控制机.
2.根据工程机器人本体结构进行运动学反解计算,求出各关节角.
3.设计新的算法控制器,使工程机器人能及时、准确、平稳的自主作业.
4.设计工程机器人控制系统,实现主控计算机对工程机器人的控制.
預頌圣鉉儐歲龈讶骅籴。
2.2工程机器人自主作业系统基本构成
本文中的工程机器人主要有三大部分系统组成,主要包括工程机器人本体、控制系统、传感检测系统,其中工程机器人本体包括工程机器人结构系统与驱动系统;传感检测系统包括位移、压力传感器、视觉传感器等,为控制系统获取有用的内、外部环境状态信息;而控制系统则包含图像处理系统、工程机器人自主作业控制统以及由环境所构成的交互系统等.工程机器人自主作业控制系统结构图如图2-2所示.渗釤呛俨匀谔鱉调硯錦。
铙誅卧泻噦圣骋贶頂廡。
2.2.1工程机器人
本系统的工程机器人是在液压挖掘机动臂的基础上,用单自由度的末端执行器替换挖掘机铲斗,从而构成了一个3自由度串联关节型机械手,如图2-3所示.末端执行器由一对啮合齿轮、抓手和四连杆机构组成,通过驱动该自由度液压缸活塞杆的伸缩进行控制,液压缸活塞杆带动四连杆机构并驱使主动齿轮啮合被动齿轮,以实现抓手的开合.这样的结构设计可保证抓手两边的抓取力相等.位移传感器平行固定在液压缸上,可随活塞杆的伸缩测量出液压缸位移的大小,实现位置闭环控制.串联关节型机械手作为工程机器人的主体,在伺服控制过程中,液压阀与液压缸的布置较困难.在一般的液压伺服系统设计时,液压阀与油缸是直接相连的,但两者之间不允许有柔性存在.如果把液压阀装在串联型关节机械手臂上,则机械手臂的重量和转动惯量增大,如果把同液压阀直接连接的驱动部分放在工程机器人的基座上,通过钢丝绳等传递动力,由于钢丝的弹性以及传动机构的间隙等也对工程机器人的特性不利.考虑到各元件的重量分配和结构刚性,工程机器人机械手臂驱动部分的合理结构布置是把执行元件液压缸放在手臂上,把液压阀放在基座上,两者之间再以挠性连接.擁締凤袜备訊顎轮烂蔷。
工程机器人机械手臂采用电液比例阀作为伺服控制元件,虽然电液伺服阀是响应特性最好的控制阀,但其制造成本和维护费用高.电液比例阀除了中位有死区外,其稳态特性与伺服阀不相上下,而制造成本和维护费用要低得多,因此得到越来越广泛的应用.贓熱俣阃歲匱阊邺镓騷。
为了提高工程机器人在作业时的安全性,对原有的基座进行了改进设计.原有的基座的上部是一个利用槽钢焊接而成的一个支撑架,下部是四个刚度较大的支柱,下部用地脚螺栓固定在地面上,上下部分通过螺栓把紧,这样整个基座是一个固定的刚性支撑,结构如图2-4所示.工程机器人在作业工程中,可能出现由于人为的误操作使抓手触地而没有及时关闭电液比例阀的现象,如果此类现象出现基座将受到系统的强大压力冲击,这种冲击可能使基座的上下连接处断裂而造成重大事故.为了避免此类事故发生,将原来固定的基座增加一个转动自由度,使基座在受到压力冲击时可以绕一轴线转动.考虑到节约成本,在基座上部不变的情况下,去掉基座下部的四个支柱,重新设计四个支腿.用槽钢作成的两前支腿,并将其与上部支架焊接在一起,但前支腿不与地面固定,再用槽钢、钢板、万向节做成后支腿.将后支腿焊接在基座上部并与地面
把紧,结构如图2-5所示.坛摶乡囂忏蒌鍥铃氈淚。
2.2.2工程机器人电液控制系统
工程机器人以液压驱动为主,分别由四组直线液压缸来控制串联关节型机械手的四个自由度.整个液压系统由液压站、油路、电控比例换向阀、比例换向阀控制器和液压缸组成,如图2–6所示.蜡變黲癟報伥铉锚鈰赘。
由图2-6可知,电液比例换向阀及其控制器是电液控制子系统的核心,由它实现对液压缸的流量控制即速度控制和换向控制.电液比例控制系统的优点是充分利用液压控制与电器控制的长处,即在功率传递方面利用液压传动大功率的优点,在信号处理方面利用电气信号的处理运算便捷的优点.考虑到工程机器人现场工作环境比较恶劣,以及成本要求,采用电液比例换向阀作为液压控制元件.电液比例换向阀是一种具有液流方向控制和流量控制功能的复合阀,主要用于控制负载的运动方向和速度,除中位有死区以及频率响应低于电液伺服阀外,其他特性越来越接近于电液伺服阀,完全能够满足本系统的要求.在节流口压差恒定的条件下,通过它的液压油流量与输入的电流信号成比例,而流动的方向则取决于比例电磁铁是否受到激励.使用比例换向阀的回路,可省去节流调速元件,能迅速、准确地实现工作循环,避免负载引起的压力尖峰以及满足切换性能的要求,延长元件和机器的使用寿命.買鲷鴯譖昙膚遙闫撷凄。
2.2.3基于立体视觉的图像处理系统
綾镝鯛駕櫬鹕踪韦辚糴。
立体视觉是计算机视觉领域的一个重要课题,它的目的在于重构场景的三维几何信息.立体视觉的研究具有重要的应用价值,其应用包括移动机器人的自主导航系统,航空及遥感测量,工业自动化系统等.立体视觉的主要研究目标可总结为两点,其一是模拟人眼的功能建立立体视觉系统,完成各种视觉任务,获取目标物体的深度图,实现三维物体重构;其二是将该研究作为探索人脑视觉工作原理的手段,进一步加深对人脑视觉的掌握和理解.驅踬髏彦浃绥譎饴憂锦。
本文采用DIGI-HIBW-60立体成像系统采集图像,该立体成像系统的摄像机模型采用的是加拿大PointGreyResearchInc.生产的Digiclops三目摄像机,如图2-7所示.通过三个Sony1/3"progressivescanCCD摄像头,IEEE1394接口,API软件接口函数,DIGI-HIBW-60立体成像系统使用户能够利用数字立体图像技术开发定制自己的应用,诸如跟踪、测量、VRML模型的建立、人机交互、自主移动机器人等方面.本文搭建的图像处理系统由DIGI-HIBW-60摄像机模型、IEEE-1394PCI卡(如图2-8所示)、图像处理计算机三部分组成.猫虿驢绘燈鮒诛髅貺庑。
2.2.4数据通信系统
TCP/IP作为Internet上最重要的一个协议族,其应用的广泛程度已经大大地超出了人们最初设计它时想象的范围.TCP/IP协议是一组包括TCP协议和IP协议,UDP协议、ICMP协议和其他一些协议的协议组.锹籁饗迳琐筆襖鸥娅薔。
TCP/IP协议并不完全符合OSI的七层参考模型.传统的开放式系统互连参考模型,是一种通信协议的7层抽象的参考模型,其中每一层执行某一特定任务.该模型的目的是使各种硬件在相同的层次上相互通信.这7层是:
物理层、数据链路层、网路层、传输层、话路层、表示层和应用层.而TCP/IP通讯协议采用了4层的层级结构,每一层都呼叫它的下一层所提供的网络来完成自己的需求.这4层分别为:
应用层、传输层、互连网络层、网络接口层.其中网络层和传输层与网络通讯程序的开发密切相关,模型如图2-9所示,TCP/IP参考模型详解如图2-10所示[40].構氽頑黉碩饨荠龈话骛。
UDP是一个无连接协议,传输数据之前源端和终端不建立连接,当它想传送时就简单地去抓取来自应用程序的数据,并尽可能快地把它扔到网络上.由于传输数据不建立连接,因此也就不需要维护连接状态.UDP信息包的标题很短,只有8个字节,相对于TCP的20个字节信息包的额外开销很小.輒峄陽檉簖疖網儂號泶。
尧侧閆繭絳闕绚勵蜆贅。
另外它的吞吐量不受拥挤控制算法的调节,只受应用软件生成数据的速率、传输带宽、源端和终端主机性能的限制.而TCP是面向连接的,可提供可靠的传输服务,但由于其底层IP协议是一种无连接的投递机制,为保证数据包传输时的连续性和正确性,其控制要比UDP复杂许多,故在实时系统中均会造成一定的时间开销,从而影响系统的实时性.识饒鎂錕缢灩筧嚌俨淒。
本文所进行的工程机器人自主控制过程,是保证工程机器人控制系统能够及时读取由立体视觉系统计算得来的目标物体空间坐标,整个作业过程,目标物体的坐标的实时性较可靠性具有更重要的意义,因此选择UDP协议作为通信协议.凍鈹鋨劳臘锴痫婦胫籴。
UDP信息包由UDP标题和数据组成.UDP的标题结构如图2-11所示,它由5个域组成:
源端端口(SourcePort)、目的地端口(DestinationPort)、用户数据包的长度(Length)和检查和(Checksum).其中,前4个域组成UDP标题(UDPheader),每个域由4个字节组成;检查和域占据2个字节,它用来检测传输过程中是否出现了错误;用户数据包的长度包括所有5个域的字节数.这样便解决了本章开始所提到四个关键问题中的第一个问题.恥諤銪灭萦欢煬鞏鹜錦。
2.2.5工程机器人自主作业控制系统
工程机器人自主作业控制统是整个工程机器人自主作业系统的核心.通过数据通信系统,它与图像处理系统控制机取得联系,并接收由图像处理系统控制机送来的目标物体空间坐标,将物体坐标由摄象机空间坐标系转换为工程机器人坐标系,再进行运动学反解,计算出各关节角.通过电液比例换向阀控制器,它控制液比例换向阀的开口大小及阀芯移动方向来控制液压缸的伸缩快慢,从而控制工程机器人的作业.同时读取位移、压力传感器的传感器信号,经处理后作为反馈量同目标量进行比较运算,再将算的阀控信号送往电液比例换向阀控制器,如此反复运算直到整个运算结束,这就是工程机器人自主作业过程.鯊腎鑰诎褳鉀沩懼統庫。
工程机器人自主作业控制系统要做控制系统的算法研究,及控制系统的软硬件设计.其中工程机器人自主作业控制系统的算法研究我们将在第四章做详细介绍,控制系统的软硬件设计将在第五章做介绍.硕癘鄴颃诌攆檸攜驤蔹。
2.3本章小结
本章设计了工程机器人自主作业控制系统,系统阐述了工程机器人自主作业控制系统的工作原理与总体构成,并介绍了各子系统的功能、相互关系及实验中使用的传感器和设备.阌擻輳嬪諫迁择楨秘騖。
第3章工程机器人运动学分析
3.1引言
关节坐标的计算是新兴的工业机器人控制过程中程序设计的基础.开发比较高级的机器人程序设计语言,要求具有按照笛卡尔坐标系规定工作任务的能力.空间中的目标物体在工作空间内的位置以及机器人操作臂的位置,都是以某个确定的坐标系来描述的;而工作任务则是以某个中间坐标系(如附于操作臂端部的坐标系)来规定的.氬嚕躑竄贸恳彈瀘颔澩。
由笛卡尔坐标系来描述工作任务时,必须把上述规定变换为一系列能够由操作臂驱动的关节位置.确定操作臂位置和姿态的各关节位置的解答,就是运动方程的求解[41].本章将研究利用坐标变换的方法,通过设置主-从手各连杆坐标系,确定各连杆的齐次变换矩阵―D-H(Denavit-Hartenberg)坐标变换矩阵[42],从而建立从手的运动学和动力学描述方程.这是进一步从事工程机器人自主作业控制技术研究工作的数学基础.釷鹆資贏車贖孙滅獅赘。
本章着重介绍了4自由度工程机器人的运动学模型.在计算机控制过程中,工程机器人抓手根据位置和关节角来进行轨迹规划,如抓手的位置是直接和关节轴的角位移变量相对应的.反过来,这些相对于关节轴的角位移变量也是由各关节液压缸的长度决定的.这些变量之间的数学表达式是通过工程机器人各关节的运动学关系来确定的.怂阐譜鯪迳導嘯畫長凉。
3.2工程机器人的正向运动学方程
工程机器人运动学研究的是操作臂各连杆间的位移关系、速度关系和加速度关系.机器人操作臂可以看作为一个开式运动链,它由一系列连杆通过转动或移动关节串联而成的.开链的一端固定在基座上,另一端是自由的,安装着末端执行器,用以操作物体,完成各种作业.关节由驱动器驱动,关节的相对运动导致连杆的运动,使抓手到达所需的位姿.谚辞調担鈧谄动禪泻類。
为了研究操作臂各连杆之间的位移关系,可在每个连杆上固接一个坐标系,然后描述这些坐标系间的关系.Denavit和Hartenberg提出一种通用的方法,用一4×4的齐次变换矩阵来描述相邻两连杆的空间关系,从而推导出“手抓坐标系”相对“参考系”的等价齐次变换矩阵,建立操作臂的运动学方程[43].嘰觐詿缧铴嗫偽純铪锩。
3.2.1工程机器人连杆的几何关系
本文所使用的工程机器人工程机器人是由四个连杆和四个转动关节组成的,每个关节有一个自由度.基座称为连杆0,不包含在这四个连杆之内.连杆1与基座由关节1相连接;连杆2与连杆1通过关节2相连接,依此类推,抓手与连杆4固接,基座固定不动,如图3-1所示.其操作臂可以看作为一个开式运动链,它由一系列连杆通过转动或移动关节串联而成的.开链的一端固定在基座上,另一端是自由的,装有末端执行器,用以操作物体,完成各种作业.关节由驱动器驱动,关节的相对运动导致连杆的运动,使抓手到达所需的位姿.图3-1所示工程机器人的连杆参数见表3-1.熒绐譏钲鏌觶鷹緇機库。
表3–13自由度连杆机器人的连杆参数
关节i
θi(°)
ai(mm)
i(°)
di(mm)
cosαi
sinαi
1
θ1
L1=350
90
0
0
1
2
θ2
L2=2014
0
0
1
0
3
θ3
L3=1400
0
0
1
0
4
θ4
L4=620
0
0
1
0
其中:
θi称为两条连杆之间的关节角;
ai代表连杆i的长度;
i称为两轴线zi与zi+1的交错角,即连杆Li的扭角;
di称为两条连杆之间的偏置;
3.2.2工程机器人的连杆坐标系的确定
连杆的功能在于保持其两端的关节轴线具有固定的几何关系,为研究操作臂各连杆之间的位移关系,可在每个连杆上固接一个坐标系,然后描述这些坐标系间的关系.为此采用将杆件坐标系固定在每个杆件的上关节处的办法,与基座固接的坐标系记为{0},第i杆件的坐标系{i}设置于i+1号关节上,并固定与i杆件上,坐标系{i}与杆件i无相对运动.i杆件坐标系{i}的oixiyizi系固定在i杆件的上关节i+1处,它的原点在关节i+1的轴线上;oizi轴与关节i+1的轴线重合;oixi轴是杆件长度的延长线;oiyi轴的方向由右手坐标系的原则决定.同样,我们也将杆件i-1的坐标系{i-1}设置在杆件i-1的上关节i的轴线处[41].工程机器人坐标系的确定如图3-2所示[44].鶼渍螻偉阅劍鲰腎邏蘞。
一旦对全部连杆规定坐标系之后,我们就可以按照下列顺序由两个旋转和两个平移来建立相邻两连杆i-1与i之间的相对关系,即坐标系{i-1}经过如下变换就可以得到坐标系{i}.纣忧蔣氳頑莶驅藥悯骛。
(1)绕zi-1轴旋转θi角,使xi-1轴转到与xi轴同一平面内.
(2)沿zi-1轴平移一距离di,把xi-1移到与xi同一直线上.
(3)沿xi轴平移一距离аi,把连杆i-1的坐标系移到使其原点与连杆i的坐标系原点重合的地方.
(4)绕xi-1轴旋转αi角,使zi-1轴转到与zi轴同一直线上.
这种关系可由表示连杆i对连杆i-1相对位置的四个齐次坐标变换来描述,此关系式为[43]:
颖刍莖蛺饽亿顿裊赔泷。
(3-1)
式中:
Trans(px,py,pz)—平移齐次坐标变换矩阵,平移矢量为[px,py,pz]T;
Rot(k,θ)—旋转齐次坐标变换矩阵,k表示旋转方向的单位矢量,θ为旋转角度.
根据表3-1所示的工程机器人的各杆件的参数,由式(3-1)可得到各杆件的A矩阵:
(3-2)
(3-3)
(3-4)
(3-5)
3.2.3工程机器人的正向运动学方程
对于工程机器人的自主作业控制,抓手能够到达一个指定的方向和位置是有必要的.抓手的位置可以通过改变各关节液压缸的长度来实现,并由此调整关节角以使其达到所需的大小.这种能够描述抓手到关节轴的位置、方向以及液压缸长度的数学表达式被称为运动学方程.由此可以看出,当液压缸的长度或关节角变量被给定了以后,抓手的位置可以通过运动学方程的正解得到;而抓手的位置和方向一旦被确定了,相应于这个位置和液压缸长度的关节角可以通过运动学方程的逆解来得到.濫驂膽閉驟羥闈詔寢賻。
由图3-2可以看出,工程机器人的位置可以根据抓手运动过程中其旋转轴来确定,即腕部关节坐标系的原点O3的坐标.对于和坐标原点O3相邻的两个连杆的位置向量ip和i+1p,有如下的表达式:
銚銻縵哜鳗鸿锓謎諏涼。
ip=Aii+1i+1p(3-6)
为了得到点O3相对于基座坐标系下的坐标,方程(3-6)可以采取递归的形式来进行求解,即有:
p0O3=(A01A12A23)p3O3=A03p3O3(3-7)
式中:
(3-8)
同理,抓手的指尖点的坐标相对于基座坐标系的坐标同样也可以通过方程(3-9)表达出来,即有
p0O4=(A04)p4O4(3-9)
式中,P4O4是抓手指尖点相对于O4x4y4z4坐标系的空间坐标,P4O4=[0001]T;
其中p4O4是相对于O4为坐标原点的空间坐标.
(3-10)
当已知关节角变量θi(i=1,…,4),图3-2中抓手之间位置O4相对于基座坐标系的坐标可以计算出来.式中,角θ的正弦和余弦简化表示形式如下:
挤貼綬电麥结鈺贖哓类。
Si=sinθi(i=1,2,3,4),
Ci=cosθi(i=1,2,3,4),
Cij=CiCj-SiSj=cos(θi+θj)(i=1,2,3,4;j=1,2,3,4),
Sij=CiSj+SiCj=sin(θi+θj)(i=1,2,3,4;j=1,2,3,4),
C234=C2C34-S2S34,
S234=S2C34+C2S34
式(3-9)描述了末端连杆坐标系{4}相对基坐标系{0}的位姿,是工程机器人运动分析和综合的基础.
图3-3所示为工程机器人的一个抓手.把所描述的坐标系的原点置于手爪指尖的中心,此原点由矢量P表示.描述抓手三个单位矢量的指向如下:
z向矢量处于夹手进入物体的方向上,称为接近矢量a,y向矢量的方向从一个指尖指向另外一个指尖,处于规定夹手方向上,称为方向矢量o;最后一个矢量叫做法线矢量n,它与方向矢量o和接近矢量a构成个一个右手矢量集合,是o和a的矢量积,其方向和大小由n=oa所确定[45].因此,变换T4具有下列元素:
赔荊紳谘侖驟辽輩袜錈。
(3-11)
当工程机器人结构的运动方程被确定后,根据已知的p0O4来求各关节变量的解,是工程机器人轨迹规划中最为重要的问题.塤礙籟馐决穩賽釙冊庫。
4.2.4工程机器人关节角与液压缸伸长量的关系
在以液压驱动的工程机器人系统中,在对工程机器人进行自主作业控制中,需要将各关节的角位移转换为液压缸的直线位移.因此,本系统3自由度工程机器人各关节转角与液压缸伸长量之间的关系如图3-4~3-5所示.裊樣祕廬廂颤谚鍘羋蔺。
仓嫗盤紲嘱珑詁鍬齊驁。
(1)对于回转自由度
假定初始位置时,10为工程机器人处于初始位置时a1、b1的夹角,此时对应的回转液压缸的长度(从其转轴
算起)为l10,l10的长度可以根据三角形的余弦定理得到.绽萬璉轆娛閬蛏鬮绾瀧。
当有回转动作时,假定回转角为θ1,则此时液压缸的伸长变换量△l1可以由下面的表达式获得:
(3-12)
式中:
为按图3–4规定坐标系的回转自由度关节转角,θ1∈[-70°,55°].
根据所获得的液压缸的伸长量,将其量化为AD卡所允许的数字量,并将其作为控制量的给定值.
(2)对于大臂自由度
对于大臂自由度而言,l20为工程机器人处于初始位置时大臂自由度液压缸的长度(从其转轴
算起),当液压缸长度发生变化时,并假定此时大臂液压缸伸长变化量为△l2,根据图3-5的几何关系,则有骁顾燁鶚巯瀆蕪領鲡赙。
(3-13)
式中:
,其中
数值上是固定不变的,而
为按照图3-5规定坐标系的大臂自由度关节转角,θ2∈[-4°,52°].瑣钋濺暧惲锟缟馭篩凉。
(3)对于前臂自由度
同理,我们可以根据三角形的几何关系来确定前臂液压缸的伸长变化量.
已知
为工程机器人处于初始位置时
(3-14)
式中:
θ3′=360°+φ30-Φ30-θ3,且φ30、Φ30为固定值,可以根据三角几几何何关系来确定.鎦诗涇艳损楼紲鯗餳類。
(4)对于抓手自由度
由于抓手自由度的结构相对复杂,很难通过简单几何关系计算出抓手自由度液压缸伸长变化量△l4与抓手自由度关节转角θ4的关系,因此采用曲线拟合的办法来确定二者关系.栉缏歐锄棗鈕种鵑瑶锬。
根据图3-7,在三角形O43O40O44中,由于∠O43O40O4的值很小,因此可近似认为O43、O41、O4
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 自由度 工程 机器人