Updated QLCPD-based solving method to be more robust
Merge branch 'robust-qp-solve' of https://github.com/edrumwri/Moby into robust-qp-solve
Added logging to infinite friction model; infinite friction model now triggered only when friction sufficiently high