ModBus rtu на stm32f030

eMBErrorCode    eStatus;
int main(void)
{
 
 
  SystemClock_Config();
 
  MX_GPIO_Init();
  MX_USART2_UART_Init();
  MX_TIM17_Init();
  /* USER CODE BEGIN 2 */
  usRegInputBuf[0] = 0x0001;
  usRegInputBuf[1] = 0x0002;
  usRegInputBuf[2] = 0x0004;
  usRegInputBuf[3] = 0x0008;
  usRegInputBuf[4] = 0x0010;
  /*режим ModBus-а*/        /*ID*/      /*скорость*/
  eStatus = eMBInit( MB_RTU, 0x01, 0, 115200, MB_PAR_NONE );
  eStatus = eMBEnable(  );
  /* USER CODE END 2 */
 
 
 
  while (1)
  {
 
    (void)eMBPoll();
 
  }
}
 
eMBErrorCode eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
{
  eMBErrorCode    eStatus = MB_ENOERR;
  int iRegIndex = ( int )( usAddress - usRegInputStart - 1);
  
  if((iRegIndex + usNRegs) > REG_INPUT_NREGS)
  {
    return eStatus;
  }
  
  while( usNRegs > 0 )
  {
    *pucRegBuffer++ = (UCHAR)( usRegInputBuf[iRegIndex] >> 8 );
    *pucRegBuffer++ = (UCHAR)( usRegInputBuf[iRegIndex] & 0xFF );
    iRegIndex++;
    usNRegs--;
  }
 
  return MB_ENOERR;
}
 
}

void USART2_IRQHandler(void)
{
  
  
  if((__HAL_UART_GET_IT(&huart_m, UART_IT_RXNE) != RESET) && (__HAL_UART_GET_IT_SOURCE(&huart_m, UART_IT_RXNE) != RESET)) { 
    prvvUARTRxISR(  ); 
    __HAL_UART_SEND_REQ(&huart_m, UART_RXDATA_FLUSH_REQUEST); 
    return;
  }
  
  if((__HAL_UART_GET_IT(&huart_m, UART_IT_TXE) != RESET) && (__HAL_UART_GET_IT_SOURCE(&huart_m, UART_IT_TXE) != RESET)) {
      prvvUARTTxReadyISR(  );
      return;
  }

  if(xRxEnable)
  {
 
     HAL_GPIO_WritePin(GPIOA, GPIO_PIN_12, GPIO_PIN_RESET);
    __HAL_UART_ENABLE_IT(&huart_m, UART_IT_RXNE);
   
  }
  else
  {
    __HAL_UART_DISABLE_IT(&huart_m, UART_IT_RXNE);
  }
  
  if(xTxEnable)
  {
    HAL_GPIO_WritePin(GPIOA, GPIO_PIN_12, GPIO_PIN_SET);
    __HAL_UART_ENABLE_IT(&huart_m, UART_IT_TXE); 
    
  }
  else
  {  
    __HAL_UART_DISABLE_IT(&huart_m, UART_IT_TXE);
  }
}

void __critical_enter(void)
{
  __disable_irq();
  ++lock_nesting_count;
}
void __critical_exit(void)
{
  /* Unlock interrupts only when we are exiting the outermost nested call. */
  --lock_nesting_count;
  if (lock_nesting_count == 0) {
    __enable_irq();
  }
}