Fix bug when in Release mode

Replace C asserts with yarp asserts, so that the code inside the assert
is executed even in Release mode.
Convert joint limits from rad to deg.
Print list of joints that are blocked.
Merge branch 'master' of https://github.com/robotology/codyco