tools: Fix CRC16 calculation.

crcmod provide wrong values, so i port NuttX crc16 lib.
fw: th_comm now sends status.