Я написал маленький task manager, который читает из очереди сообщений очередное сообщение, и ищет в очереди задач ту, которая его ожидает. А задачи представляют собой функции на основе switch, работают по состояниям. Например, надо запустить обмен по интерфейсу. Задача подготавливает данные, говорит "поехали", и записывает в очередь задач свой адрес и номер сообщения, которого она ждет. И выход. А когда обмен закончится (он идет по прерываниям), в очередь сообщений поступит код сообщения об окончании обмена. Потом task manager вызовет ту функцию (задачу), которая его ждет. В основном цикле программы будет крутиться всего лишь только task manager.