clean-up code for free_tp data structure
Synchronous Jogging for Gantry Joints at free-mode