Test animation code by animating a simple trajectory for the double pendulum

[htadashi]

Suggestion: create manually a trajectory where the second link do a circular motion while the first link is stationary

[demerdjieva]

I am not completely sure if the lengths of the "robot arms" are exactly 1 as they are defined in scenario 1, will double check this, otherwise it is working.