Fixed Lock Problem in SensorHeadPosition.java