Arduino Subroutine Return Value Based On 2