Merging poses branch

Poses creates a new topic (/visualization_markers) that uses the new class RVIZMarker to publish vectors to RVIZ. It also has an updated RVIZ file that includes the marker.