Обычный ПИД + VALVE_REG_NO_POS из библиотеки PID_Regulators.