Add second text handler
fix autopilot and turning motor control