First Code!!!
Merge branch 'master' of https://github.com/RingOfFireOrg/FT2014
Improve of Reverse
Added else claus to do smooth travel (constantly call run)