mobile yumi pseudoinverse works

development_plan.toml

examples/cart_pulling/todos.toml

examples/cartesian_space/test_by_running.sh

python/setup.py

...control/cartesian_space/cartesian_space_point_to_point.py

python/smc/control/control_loop_manager.py

python/smc/control/controller_templates/point_to_point.py

python/smc/robots/abstract_simulated_robotmanager.py

python/smc/robots/grippers/abstract_gripper.py

python/smc/robots/grippers/rs485_robotiq/rs485_robotiq.py

python/smc/robots/implementations/heron.py

python/smc/robots/implementations/mobile_yumi.py

python/smc/robots/implementations/ur5e.py

python/smc/robots/interfaces/whole_body_interface.py

python/smc/robots/utils.py

python/smc/visualization/plotters.py