移动机器人的路径跟踪方法技术

本发明专利技术揭示了一种移动机器人的路径跟踪方法，所述移动机器人包括左、右驱动轮和万向轮，包括以下步骤：S1：设定移动机器人的工作路径；S2：根据移动机器人当前方向θi、当前速度Vi及沿运动方向的尺寸L设置前瞻点Pi；S3：确定工作路径上距离前瞻点Pi最近的相邻离散点Ai、Bi；S4：计算前瞻点Pi与直线AiBi之间的距离Di；S5：计算当前方向θi与直线AiBi之间的夹角Δθi；S6：根据距离Di及夹角Δθi计算左、右驱动轮转速差ΔVi；S7：根据Vi、ΔVi对移动机器人的左、右驱动轮进行速度调节。与现有技术相比，本发明专利技术技术方案使得移动机器人实际运行轨迹与设定的工作路径误差更小，移动更为精确。

Path tracking method for mobile robot

The invention discloses a path tracking method for a mobile robot, which comprises left and right driving wheels and universal wheels, and comprises the following steps: S1: setting the working path of the mobile robot; S2: setting the forward-looking point Pi according to the current direction theta i, the current speed Vi and the size L along the moving direction of the mobile robot; Determine the nearest adjacent discrete points Ai, Bi on the working path to the forward-looking point Pi; S4: Calculate the distance between the forward-looking point Pi and the straight line AiBi Di; S5: Calculate the angle between the current direction theta I and the straight line AiBi_theta i; S6: Calculate the left and right wheel speed difference Vi according to the distance Di and the angle_theta i; S7: Calculate the moving machine according to Vi, Vi pairing. The left and right driving wheels of the human are used for speed adjustment. Compared with the prior art, the technical scheme of the invention makes the error between the actual running track and the set working path of the mobile robot smaller and the movement more accurate.

【技术实现步骤摘要】
移动机器人的路径跟踪方法
本专利技术涉及移动机器人，特别是移动机器人的路径跟踪方法。
技术介绍
随着人工智能技术及先进制造技术的不断发展，移动机器人的应用越来越广泛。为了保证能够安全、高效的完成工作，在移动机器人工作之前，用户需要确认移动机器人的工作边界或设定移动机器人的工作路径。对于割草机器人等覆盖式机器人来说，可通过设定割草范围边界，使其尽可能地覆盖草坪边界，提高割草覆盖率；对于安防巡逻机器人来说，通过设定工作路径，使其尽可能按设定工作路径行走，避免监控盲区。然后，现有的移动机器人(如割草机器人或安防巡逻机器人)在按规划的路径工作时，是通过惯性导航系统结合传感器来实现的，移动机器人的实际移动轨迹与设定工作边界或工作路径存在偏差。因此有必要提供一种解决上述问题的方案。
技术实现思路
本专利技术的目的之一在于克服
技术介绍
中的缺陷，提供一种移动机器人的安路径跟踪方法，其具体方案如下：一种移动机器人的路径跟踪方法，所述移动机器人包括左、右驱动轮和万向轮，包括以下步骤：S1：设定移动机器人的工作路径；S2：根据移动机器人当前方向θi、当前速度Vi及沿运动方向的尺寸L设置前瞻点Pi；S3：确定工作路径上距离前瞻点Pi最近的相邻离散点Ai、Bi；S4：计算前瞻点Pi与直线AiBi之间的距离Di；S5：计算当前方向θi与直线AiBi之间的夹角Δθi；S6：根据距离Di及夹角Δθi计算左、右驱动轮转速差ΔVi；S7：根据Vi、ΔVi对移动机器人的左、右驱动轮进行速度调节。进一步地，在本专利技术的优化方案中，还包括步骤S8：间隔预定时间后再返回步骤S2直到移动机器人完成工作路径跟踪。进一步地，在本专利技术的一个实施例中，所述前瞻点Pi位于移动机器人的正前方。进一步地，所述前瞻点Pi距离移动机器人的距离d＝k1*Vi*L，其中，k1为基于速度的比例系数。进一步地，在本专利技术的一个实施例中，所述步骤S4包括：S41：获取前瞻点Pi、点Ai及点Bi的坐标；S42：计算前瞻点Pi、点Ai及点Bi构成的三角形面积Si；S43：计算点Ai、点Bi之间的距离Li；S44：计算前瞻点Pi到直线AiBi的距离：Di＝2*Si/Li。进一步地，所述步骤S42和步骤S43可相互交换。进一步地，在本专利技术的一个实施例中，所述步骤S6是通过设计轮速模糊控制器计算左、右驱动轮转速差ΔVi的，包括：S61：将距离Di及夹角Δθi进行模糊化处理；S62：通过模糊控制表查询得到期望转向轮速差；S63：对期望转向轮速差去模糊化处理得到左、右驱动轮转速差ΔVi。进一步地，所述步骤S4和步骤S5可相互交换。进一步地，在本专利技术的一个实施例中，所述移动机器人为割草机器人。与现有技术相比，本专利技术技术方案通过设置与移动机器人当前方向、当前速度及移动机器人沿运动方向的长度相关的前瞻点，再通过该前瞻点确定工作路径上与其最近的两个相邻离散点，再通过计算该两个相邻离散点确定的直线与前瞻点之间的距离和与移动机器人当前方向的角度差来确定移动机器人的左右驱动轮转速差，然后根据该转速差对左右轮转速进行调节，使得移动机器人实际运行轨迹与设定的工作路径误差更小。附图说明为了更清楚地说明本专利技术实施例的技术方案，下面将对实施例中所需要使用的附图作简单的介绍，显而易见地，下面描述中的附图是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1是本专利技术方法的较佳实施例的流程图；图2是图1中的步骤S4的子步骤流程图；图3是图1中的步骤S6的子步骤流程图；图4是本专利技术方法的路径跟踪示意图。具体实施方式下面将结合附图和具体实施例对本专利技术技术方案进行清楚、完整地描述，显然，这里所描述的实施例仅仅是专利技术的一部分实施例，而不是全部的实施例。基于本专利技术描述的具体实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本专利技术权利要求所限定的保护范围内。本专利技术中的移动机器人包括控制系统、传感器系统、驱动系统和电源系统，控制系统用于根据预定程序或传感器系统返回的信号控制移动机器人执行特定的任务或动作，传感器系统用于检测移动机器人外部环境或移动机器人本身部件工作状态并发送相关信息给控制系统，驱动系统用于驱动移动机器人发生运动，电源系统为移动机器人的各系统提供电能，此外移动机器人还包括功能模块以执行特定任务。如图1至图4所示，为本专利技术一较佳实施例。在本实施例中，移动机器人以割草机器人为例进行说明，本实施例中的割草机器人的控制系统为STM32单片机；传感器系统包括陀螺仪和UWB(ultrawideband，超宽带)；驱动系统为位于割草机器人后方的大小相同的左、右驱动轮和位于割草机前方中心位置处的万向轮，左、右驱动轮由无刷电机驱动芯片MC33035DW驱动；电源系统为可充电锂氢电池。下面对本实施例中的割草机器人的路径跟踪过程进行详细说明。S1：设定移动机器人的工作路径。本专利技术方法基于设定的工作路径，可通过割草机器人的自建地图，然后设定其工作路径(如工作区域边界)，或者是将规划好的地图及工作路径发送至割草机器人的控制系统。其中，本实施例中的工作路径是由一系列离散点构成，每个离散点在地图中的坐标已确定。S2：根据移动机器人当前方向θi、当前速度Vi及沿运动方向的尺寸L设置前瞻点Pi。割草机器人本身尺寸L为已知量，具体地，当其为圆形时，L为其直径，当其为矩形时，L为沿当前运动方向的长度。割草机器人通过陀螺仪获取其在地图中的当前方向θi，通过UWB方式得到其在地图中的坐标(X0,YO)，通过测速传感器(如光栅测速)分别得到左、右驱动轮的旋转速度，然后选取左、右驱动轮的平均转速作为割草机器人当前的速度Vi，然后在割草机器人的正前方设置前瞻点Pi(即左右驱动轮连线的中心点与万向轮的连线上)，前瞻点Pi距离割草机器人的前瞻距离d＝k1*Vi*L，其中，前瞻距离d为左、右驱动轮连线中心点到前瞻点Pi的距离，k1为基于速度的比例系数，k1是通过仿真或实验获得的经验值，其取值范围一般为20-25。S3：确定工作路径上距离前瞻点Pi最近的相邻离散点Ai、Bi。首先需确定前瞻点Pi在地图坐标系中的坐标(Xp，Yp)，如图4所示，根据移动机器人当前点O及其对应的前瞻点Pi的相对关系可以得到前瞻点Pi的坐标为(X0+d*cosθi,YO+d*sinθi)，然后根据就近原则得到与前瞻点Pi最近的两个相邻离散点Ai、Bi。最简单的方法为：a、选择工作路径上的两个相邻离散点，满足其中一个离散点的横坐标大于Xp，而另一个离散点的横坐标小于Xp；b、或选择工作路径上的两个相邻离散点，满足其中一个离散点的纵坐标大于Yp，而另一个离散点的纵坐标小于Yp。S4：计算前瞻点Pi与直线AiBi之间的距离Di。如图2所示，本实施例中，获取前瞻点Pi与直线AiBi之间的距离Di的具体步骤如下：S41：获取前瞻点Pi、点Ai及点Bi的坐标，具体地，前瞻点Pi的坐标通过步骤3中可以得到，而相邻离散点Ai、Bi的坐标也可以直接读取；S42：计算前瞻点Pi、点Ai及点Bi构成的三角形面积Si，具体地，Si＝(Xa*Yb+Xb*Yp+Xp*Ya-Xa*Yp-Xp*Yb-Xb*Ya)/2；S43：计算点本文档来自技高网...

【技术保护点】
1.一种移动机器人的路径跟踪方法，所述移动机器人包括左、右驱动轮和万向轮，其特征在于，包括以下步骤：S1：设定移动机器人的工作路径；S2：根据移动机器人当前方向θi、当前速度Vi及沿运动方向的尺寸L设置前瞻点Pi；S3：确定工作路径上距离前瞻点Pi最近的相邻离散点Ai、Bi；S4：计算前瞻点Pi与直线AiBi之间的距离Di；S5：计算当前方向θi与直线AiBi之间的夹角Δθi；S6：根据距离Di及夹角Δθi计算左、右驱动轮转速差ΔVi；S7：根据Vi、ΔVi对移动机器人的左、右驱动轮进行速度调节。

【技术特征摘要】
1.一种移动机器人的路径跟踪方法，所述移动机器人包括左、右驱动轮和万向轮，其特征在于，包括以下步骤：S1：设定移动机器人的工作路径；S2：根据移动机器人当前方向θi、当前速度Vi及沿运动方向的尺寸L设置前瞻点Pi；S3：确定工作路径上距离前瞻点Pi最近的相邻离散点Ai、Bi；S4：计算前瞻点Pi与直线AiBi之间的距离Di；S5：计算当前方向θi与直线AiBi之间的夹角Δθi；S6：根据距离Di及夹角Δθi计算左、右驱动轮转速差ΔVi；S7：根据Vi、ΔVi对移动机器人的左、右驱动轮进行速度调节。2.根据权利要求1所述的移动机器人的路径跟踪方法，其特征在于，还包括步骤S8：间隔预定时间后再返回步骤S2直到移动机器人完成工作路径跟踪。3.根据权利要求1或2所述的移动机器人的路径跟踪方法，其特征在于，所述前瞻点Pi位于移动机器人的正前方。4.根据权利要求3所述的移动机器人的路径跟踪方法，其特征在于，所述前瞻点Pi距离移动机器人的距离d＝k1*Vi*L，其中，k1为基于速度的比例...

【专利技术属性】
技术研发人员：焦新涛，单鹏辉，丁璜，赵常伦，温献雷，
申请(专利权)人：广州科语机器人有限公司，
类型：发明
国别省市：广东,44