绕点旋转公式,用于机械手的旋转计算。可以配合机器视觉