Improved Quadcopter PID debugging