文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 信息与通信 > @机械臂非完整Robust Interaction Control of a Mobile manipulator – Dynamic Model Based Coordination
侵权投诉

@机械臂非完整Robust Interaction Control of a Mobile manipulator – Dynamic Model Based Coordination

ROBUSTINTERACTIONCONTROLOFAMOBILEMANIPULATOR55

3.InteractionControl–CoordinationScheme

Mobilemanipulatorsconsistoftwoprimarysubsystems;themobileplatformandthemulti-linkmanipulator.Thetwosubsystemsdiffersubstantiallyintheirtaskassignments,dynamiccharacteristicsandcontrollerrequirements.Thisphysicalinterpretationprovidesanef cientapproachtotheredundancyresolutionproblemwhichiscreatedbycombiningthetwosubsystems.First,themanipulatoriscom-mandedtofollowthedesiredtrajectoryintaskspace.Then,themobileplatformiscontrolledinthehorizontalplanetopositionthemanipulatorataspeci edpointintheworkspacetoavoidsingularcon gurationsofthemanipulator.Thismoti-vatestheapplicationofinteractioncontroltomobilemanipulatorsinwhichthecontrollersareindependentlydesignedforeachsubsystem.Thedesiredtrajectoryofthemobilemanipulatorisgivenintheglobalframe.First,themanipulatoriscommandedtomoveinthelocalframe xedonthe rstjointaxis.Subsequently,thebaseofthemanipulator,whichislocatedontheplatform,isfollowedbythemobileplatforminsuchamannerthatitcantrackthetrajectorytransformedintothelocalframe.

ThetransformationofthedesiredtrajectoryXdcanbeperformedusingtherotationmatrixRz(θ)aboutthez-axisandwehave:

1xd=Rz(Xd Xw)(43)

wherexdisthedesiredtrajectoryinthelocalframe,

cosθ sinθ0

Rz(θ)=sinθcosθ0,

001

andXw=[xwyw]Tisthelocationofthemid-pointofthewheelaxle.˙Therefore,thepositionerrorx andthevelocityerrorx aremodi edto

1(θ)(Xd Xw)x =xe Rz(44)(45)

and

˙˙dx =x˙e x(46)wherexeandx˙earethepositionandthevelocityoftheend-effector,respectivelyinthelocalcoordinateframeandx˙disthedesiredvelocitytrajectoryinthelocalcoordianteframeandcanbewrittenas

1 1˙z˙d X˙w).(θ)(Xd Xw)+Rz(θ)(Xx˙d=R(47)

We rstrewriteEq.(42)as

¨=Q+M 1τmξ

whereQ= M 1(C+G).(48)

上一页第9页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email