Qbo & Rviz ( Willow Garage 3D Visualization environment )