еще и два разных протокола на прием передачу... места в микроконтроллере много, что избыточный код ваяете?

просто любопытно, зачем изобретать велосипед?