Replaced uses of ReentrantSemaphore in GyroFilter class with atomic variables