а он и не работавет. Ваш нормально работает. Но, поскольку, задал вопрос, получил ответ, должен проверить и ответить.
это сурово, я не потяну - не хватит ни времени, ни знаний. только чуть освоил ардуину, а тут почти с нуля прибор разрабатывать, да еще с математическими заморочками...