Fix position direct and improve compliance with yarp controlboard specification

Fixes #137, fixes #134, fixes #129 and solves some aspects related to #111 .