Irqs are working. Scheduler modified to come back from no tasks.

- Userspace irq handling for timer.
- If no runnable task is left. scheduler busy loops in user context
  of last runnable task until a new task becomes runnable.

src/api/irq.c

@@ -115,7 +115,7 @@ int irq_wait(l4id_t irq_index)
 	WAIT_EVENT(&desc->wqh_irq,
 		   utcb->notify[desc->task_notify_slot] != 0,
 		   ret);
-	printk("Didn't sleep. utcb->notify[%d]=%d\n", desc->task_notify_slot, utcb->notify[desc->task_notify_slot]);
+
 	if (ret < 0)
 		return ret;
 	else

src/arch/arm/v5/irq.S

@@ -15,6 +15,14 @@ BEGIN_PROC(irq_local_disable_save)
 	mov	pc, lr
 END_PROC(irq_local_disable_save)
 
+/*
+ * r0 = last cpsr state
+ */
+BEGIN_PROC(irq_local_restore)
+	msr	cpsr_fc, r0	@ Write r0 to cpsr
+	mov	pc, lr
+END_PROC(irq_local_restore)
+
 /*
  * r0 = byte address to read from.
  */
@@ -25,3 +33,11 @@ BEGIN_PROC(l4_atomic_dest_readb)
 	mov	pc, lr		@ Return byte location value
 END_PROC(l4_atomic_dest_readb)
 
+BEGIN_PROC(irqs_enabled)
+	mrs	r1, cpsr_fc
+	tst	r1, #0x80
+	moveq	r0, #1
+	movne   r0, #0
+	mov	pc, lr
+END_PROC(irqs_enabled)
+

src/generic/scheduler.c

@@ -33,7 +33,6 @@ extern unsigned int current_irq_nest_count;
 /* This ensures no scheduling occurs after voluntary preempt_disable() */
 static int voluntary_preempt = 0;
 
-
 void sched_lock_runqueues(unsigned long *irqflags)
 {
 	spin_lock_irq(&scheduler.sched_rq[0].lock, irqflags);
@@ -359,14 +358,16 @@ void schedule()
 {
 	struct ktcb *next;
 
-	/* Should not schedule with preemption disabled or in nested irq */
+	/* Should not schedule with preemption
+	 * disabled or in nested irq */
 	BUG_ON(voluntary_preempt);
 	BUG_ON(in_nested_irq_context());
 
 	/* Should not have more ticks than SCHED_TICKS */
 	BUG_ON(current->ticks_left > SCHED_TICKS);
 
-	/* Cannot have any irqs that schedule after this */
+	/* If coming from process path, cannot have
+	 * any irqs that schedule after this */
 	preempt_disable();
 
 	/* Reset schedule flag */
@@ -410,6 +411,7 @@ void schedule()
 	}
 
 	/* Determine the next task to be run */
+get_runnable_task:
 	if (scheduler.rq_runnable->total > 0) {
 		next = link_to_struct(scheduler.rq_runnable->task_list.next,
 		       struct ktcb, rq_list);
@@ -420,7 +422,20 @@ void schedule()
 			       scheduler.rq_runnable->task_list.next,
 			       struct ktcb, rq_list);
 		} else {
-			idle_task();
+			//printk("Idle task.\n");
+			/* Poll forever for new tasks */
+			if (in_task_context()) {
+				goto get_runnable_task;
+			} else {
+				/*
+				 * If irq, return to current context without
+				 * putting into runqueue. We want the task to
+				 * get into the get_runnable_task loop in
+				 * process context.
+				 */
+				next = current;
+				goto switch_out;
+			}
 		}
 	}
 
@@ -443,6 +458,7 @@ void schedule()
 	next->sched_granule = SCHED_GRANULARITY;
 
 	/* Finish */
+switch_out:
 	disable_irqs();
 	preempt_enable();
 	context_switch(next);

src/lib/wait.c

@@ -165,7 +165,7 @@ void wake_up(struct waitqueue_head *wqh, unsigned int flags)
 		task_unset_wqh(sleeper);
 		if (flags & WAKEUP_INTERRUPT)
 			sleeper->flags |= TASK_INTERRUPTED;
-		printk("(%d) Waking up (%d)\n", current->tid, sleeper->tid);
+		//printk("(%d) Waking up (%d)\n", current->tid, sleeper->tid);
 		spin_unlock_irq(&wqh->slock, irqflags);
 
 		if (flags & WAKEUP_SYNC)