Fix robot problems regarding new version of Arduino
Merge pull request #1659 from X-Y/master

Fix robot problems regarding new version of Arduino