解决复杂三角函数式解析解的问题

最近求机械臂的逆解的解析解,出现了一个三角函数式,虽然用笨方法解出来了,可是有点太浪费时间,于是找到了一种高中常用的方法,方程如下:
a c o s θ + b s i n θ = c a cos\theta +bsin\theta =c acosθ+bsinθ=c

解法: t a n θ 2 = u , c o s θ = 1 − u 2 1 + u 2 , s i n θ = 2 u 1 + u 2 tan\frac{\theta }{2}=u,cos\theta =\frac{1-u^{2}}{1+u^{2}},sin\theta =\frac{2u}{1+u^{2}} tan2θ=u,cosθ=1+u21u2,sinθ=1+u22u

带入上式,可得: a 1 − u 2 1 + u 2 + b 2 u 1 + u 2 = c a\frac{1-u^{2}}{1+u^{2}}+b\frac{2u}{1+u^{2}}=c a1+u21u2+b1+u22u=c ( a + c ) u 2 − 2 b u + ( a − c ) = 0 (a+c)u^{2}-2bu+(a-c)=0 (a+c)u22bu+(ac)=0

u = b ± b 2 + a 2 − c 2 a + c u=\frac{b\pm \sqrt{b^{2}+a^{2}-c^{2}}}{a+c} u=a+cb±b2+a2c2

此时应注意: b 2 + a 2 − c 2 \sqrt{b^{2}+a^{2}-c^{2}} b2+a2c2 >=0

a + c ≠ 0 a+c\neq 0 a+c̸=0 时 , θ = 2 tan ⁡ − 1 ( b ± b 2 + a 2 − c 2 a + c ) \theta =2\tan^{-1}(\frac{b\pm \sqrt{b^{2}+a^{2}-c^{2}}}{a+c}) θ=2tan1(a+cb±b2+a2c2 )

a + c = 0 a+c= 0 a+c=0 时 , θ = 18 0 ∘ \theta =180^{\circ} θ=180

Logo

CSDN联合极客时间,共同打造面向开发者的精品内容学习社区,助力成长!

更多推荐