利用AGV位置信息标定其搭载机械臂位置的系统的制作方法

本发明属于导航与控制技术领域，具体涉及一种利用agv位置信息标定其搭载机械臂位置的系统。

背景技术：

搭载机械臂的麦克纳姆轮全向移动平台作为一种灵活的运载平台解决方案被广泛地应用于汽车、航空、航天、教育、医疗、工业、物流等各个领域。而agv在不断移动过程中，机械臂基座坐标系不断变化，不利于机械臂的控制。目前工业领域大多使用的是将agv和机械臂整体看做一种7自由度的系统进行运动学和动力学建模，此种方法相对来说算法复杂、开发难度较大。

技术实现要素：

(一)要解决的技术问题

本发明要解决的技术问题是：如何设计一种易实现的、用于标定agv搭载机械臂位置的系统，以确定机械臂在导航坐标系下的位置。

(二)技术方案

为了解决上述技术问题，本发明提供了利用agv位置信息标定其搭载机械臂位置的系统，所述系统为一agv模型；

所述agv模型包括机械臂1、agv车体2、视觉模块3和导航码带4；视觉模块3安装在agv车体2的前端，机械臂1通过一机械臂基座固定在agv车体2的顶部，agv车体2在自主导航时，始终沿着导航码带4行驶，视觉模块3用于实时读出自身位置处的位置信息x、y和相对于导航码带4的偏航角度ω；在导航坐标系原点、agv视觉模块的中心和机械臂基座中心设定坐标系，分别为oo、ov、oa，则导航坐标系oo随导航路径的确定而固定，视觉模块坐标系ov和机械臂基座坐标系oa随着agv车体2的移动而不断变化；

所述agv模型用于根据空间内任意两坐标系间的转换关系，确定机械臂1在导航坐标系下的位置。

优选地，所述agv模型具体用于，根据如下的空间内任意两坐标系间的转换关系，确定机械臂1在导航坐标系下的位置：

对于空间内任意一点p，若已知该点在一坐标系内的表示为^sp，欲求该点在另一坐标系下的表示^op，有：

其中，为旋转矩阵，代表两坐标系间的旋转关系，^ops-ori为平移矩阵，代表两坐标系间的平移关系。

优选地，所述agv模型具体用于，根据空间内任意两坐标系间的转换关系，按照如下方式确定机械臂1在导航坐标系下的位置：

假定空间内任意一点p，其在视觉模块坐标系ov、机械臂基座坐标系oa和导航坐标系oo三个坐标系的坐标表示依次为：^vp、^ap和^op，由于agv模型整体在导航坐标系oo的x-y平面内运动，坐标系只存在平移和以z轴为基准的旋转，根据公式1，得到坐标转换关系：

其中，(xavyavzav)和α代表机械臂基座坐标系oa沿视觉模块坐标系ov的三个坐标轴分别平移xav、yav、zav后再沿视觉模块坐标系ov的z轴方向逆时针旋转α后则oa与ov重合；(xvoyvozvo)和β代表视觉模块坐标系ov沿导航坐标系oo的三个坐标轴分别平移xvo、yvo、zvo后再沿导航坐标系oo的z轴方向逆时针旋转β后则ov与oo重合，则有变换关系：

假定p点为机械臂基座坐标系oa的中心，则^ap＝0,0,0，此时^op便是机械臂基座坐标系oa在导航坐标系oo下的表示，从而得到确定机械臂1在导航坐标系下的位置。

优选地，所述导航码带4的形状是相互连接的矩形的三条边。

优选地，所述agv为麦克纳姆轮全向移动平台。

优选地，所述机械臂1位于agv车体2的后部位置。

(三)有益效果

本发明基于建模的方式，利用坐标系间的关系，通过几组矩阵运算便能计算出机械臂相对于导航坐标系的位置，确定机械臂在导航坐标系下的位置，从而能够计算出物体在机械臂基座坐标系下的位姿表示；再结合工位内物体与导航坐标系的关系，可以方便地对机械臂轨迹进行规划。其中机械臂和agv分开建模，大大降低了模型的复杂度，方便控制。

附图说明

图1是本发明的系统结构示意图；

图2是基于图1的系统得到的agv导航示意图。

具体实施方式

为使本发明的目的、内容、和优点更加清楚，下面结合附图和实施例，对本发明的具体实施方式作进一步详细描述。

本发明提供一种用于基于码带式agv位置信息来标定其搭载的机械臂位置的系统。该系统为一gv模型，其中，在导航坐标系原点、agv视觉模块的中心和机械臂基座中心设定坐标系，分别为oo、ov、oa。agv在行驶过程中，实时获得agv视觉模块处的位置坐标(x、y)及偏角ω信息。据此，能够计算出ov相对于oo的转换关系而oa与ov间的关系随着机械结构的确定就已经确定，为因此，机械臂基座坐标系与导航坐标系间的关系就可以确定为即可以确定机械臂在导航坐标系下的位置。

基于以上思路，本发明中设计的系统，即搭载机械臂的agv模型如图1所示。包括机械臂1、agv车体2、视觉模块3、导航码带4。视觉模块3安装在agv车体2的前端，机械臂1通过一机械臂基座固定在agv车体2的顶部，agv车体2在自主导航时，始终沿着导航码带4行驶，视觉模块3能够实时读出自身位置处的位置信息(x、y)和相对于导航码带4的偏航角度ω。

根据空间内任意两坐标系间的转换关系，空间内任意一点p，若已知该点在一坐标系内的表示为^sp，欲求该点在另一坐标系下的表示^op，有：

其中，为旋转矩阵，代表两坐标系间的旋转关系。^ops-ori为平移矩阵，代表两坐标系间的平移关系。

agv导航示意图如图2所示。其中导航坐标系oo随导航路径的确定而固定，视觉模块坐标系ov和机械臂基座坐标系oa随着agv车体2的移动而不断变化。假定空间内任意一点p，其在视觉模块坐标系ov、机械臂基座坐标系oa和导航坐标系oo三个坐标系的坐标表示依次为：^vp、^ap和^op。由于agv模型整体在导航坐标系oo的x-y平面内运动，坐标系只存在平移和以z轴为基准的旋转。因此，根据公式(1)，其坐标转换关系为：

其中，(xavyavzav)和α代表机械臂基座坐标系oa沿视觉模块坐标系ov的三个坐标轴分别平移xav、yav、zav后再沿视觉模块坐标系ov的z轴方向逆时针旋转α后则oa与ov重合。由于机械臂基座固连在agv车体2上，因此(xavyavzav)和α为可测常数。同理，(xvoyvozvo)和β代表视觉模块坐标系ov沿导航坐标系oo的三个坐标轴分别平移xvo、yvo、zvo后再沿导航坐标系oo的z轴方向逆时针旋转β后则ov与oo重合。，(xvoyvozvo)和β可以通过读取导航码带4位姿信息获得。因此，根据矩阵计算，可以求得机械臂基座坐标系oa相对于导航坐标系oo的变换关系。

假定p点为机械臂基座坐标系oa的中心，则^ap＝(0,0,0)，此时^op便是机械臂基座坐标系oa在导航坐标系oo下的表示，从而得到确定机械臂1在导航坐标系下的位置。此外，当已知工位内物体在导航坐标系下的表示，根据上述公式，便可以求出该物体机械手基座坐标系下的表示，这样便能够方便的进行机械臂的运动路径规划和控制。

以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明技术原理的前提下，还可以做出若干改进和变形，这些改进和变形也应视为本发明的保护范围。