Rework mutex/semaphore code

Improve the mutex protection around shared data

Rework so that registering a driver gives a semaphore to the
driver semaphore count, deregistering it takes it (removes one
from the count) of available driver handles.

Change-Id: I9b74ed87b9371490d0ffcc8516f65bcab56d05bb