Arduino UNO. Задача термостатирования жидкости

Посмотрите видео https://www.youtube.com/watch?v=YlQDIHlZmvE&t=1s

Необходимо чтобы нагреватель работал с плавностью (которую задает PID регулирование)

и при достижении температуры выключался. (термостатирование жидкости от 30 до 40 градусов Цельсия)

Необходимо заменить Кулер на Нагреватель, это описано на 12:28 в видео "Прямое регулирование"

*пробовал разные варианты и 1)Прямое регулирование от 0 до 255 выход ШИМ

2)Прямое регулирование от 255 до 0 выход ШИМ

3)Обратное регулирование от 255 до 0 выход ШИМ

4)Обратное регулирование от 0 до 255 выход ШИМ

P.S. Все прошивается и работает, датчик фиксирует температуру, экран работает, енкодером выставляются все необходимые переменные,

но при выставлении температуры выше чем температура фикируемая датчиком DS18B20 (например в воде 21 градус Цельсия, выставляю 30), нагревания не происходит =(

Прилагаю

-код который компилируется с помощью программы FLprog

-сам проект FLprog вдруг там придется "потыкаться"

-Схему подключения (там внимательно со входом питания и выхода на нагреватель на Mosfet) - пробовал менять местами, испугался что спалил мосфет, относил там где покупал - сказали рабочий =/

Заранее спасибо