when calling getForwardKinematics with 'q' parameter, or with both 'q' and 'tcp_offset' - wrong values are returned (checked against real robot program. when calling the function without 'q' a correct answer is returned) example case : - q = -1.6007000000000000 -1.7271000000000001 -2.2029999999999994 -0.80799999999999983 1.5951000000000000 -0.030999999999999694 - result from c++ interface = 1.5028505325317383 1.8395767211914063 -1.3881249427795410 2.1046848297119141 0.53753542900085449 0.57044577598571777 - result from robot controller program (also correct result) = [-0.14397, -0.43562, 0.20203, -0.00121, 3.11628, 0.03886]