feat(dsolvers/icp_solver): add rp_problem display for debugging
feat(src): use namespace dreal