1 Star 0 Fork 0

chaosir1991/rbpf-gmapping

加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
文件
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
Measurement_Model.m 394 Bytes
一键复制 编辑 原始数据 按行查看 历史
function q = Measurement_Model(ytru, yest, sigma_v)
%% Calculates the probability of one point in the real scan matching to that same point in the estimated scan
q=1;
for i=1:size(ytru(2,:))
p_a = exp(-0.5*((ytru(1,i) - yest(1,i))/(sigma_v(1)))^2)/(sqrt(2*pi)*sigma_v(1));
p_r = exp(-0.5*((ytru(2,i) - yest(2,i))/(sigma_v(2)))^2)/(sqrt(2*pi)*sigma_v(2));
p = p_a*p_r;
q=q*p;
end
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化
1
https://gitee.com/chaosir1991/rbpf-gmapping.git
git@gitee.com:chaosir1991/rbpf-gmapping.git
chaosir1991
rbpf-gmapping
rbpf-gmapping
master

搜索帮助

0d507c66 1850385 C8b1a773 1850385