Нашел целую кучу косяков в старом проекте. Переписал некоторые части.
Теперь нет проблем с клавиатурой и правильная дешифрация IO портов по битам A4 и A3! Как приведу в божеский вид, выложу...