protocol.c 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596
  1. #include "protocol.h"
  2. #include <string.h>
  3. #include "bsp/uart.h"
  4. #include "app/pc_message.h"
  5. #include "app/bms_message.h"
  6. #include "app/iap.h"
  7. static uint16_t _check_sum(uint8_t*data,uint16_t size);
  8. static uart_enum_t current_uart = SHARK_UART0;
  9. void protocol_send_bms_info(uint8_t dest, uint8_t key, uint8_t *data, int len){
  10. can_frame_t can_frame;
  11. CAN_OUT(&(can_frame.head), dest);
  12. can_frame.key = key;
  13. shark_uart_frame_start(current_uart, (uint8_t *)&can_frame, sizeof(can_frame));
  14. shark_uart_frame_continue(current_uart, data, len);
  15. shark_uart_frame_end(current_uart);
  16. }
  17. void protocol_send_ack(uint8_t dest, uint8_t key, int result) {
  18. uint8_t data[sizeof(can_frame_t) + 1];
  19. can_frame_t *frame = (can_frame_t *)data;
  20. CAN_OUT(&(frame->head), dest);
  21. frame->key = key;
  22. data[sizeof(can_frame_t)] = result;
  23. shark_uart_write_frame(current_uart, data, sizeof(data));
  24. }
  25. void protocol_send_debug_info(uint8_t dest, uint8_t *data, int len){
  26. can_head_t can_head;
  27. CAN_OUT(&can_head, dest);
  28. shark_uart_frame_start(current_uart, (uint8_t *)&can_head, sizeof(can_head));
  29. shark_uart_frame_continue(current_uart, data, len);
  30. shark_uart_frame_end(current_uart);
  31. }
  32. /*如果接收到的数据frame,无法识别为新的protocol,认为是老协议,这里通过老协议发送给PSxxx,告知
  33. 只支持新协议
  34. */
  35. void protocol_notify_old_frame(uart_enum_t uart_no){
  36. current_uart = uart_no;
  37. protocol_old_head_t head;
  38. memset(&head, 0, sizeof(head));
  39. head.size = sizeof(head);
  40. head.protocol = 'C';
  41. head.type = 0x30;
  42. head.dir = 0x16;
  43. head.cmd = 0x10;
  44. head.bStatus = 1;
  45. head.checksum = _check_sum((uint8_t *)&head, head.size);
  46. shark_uart_write_bytes(current_uart, (uint8_t *)&head, head.size);
  47. }
  48. void protocol_recv_frame(uart_enum_t uart_no, uint8_t *data, int len){
  49. current_uart = uart_no;
  50. if (len < sizeof(can_frame_t)){
  51. return;
  52. }
  53. can_frame_t *can_frame = (can_frame_t *)data;
  54. if (!CAN_IN(&(can_frame->head))) {//data is sent by myself, drop
  55. return;
  56. }
  57. len -= sizeof(can_frame_t);
  58. if (can_frame->key >= CAN_KEY_IAP_ENTER){
  59. process_iap_message(can_frame, len);
  60. }else {
  61. if (can_frame->head.can_addr == 0x45){ //pc sent
  62. process_pc_message(can_frame, len);
  63. }else {
  64. process_bms_message(can_frame, len);
  65. }
  66. }
  67. }
  68. static uint16_t _check_sum(uint8_t*data,uint16_t size)
  69. {
  70. uint32_t checksum;
  71. if((NULL == data)||(0 == size)){
  72. return 0;
  73. }
  74. checksum = 0;
  75. while(size>1) {
  76. checksum += *(uint16_t*)data;
  77. data += 2;
  78. size -= 2;
  79. }
  80. if(size>0) {
  81. checksum += *data;
  82. }
  83. while(checksum>>16) {
  84. checksum = (checksum&0xFFFF)+(checksum>>16);
  85. }
  86. return (uint16_t)~checksum;
  87. }