tuning PID, height OK