protocol.c 2.9 KB

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