Error al comparar un string recibida por XBEE

Estas imprimiendo la cadena recogida por serial ¿cuadra con lo que esperas?.Otra cosa ,si compruebas si el caracter recibido es el de final antes de añadirlo a la cadena te ahorraras tener que restarlo y complicar el sketch con lineas innecesarias.