Implementing a few bug fixes for UseSkillGoal