This is a HUGE refactor of PDgravity_test since the previous version is not compliant with standard YARP module and this version take care of new joint. Already tested and working in simulation, needs to be tested in the real robot. Still missing loading of PD values from file.