CDCPD Constructor should be refactored #43
Description
The constructor for CDCPD is messy and should be refactored. I've got most of the way there with https://github.com/UM-ARM-Lab/cdcpd/tree/cdcpd_constructor_refactor but there was a problem with the pybind11 bindings that I didn't have time to fix.