You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

109 lines
3.9 KiB

2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
  1. //
  2. // Created by zwsd
  3. //
  4. #pragma once
  5. #include <map>
  6. #include "basic.hpp"
  7. #include "sdk/os/zos.hpp"
  8. // #include "sdk\components\zprotocols\zcancmder\zcancmder_protocol.hpp"
  9. namespace iflytop {
  10. using namespace std;
  11. typedef function<void(CanPacketRxBuffer *report)> zcan_commnader_master_onpacket_t;
  12. class ZCanCommnaderMasterListener {
  13. public:
  14. zcan_commnader_master_onpacket_t on_ack;
  15. };
  16. typedef function<void(uint8_t *packet, size_t len)> rawpacket_t;
  17. class ZCanCommnaderMaster : public ZCanIRQListener, public IZcanCmderMaster {
  18. public:
  19. class CFG {
  20. public:
  21. uint8_t deviceId = 0; //
  22. /*******************************************************************************
  23. * CANConfig *
  24. *******************************************************************************/
  25. CAN_HandleTypeDef *canHandle; // Ĭ��ʹ��CAN1
  26. int canFilterIndex0; // ������0 ���գ�������������Ϣ
  27. int maxFilterNum; // ʹ�õĹ���������������ֵ14��Ĭ��Ϊ7
  28. int rxfifoNum; // ʹ�õ�FIFO,Ĭ��ʹ��FIFO0
  29. int packetRxOvertime_ms; //
  30. };
  31. uint8_t txbuff[2100];
  32. public:
  33. class LoopJobContext {
  34. public:
  35. bool hasDoneSomething;
  36. };
  37. private:
  38. CFG *m_config = NULL; // ����
  39. bool m_canOnRxDataFlag = false; // �Ƿ������ݽ��գ����ڴ��ж�������ת�Ƶ�MainLoop������
  40. uint32_t m_lastPacketTicket = 0; // ��һ�ν��յ���Ϣ��ʱ�䣬�����ж��������Ƿ��Ͽ�����
  41. HAL_StatusTypeDef m_lastTransmitStatus; // �ϴε���can���ͷ����ķ���ֵ
  42. #define CAN_PACKET_RX_BUFFER_NUM 5
  43. CanPacketRxBuffer m_canPacketRxBuffer[CAN_PACKET_RX_BUFFER_NUM];
  44. int txPacketInterval_ms = 0;
  45. ZThread m_loopThread;
  46. map<uint16_t, ZCanCommnaderMasterListener> m_on_packet_map;
  47. zmutex m_on_packet_map_lock;
  48. uint16_t m_index_off = 0;
  49. onpacket_t m_on_event;
  50. rawpacket_t m_rawpacketcb = nullptr;
  51. zmutex txlock;
  52. public:
  53. ZCanCommnaderMaster() {}
  54. CFG *createCFG();
  55. void init(CFG *cfg);
  56. void setTxPacketInterval(int interval_ms) { txPacketInterval_ms = interval_ms; }
  57. virtual int32_t sendCmd(int32_t cmdid, int32_t moduleid, int32_t *param, size_t npara, int32_t *ack, size_t nack, int overtime_ms) override;
  58. virtual int32_t sendCmdAndReceiveBuf(int32_t cmdid, int32_t moduleid, int32_t *param, size_t npara, uint8_t *ack, int32_t *rxsize, int overtime_ms) override;
  59. virtual void regEventPacketListener(onpacket_t on_event) override;
  60. void sendRawPacket(uint8_t *packet, size_t len);
  61. void regRawPacketListener(rawpacket_t rawpacketcb);
  62. public:
  63. virtual void STM32_HAL_onCAN_RxFifo0MsgPending(CAN_HandleTypeDef *can);
  64. virtual void STM32_HAL_onCAN_Error(CAN_HandleTypeDef *can);
  65. private:
  66. void loop();
  67. uint8_t getDeviceId() { return m_config->deviceId; }
  68. void sendPacket(uint8_t *packet, size_t len);
  69. void regListener(uint16_t index, zcan_commnader_master_onpacket_t onack);
  70. void unregListener(uint16_t index);
  71. void callListener(CanPacketRxBuffer *report);
  72. bool isListenerReg(uint16_t index);
  73. int getListenerNum();
  74. uint16_t generateFreeIndex();
  75. bool sendPacketSub(int npacket, int packetIndex, uint8_t *packet, size_t len, int overtimems);
  76. HAL_StatusTypeDef initializeFilter();
  77. HAL_StatusTypeDef activateRxIT();
  78. HAL_StatusTypeDef deactivateRxIT();
  79. bool getRxMessage(CAN_RxHeaderTypeDef *pHeader, uint8_t aData[] /*8byte table*/);
  80. size_t safe_memcpy(void *dst, size_t dst_max_size, void *src, size_t src_len);
  81. void initCanPacketRxBuffer(CanPacketRxBuffer *buf, uint16_t id);
  82. CanPacketRxBuffer *allocCanPacketRxBufferInIRQ(uint16_t id);
  83. CanPacketRxBuffer *findCanPacketRxBufferInIRQ(uint16_t id);
  84. void processReadyPacket(CanPacketRxBuffer *buf);
  85. };
  86. } // namespace iflytop