Arduino Return Value From Function C