Probably broken code but still worth tryong
Modified the mavlink teensy code to use Xbee Library, which now has support for escaped characters. Also modified the code to check for successful-ish Rx64 packet reception. Without this last check, it is possible for the code to send even if there is a 7E in the payload buffer (which is obviously wrong)