动态场景中轮式移动机器人的视觉镇定控制.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN109816717A(43)申请公布日2019.05.28(21)申请号201711171647.0(22)申请日2017.11.20(71)申请人天津工业大学地址300387天津市西青区宾水西道399号(72)发明人李宝全尹成浩师五喜冀东(51)Int.Cl.G06T7/70(2017.01)G06T7/80(2017.01)G06T7/246(2017.01)B25J19/00(2006.01)权利要求书4页说明书10页附图5页(54)发明名称动态场景中轮式移动机器人的视觉镇定控制(57)摘要一种动态场景中轮式移动机器人的视觉镇定系统的设计。本文基于单目的轮式移动机器人提出了一种新颖的方法，可以让机器人在视觉目标移动的情况下进行视觉伺服。对于现有的方法，当特征点固定时，移动机器人可以正确的到达期望位姿处，不过当特征点移动后，移动机器人难以到达期望位姿处。为了监视特征点的移动，我们在实验场景中增加了一个监视摄像机，当特征点移动之后移动机器人仍然可以到达期望位姿。通过监视摄像机的图像，利用POSIT算法计算出移动后的特征点与监视摄像机的关系，进而计算出相应的坐标系和特征点之间的关系。利用坐标系变换规则，根据实时的图像反馈信息计算出当前位姿和期望位姿之间的旋转矩阵和平移向量。利用基于极坐标表示法的控制器驱动移动机器人到达期望位姿处。仿真与实验结果均证CN109816717A明本方法有效可靠。CN109816717A权利要求书1/4页1.一种动态场景中轮式移动机器人的视觉镇定系统，其特征包括以下步骤：第1，定义系统坐标系第1.1，系统坐标系的描述基于视觉目标定义了基准坐标系设置摄像机与移动机器人的坐标系相重合，定义在当前位姿处的机器人/摄像机坐标系为其中的原点在摄像机的光心位置处，即车轮轴线中心点的正上方；的zc轴与摄像机光轴重合，同时也和机器人前进方向重合，xc轴和机器人轮轴平行；yc轴垂直于zcxc平面；是机器人的期望位姿，为固定摄像机的位置，固定摄像机的作用是监视特征点的移动，坐标系相对关系如附图2、3所示；Mi定义为特征点移动之前的位置，为特征点移动之前的目标坐标系；M*定义为特征点移动之后的位置，为特征点移动之后的目标坐标系；基于视觉目标定义基准坐标系，假设特征点Mi(i＝1，2……i)是非共面的，其3维坐标是已知的；第1.2，控制方案特征点运动时移动机器人可以有效地完成视觉镇定任务；视觉伺服镇定策略由三个阶段组成：第一阶段，监视摄像机采用POSIT方法计算出特征点移动前和移动后的关系；第二阶段，可以获得实时的机器人的当前姿态和期望姿势旋转矩阵和平移向量；最后在第三阶段，结合李亚普诺夫理论和极坐标，设计运动控制器来驱动机器人到达想要的位姿；附图1给出了所提供方案的框图；经过严格的理论可以证明所提出的视觉伺服方案是有效的；第2，系统设计第2.1，监视摄像机控制策略第2.1.1，特征点移动之前的坐标系与监视摄像机坐标系之间的关系定义目标坐标系为{M1，u，v，w}，目标坐标系以特征点中序号为1的点M1为原点，Mi是第is个特征点的空间位置，经POSIT方法所求出的旋转矩阵和平移向量To为：特征点移动之前坐标系和监视摄像机坐标系之间的关系为：第2.1.2，特征点移动之后坐标系与监视摄像机坐标系之间的关系定义目标坐标系为{M*1，u*，v*，w*}，其中目标坐标系以特征点中序号为1的点M*1为原s点，M*i是第i个特征点的空间位置，所求出的旋转矩阵和平移向量Ta为：特征点移动之后坐标系和监视摄像机坐标系之间的关系为：2CN109816717A权利要求书2/4页由此可知特征点在移动前和移动后相对于摄像机坐标系的空间位置；不过也需要知道特征点移动前与移动后坐标系之间的旋转与平移关系；第2.1.3，特征点移动前与移动后坐标系之间的关系o设移动后的特征点变换到移动前坐标系的旋转矩阵为平移向量为Ta：根据坐标系变换规则，由监视摄像机坐标系、特征点移动之前坐标系和移动之后坐标系的旋转关系可得：由此可得的值；特征点移动后与移动前坐标系的关系为：其中(Ai，Bi，Ci)表示的是特征点移动后在移动前所在坐标系的坐标值；o求出Ta，因此可得移动前与移动后两个坐标系之间的关系；第2.2，移动机器人控制策略第2.2.1，特征点移动之前坐标系与机器人期望坐标系的关系建立机器人坐标系，机器人前进的方向为zc轴，左右方向为xc轴，上下方向为yc轴，g，e，f分别是其单位向量；首先在移动机器人的期望位置进行取像，用POSIT算法可以算出，特征点移动前相对移d动机器人期望坐标系的旋转矩阵和平移向量To为：(Xc1，Yc1，Zc1)是点M1在移动机器人期望坐标系下坐标值，特征点移动之前坐