how to fixed the target pose

[kintzhao]

how to fixed the target pose, make the smooth path align with the target

[LiJiangnanBit]

you can modify the end-state constraints to fix the target l and theta with ref.