Small tweaks to arduino code.
Merge pull request #3 from msk-/master

Small tweaks to arduino code.