Flush TX FIFO after an unsuccessful transmission

weather-sensor/firmware/nrf24l01.c

  */
 
 void Print_Register_Contents(uint8_t address);
+void Send_TX_Flush_Command(void);
 
 /* Startup and initial configuration of the NRF24L01 */
 void Initialize_NRF24L01(void)
 			transmissionFinished = true; //TODO: indicate failure
 			sprintf(debugString, "%s\r\n", "max ret");
 			Print_Debug_String(debugString);
+
+			Send_TX_Flush_Command(); /* Remove the packet from the TX FIFO as it is not done automatically */
 		}
 		
 		timeout ++; // TODO: this should work without the time out, as MAX_RT should be triggered if no ACK is received
 	NRF_CSN_PORT |= (1 << NRF_CSN_PIN); // Stop the transmission
 }
 
+// TODO: clean up functions
 void Send_Activate_Command(void)
 {
 	/* First write the write command with the address */
 	NRF_CSN_PORT |= (1 << NRF_CSN_PIN); // Stop the transmission
 }
 
+void Send_TX_Flush_Command(void)
+{
+	/* First write the write command with the address */
+	NRF_CSN_PORT &= ~(1 << NRF_CSN_PIN); // Start the transmission
+	SPDR = 0xE1;
+	
+	while(!(SPSR & (1<<SPIF))); // Wait for transmission complete
+
+	NRF_CSN_PORT |= (1 << NRF_CSN_PIN); // Stop the transmission
+}
+
 
 
 void Write_Message_To_TX_FIFO(uint8_t length, uint8_t * buffer)