四轮麦克纳姆轮巡检机器人运动控制方法技术

本发明专利技术公开了一种四轮麦克纳姆轮巡检机器人运动控制方法。其包括将巡检机器人的运动分解为三个独立分量，计算巡检机器人的各个麦克纳姆轮的轴心速度，计算巡检机器人的各个麦克纳姆轮的平行速度，计算巡检机器人的各个麦克纳姆轮的转动速度，控制巡检机器人在平面内运动。本发明专利技术可以让巡检机器人在平面上完成任意方向的运动，而无需让巡检机器人绕某一圆心旋转，从而有效的提高了巡检机器人运动效率，使得巡检机器人能在更小的空间完成就地转向、横向移动和按照一定角度斜线运动，避免了普通橡胶轮胎运动的不足。

The four round of Mecanum wheel motion inspection robot control method

The invention discloses a four round Mecanum wheel motion inspection robot control method. It will include inspection robot motion is divided into three independent components, calculating each inspection robot Mecanum wheel axis speed calculation, inspection robot each Mecanum wheel parallel computing speed, each inspection robot Mecanum wheel rotational speed, control movement in the plane of patrol robot. The invention allows the robot to complete the inspection in any direction in the plane of the movement, without making the inspection robot rotating around a circle, which effectively improves the efficiency of inspection robot motion, the robot can complete the on-site inspection of steering, lateral movement and oblique movement at a certain angle in a smaller space, avoids the shortcomings of ordinary rubber tire movement.

【技术实现步骤摘要】
四轮麦克纳姆轮巡检机器人运动控制方法
本专利技术属于巡检机器人运动控制
，尤其涉及一种四轮麦克纳姆轮巡检机器人运动控制方法。
技术介绍
移动式机器人与固定基座的机器人相比，具有更大、更灵活的工作空间，但同时轮式运动引入了非完整约束。作为一类典型的非完整系统，移动机器人的镇定和跟踪问题引起了人们的广泛关注。对非完整约束移动机器人的控制策略的研究成为机器人研究的一个热点。从90年代末期尤其是2000年以后，许多研究者开始关注这一问题，并致力于不确定非完整系统的控制研究。相关工作的重点主要是解决系统的模型不确定性、外界干扰以及信号的噪声污染、输入受限、转弯半径受限等实际问题，进行相关的鲁棒和自适应控制以及滤波器的设计。研究不确定非完整系统镇定和跟踪问题的文献的多样性，主要是因为对不确定性或干扰采用了不同的模型，以及使用了不同的处理方法以取得鲁棒性或适应性。对不确定非完整动力学系统进行设计的主要方法有自适应控制、鲁棒控制、鲁棒自适应控制、智能控制等。轮式移动机器人是一个具有大延迟、高度非线性的复杂系统”。建立精确的数学模型十分困难，在进行航向跟踪控制时。参数的变化对系统模型的影响较大，其中纵向速度的影响最为明显。轮式移动机器人的一般的控制方法是把期望的航向与机器人的实测航向之间的误差作为控制器的输入偏差。轮式移动机器人的航向与其纵向速度、横向速度、前轮的偏角、机器人绕其重心的转动惯量、重心的位置、前后轮的侧偏系数以及实际的道路情况等诸多因素都有关，因此，对轮式机器人建立动力学模型是比较困难的。
技术实现思路
本专利技术的专利技术目的是：为了解决现有技术中存在的以上问题，本专利技术提出了一种四轮麦克纳姆轮巡检机器人运动控制方法。本专利技术的技术方案是：一种四轮麦克纳姆轮巡检机器人运动控制方法，包括以下步骤：A、将巡检机器人在平面内的运动分解为X轴平动、Y轴平动、yaw轴自转三个独立分量；B、计算巡检机器人的各个麦克纳姆轮的轴心速度；C、将步骤B中巡检机器人的各个麦克纳姆轮的轴心速度分解为沿辊子方向的平行速度和垂直于辊子方向的垂直速度，计算巡检机器人的各个麦克纳姆轮的平行速度；D、根据步骤C中巡检机器人的各个麦克纳姆轮的平行速度计算巡检机器人的各个麦克纳姆轮的转动速度；E、根据步骤D中巡检机器人的各个麦克纳姆轮的转动速度控制巡检机器人在平面内运动。进一步地，所述步骤B计算巡检机器人的各个麦克纳姆轮的轴心速度的计算公式具体为：其中，为麦克纳姆轮的轴心速度矢量，为巡检机器人的几何中心速度矢量，为yaw轴自转的角速度，为从巡检机器人的几何中心指向麦克纳姆轮的轴心的矢量。进一步地，所述步骤C中计算巡检机器人的各个麦克纳姆轮的平行速度的计算公式具体为：其中，为麦克纳姆轮的平行速度矢量，vx为麦克纳姆轮的轴心速度在X轴方向的速度分量，vy为麦克纳姆轮的轴心速度在Y轴方向的速度分量。进一步地，所述步骤D中计算巡检机器人的各个麦克纳姆轮的转动速度的计算公式具体为：其中，vω为麦克纳姆轮的转动速度。本专利技术的有益效果是：本专利技术通过将巡检机器人的运动分解为三个独立分量，计算出巡检机器人的各个麦克纳姆轮的轴心速度，从而计算出巡检机器人的各个麦克纳姆轮的转动速度；通过X轴平动、Y轴平动、yaw轴自转三个独立分量的运动结合，可以让巡检机器人在平面上完成任意方向的运动，而无需让巡检机器人绕某一圆心旋转，从而有效的提高了巡检机器人运动效率，使得巡检机器人能在更小的空间完成就地转向、横向移动和按照一定角度斜线运动，避免了普通橡胶轮胎运动的不足。附图说明图1是本专利技术的四轮麦克纳姆轮巡检机器人运动控制方法流程示意图。图2是本专利技术实施例中巡检机器人的运动分解示意图。图3是本专利技术实施例中巡检机器人的麦克纳姆轮轴心速度示意图。图4是本专利技术实施例中巡检机器人的四个麦克纳姆轮轴心速度示意图。图5是本专利技术实施例中巡检机器人的麦克纳姆轮轴心速度分解示意图。图6是本专利技术实施例中巡检机器人的四个麦克纳姆轮轴心速度分解示意图。具体实施方式为了使本专利技术的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本专利技术进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本专利技术，并不用于限定本专利技术。如图1所示，为本专利技术的四轮麦克纳姆轮巡检机器人运动控制方法流程示意图。一种四轮麦克纳姆轮巡检机器人运动控制方法，包括以下步骤：A、将巡检机器人在平面内的运动分解为X轴平动、Y轴平动、yaw轴自转三个独立分量；B、计算巡检机器人的各个麦克纳姆轮的轴心速度；C、将步骤B中巡检机器人的各个麦克纳姆轮的轴心速度分解为沿辊子方向的平行速度和垂直于辊子方向的垂直速度，计算巡检机器人的各个麦克纳姆轮的平行速度；D、根据步骤C中巡检机器人的各个麦克纳姆轮的平行速度计算巡检机器人的各个麦克纳姆轮的转动速度；E、根据步骤D中巡检机器人的各个麦克纳姆轮的转动速度控制巡检机器人在平面内运动。在步骤A中，本专利技术的巡检机器人的各个麦克纳姆轮由两大部分组成：轮毂和辊子(roller)。轮毂是整个轮子的主体支架，辊子则是安装在轮毂上的鼓状物。麦克纳姆轮的轮毂轴与辊子转轴呈45°角。如图2所示，为本专利技术实施例中巡检机器人的运动分解示意图。本专利技术将巡检机器人在巡检平面内的运动分解为三个独立分量，分别为：X轴平动、Y轴平动、yaw轴自转。本专利技术的巡检机器人的四个麦克纳姆轮的速度也是由四个独立的电机提供的。所以四个麦克纳姆轮的合理速度是存在某种约束关系的，逆运动学可以得到唯一解，而正运动学中不符合这个约束关系的方程将无解。在步骤B中，如图3所示，为本专利技术实施例中巡检机器人的麦克纳姆轮轴心速度示意图。本专利技术计算巡检机器人的各个麦克纳姆轮的轴心速度的计算公式具体为：其中，为麦克纳姆轮的轴心速度矢量，为巡检机器人的几何中心速度矢量，为yaw轴自转的角速度，为从巡检机器人的几何中心指向麦克纳姆轮的轴心的矢量。再将麦克纳姆轮的轴心速度矢量分别沿X轴方向和Y轴方向进行分解，计算麦克纳姆轮的轴心速度矢量分别沿X轴方向和Y轴方向的分量，表示为：其中，vx为麦克纳姆轮的轴心速度在X轴方向的速度分量，vy为麦克纳姆轮的轴心速度在Y轴方向的速度分量，为巡检机器人沿X轴方向的速度，为巡检机器人沿Y轴方向的速度，rx为沿X轴方向的分量，ry为沿X轴方向的分量。如图4所示，为本专利技术实施例中巡检机器人的四个麦克纳姆轮轴心速度示意图。根据上述计算方法即可得到巡检机器人的各个麦克纳姆轮的轴心速度。在步骤C中，如图5所示，为本专利技术实施例中巡检机器人的麦克纳姆轮轴心速度分解示意图。本专利技术将步骤B中巡检机器人的各个麦克纳姆轮的轴心速度分解为沿辊子方向的平行速度和垂直于辊子方向的垂直速度，由于垂直于辊子方向的垂直速度对于巡检机器人的运动不会产生影响，因此本专利技术只需计算巡检机器人的各个麦克纳姆轮的平行速度，计算公式具体为：其中，为麦克纳姆轮的平行速度矢量，vx为麦克纳姆轮的轴心速度在X轴方向的速度分量，vy为麦克纳姆轮的轴心速度在Y轴方向的速度分量。在步骤D中，本专利技术根据步骤C中巡检机器人的各个麦克纳姆轮的平行速度计算巡检机器人的各个麦克纳姆轮的转动速度，计算公式具体为：其中，vω为麦克纳姆轮的转动速度。如图6所示，为本专利技术实施例中巡检机器人的四个麦克纳姆轮本文档来自技高网...

【技术保护点】
一种四轮麦克纳姆轮巡检机器人运动控制方法，其特征在于，包括以下步骤：A、将巡检机器人在平面内的运动分解为X轴平动、Y轴平动、yaw轴自转三个独立分量；B、计算巡检机器人的各个麦克纳姆轮的轴心速度；C、将步骤B中巡检机器人的各个麦克纳姆轮的轴心速度分解为沿辊子方向的平行速度和垂直于辊子方向的垂直速度，计算巡检机器人的各个麦克纳姆轮的平行速度；D、根据步骤C中巡检机器人的各个麦克纳姆轮的平行速度计算巡检机器人的各个麦克纳姆轮的转动速度；E、根据步骤D中巡检机器人的各个麦克纳姆轮的转动速度控制巡检机器人在平面内运动。

【技术特征摘要】
1.一种四轮麦克纳姆轮巡检机器人运动控制方法，其特征在于，包括以下步骤：A、将巡检机器人在平面内的运动分解为X轴平动、Y轴平动、yaw轴自转三个独立分量；B、计算巡检机器人的各个麦克纳姆轮的轴心速度；C、将步骤B中巡检机器人的各个麦克纳姆轮的轴心速度分解为沿辊子方向的平行速度和垂直于辊子方向的垂直速度，计算巡检机器人的各个麦克纳姆轮的平行速度；D、根据步骤C中巡检机器人的各个麦克纳姆轮的平行速度计算巡检机器人的各个麦克纳姆轮的转动速度；E、根据步骤D中巡检机器人的各个麦克纳姆轮的转动速度控制巡检机器人在平面内运动。2.如权利要求1所述的四轮麦克纳姆轮巡检机器人运动控制方法，其特征在于，所述步骤B计算巡检机器人的各个麦克纳姆轮的轴心速度的计算公式具体为：其中，为麦克纳...

【专利技术属性】
技术研发人员：周谊，
申请(专利权)人：四川超影科技有限公司，
类型：发明
国别省市：四川,51