代码拉取完成,页面将自动刷新
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
此处可能存在不合适展示的内容,页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容,可点击提交进行申诉,我们将尽快为您处理。