Workaround to match iCub skinContactList output (proper fix would be to move the root_link to have id = 3 or 4, but I am afraid somewhere in the code we assume the root_link to be LocalId(1,0)
Merge branch 'master' of https://github.com/robotology/codyco