Added new plotting features for showing velocity errors'
New vectorized measurement generation functions for the Kalman filter
Added a simulation wrapper which generates a trajectory and measurement data to be run through the EKF