В общем были у меня подозрения на одну тяжелую подпрограмму, вынес ее отдельной задачей, понизил приоритет, увеличил интервал. Сейчас все работает нормально, связь не падает.