Создание очереди выполнения заданий

[LeVlad]

Добрый день.
Делаю визуализацию и упёрся вот во что:
Есть 4 кнопки (каждая управляет своим механизмом), которые могут нажиматься в любой последовательности в зависимости от необходимости. Нажатие кнопки присваивает переменной определённое значение (координату), и по этому значению происходит выполнение действия (передвижение механизма в определенную точку).
Предположим, что нажали кнопку 2, затем 1, затем 4, затем 3.
Как реализовать очередность выполнения этих задач ? Чтобы сначала механизм, управляемый кнопкой 2 доехал до нужной точки, после этого поехал механизм, управляемый кнопкой 1 , затем 4 и 3.
Можно ли сделать это с использованием массива? И как создать лог (историю нажатий этих кнопок)?
Подтолкните в нужную сторону, пожалуйста! Буксую на одном месте.
Пишу на ST.