detecttreesi16.m

slam进阶学习

function x=detectTrees(RR) 
% laser range  RR is a [1x361] matrix, in meters!!!!.
% return x, a 3xn matrix, where
% x(1,i) distance to i-landmark center
% x(2,i) angle of i-landmark center (in radians)
% x(3,i) i-landmark diameter
% Jos