Added gazebo prototype v0.1