Inconsistent Units in connfig, conntact_params, etc

[John-Bonnin]

Find all instances of the scalar "1000" and delete them so we can ask the user to always enter data into the configuration yamls in meters. In conntext, get_pose_from_yaml is a big offender. Make sure to fix the data in the yamls as you fix the code!