[Mad]

I added some files:

- RoboDK_test.py is telling the robot arm where to go. Create a new station inside RoboDK, load the franka emika robot arm and run the script.

- FrankaEmikaFail.mp4 shows what happens on my PC and xArm6Working.mp4 how it should look like - the blue tool vector should touch the red base vector tip

I also added two images of the problematic positions - First iteration works, second does not