双臂机器人主要应用于特殊环境和与人类交互环境中。特殊环境下作业的双臂机器人示例如图 1-1 所示,通常由两个单机械臂组成,并且机械臂的尺寸与人类手臂相差较大,机械臂基座固定的位置也各有差异,这是因为它们需要被应用于特定的环境中。如图 1-1(a)所示,两个 ABB 工业机械臂被固定在生产线的两侧,进行鼠标装配操作。图 1-1(b)中 Dextre 空间机器人的两个尺寸巨大的机械臂被固定空间站两侧,用来进行在轨维护等任务。图 1-1(c)中的蛟龙号的两个机械臂被固定在探测仓前端,用于海底表面的样本采集。特别地,在 2010年通过机械臂将五星红旗插入中国南海海底 3759 米表面。图 1-1(d)中 Eurobot外星探测车前端装有两个机械臂用来采集地表样本。
第 2 章 面向非对称协调任务的自主定位方法
2.1 引言
在双臂非对称协调操作中,第一阶段是需要实现两个操作物的定位任务。操作物被两个机械臂末端执行器固定地夹持,通过控制机械臂末端运动来实现操作物位姿控制。通常情况下,操作物模型是需要精确已知的,比如轴孔对齐任务,需要已知轴与孔的长度以及直径等。然而,除了在工业装配等特殊场合,多数的应用场合下很难获得精确的操作物模型,这也限制了拟人双臂机器人的应用范围。 人类手臂在执行非对称协调任务时是无需精确已知操作物模型,这是因为人类可以通过眼睛来观测操作物的特征,进而引导手臂实现操作物位姿对齐,这就是所谓的手眼协调操作。为了使得机器人可以像人类一样实现手眼协调操作,本章采用摄像机对操作物的位姿特征进行实时采集,并应用视觉伺服方法控制机械臂完成任务,进而提高双臂机器人在定位任务中的环境适应能力。
2.2 双臂非对称协调任务描述
本章目标是通过双臂机器人实现两个操作物的位姿对齐任务。轴与孔是具有泛化特征的操作物,它可以是圆柱形的多轴孔,或是方形的轴孔,例如三项的插座与插头,方形的杯子与杯盖等。以下两个操作物以轴孔为例给出说明:
(1) 轴孔位姿对齐任务视为将轴与孔的轴线以及端面中心点位置进行对齐。
(2) 轴与孔的端面中心到两个机械臂末端坐标系原点的位置向量是未知的,轴与孔的直径也是未知的。
(3) 轴被右臂末端夹持且保持固定,孔被左臂末端夹持且位姿保持固定。
(4) 双臂末端执行器上的特征点保持在场景摄像机视野内。
(5) 轴孔位姿对齐目标精度为各个坐标轴方向的位置误差为<5mm,姿态误差为<1°,这符合通用的装配任务的初始位姿对齐误差[144]。
采用MOTOMAN SDA5F双臂机器人平台,它具有两个7DOF冗余机械臂。由于操作物的模型未知,因此需要采用多于一台摄像机对操作物的三维模型进行重建。那么视觉系统由两台单目彩色摄像机组成(其中使用了双目摄像机中的一台摄像机),一台摄像机放置机器人头部作为场景摄像机,一台固定在右机械臂末端附近作为手眼摄像机,通过场景和手眼两台摄像机对目标特征进行观察来完成双臂协调任务。双臂机器人相关坐标系定义如图2-1所示。 对于机械臂视觉伺服控制,由于PBVS方法过于依赖摄像机和操作物模型参数,而在操作物模型未知的情况下很难应用于实际任务。因此本章采用IBVS方法对两个机械臂进行手眼协调控制。