protocol.c 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190
  1. #include "protocol.h"
  2. #include "process.h"
  3. #include "cfg.h"
  4. #include "uart.h"
  5. #ifdef IS_BOOTLOADER
  6. uint32_t Firmware_Version[4] = {1, 0, 0, 20240725};
  7. #else
  8. uint32_t Firmware_Version[4] = {1, 1, 1, 20240726};
  9. #endif
  10. uint16_t Read_FirmwareVersion(uint8_t *pBuf, uint16_t buf_len)
  11. {
  12. int i;
  13. if( buf_len < 16){
  14. return 0;
  15. }
  16. for (i = 0; i < 4; ++i)
  17. {
  18. pBuf[i * 4] = (Firmware_Version[i] >> 24) & 0xff;
  19. pBuf[i * 4 + 1] = (Firmware_Version[i] >> 16) & 0xff;
  20. pBuf[i * 4 + 2] = (Firmware_Version[i] >> 8) & 0xff;
  21. pBuf[i * 4 + 3] = (Firmware_Version[i] >> 0) & 0xff;
  22. }
  23. return 16;
  24. }
  25. uint16_t Read_HardwareVersion(uint8_t *pBuf, uint16_t buf_len)
  26. {
  27. if( buf_len < 2){
  28. return 0;
  29. }
  30. pBuf[0] = (config->hw_version >> 8)&0xff;
  31. pBuf[1] = (config->hw_version >> 0)&0xff;
  32. return 2;
  33. }
  34. uint16_t Read_Deviceid(uint8_t *pBuf, uint16_t buf_len)
  35. {
  36. if( buf_len < 4){
  37. return 0;
  38. }
  39. pBuf[0] = (config->deviceid >> 24)&0xff;
  40. pBuf[1] = (config->deviceid >> 16)&0xff;
  41. pBuf[2] = (config->deviceid >> 8)&0xff;
  42. pBuf[3] = (config->deviceid >> 0)&0xff;
  43. return 4;
  44. }
  45. uint16_t Read_Devicetype(uint8_t *pBuf, uint16_t buf_len)
  46. {
  47. if( buf_len < 2){
  48. return 0;
  49. }
  50. pBuf[0] = (config->devicetype >> 8)&0xff;
  51. pBuf[1] = (config->devicetype >> 0)&0xff;
  52. return 2;
  53. }
  54. uint16_t Read_Addr(uint8_t *pBuf, uint16_t buf_len)
  55. {
  56. if( buf_len < 2){
  57. return 0;
  58. }
  59. pBuf[0] = 0x00;
  60. pBuf[1] = config->addr;
  61. return 2;
  62. }
  63. uint16_t Read_Baudrate(uint8_t *pBuf, uint16_t buf_len)
  64. {
  65. if( buf_len < 2){
  66. return 0;
  67. }
  68. pBuf[0] = 0x00;
  69. pBuf[1] = config->br_index;
  70. return 2;
  71. }
  72. uint16_t Read_LockStatus(uint8_t *pBuf, uint16_t buf_len)
  73. {
  74. if( buf_len < 4){
  75. return 0;
  76. }
  77. pBuf[0] = Process_LockStatus();
  78. pBuf[1] = Process_UnlockStatus();
  79. pBuf[2] = Process_CoverStatus();
  80. pBuf[3] = 0x00;
  81. return 4;
  82. }
  83. /*=======================================================================================*/
  84. uint8_t Write_Addr(uint8_t *pdata, uint8_t len)
  85. {
  86. if(len == 2){
  87. config->addr = pdata[1];
  88. return RET_OK|RET_NEED_SAVE;
  89. }else{
  90. return RET_DATAINVALID;
  91. }
  92. }
  93. uint8_t Write_Baudrate(uint8_t *pdata, uint8_t len)
  94. {
  95. if(len == 2){
  96. if(pdata[1] >= BaudRate_4800 && pdata[1] <= BaudRate_230400){
  97. config->br_index = pdata[1];
  98. return RET_OK|RET_NEED_SAVE;
  99. }else{
  100. return RET_DATAINVALID;
  101. }
  102. }else{
  103. return RET_DATAINVALID;
  104. }
  105. }
  106. uint8_t Write_HardwareVersion(uint8_t *pdata, uint8_t len)
  107. {
  108. if(len == 2){
  109. config->hw_version = ((uint16_t)pdata[0]<<8) | pdata[1];
  110. return RET_OK|RET_NEED_SAVE;
  111. }else{
  112. return RET_DATAINVALID;
  113. }
  114. }
  115. uint8_t Write_Deviceid(uint8_t *pdata, uint8_t len)
  116. {
  117. if(len == 4){
  118. config->deviceid = ((uint32_t)pdata[0]<<24) | ((uint32_t)pdata[1]<<16)| ((uint32_t)pdata[2]<<8)| pdata[3];
  119. return RET_OK|RET_NEED_SAVE;
  120. }else{
  121. return RET_DATAINVALID;
  122. }
  123. }
  124. uint8_t Write_Devicetype(uint8_t *pdata, uint8_t len)
  125. {
  126. if(len == 2){
  127. config->devicetype = ((uint16_t)pdata[0]<<8) | pdata[1];
  128. return RET_OK|RET_NEED_SAVE;
  129. }else{
  130. return RET_DATAINVALID;
  131. }
  132. }