На CFC эту задачу сделал, всё получилось. Теперь поставили задачу сделать тоже на ST. По FIFO посмотрю, попробую