Выложил прошивку , схему немножко изменил.
Проверил работает. Еще 4 входа выхода остались свободны, можно как нибудь использовать.