Fixed internal UART drivers; added TRICAL and AHRS UKF error recovery code; simplified stream handling