Adding CRC16 function