Принцип реализации многозадачности примерно один что на си что на асме. Описан например в книжке Кристиан Тавернье PIC-микроконтроллеры практика применения страница 172.
Например одна задача выполняется в основном цикле а другая в прерывании. Далее организуем ветвление по необходимым признакам для выполнения дополнительных задач или организуем временной цикл и разносим задачи по времени.