Хочется сделать блок питания управляемый микроконтроллером, но мало опыта работы связаной с написанием программ для МК.

Имеется схема:


а так же МК ATmega8, ЖК-совместимый с HD44780. Помогите пожалуйста придумать алгоритм работы программы, ну и если возможно, то и помочь кодом на СИ.

Задание следушие:
1) Имерение и вывод на дисплей выходного напряжения и тока потребления (понятно, что выходное напряжение подводится к одному из выводов АЦП МК, а напряжение снимаемое с датчика тока резисторе R3 после усиления приходит на другой вход АЦП).
2) Выставлять значение тока после превышения, которого БП входит в режим стабилизации тока.
3) Напряжение от 0 В до 5 В формируемое источником V4 - есть ШИМ после фильтра (наверно Баттерворта 4 порядка).