NbusCommunicator.cpp 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203
  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. #if NBUS_LED_POLARITY_REVERSED
  59. HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_RESET);
  60. #else
  61. HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);
  62. #endif // POLARITY
  63. #endif // NBUS_USE_LED
  64. }
  65. void NbusCommunicator::setLedOff()
  66. {
  67. #if NBUS_USE_LED
  68. #if NBUS_LED_POLARITY_REVERSED
  69. HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);
  70. #else
  71. HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_RESET);
  72. #endif // POLARITY
  73. #endif // NBUS_USE_LED
  74. }
  75. void NbusCommunicator::toggleLed()
  76. {
  77. #if NBUS_USE_LED
  78. HAL_GPIO_TogglePin(GPIOB, GPIO_PIN_3);
  79. #endif // NBUS_USE_LED
  80. }
  81. #else // ESP32
  82. NbusCommunicator::NbusCommunicator(UART_HandleTypeDef *uartNbus, UART_HandleTypeDef *uartMaster)
  83. : _uart_nbus{uartNbus}, _uart_master{uartMaster}
  84. {
  85. }
  86. void NbusCommunicator::sendToMaster(DataFrame *master_frame)
  87. {
  88. if (master_frame == nullptr || master_frame->IsEmpty())
  89. return;
  90. _uart_master->write(master_frame->GetFrame(), master_frame->GetLength());
  91. }
  92. void NbusCommunicator::sendToSlave(DataFrame *slaveFrame)
  93. {
  94. setLedOn();
  95. _uart_nbus->write(slaveFrame->GetFrame(), slaveFrame->GetLength());
  96. setLedOff();
  97. }
  98. DataFrame* NbusCommunicator::sendAndReceiveSlave(DataFrame *slave_frame)
  99. {
  100. this->sendToSlave(slave_frame);
  101. this->_receiveFromSlave();
  102. return &_packet_rx;
  103. }
  104. void NbusCommunicator::_receiveFromSlave()
  105. {
  106. int16_t packet_size = 0;
  107. int16_t received_size = 0;
  108. int16_t in_bytes = 0;
  109. //HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);
  110. // reference time
  111. time_t time0 = millis();
  112. // read packet length
  113. while (packet_size == 0 && millis() - time0 <= NBUS_COMM_UART_RX_TIMEOUT)
  114. {
  115. if (_uart_nbus->available())
  116. {
  117. packet_size = _uart_nbus->read();
  118. _data_packet_comm[received_size++] = packet_size;
  119. }
  120. }
  121. // read rest of the packet
  122. while (received_size < packet_size && millis() - time0 <= NBUS_COMM_UART_RX_TIMEOUT)
  123. {
  124. in_bytes = _uart_nbus->available();
  125. if (in_bytes > 0)
  126. {
  127. _uart_nbus->readBytes(_data_packet_comm + received_size, in_bytes);
  128. received_size += in_bytes;
  129. }
  130. }
  131. _packet_rx.Init();
  132. if (received_size > 0)
  133. {
  134. _packet_rx.FromArray(_data_packet_comm, received_size);
  135. }
  136. //HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_RESET);
  137. _packet_rx.Commit();
  138. }
  139. void NbusCommunicator::setLedOn()
  140. {
  141. #if NBUS_USE_LED
  142. #if NBUS_LED_POLARITY_REVERSED
  143. digitalWrite(NBUS_LED_PIN, LOW);
  144. #else
  145. digitalWrite(NBUS_LED_PIN, HIGH);
  146. #endif // POLARITY
  147. #endif // NBUS_USE_LED
  148. }
  149. void NbusCommunicator::setLedOff()
  150. {
  151. #if NBUS_USE_LED
  152. #if NBUS_LED_POLARITY_REVERSED
  153. digitalWrite(NBUS_LED_PIN, HIGH);
  154. #else
  155. digitalWrite(NBUS_LED_PIN, LOW);
  156. #endif // POLARITY
  157. #endif // NBUS_USE_LED
  158. }
  159. void NbusCommunicator::toggleLed()
  160. {
  161. #if NBUS_USE_LED
  162. digitalWrite(NBUS_LED_PIN, !digitalRead(NBUS_LED_PIN));
  163. #endif // NBUS_USE_LED
  164. }
  165. #endif // platform