Multiple fixes in benchmark tool. Added end effector offsets