2 u011061238 u011061238 于 2013.06.14 10:40 提问

有关于移动机器人的视觉导航的MATLAB程序

有关于移动机器人的视觉导航的MATLAB程序,要求是导航不是领航,并能生成二维曲线图,进行动画仿真
我这儿有一个领航的程序,求高手改成导航的程序:(着急用不胜感激)
clear;
clf;
clc;
maxT=100; %模拟时间
t=0:maxT; %虚拟时间 单位:秒
UL=0.2; %领航机器人速度 单位:m/s
Um=0.5; %跟随机器人 最大输出速度 单位:m/s
XL=UL.*t; %初始化 xl
YL=0.*XL; %初始化 yl
YF=0.*t; XF=0.*t; %初始化 xf and yf
XF(1)=-4; YF(1)=2; %设定 xf and yf Xo (x,y)
dp=0.5; %设定 保持距离 单位:m
et=0.*t; %初始化保持距离 单位:m
ect=0.*t; %初始化速度 单位:m
dt=0.*t; %初始化机器人间距 单位:m
Rotatc=0.*t;
dt(1)=sqrt((abs(XF(1)-XL(1)))^2+(abs(YF(1)))^2);
et(1)=dt(1)-dp;
ect(1)=0;
U=0.*t; %初始化输出速度 单位:m/s
R=0.*t; %初始化角速度 单位:rad/s
R(1)=pi/2; %跟随机器人 初始朝向角
Rm=0.1; %跟随机器人最大角速度
agtanX=0.*t;

agtanY=0.*t;
Angletan=0.*t;
Rotat=0.*t;
%agtanX(1)=5*cos(R(1))+XF(1);
%agtanY(1)=5*sin(R(1))+YF(1);

%subplot(2,2,1),plot([XF(1),agtanX(1)],[YF(1),agtanY(1)],'-g');

kp=0.4;
ki=0.6;
krp=0.2;
kri=0.7;
Ut=0;
Pl=4;

for n=2:maxT

dt(n)=sqrt((XF(n-1)-XL(n))^2+(YF(n-1)-YL(n))^2); %机器人间距
et(n)=dt(n)-dp; %保持距离
ect(n)=(et(n)-et(n-1)); %分离速度
U(n)=kp*ect(n)+ki*et(n); %跟随机器人输出速度

if (U(n)>Um)                    %为了不使机器人过速
    U(n)=Um; 
end;

Angletan(n)=atan2((YL(n)-YF(n-1)),(XL(n)-XF(n-1)));     %跟随机器人期望达到的朝向
Rotat(n)=Angletan(n)-R(n-1);                %跟随机器人当前角度和期望朝向间的夹角    

if (abs(Rotat(n))>pi)                       %转化为(-pi,pi)
    Rotat(n)=(2*pi-abs(Rotat(n)))*(-abs(Rotat(n))/Rotat(n));
end

Rotatc(n)=kri*(Rotat(n)-Rotat(n-1))+krp*Rotat(n-1);     %角速度

if (abs(Rotatc(n))>=Rm)                     %限制角速度
    Rotatc(n)=(Rotatc(n)/abs(Rotatc(n)))*Rm;       
end  

R(n)=R(n-1)+Rotatc(n);                      %跟随机器人朝向
%Ut=U(n)/(abs(Rotatc(n)))*(sqrt(2-(cos(Rotat(n)))));%跟随机器人移动的距离
XF(n)=XF(n-1)+U(n)*cos(R(n-1)+Rotatc(n)/2);               %移动
YF(n)=YF(n-1)+U(n)*sin(R(n-1)+Rotatc(n)/2);

pause(0.01);shg;                            %绘制跟随轨迹
subplot(2,2,1),plot(XL(n),YL(n),'dr');hold on;

agtanX(n)=Pl*cos(R(n))+XF(n);                %绘制指向标记
agtanY(n)=Pl*sin(R(n))+YF(n);      
subplot(2,2,1),plot(XF(n),YF(n),'ob','Markersize',12);axis([-10,30,-20,20]);hold on;    
subplot(2,2,1),plot([XF(n),agtanX(n)],[YF(n),agtanY(n)],'-g');

end

%main pic
%subplot(2,2,1),plot(XL,YL,'dr');
%hold on;
agtanX(1)=Pl*cos(R(1))+XF(1); %绘制指向标记
agtanY(1)=Pl*sin(R(1))+YF(1);

subplot(2,2,1),plot(XF(1),YF(1),'ob','Markersize',12);%axis([0,30,-20,20]);
subplot(2,2,1),plot([XF(1),agtanX(1)],[YF(1),agtanY(1)],'-g');
title('\fontsize{12}\bf 路线图')
xlabel('\fontsize{12}\bfx\rightarrow');
ylabel('\fontsize{12}\bfy\rightarrow');
%grid on;
%output U speed
subplot(2,2,2),plot(t,U,'-b','LineWidth',2);%axis([0,60,-2,2]);
title('\fontsize{12}\bf 输出速度')
xlabel('\fontsize{12}\bft\rightarrow');
ylabel('\fontsize{12}\bfy\rightarrow');
%distance
subplot(2,2,3),plot(t,dt,'-b','LineWidth',2);%axis([0,30,0,20]);
title('\fontsize{12}\bf 间距')
xlabel('\fontsize{12}\bft\rightarrow');
ylabel('\fontsize{12}\bfy\rightarrow');
%distance Rotatc
subplot(2,2,4),plot(t,Rotatc,'-b','LineWidth',2);
title('\fontsize{12}\bf 角速度')
xlabel('\fontsize{12}\bft\rightarrow');
ylabel('\fontsize{12}\bfy\rightarrow');grid on;
shg;

2个回答

wangyaninglm
wangyaninglm   Ds   Rxr 2015.01.16 12:58
qq_31215943
qq_31215943   2017.03.30 17:44

您好,这个问题解决了吗?我现在也需要移动机器人的导航程序。

Csdn user default icon
上传中...
上传图片
插入图片
准确详细的回答,更有利于被提问者采纳,从而获得C币。复制、灌水、广告等回答会被删除,是时候展现真正的技术了!
其他相关推荐
【Robot】移动机器人的几种视觉算法
移动机器人的几种视觉算法 机智的大群主 · 1 个月前 谈到移动机器人,大家第一印象可能是服务机器人,实际上无人驾驶汽车、可自主飞行的无人机等等都属于移动机器人范畴。它们能和人一样能够在特定的环境下自由行走/飞行,都依赖于各自的定位导航、路径规划以及避障等功能,而视觉算法则是实现这些功能关键技术。 如果对移动机器人视觉算法不了解,你或许不知道获取物体深度信息、定位导航以及壁障等都是基
移动机器人视觉定位方法的研究
本文针对移动机器人的局部视觉定位问题进行了研究。首先通过移动机器人视觉定位与目标跟踪系统求出目标质心特征点的位置时间序列, 然后在分析二次成像法获取目标深度信息的缺陷的基础上, 提出了一种获取目标的空间位置和运动信息的方法。该方法利用序列图像和推广卡尔曼滤波, 目标获取采用了H IS 模型。在移动机器人满足一定机动的条件下, 较精确地得到了目标的空间位置和运动信息。仿真结果验证了该方法的有效性和可
基于单目视觉的移动机器人室内定位与运动目标跟踪
众所周知,利用双目摄像头可以方便地进行室内地图的构建,并进行移动机器人自身的定位,但是,由于双目摄像机在进行这些工作之前,首先要进行图像的匹配,而图像匹配是非常耗时的一项工作,目前的计算机系统尚没有办法实现快速计算并进行实时性反馈。为了解决室内移动机器人的实时自定位问题,本文提出了采用单目摄像头对机器人进行室内定位的方法。文中首先分析了世界坐标系、摄像机坐标系、图像坐标系以及计算机像素坐标系之间的
基于视觉导航的自主机器人简介(一)
自主移动机器人当代,机器人系统已经在工业自动化生产、监控系统、AGV(自主导引车)、医疗等各个领域得到较广应用。美国的军用机器人研发一直处于全球领先地位(如:BigDog),日本的服务机器人不仅会带来巨大的经济效益,也将有助于解决日本的老龄化问题。相比而言,中国机器人正处于发展研究阶段,离真正产业化还有相当一段距离要走,国内知名的如DJI(无人飞行器)、汇川机器人等。而在这些应用中,自主移动机器人其
自主移动机器人常用的导航定位技术及原理
随着经济的发展和科技的进步,智能机器人早就不是什么新鲜事物。而室内服务机器人作为新兴发展起来的产业,逐渐成为目前行业的风口浪尖,从最早的扫地机器人开始,家庭陪伴机器人、送餐机器人等陆续进入公众视线。 不管什么类型的机器人,只要自主移动,就需要在家庭或其他环境中进行导航定位。假如用金字塔来表示机器人技术,那么定位导航作为最底层技术,正是构建整个机器人的核心关键。 如何实现移动机器人在不确
j移动机器人的视觉导航
移动机器人的视觉导航,计算机视觉,图像处理。视频图像相关。
室外移动机器人视觉导航关键技术研究
室外移动机器人 视觉导航 道路检测 立体匹配 避障路径规划
移动机器人的视觉导航
移动机器人的视觉导航 计算机视觉的图像处理和 目标跟中 软件系类
移动机器人定位方法概述
引言 自主移动机器人导航过程需要回答三个问题:“我在哪里?”“我要去哪儿?”和“我怎样到达那里?”。定位就是要回答第一个问题,确切的,移动机器人定位就是确定机器人在其运动环境中的世界坐标系的坐标。 根据机器人定位可分为相对定位和绝对定位。 一、相对定位 移动机器人相对定位也叫作位资跟踪,假定机器人初始位资,采用相邻近时刻传感器信息对机器人位置进行跟踪估计。相对定位分为里程计法和惯性导航法
干货|自动驾驶 vs 机器人定位技术
点击上方“中兴开发者社区”,关注我们 每天读一篇一线开发者原创好文 金明 天津最早从事AI算法及创新工作的骨干之一 目前为机器人团队软件架构师 ▍定位问题的引入 我们所熟知的机器人,可以大致分为以下四类: 这四种类型的机器人可以做组合,如有智能行为的移动机器人,机器人可以移动并做一些操作行为。 前两类机器人发展的比较