[Task Scheduler] Resolved bug where we look for available id outside the...

[Task Scheduler] Resolved bug where we look for available id outside the mutex, added a variable to save the minimum id that could be used at the next add operation