Inherits from moveit visual tools
Moved some functionality out into moveit_visual_tools
Removed duplicate rviz marker publisher and node handle
Changes from code review of lightning
Added publishRobotPath() function