Simulation now creates 8 states: (x,y,tht,v,omg,bias,verrR,verrL). Added some plotting for simulation