Add debug code to DantigLCPSolver