add stereo click marker to rviz and fixes