The frame a fit of a pose and a goal is solved in: a root's position and heading.
The turn into the frame: minus the heading about +Y.
The root's x, world metres.
Optional
The root's y, world metres; omission means zero for an explicit floor frame.
The root's z, world metres.
The frame a fit of a pose and a goal is solved in: a root's position and heading.