Changed the sensor read semaphore to a mutex