Да примерно так.
Дальше смотрите( по данным, которые выводятся в Serial ), работает ли программа, так как вы ожидаете.
Если, что то работает не так как нужно, меняете код и снова проверяете.
Начните разбираться с малого, отладьте такой код, например нажали кнопку, пищалка пищит, отпустили не...