Adding initial code for plotting kalman filter. Hard coded example that just needs sigma x, sigma y and rho to plot it.