Можно упростить задачу. По фронту (спаду) любого бита режима обнулять (или приводить в исходное) выходы управления
Попробуйте сначала это. Не получится тогда переделывайте программы