Clean some debug, rename output trajectory in detailed motion
Add long distance primitive option to reduce the number of expansions when far away from the target. Use with caution