Added one world and basic obstacle avoidance package