Fixed a bug of changing goal in singleReplay.py;
Added a shaking motion in teleopCart.py