Добавлен код для AVR, к сожалению не проверен, т.к. мой Teensy сбоит :(