首页 >> 防盗盖

一种移动机器人的路径规划算法龙门刨铣床

发布时间:2022-08-05 15:07:23 来源:福邦五金网

一种移动机器人的路径规划算法

一种移动机器人的路径规划算法 2011年12月09日 来源: 1引言 移动机器人路径规划问题是指在有障碍物的工作环境中寻找一条恰当的从给定起点到终点的运动路径,使机器人在运动过程中能安全、无碰撞地绕过所有的障碍物[1]。 障碍环境中机器人的无碰撞路径规划[2]是智能机器人研究的重要课题之一,由于在障碍空间中机器人运动规划的高度复杂性使得这一问题至今未能很好地解决。路径规划问题根据机器人的工作环境模型可以分为两种,一种是基于模型的路径规划,作业环境的全部信息都是预知的;另一种是基于传感器的路径规划,作业环境的信息是全部未知或部分未知的。 对机器人路径规划的研究,世界各国的专家学者们提出了许多不同的路径规划方法,主要可分为全局路径和局部路径规划方法。全局路径规划方法有位形空间法、广义锥方法、顶点图像法、栅格划归法;局部路径规划方法主要有人工势场法。这些方法都各有优缺点[3],也没有一种方法能够适用于任何场合。 本文提出一种最短切线路径的规划方法,其涉及的理论并不高深,计算简单,容易实现,可供侧重于应用的读者参考。下面将详细介绍该算法的基本原理,最后给出仿真实现的结果。2最短切线路径算法2.1算法基本原理 (1)首先判断机器人和给定的目标位置之间是否存在障碍物。如图1所示,以B代表目标位置,其坐标为(xB,yB),以R、A分别代表机器人及障碍物,坐标为(xR,yR)、(xA,yA)。Rr和Ra表示机器人和障碍物的碰撞半径,也就是说在其半径以外无碰撞的危险。这里对碰撞半径的选择作出一点说明,碰撞半径越小,发生碰撞的危险度越大,但切线路径越短;碰撞半径越大,发生碰撞的危险度越小,但同时切线路径越长。要根据实际情况和控制要求来确定碰撞半径。若机器人与目标位置之间不存在障碍物,机器人可走直线直接到达目标位置,此时的直线方程可由两点式确定: 写成ax+by+c=0的标准形式得:若d>Ra+Rr,则机器人可沿直线到达目标点而不碰物体A,此时物体A不是障碍物。若d<Ra+Rr,机器人走直线可能碰上物体A,此时物体A应被视为障碍物。 (2)求切线路径。如图1所示,以A点为圆心,Ra+Rr为半径作碰撞圆,其方程为: k1,k2为待求斜率,联立方程组:可分别求得两切线的斜率k1,k2,显然k1,k2各有两个值,分别对应两条切线方程。两组切线两两相交,由方程组求得两个交点C1、C2,称为绕过障碍物A的中途点。由此可以得到绕过障碍物A并到达目标点B的两条切线路径,路径1:R→C1→B;路径2:R→C2→B。比较两条路径的长度,在图1中,|RC1|+|BC1|<|RC2|+|BC2|,可知,路径1为最短切线路径。2.2多障碍物情况 对于存在多个障碍物的情形,可分成几种情况来考虑。 (1)障碍物位于前一障碍物的中途点。也就是说,机器人要到达的中途点位于另一个障碍物的碰撞圆内,如果机器人到达中途点就有可能碰上该障碍物,此时可以用该障碍物的坐标代替原障碍物的坐标来求这一侧的中途点。对于另外一侧的中途点,如果也有障碍物,同样处理;若没有,则中途点不变。然后,仍然计算并比较两条路径的长度,选择最短的切线路径。如图2所示,图中虚线表示原来的路径1,由于中途点被障碍物A2阻挡,路径1上移。此时,|RC1|+|BC1|>|RC2|+|BC2|,最短切线路径应为路径2。 (2)在切线路径上存在障碍物。可把绕过多个障碍物到达最终位置的任务分割成若干子任务,每个子任务要求绕过一个障碍物。这样,一个子任务就相当于前面只有一个障碍物的情况。以Bi、Ci分别表示第i个子任务的目标点和中途点,执行第i个子任务时,如果在到达Bi的路径上存在障碍物,则增加第i+1个子任务,此时目标点Bi+1就是Bi;如果在到达Ci的路径上存在障碍物,则增加第i+1个子任务,此时目标点Bi+1是Ci。

双分支阻滞怎么治疗

长春男科医院

池州看早泄比较好的专家

广州哪个医院看妇科好

济南男科医院排行榜

友情链接