Зачем на FBD-то это пишете? В документации есть прекрасный пример на ST. Там все намного читабельней.
Потом, если пробуете в эмуляторе, то ничего работать не будет! Библиотека использует аппаратные особенности контроллера и эмулятором не поддерживается.