Working FIFO scheduler, compass uses the scheduler. Scheduler needs to be revamped so the interrupts are handled in a significantly shorter period of time so they don't recurse, but that shouldn't be too difficult.