fixing first step and circle logic
Merge branch 'develop' of github.com:erhs-robotics/Miniurban2013 into develop