added pitch and depth to PID_pilot