Whole Body Interface implementation for IIT Coman robot