#ifndef __MAILBOX_H__

#define __MAILBOX_H__

#include <stdint.h>

#include <stdlib.h>

#include <string.h>

typedef struct

{

  // uint32_t Capacity;

  uint8_t * Memory;

  uint32_t MailSize;

  uint32_t MailCount;

  uint32_t ReadIndex;

  uint32_t ReadCount;

} MAILBOX;

// Creates a new mailbox and Init it.

MAILBOX * MBX_Create( uint32_t MailSize, uint32_t MailCount );

// Deletes a specified mailbox.

void MBX_Delete( MAILBOX * Mailbox );

// Clears all messages in a specified mailbox.

void MBX_Clear( MAILBOX * Mailbox );

// Init a new mailbox.

void MBX_Init( MAILBOX * Mailbox, uint32_t MailSize, uint32_t MailCount,

  void * Memory );

// Stores a new message of a predefined size in a mailbox.

uint32_t MBX_Write( MAILBOX * Mailbox, void * Mail );

/*

 * Stores a new message of a predefined size into a mailbox in front of all

 * other messages, if the mailbox is able to accept one more message.

 * The new message will be retrieved first.

 */

uint32_t MBX_WriteFront( MAILBOX * Mailbox, void * Mail );

/* Retrieves a new message of a predefined size from a mailbox.

 * Mail : Pointer to the memory area that the message should be stored at.

 * Make sure that it points to a valid memory area and that there is sufficient

 * space for an entiremessage. The message size (in bytes) was defined

 * when the mailbox was created.

 */

uint32_t MBX_Read( MAILBOX * Mailbox, void * Mail );

// Returns the number of mail currently available in a specified mailbox.

uint32_t MBX_GetCount( MAILBOX * Mailbox );

#endif /* __MAILBOX_H__ */

#include "mailbox.h"

#include "macro_misc.h"

#include "cmsis_os.h"

// Creates a new mailbox and Init it.

MAILBOX * MBX_Create( uint32_t MailSize, uint32_t MailCount )

{

  uint32_t Size = ALIGN_UP( sizeof(MAILBOX),  ) + MailSize * MailCount;

  MAILBOX * Mailbox = (MAILBOX *) osMalloc( Size, osWaitForever );

  if ( Mailbox ==  )

    return Mailbox;

  uint8_t * Memory = //

    (uint8_t *) ( ( (uint32_t) ( Mailbox ) ) + ALIGN_UP( sizeof(MAILBOX),  ) );

  MBX_Init( Mailbox, MailSize, MailCount, Memory );

  return Mailbox;

}

// Deletes a specified mailbox.

void MBX_Delete( MAILBOX * Mailbox )

{

  osFree( Mailbox );

}

// Clears all messages in a specified mailbox.

void MBX_Clear( MAILBOX * Mailbox )

{

  Mailbox->ReadCount = ;

}

// Returns the number of mail currently available in a specified mailbox.

uint32_t MBX_GetCount( MAILBOX * Mailbox )

{

  return Mailbox->ReadCount;

}

// Init a new mailbox.

void MBX_Init( MAILBOX * Mailbox, uint32_t MailSize, uint32_t MailCount,

  void * Memory )

{

  // Mailbox->Capacity = MailCount * MailSize;

  Mailbox->MailSize = MailSize;

  Mailbox->MailCount = MailCount;

  Mailbox->Memory = Memory;

  Mailbox->ReadIndex = ;

  Mailbox->ReadCount = ;

}

/* Stores a new message of a predefined size in a mailbox.

 *

 * 0: Message could not be stored (mailbox is full).

 * 1: Success; message stored.

 */

uint32_t MBX_Write( MAILBOX * Mailbox, void * Mail )

{

  if ( Mailbox->ReadCount == Mailbox->MailCount )

    return ;

  uint32_t Value = osDisableInterrupt( );

  uint32_t IndexToWrite = ( Mailbox->ReadIndex + Mailbox->ReadCount );

  if ( IndexToWrite == Mailbox->MailCount )

    IndexToWrite = ;

  uint32_t MemoryIndexToWrite = IndexToWrite * Mailbox->MailSize;

  memcpy( &Mailbox->Memory[ MemoryIndexToWrite ], Mail, Mailbox->MailSize );

  Mailbox->ReadCount++;

  osRestoreInterrupt( Value );

  return ;

}

/*

 * Stores a new message of a predefined size into a mailbox in front of all

 * other messages, if the mailbox is able to accept one more message.

 * The new message will be retrieved first.

 *

 * 0: Message could not be stored (mailbox is full).

 * 1: Success; message stored.

 */

uint32_t MBX_WriteFront( MAILBOX * Mailbox, void * Mail )

{

  if ( Mailbox->ReadCount == Mailbox->MailCount )

    return ;

  if ( Mailbox->ReadCount ==  )

    return MBX_Write( Mailbox, Mail );

  uint32_t Value = osDisableInterrupt( );

  uint32_t IndexToWrite;

  if ( Mailbox->ReadIndex )

    IndexToWrite = Mailbox->ReadIndex - ;

  else

    IndexToWrite = Mailbox->MailCount - ;

  uint32_t MemoryIndexToWrite = IndexToWrite * Mailbox->MailSize;

  memcpy( &Mailbox->Memory[ MemoryIndexToWrite ], Mail, Mailbox->MailSize );

  Mailbox->ReadIndex = IndexToWrite;

  Mailbox->ReadCount++;

  osRestoreInterrupt( Value );

  return ;

}

/* Retrieves a new message of a predefined size from a mailbox.

 * Mail : Pointer to the memory area that the message should be stored at.

 * Make sure that it points to a valid memory area and that there is sufficient

 * space for an entiremessage. The message size (in bytes) was defined

 * when the mailbox was created.

 *

 * 0: Message could not be retrieved (mailbox is empty)

 * 1: Success; message retrieved.

 */

uint32_t MBX_Read( MAILBOX * Mailbox, void * Mail )

{

  if ( Mailbox->ReadCount ==  )

    return ;

  uint32_t Value = osDisableInterrupt( );

  uint32_t MemoryIndexToRead = Mailbox->ReadIndex * Mailbox->MailSize;

  memcpy( Mail, &Mailbox->Memory[ MemoryIndexToRead ], Mailbox->MailSize );

  Mailbox->ReadIndex++;

  if ( Mailbox->ReadIndex == Mailbox->MailCount )

    Mailbox->ReadIndex = ;

  Mailbox->ReadCount--;

  osRestoreInterrupt( Value );

  return ;

}