График напряжения от времени нарисуйте.
И график желаемого значения на выходе.
И не просто какой-то, а чтобы там были случаи скачков напряжения туда-сюда и т.п.

Прогаммировать нужно после того, как стало понятно как должна вести себя система.