using "position based dynamics" to simulation rigid body