Change default number of pairs in LSR1 and update stalling status to -3
Add npairs option to auglag driver
Fix a bug when infinite curvature is detected