Refactored arduino code
Changed message to use an array of shorts