feat(icp_solver): Fixed bug in SAT heuristic and created new variable selection for ICP