Update idyn2kdl_icub.cpp

@andreadelprete if you update this and run the model generator you should get two new frames, let me know if this is working.