Fix bluetooth sleep bug
Improve pick_next_highest_task_rt