Add CRC check and read all 40 bits properly.
Remove unit from message.