Fixed something in the scheduler

Something was going on with the multiple calls to GetTimeUS inside the
interrupt handler for the scheduler. Not really sure why, but reducing
this to one calls seems to have solved the issue.