STM32 FreeRTOS UART Empfangsproblem

Hallo,

ich nutze FreeRTOS auf einem STm32 und möchte Daten senden und empfangen 
über UART.
Die Senderoutine funktioniert auch, Probleme habe ich nur bei der 
Empfangsroutine. Dort werden die Daten sporadisch verschoben empfangen 
und ich kann mir nicht erklären, wieso diese Phänomen auftritt.

Ich hänge mal meinen Interrupt Handler an:

[c]

void USART3_IRQHandler(void)
{
  uint16_t sr = USART3->SR;
  char ch;
  portBASE_TYPE xHigherPriorityTaskWoken = pdFALSE;
  portBASE_TYPE xTaskWokenByReceive  = pdFALSE;
  // Check for received Data
  if (sr & USART_SR_RXNE)
  {
    ch = (char) USART3->DR;
    xQueueSendFromISR (hSerialRx, &ch, &xHigherPriorityTaskWoken);
  }

  // Check if transmit buffer is empty
  if (sr & USART_SR_TXE)
  {
    // Send character if available
    if (pdTRUE == xQueueReceiveFromISR(hSerialTx, &ch, 
&xTaskWokenByReceive))
        USART3->DR = ch;
    else
      // disable TXE interrupt
      USART3->CR1 &= ~USART_CR1_TXEIE;
  }

  // Switch context if necessary.
  if( xHigherPriorityTaskWoken || xTaskWokenByReceive)
      taskYIELD ();
}


In der main wird folgendes konfiguriert:

[c]
int main (void)
{
  SystemInit();
  periph();
  init_usart3(9600);


  NVIC_InitTypeDef NVIC_InitStructure =
  {
    .NVIC_IRQChannel = USART3_IRQn,
    .NVIC_IRQChannelPreemptionPriority = 
(configMAX_SYSCALL_INTERRUPT_PRIORITY >> 4) + 1,
    .NVIC_IRQChannelSubPriority = 0,
    .NVIC_IRQChannelCmd = ENABLE,
  };
  NVIC_Init( &NVIC_InitStructure );
  NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4);

  // Hier Tasks erstellen
  xTaskCreate( vTaskReceive_Send, "Receive",256, NULL, 2 , NULL );
  xTaskCreate( vTaskFillQueue, "Fill", 256, NULL, 1 , NULL );


  // Hier Queues erstellen
  hSerialTx = xQueueCreate( 260, sizeof( uint8_t ) );
  hSerialRx = xQueueCreate( 260, sizeof( uint8_t ) );
  hUSART1_tx = xQueueCreate( 256, sizeof( uint8_t ) );
  hUSART1_rx = xQueueCreate( 256, sizeof( uint8_t ) );
  xdata = xQueueCreate (20, sizeof( uint8_t ));


  }

  // Hier scheduler starten
  vTaskStartScheduler();
}

[\c]


Ich habe keine Ahnung wo der Fehler liegt. Ich nutze die heap2.c, kann 
es da irgendwie zu einem Fehler kommen?

Gruß
paule