A few tweaks in localization and state machine for parsing and visual servo
Merge branch 'master' of https://github.com/rss-2014-team-6/rss-team-6