Added another VizWorld for the error ellipse. Still need to understand how the ellipse is made, and how I can use our covariance matrix from the robot to calculate the ellipse