Спасибо.
Получается Pid_3pos_im_anr и Pid_function мне не подходят?

А привести мощность можно так: (PID_OUT + 100) /20? или ерунду я написал?