#define MESSAGE_SIZE 20
#define MESSAGE_ARR_SIZE  20

typedef struct TEST_MESSAGE_S
{
    int id;
    char data[MESSAGE_SIZE];
}TEST_MESSAGE;

TEST_MESSAGE messages[MESSAGE_ARR_SIZE];

char spectra_packet[20];

int  spectra_id;
int spectra_command;

int BinarySearch(TEST_MESSAGE a[], int pos, int key, int *found);
void InsertElement(int id, char *msg);
void DeleteElement(int id);

int BinarySearch(TEST_MESSAGE a[], int pos, int key, int *found)
{
    int first = 0;
    int last = pos;
    int mid;
    
    if (pos == 0)  //empty array
    {
        *found = 0;
        return 0;
    }
    else if (a[0].id > key) 
    {
        *found = 0;
        return 0;
    }
    else if (a[pos - 1].id < key)
    {
        *found = 0;
        return pos;
    }
    
    while (first < last)
    {
        mid = first + (last - first) / 2;

        if (key <= a[mid].id)
            last = mid;
        else
            first = mid + 1;
    }

    if (a[last].id == key)
    {
        *found = 1;
        return last;
    }
    else
    {
       *found = 0;
        return last;
    }
}

void UpdateElement(int id[, char msg[])
{
}

void InsertElement(int id, char *msg)
{
    int idx;
    
    idx = BinarySearch(messages, glob_pos, id, &found);
    
    if (found)  //command NEW but the element exists - issue UPDATE
    {
        UpdateElement(idx, msg);
    }
    else //element not found - add one
    {
        memmove(messages+(idx+1), messages+idx, sizeof(TEST_MESSAGE)*(glob_pos-idx));   //glob_pos-1-idx
        
        messages[idx].id = id;
        memcpy(messages[idx].data, msg, sizeof(spectra_packet));
        
       //if (glob_pos < MESSAGE_ARR_SIZE)
        glob_pos++;
    }
}

void DeleteElement(int id)
{
     int idx;
    
    idx = BinarySearch(messages, glob_pos, id, &found);
    
    if (found) 
    {
       memmove(messages+idx, messages+(idx+1), sizeof(TEST_MESSAGE)*glob_pos-1-idx);
       
       if (glob_pos > 0)
           glob_pos--;
    }
}

 /////////////////////////////TEST  AREA ///////////////////////////////////
  for (idx = 0; idx < 20; idx++)
  {
      messages[idx].id = -1;
  }
  
  while(1)
  {
      spectra_id = spectra_packet[0];
      spectra_command = spectra_packet[1];
      
      switch (spectra_command)
      {
            case 1:
                if (glob_pos < MESSAGE_ARR_SIZE)
                    InsertElement(spectra_id, spectra_packet);
            break;
            case 2:
                DeleteElement(spectra_id);
            break;
      }
  }
/////////////////////////////////////////////////////////////////////