mod is slow

diff --git a/tos/system/QueueC.nc b/tos/system/QueueC.nc
index 860934833949e98996e3fbc5f43343cde672357b..3f8d378772a8126d30525918a7c1bae770625bcc 100644 (file)
--- a/tos/system/QueueC.nc
+++ b/tos/system/QueueC.nc
@@ -87,7 +87,7 @@ implementation {
     dbg("QueueC", "%s: size is %hhu\n", __FUNCTION__, size);
     if (!call Queue.empty()) {
       head++;
-      head %= QUEUE_SIZE;
+      if (head == QUEUE_SIZE) head = 0;
       size--;
       printQueue();
     }
@@ -99,7 +99,7 @@ implementation {
       dbg("QueueC", "%s: size is %hhu\n", __FUNCTION__, size);
       queue[tail] = newVal;
       tail++;
-      tail %= QUEUE_SIZE;
+      if (tail == QUEUE_SIZE) tail = 0;
       size++;
       printQueue();
       return SUCCESS;