Added take/give semaphore into ITG3200 driver