fixed jacobians for joint update, include distance in joint space and end-effector space, added transparency