Restore set and get FloatingBaseLink