First commit of the pr2 collision checker