Working Version of 3D Rigid Body Simulator