Arduino Subroutine Return Value Based On Criteria