计算两铰接连杆旋转角度使末端到达指定坐标的方法咨询

可以计算，该问题属于平面二自由度串联连杆的逆运动学求解范畴，只要目标点在连杆的可达工作空间内，就能得到对应的旋转角度，部分场景下存在两种可行的角度组合。

前置参数定义 #

• 第一根杆件长度为l₁，可绕原点旋转的角度为θ₁（以x轴正方向为0位，逆时针为正方向）
• 第二根杆件长度为l₂，相对第一根杆件铰接点的旋转角度为θ₂（以第一根杆件延伸方向为0位，逆时针为正方向）
• 待到达的目标点平面坐标为*(x,y)*

推导过程 #

1. 正向运动学关系 #

第二根杆件末端的坐标可由两根杆的角度直接计算得到，对应公式为：

x = l₁·cosθ₁ + l₂·cos(θ₁+θ₂)
y = l₁·sinθ₁ + l₂·sin(θ₁+θ₂)

2. 求解第二根杆的旋转角θ₂ #

将上述两个公式左右两边分别平方后相加，利用三角函数平方和为1的特性消去角度和项，可得：
x² + y² = l₁² + l₂² + 2l₁l₂·cosθ₂
整理后得到cosθ₂的表达式：
cosθ₂ = (x² + y² - l₁² - l₂²) / (2l₁l₂)

解的存在性判断

• 若|cosθ₂| > 1：无解，目标点超出连杆可达范围，连杆最大可达半径为l₁+l₂，最小可达半径为*|l₁-l₂|*，仅当目标点到原点的距离在二者之间时有解
• 若|cosθ₂| = 1：θ₂有唯一解，对应连杆完全伸直（θ₂=0）或完全折叠（θ₂=180°）的构型
• 若|cosθ₂| < 1：θ₂有两个互为正负的解，对应“肘部向上”和“肘部向下”两种不同的可达构型

3. 求解第一根杆的旋转角θ₁ #

先计算目标点相对于原点的极角φ = atan2(y, x)，再计算第一根杆与原点到目标点连线的夹角β，由余弦定理可得：
cosβ = (l₁² + x² + y² - l₂²) / (2l₁·√(x²+y²))
最终θ₁的解为θ₁ = φ ± β，正负号与θ₂的解一一对应，可根据实际应用场景的构型约束选择对应解。

内容的提问来源于stack exchange，提问作者Роман Савранский