test(nra_ode): add nra_ode test
refactor(icp_solver): remove debug messages