Прогу я тебе напишу не проблема. Для пробы можно и без контроллера через оптопару подключить.