1 files changed, 20 insertions, 0 deletions

diff --git a/firmware/kernel.c b/firmware/kernel.c
index b30a3bb12b..f8b9cec2e1 100644
--- a/firmware/kernel.c
+++ b/firmware/kernel.c
@@ -83,6 +83,26 @@ void queue_init(struct event_queue *q)
     all_queues[num_queues++] = q;
 }
 
+void queue_delete(struct event_queue *q)
+{
+    int i;
+
+    /* Find the queue to be deleted */
+    for(i = 0;i < num_queues;i++)
+    {
+        if(all_queues[i] == q)
+            break;
+    }
+
+    /* Move the following queues up in the list */
+    for(;i < num_queues-1;i++)
+    {
+        all_queues[i] = all_queues[i+1];
+    }
+
+    num_queues--;
+}
+
 void queue_wait(struct event_queue *q, struct event *ev)
 {
     while(q->read == q->write)