Optimized command parsing/construction code.

Was too slow to achieve full ISOBUS data rate.