Test and fix CRC calculation. Ready for real HW comm test.