1 Star 0 Fork 0

gzl2012/rbpf-gmapping

加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
Motion_Model_Velocity_Test.m 730 Bytes
一键复制 编辑 原始数据 按行查看 历史
Adrian Llopart 提交于 2016-04-14 12:55 . Initial Update of all files
function p_xt= Motion_Model_Velocity_Test(u, x_p, a, gridsize)
%% Test to figure out which 'a' parameters suit you best
% u: control command
% x_p: initial position with orientation
% a: [a_1 ... a_6 ] of tested parameters
%the test will calculate the probability of the robot moving to every
%possible cell in the grid generating a banana-shaped density function
p_xt=zeros(gridsize(1), gridsize(2));
for i=1:gridsize(1)
for j=1:gridsize(2)-1
p_xt(i,j) = Motion_Model_Velocity([j i x_p(3)], u, x_p, a) ;
end
end
% Visualize results
figure(66)
clf;
hold on;
plot(x_p(1), x_p(2), 'dr');
surf(p_xt);
view([0 -90]);
hold off;
end
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化
Matlab
1
https://gitee.com/gzl2012/rbpf-gmapping.git
git@gitee.com:gzl2012/rbpf-gmapping.git
gzl2012
rbpf-gmapping
rbpf-gmapping
master

搜索帮助