Changed name for ForceTorque, torque and joint speed ports. Commented in Cmake the testmotor due to linking problems.