www.cs.cmu.edu

Kalman Filter Velocity Estimation Example

% constants T = 0.01; % set up desired trajectory i = 1; for t = 0:T:0.1 posd(i) = 0; veld(i) = 0; accd(i) = 0; i = i + 1; end for t = 0:T:1.0 [p,v,a] = minjerk(t ...