Final version Autopilot. TODO : Integration and some funct ;).