First module working with the new wbi_id: wholeBodyDynamicsTree