start to provide access to c++ neb distance
add c++ distance_squared_grad
use the c++ rigid body distance calculation in python