ADD: space soft body step function
FIX: conj grad solver