《操作臂的力控制》课件

1.位置控制的局限性

当末端执行器与操作臂工作环境发生碰撞时，纯粹的位置控制已经不适用。.考虑用海绵擦玻璃.用刚性刮削工具从玻璃表面刮油漆.

第11章:操作臂的力控制

概述

如果末端执行器、工具或者环境刚性很高，则操作臂压贴在平面上的操作执行起来就非常困难.

第11章:操作臂的力控制

概述

2.工业机器人在装配作业中的应用简单的应用场合

流水线作业

目前，操作臂的灵巧性仍然较低，限制在自动化装配领域中的应用.第11章:操作臂的力控制

概述

假设仅需要描述接触和自由状态，只考虑由于接触产生的力，主要是刚度较大的物体之间的接触力。每一个操作任务可以分解为多个子任务，这些子任务都是由操作臂末端执行器和工作环境之间特定的接触状态定义的。对于每一个与这种子任务相关的约束，称为自然约束。

自然约束：位置约束、力约束第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

Example:

用扳手夹着笔从孔中拔出来.我们假设:笔可以垂直出入孔，而且忽略摩擦力.整个工作过程是准静态的，忽略所有惯性力.第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系考虑和运动相关的约束自然约束:

由于几何的约束关系，螺丝不能在x和y的方向移动:也不能绕着x和y轴转动:人工约束:Theremainingdirectionsarelinearandangularzaxes.Velocitiesalonethesetwodirectionscanbeassignedarbitrarily,andmaybecontrolledwithpositioncantrolmode.Weselect:第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系考虑静态约束

自然约束:由于做了准静态的假设，即忽略所有惯性力，所以笔在运动方向上不能有任何的加速度和力:人工约束:由于孔在几何上有约束，所以我们必须保证有如下的力输入:第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系自然约束和人工约束的坐标轴都是互相正交的.自然约束中的运动学部分与人工约束的静态部分坐标相同.自然约束中的静态部分与人工约束的运动学部分坐标相同.

Kinematic

StaticNaturalconstrainsArtificialconstrains第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

Example:

摇手柄.

第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

Example:

拧螺丝.

第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

4.装配策略

Assemblystrategyisatermthatreferstoasequenceofplannedartificialconstraintsthatwillcausethetasktoproceedinadesirablemanner.Thesystemcandetectachangeinthecontactingsituationsothattransitionsinthenaturalconstraintscanbetracked.Witheachsuchchangeinnaturalconstraints,anewsetofartificialconstraintsisrecalledfromthesetofassemblystrategiesandenforcedbythecontrolsystem.

第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

Example:Anassemblysequenceusedtoputaroundpegintoaroundhole.Foreachofthesubtasksshown,givethenaturalandartificialconstraints.Also,indicatehowthesystemsensesthechangeinthenaturalconstraintsastheoperationproceeds.Firstattachtheconstraintframetothepeg.

第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

InFig.(a),thepegisinfreespace,sothenaturalconstrainsare:

Therefore,theartificialconstrainsinthiscaseconstituteanentirepositiontrajectory,whichmovesthepeginthedirectiontowardthesurface.

第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

InFig.(b),thepeghasreachedthesurface.Todetectthatthishashappened,weobservetheforceinthedirection.Whenthissensedforceexceedsathreshold,wesensecontact,whichimpliesanewcontactingsituationwithanewsetofnaturalconstraints.Thepegisnotfreetomovein,ortorotateaboutor.IntheotherthreeDOF,itisnotfreetoapplyforces.

第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

Hence,naturalconstraints:

Theartificialconstraintsdescribethestrategyofslidingalongthesurfaceinthedirectionwhileapplyingsmallforcestoensurethatcontactismaintained.Thus,wehave:

第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

InFig.(c),thepeghasfallenslightlyintothehole.Thissituationissensedbyobservingthevelocityinthedirectionandwaitingforittocrossathreshold.Itsignalsthatthenaturalconstraintshavechanged,andstrategymustchange.Thenewnaturalconstraintsare:

artificialconstraints:第11章:操作臂的力控制

§11.1局部约束任务中的控制坐标系

1.位置/力混合控制

两种极端情况:第11章:操作臂的力控制

§11.2位置/力混合控制

沿着自然力约束的方向进行操作臂的位置控制.沿着自然位置约束的方向进行操作臂的力控制.沿着任意坐标系{C}的正交自由度方向进行任意位置和力的混合控制.第11章:操作臂的力控制

§11.2位置/力混合控制

2.质量弹簧系统的力控制

Inconsideringforcesofcontact,wemustmakesomemodeloftheenvironmentuponwhichweareacting.Wemodelcontactwithanenvironmentasaspring:weassumethesystemisrigidandtheenvironmenthassomestiffness,.Thevariablewewishtocontrolistheforceactingontheenvironment,,whichistheforceactinginthespring,.第11章:操作臂的力控制

§11.2位置/力混合控制

Theequationdescribingthisphysicalsystemis:Writtenintermsofthevariablewewishtocontrol:

Controllaw:Weget:

However,wecannotuseknowledgeofincontrollaw.第11章:操作臂的力控制

§11.2位置/力混合控制

Ifwechoosetoleavetheoutofcontrollaw:wefindthat:

where,theeffectiveforce-feedbackgain.

第11章:操作臂的力控制

§11.2位置/力混合控制

Whentheenvironmentisstiff,mightbesmall,andsotheerrorisquitelarge.Ifwechoosetouseinthecontrollawinplaceoftheterm:

Therefore,thesteady-stateerrorisquiteanimprovementthanbefore.第11章:操作臂的力控制

§11.2位置/力混合控制

Generally,practicalconsiderationschangetheimplementationofforcecontrolservoquiteabit:First,forcetrajectoriesareusuallyconstants.Anotherrealityisthatsensedforcesarequitenoisy,wecanobtainthederivativeoftheforceontheenvironmentas.

第11章:操作臂的力控制

§11.2位置/力混合控制

3.位置/力混合控制策略

1)约束坐标系{C}中的笛卡尔坐标系

ConsideramanipulatorhavingthreeDOFwithprismaticjointsactinginthedirections.Assumethat:Thejointmotionsarelinedupexactlywiththeconstraintframe.Theend-effectorisincontactwithasurfaceofstiffnessthatisorientedwithitsnormalinthe--direction.第11章:操作臂的力控制

§11.2位置/力混合控制

这种情况下，力/位置混合控制问题的解比较清楚:力控制在方向，位置控制在

方向.关节1和关节3用位置控制器，关节2用力控制器.在方向上设置位置轨迹，在方向上设置力轨迹（很可能只是一个常数）第11章:操作臂的力控制

§11.2位置/力混合控制矩阵来确定采用哪种控制模式.第11章:操作臂的力控制

§11.2位置/力混合控制

2)一般操作臂的控制

第11章:操作臂的力控制

§11.2位置/力混合控制与约束坐标系一直的笛卡尔操作臂混合控制器.第11章:操作臂的力控制

§11.2位置/力混合控制

3)附加可变刚度

Controllingadegreeoffreedominstrictpositionorforcecontrolrepresentscontrolattwoendsofthespectrumofservostiffness:Anidealpositionservoisinfinitelystiffandrejectsallforcedisturbancesactingonthesystem.Anidealforceservoexhibitszerostiffnessandmaintainsthedesiredforceapplicationregardlessofpositiondisturbances.

Itcouldbeusefultobeabletocontroltheend-effectortoexhibitstiffnessesotherthanzeroorinfinite.Ingeneral,wemightwishtocontrolthemechanicalimpedanceoftheend-effector.

Example:Indealingwithplasticpartsorsprings,wecouldwishtosetservostiffnesstootherthanzeroorinfinite.第11章:操作臂的力控制

§11.2位置/力混合控制真正的力控制并没用应用到工业机器人中，这主要是因为:大量的计算;缺少动力学模型的精确参数;缺少可靠耐用的力传感器;力/位置混合控制方法的复杂.

第11章:操作臂的力控制

§11.3当前工业机器人的控制方法

1.被动柔顺性

Example:RCC第11章:操作臂的力控制

§11.3当前工业机器人的控制方法

2.通过降低位置增益实现柔顺性

Considerageneralspringwithsixdegreesoffreedom.Itsactioncouldbedescribedby:whereisadiagonal6×6matrixwiththreelinearstiffnessfollowedbythreetorsionalstiffnessonthediagonal.

Problem:Howcouldwemaketheend-effectorofamanipulatorexhibitthisstiffnesscharacteristic?RecallingthedefinitionofthemanipulatorJacobian:

第11章:操作臂的力控制

§11.3当前工业机器人的控制方法

Whereasasimplejoint-basedpositioncontrollaw:

Salisburysuggestsusing:

whereisthedesiredstiffnessoftheend-effectorinCatesianspace.Essentially,throughuseoftheJacobian,aCartesianstiffnesshasbeentransformedtoajoint-spacestiffness.第11章:操作臂的力控制

§11.3当前工业机器人的控制方法

Example:Consideratwo-linkplanarrobotarm.Obtainthejointfeedbackgainmatrixproducingtheendpointstiffness:第11章:操作臂的力控制

§11.3当前工业机器人的控制方法

Assumingthatthelinklengthis1forbothlinks,theJacobianis:So:Notethatthejointfeedbackgainmatrixissymmetricandthatthematrixdege