Prosper Van
xbee communication for UWB quadcopter project Originally by Greg Abdo Forking to reduce impact of interrupt by moving packetbuilder out of the interrupt and letting be handled in the main loop
Fork of
com
by 
Prosper Van
Diff: queueChar/queueChar.cpp
- Revision:
- 17:acef0fb07510
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/queueChar/queueChar.cpp Mon Oct 06 04:59:20 2014 +0000
@@ -0,0 +1,132 @@
+/*************************** queue.cpp ***************************************/
+/* */
+/*****************************************************************************/
+
+#include "queueChar.h"
+
+/***************************** constructor ***********************************/
+/* Description: */
+/*****************************************************************************/
+
+queueChar::queueChar()
+{
+ front = 0;
+ end = 0;
+ lengthVar = 0;
+ for (int i = 0; i < MAXQUEUECHARLENGTH; i++)
+ {
+ buffer[i] = 0;
+ }
+}
+
+/******************************* distructor **********************************/
+/* Description: */
+/*****************************************************************************/
+
+queueChar::~queueChar()
+{
+ clear(); // Clear the entire queue.
+}
+
+/*****************************************************************************/
+/* Description: */
+/* Accepts: */
+/* Returns: */
+/*****************************************************************************/
+
+bool queueChar::isEmpty()
+{
+ bool empty = front == end;
+ if (empty) lengthVar = 0;
+ return empty;
+}
+
+/*****************************************************************************/
+/* Description: */
+/* Accepts: */
+/* Returns: */
+/*****************************************************************************/
+
+void queueChar::clear()
+{
+ lengthVar = 0;
+ front = 0;
+ end = 0;
+}
+
+/*****************************************************************************/
+/* Description: */
+/* Accepts: */
+/* Returns: */
+/*****************************************************************************/
+
+void queueChar::add( char data )
+{
+ buffer[front] = data;
+ front = nextIndex(front);
+ if (front == end)
+ end = nextIndex(end);
+ else
+ lengthVar++;
+}
+
+/*****************************************************************************/
+/* Description: */
+/* Accepts: */
+/* Returns: */
+/*****************************************************************************/
+
+char queueChar::pop()
+{
+ if (isEmpty())
+ return 255;
+ else
+ {
+ lengthVar--;
+ char data = buffer[end];
+ end = nextIndex(end);
+ return data;
+ }
+}
+
+/*****************************************************************************/
+/* Description: */
+/* Accepts: */
+/* Returns: */
+/*****************************************************************************/
+
+char queueChar::peek()
+{
+// return front;
+ char data = buffer[end];
+ return data;
+}
+
+/*****************************************************************************/
+/* Description: */
+/* Accepts: */
+/* Returns: */
+/*****************************************************************************/
+
+char queueChar::length()
+{
+ short diff = front - end;
+ if (diff < 0)
+ diff += MAXQUEUECHARLENGTH;
+// diff = diff % MAXQUEUECHARLENGTH;
+ return diff;
+// if (diff == lengthVar)
+// return lengthVar;
+// else
+// lengthVar = diff;
+// return 255;
+}
+
+
+char queueChar::nextIndex(char index)
+{
+ index++;
+ if (index >= MAXQUEUECHARLENGTH)
+ index = 0;
+ return index;
+}
\ No newline at end of file