step only one integration step
step only one integration step
 fail git status
implement new method for forces
bug when 4 contact poitns