Add missing setup_project_finalize in CMakeLists.txt.
Add linewidth as a parameter to ScenePublisher.addPolygon.
Remove parameter dist in ScenePublisher.addPolygon.

  - replaced by first coordinate of point.
Do not hardcode reference frame.

  - "/l_sole" -> "/"+self.referenceFrame.