Arduino Subroutine Return Value Based On Two