Revert https://github.com/robotology-playground/wholebodyinterface/commit/a65a7f828d957d8278a68a196828f992d14d407f