3 files changed, 34 insertions, 7 deletions

diff --git a/firmware/API b/firmware/API
index c74aa20b0d..05d7d20961 100644
--- a/firmware/API
+++ b/firmware/API
@@ -238,6 +238,11 @@ Various
 
      Returns true if the queue is empty.
 
+  int queue_broadcast(int id, void *data)
+
+     Posts an event in all queues that has been initiated with queue_init().
+     Returns the number of queues that were posted to.
+
   int tick_add_task(void (*f)(void))
 
      Add a task to the tick task queue. The argument is a pointer to a
diff --git a/firmware/kernel.c b/firmware/kernel.c
index 3e6f89bc7e..02b76e1e5d 100644
--- a/firmware/kernel.c
+++ b/firmware/kernel.c
@@ -29,21 +29,22 @@ void (*tick_funcs[MAX_NUM_TICK_TASKS])(void);
 
 static void tick_start(unsigned int interval_in_ms);
 
+/* This array holds all queues that are initiated. It is used for broadcast. */
+static struct event_queue *all_queues[32];
+static int num_queues;
+
 /****************************************************************************
  * Standard kernel stuff
  ****************************************************************************/
 void kernel_init(void)
 {
-    int i;
-
     /* Init the threading API */
     init_threads();
     
-    /* Clear the tick task array */
-    for(i = 0;i < MAX_NUM_TICK_TASKS;i++)
-    {
-        tick_funcs[i] = NULL;
-    }
+    memset(tick_funcs, 0, sizeof(tick_funcs));
+
+    num_queues = 0;
+    memset(all_queues, 0, sizeof(all_queues));
     
     tick_start(1000/HZ);
 }
@@ -82,6 +83,9 @@ void queue_init(struct event_queue *q)
 {
     q->read = 0;
     q->write = 0;
+
+    /* Add it to the all_queues array */
+    all_queues[num_queues++] = q;
 }
 
 void queue_wait(struct event_queue *q, struct event *ev)
@@ -112,6 +116,17 @@ bool queue_empty(struct event_queue* q)
     return ( q->read == q->write );
 }
 
+int queue_broadcast(int id, void *data)
+{
+   int i;
+
+   for(i = 0;i < num_queues;i++)
+   {
+      queue_post(all_queues[i], id, data);
+   }
+   
+   return num_queues;
+}
 
 /****************************************************************************
  * Timer tick
diff --git a/firmware/kernel.h b/firmware/kernel.h
index ee9ded7ab0..ef287e5689 100644
--- a/firmware/kernel.h
+++ b/firmware/kernel.h
@@ -32,6 +32,12 @@
 #define QUEUE_LENGTH 16 /* MUST be a power of 2 */
 #define QUEUE_LENGTH_MASK (QUEUE_LENGTH - 1)
 
+/* System defined message ID's */
+#define SYS_USB_CONNECTED         -1
+#define SYS_USB_CONNECTED_ACK     -2
+#define SYS_USB_DISCONNECTED      -3
+#define SYS_USB_DISCONNECTED_ACK  -4
+
 struct event
 {
     int id;
@@ -65,6 +71,7 @@ extern void queue_init(struct event_queue *q);
 extern void queue_wait(struct event_queue *q, struct event *ev);
 extern void queue_post(struct event_queue *q, int id, void *data);
 extern bool queue_empty(struct event_queue* q);
+extern int queue_broadcast(int id, void *data);
 
 extern void mutex_init(struct mutex *m);
 extern void mutex_lock(struct mutex *m);