Thanks for your great job! would you mind release the part that how franka robot take actions with the 3D trajectory?