Такая же идея как и у меня. Замеряли, ты прошел, свет вкл. Ты выходишь, снова происходит замер, свет выкл. Состояние выключателя только запоминать надо.
Вообще не проблема. По фронту пишешь в регистр +1, включаешь выход, дальше цикл со сравнением. Будет ещё +1, то выключаешь