ваще seral.println Никогда не использовал. только serial.print. 
 
и еще. массив cmd[i] очищается если ни одно из условий не выполняется или нет? 
 
может жестко проверять при приеме данных из порта по маске команды и как только расхождение обнаружилось сразу массив  очищать. 
		
	
		
		
		
		
		
	
	 |