I am trying to visualize my robot as above. The waypoints are calculated with GeneralizedInverseKinematics(). The above show() command however does not show how the robot moves towards these waypoints. It is rather a picture with robots at those waypoints. Is there any other way how I can visualize that the robot actually moves towards these waypoints? Below, you can see how it looks right now.