A Small Library for 3D Rigid Body Physics Tutorial