Add new urdf double pendulum