89 lines
2.2 KiB
C
89 lines
2.2 KiB
C
/*
|
|
* =====================================================================================
|
|
*
|
|
* ________ .__ __ ________ ____ ________
|
|
* \_____ \ __ __|__| ____ | | __\______ \ _______ _/_ |/ _____/
|
|
* / / \ \| | \ |/ ___\| |/ / | | \_/ __ \ \/ /| / __ \
|
|
* / \_/. \ | / \ \___| < | ` \ ___/\ / | \ |__\ \
|
|
* \_____\ \_/____/|__|\___ >__|_ \/_______ /\___ >\_/ |___|\_____ /
|
|
* \__> \/ \/ \/ \/ \/
|
|
*
|
|
* www.optixx.org
|
|
*
|
|
*
|
|
* Version: 1.0
|
|
* Created: 07/21/2009 03:32:16 PM
|
|
* Author: david@optixx.org
|
|
*
|
|
* =====================================================================================
|
|
*/
|
|
#ifndef __FIFO_H__
|
|
#define __FIFO_H__
|
|
|
|
#include <avr/io.h>
|
|
#include <avr/interrupt.h>
|
|
|
|
typedef struct {
|
|
uint8_t volatile count; // # Zeichen im Puffer
|
|
uint8_t size; // Puffer-Größe
|
|
uint8_t *pread; // Lesezeiger
|
|
uint8_t *pwrite; // Schreibzeiger
|
|
uint8_t read2end, write2end; // # Zeichen bis zum Überlauf Lese-/Schreibzeiger
|
|
} fifo_t;
|
|
|
|
extern void fifo_init(fifo_t *, uint8_t * buf, const uint8_t size);
|
|
extern uint8_t fifo_put(fifo_t *, const uint8_t data);
|
|
extern uint8_t fifo_get_wait(fifo_t *);
|
|
extern int fifo_get_nowait(fifo_t *);
|
|
|
|
static inline uint8_t _inline_fifo_put(fifo_t * f, const uint8_t data)
|
|
{
|
|
if (f->count >= f->size)
|
|
return 0;
|
|
|
|
uint8_t *pwrite = f->pwrite;
|
|
|
|
*(pwrite++) = data;
|
|
|
|
uint8_t write2end = f->write2end;
|
|
|
|
if (--write2end == 0) {
|
|
write2end = f->size;
|
|
pwrite -= write2end;
|
|
}
|
|
|
|
f->write2end = write2end;
|
|
f->pwrite = pwrite;
|
|
|
|
uint8_t sreg = SREG;
|
|
cli();
|
|
f->count++;
|
|
SREG = sreg;
|
|
|
|
return 1;
|
|
}
|
|
|
|
static inline uint8_t _inline_fifo_get(fifo_t * f)
|
|
{
|
|
uint8_t *pread = f->pread;
|
|
uint8_t data = *(pread++);
|
|
uint8_t read2end = f->read2end;
|
|
|
|
if (--read2end == 0) {
|
|
read2end = f->size;
|
|
pread -= read2end;
|
|
}
|
|
|
|
f->pread = pread;
|
|
f->read2end = read2end;
|
|
|
|
uint8_t sreg = SREG;
|
|
cli();
|
|
f->count--;
|
|
SREG = sreg;
|
|
|
|
return data;
|
|
}
|
|
|
|
#endif /* _FIFO_H_ */
|