Output more info for LCP solver
Merge branch 'resting-contact' of https://github.com/edrumwri/Moby into resting-contact
Fixed some bugs in ConePrimitive and CylinderPrimitive