Screw axis measurement, jacobian estimation from end effector and joint speeds