123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869 |
- #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_ */
|