added thread_yield_to_higher_priority and thread lower priority functions. Need to fix next thread to run