Bug might be gone...
Optimized command parsing/construction code.

Was too slow to achieve full ISOBUS data rate.