Fix position direct and improve compliancy with yarp controlboard specification

Fixes #137, fixes #134, fixes #129 and address some points of #111 .