Update Stage_ros on my fork

Update vinter_sim (my fork) with updates on stage_ros