[TaskScheduler] Manually lock/unlock mutex in addTask and disableTask

The use of RAII classes to lock/unlock the mutex in the aforementioned
functions causes undesired re-locking/unlocking in the case of an
early return, because of the way RAII works. Avoid this by manually
locking and unlocking the mutex.