Reverted code
Restored original example code of 2D robot sim