WIP - XBee Read check how many bytes

Added code to check to see how many bytes are in the XBee input queue
and then use this to only continue to read if there are a reasonable
number of bytes on the queue...