Moved all source to the trunk directory.

[pub/lufa.git] / Projects / AVRISP_Programmer / RingBuff.c

diff --git a/Projects/AVRISP_Programmer/RingBuff.c b/Projects/AVRISP_Programmer/RingBuff.c
new file mode 100644 (file)
index 0000000..1f477f1
--- /dev/null
+++ b/Projects/AVRISP_Programmer/RingBuff.c
@@ -0,0 +1,120 @@
+/*\r
+             LUFA Library\r
+     Copyright (C) Dean Camera, 2009.\r
+              \r
+  dean [at] fourwalledcubicle [dot] com\r
+      www.fourwalledcubicle.com\r
+*/\r
+\r
+/*\r
+  Copyright 2009  Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
+\r
+  Permission to use, copy, modify, and distribute this software\r
+  and its documentation for any purpose and without fee is hereby\r
+  granted, provided that the above copyright notice appear in all\r
+  copies and that both that the copyright notice and this\r
+  permission notice and warranty disclaimer appear in supporting\r
+  documentation, and that the name of the author not be used in\r
+  advertising or publicity pertaining to distribution of the\r
+  software without specific, written prior permission.\r
+\r
+  The author disclaim all warranties with regard to this\r
+  software, including all implied warranties of merchantability\r
+  and fitness.  In no event shall the author be liable for any\r
+  special, indirect or consequential damages or any damages\r
+  whatsoever resulting from loss of use, data or profits, whether\r
+  in an action of contract, negligence or other tortious action,\r
+  arising out of or in connection with the use or performance of\r
+  this software.\r
+*/\r
+\r
+#include "RingBuff.h"\r
+\r
+void Buffer_Initialize(RingBuff_t* Buffer)\r
+{\r
+       BUFF_ATOMIC_BLOCK\r
+       {\r
+               Buffer->InPtr    = (RingBuff_Data_t*)&Buffer->Buffer;\r
+               Buffer->OutPtr   = (RingBuff_Data_t*)&Buffer->Buffer;\r
+               Buffer->Elements = 0;\r
+       }\r
+}\r
+\r
+void Buffer_StoreElement(RingBuff_t* Buffer, RingBuff_Data_t Data)\r
+{\r
+       BUFF_ATOMIC_BLOCK\r
+       {\r
+       #if defined(BUFF_DROPOLD)\r
+               if (Buffer->Elements == BUFF_LENGTH)\r
+               {\r
+                       Buffer->OutPtr++;\r
+       \r
+                       if (Buffer->OutPtr == &Buffer->Buffer[BUFF_LENGTH])\r
+                         Buffer->OutPtr = (RingBuff_Data_t*)&Buffer->Buffer;\r
+               }\r
+               else\r
+               {\r
+                       Buffer->Elements++;\r
+               }\r
+       #elif defined(BUFF_DROPNEW)\r
+               if (Buffer->Elements == BUFF_LENGTH)\r
+                 return;\r
+       \r
+                 Buffer->Elements++;\r
+       #elif defined(BUFF_NODROPCHECK)\r
+                 Buffer->Elements++;\r
+       #endif\r
+       \r
+               *(Buffer->InPtr) = Data;\r
+               Buffer->InPtr++;\r
+       \r
+               if (Buffer->InPtr == &Buffer->Buffer[BUFF_LENGTH])\r
+                 Buffer->InPtr = (RingBuff_Data_t*)&Buffer->Buffer;\r
+       }\r
+}\r
+\r
+RingBuff_Data_t Buffer_GetElement(RingBuff_t* Buffer)\r
+{\r
+       RingBuff_Data_t BuffData;\r
+       \r
+       BUFF_ATOMIC_BLOCK\r
+       {\r
+#if defined(BUFF_EMPTYRETURNSZERO)\r
+               if (!(Buffer->Elements))\r
+                 return 0;\r
+#elif !defined(BUFF_NOEMPTYCHECK)\r
+       #error No empty buffer check behaviour specified.\r
+#endif\r
+\r
+               BuffData = *(Buffer->OutPtr);\r
+       \r
+               Buffer->OutPtr++;\r
+               Buffer->Elements--;\r
+       \r
+               if (Buffer->OutPtr == &Buffer->Buffer[BUFF_LENGTH])\r
+                 Buffer->OutPtr = (RingBuff_Data_t*)&Buffer->Buffer;\r
+       }\r
+       \r
+       return BuffData;\r
+}\r
+\r
+#if defined(BUFF_USEPEEK)\r
+RingBuff_Data_t Buffer_PeekElement(const RingBuff_t* Buffer)\r
+{\r
+       RingBuff_Data_t BuffData;\r
+\r
+       BUFF_ATOMIC_BLOCK\r
+       {\r
+#if defined(BUFF_EMPTYRETURNSZERO)\r
+               if (!(Buffer->Elements))\r
+                 return 0;\r
+#elif !defined(BUFF_NOEMPTYCHECK)\r
+       #error No empty buffer check behaviour specified.\r
+#endif\r
+\r
+               BuffData = *(Buffer->OutPtr);\r
+       }\r
+\r
+       return BuffData;\r
+}\r
+#endif\r