Added calibration flag
Updated CMakeLists.txt
Changed port with encoderServer
Changed arm, changed pID
Incresed control loop time. Small code refactor
Added new yarpscope file (working with robot)
Changed some port names
fixed typo that cause the left and right wrists to be mixed while solving the IK problem