First working version of the wbi with the double pendulum