Added new double pendulum, now in urdf (preliminary version, improvement welcome)