admin管理员组

文章数量:1530864

1 简介

针对移动机器人的实时导航和避障设计了基于人工势场的控制算法,用该算法控制移动机器人能在未知的环境中,实时检测出障碍物,并实时规划出合理路径,稳定,平滑连续地向目标行驶,给出了机器人行驶的实验结果.通过小车车体方位计算确定了避障方法-人工势场法,即目标位置对移动机器人产生一种虚拟的吸引力,而障碍物对机器人产生一种虚拟的排斥力,这两种力的合成就决定了移动机器人的运动.通过对处于静态环境下的小车的路径进行了规划并进行计算机仿真.仿真结果表明,该人工势场法能有效地实现机器人小车的避障功能.​

2 部分代码

clear all;
clc
close all
%障碍和目标,起始位置都已知的路径规划,意图实现从起点可以规划出一条避开障碍到达目标的路径。
%初始化车的参数
Xo=[0 0];% 起点位置
k=1000;% 计算引力需要的增益系数
%K=0;% 初始化
m=10;% 计算斥力的增益系数,都是自己设定的。
Po=1;%障碍影响距离,当障碍和车的距离大于这个距离时,斥力为0,即不受该障碍的影响。也是自己设定。
n=9;%障碍个数
a=0.5;
l=0.1;% 步长
J=300;%循环迭代次数
r = 0.5;
%如果不能实现预期目标,可能也与初始的增益系数, Po 设置的不合适有关。
%end
%给出障碍和目标信息
Xsum=[10 10;1 1.5;3 2.2;4 4.5;3 6;6 2.5;5.5 6; 6 4.5;9 9;8.5 5];% 这个向量是(n+1)*2 维,其中[10 10] 是目标

本文标签: 路径机器人算法代码matlab