Added "goalThreshold" member and set it to 0.2 without considering base orientation.