Теряются данные при считывании по UART, STM32F103RD Опции

[Atlantis-]

Здравствуйте!
Столкнулся с проблемой потери данных и не понимаю откуда ноги растут.
Суть такая: по таймеру с частотой 500 Гц я опрашиваю датчики. На одной шине UART расположены два датчика. То есть я отправляю команду, считываю данные (по DMA) с одного датчика, переключаю на другой датчик - считываю данные с него. Раньше у меня была передача по USB и я в прерывании, каждую 1 мс проверял, есть ли данные от датчиков, копировал в отдельный массив и передавал.
Сейчас мне надо перейти на UART и тот же самый алгоритм почему то дает непонятный сбой. Каждую 1 мс по UART присылаю команду "передать данные", в прерывании проверяю есть ли данные, перекопирую их в массив, в начало массива добавляю счетчик и кол-во данных. После запуска через несколько секунд возникает сбой - байт "кол-во данных" пропадает.

[r_dot]

... с частотой 500 Гц я опрашиваю датчики.
... Каждую 1 мс по UART присылаю команду "передать данные"...

"С частотой 500 Гц" - это каждые 2 мс...
Где наврали?

И очень подозрительно реализован опрос: может, после посылки команды "передать данные" надо дожидаться ответа на неё, а не посылать следующую команду? В приёмнике ведь наверняка есть приёмный буфер?