Add HACD convex decomposition in trajopt
- Unlike the one in cloudproc, this one doesn't require PCL
- Add support for dynamically performing convex decomposition when creating the collision shapes of the openrave links. This is currently not used as the decomposition operation is slow.
- Add a python wrapper for it and TriMesh python-cpp converters
Update the colors of the links' geometries when the bodies are updated.