Added Rvizmarker (functional) Began goHome