NbusCommunicator.cpp 4.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188
  1. /**
  2. * @file NbusCommunicator.cpp
  3. * @brief Implementation of hardware communication interface.
  4. * @date Jun 19, 2026
  5. * @author Juraj Dudak, Matus Necas
  6. */
  7. #include "NbusCommunicator.h"
  8. #if !defined(ESP32)
  9. NbusCommunicator::NbusCommunicator(UART_HandleTypeDef *uartNbus, UART_HandleTypeDef *uartMaster)
  10. : _uart_nbus{uartNbus}, _uart_master{uartMaster}
  11. {
  12. }
  13. void NbusCommunicator::sendToMaster(DataFrame *master_frame)
  14. {
  15. if (master_frame == nullptr || master_frame->IsEmpty())
  16. return;
  17. while (_uart_master->gState != HAL_UART_STATE_READY)
  18. {
  19. __NOP(); // cakanie na ukoncenie prebiehajuceho odosielania
  20. // tu to moze byt vcelku tesno odoslany dalsi paket. je tam pauza o dlzke 1.2bit
  21. }
  22. HAL_UART_Transmit_DMA(_uart_master, master_frame->GetFrame(), master_frame->GetLength());
  23. }
  24. void NbusCommunicator::sendToSlave(DataFrame *slaveFrame)
  25. {
  26. setLedOn();
  27. HAL_UART_Transmit(_uart_nbus, slaveFrame->GetFrame(), slaveFrame->GetLength(), NBUS_COMM_UART_TX_TIMEOUT);
  28. setLedOff();
  29. }
  30. DataFrame* NbusCommunicator::sendAndReceiveSlave(DataFrame *slave_frame)
  31. {
  32. this->sendToSlave(slave_frame);
  33. this->_receiveFromSlave();
  34. return &_packet_rx;
  35. }
  36. void NbusCommunicator::_receiveFromSlave()
  37. {
  38. uint16_t received_size;
  39. setLedOn();
  40. memset(_data_packet_comm, 0, NBUS_COMM_MAX_FRAME_SIZE);
  41. // DMA communication must be in blocking mode for less overhead
  42. HAL_StatusTypeDef status = HAL_UARTEx_ReceiveToIdle(_uart_nbus, _data_packet_comm, NBUS_COMM_MAX_FRAME_SIZE,
  43. &received_size, NBUS_COMM_UART_RX_TIMEOUT);
  44. _packet_rx.Init();
  45. if (status == HAL_OK)
  46. {
  47. if (received_size > 0)
  48. {
  49. _packet_rx.FromArray(_data_packet_comm, received_size);
  50. }
  51. }
  52. setLedOff();
  53. _packet_rx.Commit();
  54. }
  55. void NbusCommunicator::setLedOn()
  56. {
  57. #if NBUS_USE_LED
  58. HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);
  59. #endif // NBUS_USE_LED
  60. }
  61. void NbusCommunicator::setLedOff()
  62. {
  63. #if NBUS_USE_LED
  64. HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_RESET);
  65. #endif // NBUS_USE_LED
  66. }
  67. void NbusCommunicator::toggleLed()
  68. {
  69. #if NBUS_USE_LED
  70. HAL_GPIO_TogglePin(GPIOB, GPIO_PIN_3);
  71. #endif // NBUS_USE_LED
  72. }
  73. #else // ESP32
  74. NbusCommunicator::NbusCommunicator(UART_HandleTypeDef *uartNbus, UART_HandleTypeDef *uartMaster)
  75. : _uart_nbus{uartNbus}, _uart_master{uartMaster}
  76. {
  77. }
  78. void NbusCommunicator::sendToMaster(DataFrame *master_frame)
  79. {
  80. if (master_frame == nullptr || master_frame->IsEmpty())
  81. return;
  82. _uart_master->write(master_frame->GetFrame(), master_frame->GetLength());
  83. }
  84. void NbusCommunicator::sendToSlave(DataFrame *slaveFrame)
  85. {
  86. setLedOn();
  87. _uart_nbus->write(slaveFrame->GetFrame(), slaveFrame->GetLength());
  88. setLedOff();
  89. }
  90. DataFrame* NbusCommunicator::sendAndReceiveSlave(DataFrame *slave_frame)
  91. {
  92. this->sendToSlave(slave_frame);
  93. this->_receiveFromSlave();
  94. return &_packet_rx;
  95. }
  96. void NbusCommunicator::_receiveFromSlave()
  97. {
  98. int16_t packet_size = 0;
  99. int16_t received_size = 0;
  100. int16_t in_bytes = 0;
  101. //HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);
  102. // reference time
  103. time_t time0 = millis();
  104. // read packet length
  105. while (packet_size == 0 && millis() - time0 <= NBUS_COMM_UART_RX_TIMEOUT)
  106. {
  107. if (_uart_nbus->available())
  108. {
  109. packet_size = _uart_nbus->read();
  110. _data_packet_comm[received_size++] = packet_size;
  111. }
  112. }
  113. // read rest of the packet
  114. while (received_size < packet_size && millis() - time0 <= NBUS_COMM_UART_RX_TIMEOUT)
  115. {
  116. in_bytes = _uart_nbus->available();
  117. if (in_bytes > 0)
  118. {
  119. _uart_nbus->readBytes(_data_packet_comm + received_size, in_bytes);
  120. received_size += in_bytes;
  121. }
  122. }
  123. _packet_rx.Init();
  124. if (received_size > 0)
  125. {
  126. _packet_rx.FromArray(_data_packet_comm, received_size);
  127. }
  128. //HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_RESET);
  129. _packet_rx.Commit();
  130. }
  131. void NbusCommunicator::setLedOn()
  132. {
  133. #if NBUS_USE_LED
  134. digitalWrite(NBUS_LED_PIN, HIGH);
  135. #endif // NBUS_USE_LED
  136. }
  137. void NbusCommunicator::setLedOff()
  138. {
  139. #if NBUS_USE_LED
  140. digitalWrite(NBUS_LED_PIN, LOW);
  141. #endif // NBUS_USE_LED
  142. }
  143. void NbusCommunicator::toggleLed()
  144. {
  145. #if NBUS_USE_LED
  146. digitalWrite(NBUS_LED_PIN, ~digitalRead(NBUS_LED_PIN));
  147. #endif // NBUS_USE_LED
  148. }
  149. #endif // platform