Попробуйте сделать 2 контура управления:
1й ПИ-регулятор для стабилизации тока дросселя, коэффициенты выбираем исходя из параметров эквивалентной RL цепи: kp = L * wcc, ki = R * wcc * ts
Где ts - период вызова регулятора (обычно равен или кратен периоду ШИМ) wcc - частота среза регулятора, для случая 1 выборка АЦП на 1 период ШИМ: 0.05 * (1/ts) * 2 * pi
Второй контур стабилизации напряжения, так же ПИ регулятор выход которого даёт задание на 1й контур, но для него параметры лучше подбирать по step response