Самое забавное, что я пока это всё писал, убедился, что всё работает так, как надо, с разными МК разных семейств запускал.

Но нужны тесты.. Ы