feedforward command has been debugged. Error was found in the definition of pab and pcb which were not updated correctly. A conversion factor rad2deg has been introduced.
added some lines for debugging
gains updated to handle the new conversion from rad to deg
Merge branch 'master' of https://github.com/robotology/codyco