Working on icub whole body interface

Add method to close interface
Add method to set reference speed for position control
Velocity/acceleration estimation still doesn't work