vehicle+tracking 源代码

figure(13) clf v=[0 WORLD_SIZE 0 WORLD_SIZE]; axis(v); hold on; plot(xtrue(1,:),xtrue(2,:),'r',beacons(:,1),beacons(:,2),'go'…

function [perr,oerr,index,dmin]=get_err(x,path,prev_idx) % % [perr,oerr,index]=get_err(x,path,last_pt) % % A function to com…

These functions allow generation of a control path and true state vector for a car-like vehicle. Functions: beacons(x,y)=get_…

function [xnext,unext]=get_control(x,u,perr,oerr,dt) % % [xnext,unext]=get_control(x,u,perr,oerr) % % A function to compute a …

function draw_hypothesis (H, features, observations, vehicle, color) %------------------------------------------------------- % …

function result = transform_observations (observations, vehicle) %------------------------------------------------------- % Univ…

function [vehicle, ok] = estimate_vehicle_location (H, features, observations), %------------------------------------------------…

function draw_observations (observations, color) %------------------------------------------------------- % University of Zarago…

function draw_scan (scan, observations) %------------------------------------------------------- % University of Zaragoza % Cen…

function draw_vehicle (vehicle, color) %------------------------------------------------------- % University of Zaragoza % Cent…