some tweaking with telemetry
Optimized considerably the telemetry reading/processing (it is working)
Got read of 2 intermediates data structures (too bad IOIO does not exposes
its internal buffer supporting the Serial Input Stream, or at least
returns bytes rather than int).
Also simply drop the case where erroneous message header could be read
(not sure if it happens at all, but if it does, then we just drop
completely the message and do not try to backtrack)
debug mode
one more link for IOIO