Added Soft Fpga Reset.
FPGA RELATION MODIFIED, calibrate are more accurate now !
Debug astar, asserv, and harvest
Merge branch 'master' of https://github.com/astralien3000/robot2014