Скетч Arduino для управления диском

Требуется разработать скетч для Arduino, управляющий двигателем, который перемещает вращающийся диск на одно отверстие. Датчик света выдает логический 0 при наличии света. Управление осуществляется двумя входами, поочередно меняющими состояние с низкого на высокий. При изменении уровня любого из управляющих входов с низкого на высокий включается двигатель. Диск начинает вращаться, и выход датчика становится сначала высоким (не на отверстии), а затем снова низким (на отверстии). Переход на следующее отверстие занимает несколько секунд.

Необходимо устранить дребезг при начале движения. Если при включении питания диск находится не на отверстии, его следует сдвинуть на отверстие. Если диск уже перешел на новое отверстие, а один из управляющих входов все еще высокий, его следует игнорировать, и диск должен двигаться только при высоком состоянии другого входа.