Initial flight controller code