CANTask.c 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132
  1. #include "bsp.h"
  2. #include "bsp_custom.h"
  3. #include "osasys.h"
  4. #include "ostask.h"
  5. #include "queue.h"
  6. #include "ps_event_callback.h"
  7. #include "cmisim.h"
  8. #include "cmimm.h"
  9. #include "cmips.h"
  10. #include "sockets.h"
  11. #include "psifevent.h"
  12. #include "ps_lib_api.h"
  13. #include "lwip/netdb.h"
  14. #include <cis_def.h>
  15. #include "debug_log.h"
  16. #include "slpman_ec616.h"
  17. #include "plat_config.h"
  18. #include "ec_tcpip_api.h"
  19. #include "hal_module_adapter.h"
  20. #include "UartTask.h"
  21. #include "MainTask.h"
  22. #include "app.h"
  23. #include "CANTask.h"
  24. #include "UDSService.h"
  25. extern volatile bool Sleep_flag;
  26. CAN_Msg_Type CanRxMsg[2];
  27. /*线程声明*/
  28. #define PROC_CAN_RX_TASK_STACK_SIZE (1024)
  29. static StaticTask_t gProcess_Can_Rx_Task_t;
  30. static UINT8 gProcess_Can_Rx_TaskStack[PROC_CAN_RX_TASK_STACK_SIZE];
  31. static process_CAN gProcess_CAN_Task = PROCESS_CAN_STATE_IDLE;
  32. #define PROC_CAN_STATE_SWITCH(a) (gProcess_CAN_Task = a)
  33. volatile bool CAN_Sleep_State = false;
  34. UINT8 CanSendSlpHandler = 0xfd;
  35. void CANTaskInit(void* arg)
  36. {
  37. osThreadAttr_t task_rx_attr,task_tx_attr;
  38. Can_InitType param;
  39. param.baudrate = CAN_250Kbps;
  40. param.mode = REQOP_NORMAL;
  41. param.packType = STD_PACK;
  42. memset(&task_rx_attr,0,sizeof(task_rx_attr));
  43. memset(gProcess_Can_Rx_TaskStack, 0, PROC_CAN_RX_TASK_STACK_SIZE);
  44. task_rx_attr.name = "Can_Task";
  45. task_rx_attr.stack_mem = gProcess_Can_Rx_TaskStack;
  46. task_rx_attr.stack_size = PROC_CAN_RX_TASK_STACK_SIZE;
  47. task_rx_attr.priority = osPriorityBelowNormal7;
  48. task_rx_attr.cb_mem = &gProcess_Can_Rx_Task_t;
  49. task_rx_attr.cb_size = sizeof(StaticTask_t);
  50. HAL_Can_Init(param);
  51. osDelay(1000);
  52. osThreadNew(Can_Receive, NULL, &task_rx_attr);
  53. }
  54. static void Can_Receive()
  55. {
  56. slpManSlpState_t State;
  57. uint8_t cnt,temp,udsFlag=0;
  58. UINT8 i = 0;
  59. while(true)
  60. {
  61. memset(CanRxMsg, 0, sizeof(CanRxMsg));
  62. switch(gProcess_CAN_Task)
  63. {
  64. case PROCESS_CAN_STATE_IDLE:
  65. CAN_Sleep_State = false;
  66. PROC_CAN_STATE_SWITCH(PROCESS_CAN_STATE_WORK);
  67. break;
  68. case PROCESS_CAN_STATE_WORK:
  69. {
  70. if(Sleep_flag)
  71. {
  72. PROC_CAN_STATE_SWITCH(PROCESS_CAN_STATE_SLEEP);
  73. }
  74. HAL_Can_Receive(CanRxMsg);
  75. for(i=0; i<2; i++)
  76. {
  77. if(CanRxMsg[i].Id == 0x7A0)
  78. {
  79. udsFlag = 1;
  80. UDSService[i] = CanRxMsg[i].Data[0];
  81. UDSSubService[i] = CanRxMsg[i].Data[1];
  82. UDSSubServiceActionCode[i] = CanRxMsg[i].Data[2];
  83. if(UDSService[i] == 0x10)
  84. {
  85. if(UDSSubService[i] == 0x02)
  86. {
  87. UDSSwitch = 1;
  88. }
  89. }
  90. }
  91. }
  92. if(udsFlag==1)
  93. {
  94. UDS_Service();
  95. udsFlag = 0;
  96. }
  97. break;
  98. }
  99. case PROCESS_CAN_STATE_SLEEP:
  100. {
  101. HAL_Can_Sleep();
  102. CAN_Sleep_State = true;
  103. while(true)
  104. {
  105. osDelay(60000/portTICK_PERIOD_MS);
  106. }
  107. break;
  108. }
  109. }
  110. osDelay(50);
  111. }
  112. }