shark_utils.c 3.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134
  1. #include "shark_utils.h"
  2. #include "bsp/shark_bsp.h"
  3. #include "string.h"
  4. const u16 shark_crc16_table[] = {
  5. 0x0000, 0x1189, 0x2312, 0x329B, 0x4624, 0x57AD, 0x6536, 0x74BF, 0x8C48, 0x9DC1,
  6. 0xAF5A, 0xBED3, 0xCA6C, 0xDBE5, 0xE97E, 0xF8F7, 0x1081, 0x0108, 0x3393, 0x221A,
  7. 0x56A5, 0x472C, 0x75B7, 0x643E, 0x9CC9, 0x8D40, 0xBFDB, 0xAE52, 0xDAED, 0xCB64,
  8. 0xF9FF, 0xE876, 0x2102, 0x308B, 0x0210, 0x1399, 0x6726, 0x76AF, 0x4434, 0x55BD,
  9. 0xAD4A, 0xBCC3, 0x8E58, 0x9FD1, 0xEB6E, 0xFAE7, 0xC87C, 0xD9F5, 0x3183, 0x200A,
  10. 0x1291, 0x0318, 0x77A7, 0x662E, 0x54B5, 0x453C, 0xBDCB, 0xAC42, 0x9ED9, 0x8F50,
  11. 0xFBEF, 0xEA66, 0xD8FD, 0xC974, 0x4204, 0x538D, 0x6116, 0x709F, 0x0420, 0x15A9,
  12. 0x2732, 0x36BB, 0xCE4C, 0xDFC5, 0xED5E, 0xFCD7, 0x8868, 0x99E1, 0xAB7A, 0xBAF3,
  13. 0x5285, 0x430C, 0x7197, 0x601E, 0x14A1, 0x0528, 0x37B3, 0x263A, 0xDECD, 0xCF44,
  14. 0xFDDF, 0xEC56, 0x98E9, 0x8960, 0xBBFB, 0xAA72, 0x6306, 0x728F, 0x4014, 0x519D,
  15. 0x2522, 0x34AB, 0x0630, 0x17B9, 0xEF4E, 0xFEC7, 0xCC5C, 0xDDD5, 0xA96A, 0xB8E3,
  16. 0x8A78, 0x9BF1, 0x7387, 0x620E, 0x5095, 0x411C, 0x35A3, 0x242A, 0x16B1, 0x0738,
  17. 0xFFCF, 0xEE46, 0xDCDD, 0xCD54, 0xB9EB, 0xA862, 0x9AF9, 0x8B70, 0x8408, 0x9581,
  18. 0xA71A, 0xB693, 0xC22C, 0xD3A5, 0xE13E, 0xF0B7, 0x0840, 0x19C9, 0x2B52, 0x3ADB,
  19. 0x4E64, 0x5FED, 0x6D76, 0x7CFF, 0x9489, 0x8500, 0xB79B, 0xA612, 0xD2AD, 0xC324,
  20. 0xF1BF, 0xE036, 0x18C1, 0x0948, 0x3BD3, 0x2A5A, 0x5EE5, 0x4F6C, 0x7DF7, 0x6C7E,
  21. 0xA50A, 0xB483, 0x8618, 0x9791, 0xE32E, 0xF2A7, 0xC03C, 0xD1B5, 0x2942, 0x38CB,
  22. 0x0A50, 0x1BD9, 0x6F66, 0x7EEF, 0x4C74, 0x5DFD, 0xB58B, 0xA402, 0x9699, 0x8710,
  23. 0xF3AF, 0xE226, 0xD0BD, 0xC134, 0x39C3, 0x284A, 0x1AD1, 0x0B58, 0x7FE7, 0x6E6E,
  24. 0x5CF5, 0x4D7C, 0xC60C, 0xD785, 0xE51E, 0xF497, 0x8028, 0x91A1, 0xA33A, 0xB2B3,
  25. 0x4A44, 0x5BCD, 0x6956, 0x78DF, 0x0C60, 0x1DE9, 0x2F72, 0x3EFB, 0xD68D, 0xC704,
  26. 0xF59F, 0xE416, 0x90A9, 0x8120, 0xB3BB, 0xA232, 0x5AC5, 0x4B4C, 0x79D7, 0x685E,
  27. 0x1CE1, 0x0D68, 0x3FF3, 0x2E7A, 0xE70E, 0xF687, 0xC41C, 0xD595, 0xA12A, 0xB0A3,
  28. 0x8238, 0x93B1, 0x6B46, 0x7ACF, 0x4854, 0x59DD, 0x2D62, 0x3CEB, 0x0E70, 0x1FF9,
  29. 0xF78F, 0xE606, 0xD49D, 0xC514, 0xB1AB, 0xA022, 0x92B9, 0x8330, 0x7BC7, 0x6A4E,
  30. 0x58D5, 0x495C, 0x3DE3, 0x2C6A, 0x1EF1, 0x0F78
  31. };
  32. u16 shark_crc16_update_byte(u16 crc, u8 value)
  33. {
  34. return shark_crc16_table[(crc ^ value) & 0xFF] ^ (crc >> 8);
  35. }
  36. u16 shark_crc16_update(u16 crc, const u8 *data, u16 size)
  37. {
  38. const u8 *end;
  39. for (end = data + size; data < end; data++) {
  40. crc = shark_crc16_update_byte(crc, *data);
  41. }
  42. return crc;
  43. }
  44. u16 shark_crc16_check(const u8 *data, u16 size)
  45. {
  46. return shark_crc16_update(0, data, size);
  47. }
  48. u32 shark_iap_checksum_init(void)
  49. {
  50. return 0xFFFFFFFFU;
  51. }
  52. u32 shark_iap_checksum_finish(u32 crc)
  53. {
  54. return crc ^ 0xFFFFFFFFU;
  55. }
  56. u32 shark_iap_checksum_put(u32 crc, const u8 *buff, u32 length)
  57. {
  58. const u8 *buff_end;
  59. for (buff_end = buff + length; buff < buff_end; buff++) {
  60. u8 value = *buff;
  61. u8 i;
  62. for (i = 0; i < 8; i++) {
  63. if (((crc ^ value) & 1) != 0) {
  64. crc = (crc >> 1) ^ 0xEDB88320U;
  65. } else {
  66. crc >>= 1;
  67. }
  68. value >>= 1;
  69. }
  70. }
  71. return crc;
  72. }
  73. u16 shark_decode_u16(const u8 *buff)
  74. {
  75. return DECODE_U16(buff);
  76. }
  77. u32 shark_decode_u24(const u8 *buff)
  78. {
  79. return DECODE_U24(buff);
  80. }
  81. u32 shark_decode_u32(const u8 *buff)
  82. {
  83. return DECODE_U32(buff);
  84. }
  85. void shark_encode_u16(u8 *buff, u16 value)
  86. {
  87. buff[0] = value;
  88. buff[1] = value >> 8;
  89. }
  90. void shark_encode_u24(u8 *buff, u32 value)
  91. {
  92. shark_encode_u16(buff, value);
  93. buff[2] = value >> 16;
  94. }
  95. void shark_encode_u32(u8 *buff, u32 value)
  96. {
  97. shark_encode_u24(buff, value);
  98. buff[3] = value >> 24;
  99. }
  100. u8 shark_read_chip_id(u8 *buff)
  101. {
  102. #ifdef GD32F3x0
  103. u32 values[] = { REG32(0x1FFFF7AC), REG32(0x1FFFF7B0), REG32(0x1FFFF7B4), REG32(0x1FFFF7E0) };
  104. #else
  105. u32 values[] = { REG32(0x1FFFF7E8), REG32(0x1FFFF7EC), REG32(0x1FFFF7F0), REG32(0x1FFFF7E0) };
  106. #endif
  107. memcpy(buff, values, sizeof(values));
  108. return sizeof(values);
  109. }