cmdDecode.c 929 B

1234567891011121314151617181920212223242526272829303132333435363738394041
  1. #include "cmdDecode.h"
  2. #include "crc8.h"
  3. bool checkFramLegal(uint8_t *srcBuffer, uint8_t srcLen)
  4. {
  5. bool ret = false;
  6. uint8_t len;
  7. uint8_t cmd;
  8. uint8_t crc1;
  9. // uint8_t crc2;
  10. len = srcBuffer[0];
  11. cmd = srcBuffer[1];
  12. crc1 = srcBuffer[len];
  13. // crc2 = srcBuffer[len];
  14. if (len == (srcLen - 1))
  15. {
  16. if (cmp_crc8(srcBuffer, srcLen - 1, crc1))
  17. {
  18. ret = true;
  19. // ret = cmp_crc8(srcBuffer, srcLen - 1, crc2);
  20. }
  21. }
  22. return ret;
  23. }
  24. void completFramParams(uint8_t *srcBuffer, uint8_t srcLen)
  25. {
  26. uint8_t *head;
  27. uint8_t *len;
  28. uint8_t *crc1;
  29. // uint8_t *crc2;
  30. uint8_t *end;
  31. len = &srcBuffer[0];
  32. crc1 = &srcBuffer[srcLen - 1];
  33. // crc2 = &srcBuffer[srcLen - 1];
  34. *len = srcLen - 1;
  35. *crc1 = get_crc8(srcBuffer, srcLen - 1);
  36. // *crc2 = get_crc8(srcBuffer, srcLen - 1);
  37. }