Если вам нравится садо мазо то не склоняйте к этому других. На форуме есть пример ПИД на ST + обвязка на CFC.