fixed joined path following reference mpc

...s/with_planner/base_and_ee_path_following_from_planner.py

...lems/with_planner/ee_only_path_following_from_plannner.py

examples/cart_pulling/disjoint_control/demo.py

...ulling/disjoint_control/mpc_base_clik_arm_control_loop.py

...s/cart_pulling/map_tests/topics_for_robot_localization.md

...art_pulling/path_construction_tests/path6d_from_path2d.py

examples/cart_pulling/technical_report/cart_pulling.aux

examples/cart_pulling/technical_report/cart_pulling.log

examples/cart_pulling/technical_report/cart_pulling.pdf

...les/cart_pulling/technical_report/cart_pulling.synctex.gz

examples/cart_pulling/technical_report/cart_pulling.tex

examples/cart_pulling/technical_report/cart_pulling.toc

examples/cart_pulling/todos.toml

examples/navigation/mobile_base_navigation.py

examples/path6d_from_path2d.py

...l/cartesian_space/cartesian_space_trajectory_following.py

...c/control/controller_templates/path_following_template.py

...n/smc/control/optimal_control/croco_mpc_path_following.py

...n/smc/path_generation/path_math/cart_pulling_path_math.py

python/smc/path_generation/path_math/path2d_to_6d.py