Adds GoalTransform class to be used for constrained teleop