Subversion Repositories funbase_ip_library

/*

 *

 *   Fifo for saving interrupt information, implementation

 *

 *   Lasse Lehtonen

 *

 */

#include "hpd_isr_fifo.h"

#include <sys/alt_irq.h>

#include <stdlib.h>

// Store item to last place, called only from ISR

void hpd_isr_fifo_push(Hpd_isr_fifo* fifo, Hpd_isr_info* item)

{

  Hpd_isr_info* temp = fifo->root;

  item->next = NULL;

  while(temp != NULL && temp->next != NULL)

    {

      temp = temp->next;

    }

  if(fifo->size < 1)

    {

      fifo->root = item;

    }

  else

    {

      temp->next = item;

    }

  fifo->size++;

}

// Returns the first item, remember to free its memory!

Hpd_isr_info* hpd_isr_fifo_pop (Hpd_isr_fifo* fifo)

{

  Hpd_isr_info* temp;

  // Prevent ISR from messing with fifo

  alt_irq_context cntx = alt_irq_disable_all();

  {

    if(fifo->size < 1)

      {

        return NULL;

      }

    temp = fifo->root;

    fifo->root = temp->next;

    fifo->size--;

    temp->next = NULL;

  }

  alt_irq_enable_all(cntx);

  return temp;

}

int hpd_isr_fifo_size(Hpd_isr_fifo* fifo)

{

  return fifo->size;

}

Hpd_isr_fifo* hpd_isr_fifo_create()

{

  //Allocate space for new and initialize data

  Hpd_isr_fifo* fifo = (Hpd_isr_fifo*) malloc(sizeof(Hpd_isr_fifo));

  fifo->root = NULL;

  fifo->size = 0;

  return fifo;

}