Added Matlab Plotting of cppUKF Result