[发明专利]一种麦克纳姆轮AGV的任意姿态导航方法

权利要求书

1.一种麦克纳姆轮AGV的任意姿态导航方法，其特征在于，包括以下步骤：

S1、将导航轨迹贴于地面，使可被麦克纳姆轮AGV识别；

S2、麦克纳姆轮AGV采集地面导航轨迹信息并沿导航路径寻迹前行；

S3、麦克纳姆轮AGV在接收到要求按照一种规定姿态沿路径导航的指令后，进行车体位置、姿态的实时调整，并保持规定姿态沿导航路径寻迹前行。

2.如权利要求1所述的方法，其特征在于，步骤S2中，还将麦克纳姆轮AGV自身所拥有的坐标系称之为车体坐标系；将导航轨迹自身所拥有的坐标系称之为路径坐标系；麦克纳姆轮AGV在行驶时能够利用纵移速度v_y1、横移速度v_x1与水平面旋转速度v_ω的矢量合成实现全向移动，其中纵移速度v_y1与横移速度v_x1的合成实现麦克纳姆轮AGV在水平面内的位置移动，水平面旋转速度v_ω1实现麦克纳姆轮AGV在水平面内的姿态变换。

3.如权利要求2所述的方法，其特征在于，步骤S2中，还规定纵移速度矢量与车体坐标系的纵坐标轴平行，即矢量处于车体坐标系y轴上；横移速度矢量与车体坐标系的横坐标轴平行，即矢量处于车体坐标系x轴上。

4.如权利要求3所述的方法，其特征在于，步骤S2中，给定沿路径坐标系的坐标轴方向的纵向移动速度v_y2、横向移动速度v_x2，使得麦克纳姆轮AGV沿导航轨迹行驶，其中只有一个速度为沿路径方向的主行驶速度，另一速度为正交调整速度。

5.如权利要求4所述的方法，其特征在于，步骤S3中，麦克纳姆轮AGV在接收到要求按照一种规定姿态沿路径导航的指令后，利用速度分解合成算法进行车体位置、姿态的实时调整，并保持规定姿态沿导航路径寻迹前行。

6.如权利要求5所述的方法，其特征在于，步骤S3中，利用速度分解合成算法进行车体位置、姿态的实时调整具体为：当车体坐标系的x轴正向与路径坐标系的x轴正向成0度夹角时，顺时针旋转车体坐标系，旋转角度为给定角度ω₀，使得麦克纳姆轮AGV在导航轨迹上呈现预期姿态，那么就相当于纵向移动速度v_y2、横向移动速度v_x2分别对应的速度矢量在车体坐标系中逆时针旋转了给定角度ω₀，将速度抽象于车体坐标系、路径坐标系中；

假设纵移速度矢量在路径坐标系中为(0,y₂)，横移速度矢量在路径坐标系中为(x₂,0)；

速度矢量的合成矢量在车体坐标系的横纵坐标轴上的正交分量就为麦克纳姆轮AGV的实际运行速度；

的合成矢量在路径坐标系中的坐标即为(x₂,y₂)利用矢量旋转公式得到的合成矢量在车体坐标系中的坐标：

y₁＝y₂cosω₀+x₂sinω₀

x₁＝x₂cosω₀-y₂sinω₀

由此得出麦克纳姆轮AGV应该被赋予的移动速度：

v_y1＝y₂cosω₀+x₂sinω₀

v_x1＝x₂cosω₀-y₂sinω₀

此时，麦克纳姆轮AGV以所述应该被赋予的移动速度实现车体位置、姿态的实时调整。

7.如权利要求1所述的方法，其特征在于，步骤S3中，麦克纳姆轮AGV接收上位机要求按照一种规定姿态沿路径导航的指令。