[发明专利]爬行机器人在圆柱类物体表面运动位置的描述方法

说明书

本发明提供了一种爬行机器人在圆柱类物体表面运动位置的描述方法，采用分步假设法，如下：在笛卡尔直角坐标系中，设一圆柱面的轴线m在平面zoy内，在m轴上任意选择一圆A，圆A上任选一点C作为机器人在圆柱面上的位置；经分步假设，齐次向量表示，矩阵平移或旋转变换解算，改变相应的坐标值就可以求得任意点的坐标值，即对机器人在圆柱面上沿轴线方向移动或绕轴线对转动到任意点的位置描述。不管机器人在圆柱面上的移动方向是向左、向右、向前、向后，在出现多个分支方向的情况下，所用到的方法都是一样的，只需要利用本发明方法提供的公式平移或旋转变换，改变相应的坐标值就可以求得任意点的坐标值。

技术领域

本发明涉及机器人领域，尤其涉及机器人运动位置的描述方法。

背景技术

随着机器人技术的发展和在实践中的不断应用，机器人技术越来越成熟，应用领域也越来越广泛；尤其是一些比较危险的高空恶劣环境，我们更是迫切需要机器人能够代替人力工作；机器人代替人力，符合社会发展的需要，能够把人力从繁重危险的作业环境中解放出来，还能提高生产效率。

爬管、爬杆、爬树等圆柱类物体的外表面的机器人有着广阔的发展前景，具有比较大的研究价值，目前该类机器人的发展还处于起步阶段；其中，影响该类机器人研究和应用的一个重要问题就是机器人在复杂管路或分叉上运动过程中的精确位置如何进行描述确定。如果在三维空间中以笛卡尔直角坐标系中的坐标(x,y,z)来表示空间位置的话，其难点就是机器人可能沿着水平管运动，还可能沿着竖直管运动，还有可能沿着任意倾斜角度的斜管运动；在沿着各类管路的运动，不但包括沿管路轴线方向的平移，还包括绕着管路外表面任意角度的旋转动；尤其是机器人绕斜管旋转任意角度的位置描述用常规的方法不容易描述。

发明内容

本发明提供了一种机器人在爬圆柱类物体的外表面时的精确位置描述方法。该方法以地面为绝对参考系，符合物体宏观运动的轨迹研究和其他控制的需要。

一种爬行机器人在圆柱类物体表面运动位置的描述方法，采用分步假设法，如下：

步骤一、在笛卡尔直角坐标系中，设一圆柱面的轴线m在平面zoy内，圆柱的半径为r；轴线m与z轴的夹角为θ，与z轴的交点为E；E与平面xoy之间的距离为a；在轴线m上任意选择一点A，该点到E的距离为b；过点A做垂直于轴线m的平面，则平面与圆柱面的相交面为圆A；在圆A上，任选一点C，将C点坐标作为机器人在圆柱面上的位置；其中，C点在圆柱面上的运动可以是沿着轴线m方向的移动，也可以是绕着轴线m的转动；

步骤二、为了求机器人在圆柱面上的C点位置，现做如下分步假设：

1、让圆柱轴线m的初始位置与y轴重合；

2、让点C的起始点在坐标原点O，并记该点向量为C₁；此时点向量C₁用齐次向量表示为：

3、点C从原点O沿y轴平移到A₁点，此时点向量记为C₂，此时点向量C₂可以根据平移矩阵得到，平移矩阵为：

式中x₀—沿x轴方向平移距离；

y₀—沿y轴方向平移距离；

z₀—沿z轴方向平移距离；

则

4、点C从A₁点沿z轴方向平移到B₁点，此时点向量记为C₃；C₃向量可根据平移矩阵得到；