【数学问题2】动力学建模
在動力學基礎篇我們已經(jīng)介紹了關節(jié)速度與末端執(zhí)行器速度的關系,這一片將會帶大家探討加速度之間的關系,因為力的作用,總是離不開加速度。
一、公式回顧
對于旋轉(zhuǎn)關節(jié),各連桿的線速度與角速度可以表示為如下:
i+1ωi+1=ii+1Riωi+θ˙i+1i+1Z^i+1(1-1)^{i+1} \omega_{i+1} = ^{i+1}_{i}R \ ^i \omega_i + \dot \theta_{i+1} \ ^{i+1}\hat Z _{i+1} \tag{1-1}i+1ωi+1?=ii+1?R?iωi?+θ˙i+1??i+1Z^i+1?(1-1)
i+1vi+1=ii+1R(ivi+iωi×iPi+1)(1-2)^{i+1}v_{i+1} =^{i+1}_{i}R ( \ ^iv_i + \ ^i\omega_i \times \ ^iP_{i+1})\tag{1-2}i+1vi+1?=ii+1?R(?ivi?+?iωi?×?iPi+1?)(1-2)
對于滑動關節(jié),上一章沒有給出,推導方法類似,這里直接給出公式:
i+1ωi+1=ii+1Riωi(1-3)^{i+1} \omega_{i+1} = \ _i ^{i+1}R\ ^i\omega_i\tag{1-3}i+1ωi+1?=?ii+1?R?iωi?(1-3)
i+1vi+1=ii+1R(ivi+iωi×iPi+1)+d˙i+1i+1Z^i+1(1-4)^{i+1}v_{i+1} =^{i+1}_{i}R ( \ ^iv_i + \ ^i\omega_i \times \ ^iP_{i+1}) + \dot d_{i+1} \ ^{i+1} \hat Z_{i+1} \tag{1-4}i+1vi+1?=ii+1?R(?ivi?+?iωi?×?iPi+1?)+d˙i+1??i+1Z^i+1?(1-4)
二、剛體加速度公式
1、線加速度
跟位置與速度關系同理,我們可以通過對速度進行微分得到加速度:
BAQ=dBVQdt=limΔt→0BVQ(t+Δt)?BVQ(t)Δt^BA_Q = \frac{d^BV_Q}{dt} = \underset{\Delta t\rightarrow 0}{lim}\frac{^BV_Q(t+\Delta t) - ^BV_Q(t)}{\Delta t}BAQ?=dtdBVQ??=Δt→0lim?ΔtBVQ?(t+Δt)?BVQ?(t)?
不同參考系下的加速度變換如下:
2、角加速度
AΩ˙B=dAΩBdt=limΔt→0AΩB(t+Δt)?AΩB(t)Δt^A \dot \Omega_B = \frac{d^A \Omega_B}{dt} = \underset{\Delta t\rightarrow 0}{lim}\frac{^A \Omega_B(t+\Delta t) - ^A \Omega _B(t)}{\Delta t}AΩ˙B?=dtdAΩB??=Δt→0lim?ΔtAΩB?(t+Δt)?AΩB?(t)?
不同參考系下的加速度變換如下,假設參考系{B}\{B\}{B}以角速度AΩB^A\Omega_BAΩB?相對于參考系{A}\{A\}{A}轉(zhuǎn)動,同時參考系{C}\{C\}{C}以角速度BΩC^B\Omega_CBΩC?相對于參考系{B}\{B\}{B}轉(zhuǎn)動:
AΩC=AΩB+BARBΩC^A \Omega_C = \ ^A\Omega_B + \ ^A_BR ^B\Omega_CAΩC?=?AΩB?+?BA?RBΩC?
AΩ˙C=AΩ˙B+BARBΩ˙C+AΩB×BARBΩC^A \dot \Omega_C = \ ^A\dot \Omega_B + \ ^A_BR \ ^B\dot \Omega_C + \ ^A\Omega_B \times \ ^A_BR ^B\Omega_CAΩ˙C?=?AΩ˙B?+?BA?R?BΩ˙C?+?AΩB?×?BA?RBΩC?
三、平行移軸定理
平行移軸定理描述了一個以剛體質(zhì)心為原點的坐標系平移到另外一個坐標系時慣性裝量的變換關系。假設{C}\{C\}{C}是以剛體質(zhì)心為原點的坐標系,{A}\{A\}{A}為任意平移后的坐標系,則并行移軸定理可以表示為:
AI=CI+m(PcTPcI3?PcPcT)^AI = \ ^CI + m(P_c^TP_cI_3 - P_cP_c^T)AI=?CI+m(PcT?Pc?I3??Pc?PcT?)
式中,Pc=[xcyczc]TP_c = [x_c\quad y_c \quad z_c]^TPc?=[xc?yc?zc?]T表示剛體質(zhì)心在坐標系{A}\{A\}{A}中的位置。
四、牛頓、歐拉方程
牛頓方程,式中,m為剛體質(zhì)量
F=mv˙c(4-1)F = m\dot v_c \tag {4-1}F=mv˙c?(4-1)
歐拉方程,ω˙,ω\dot \omega ,\omegaω˙,ω分別為角加速度和角速度,CI^CICI表示剛體質(zhì)心坐標系中的慣性張量
N=CIω˙+ω×CIω(4-2)N = \ ^CI \dot \omega + \omega \times \ ^CI \omega \tag{4-2}N=?CIω˙+ω×?CIω(4-2)
五、牛頓-歐拉迭代動力學方程
1、加速度迭代
為了計算作用在連桿上的慣性力,需要計算每個連桿在某一時刻的角速度,線加速度,角加速度。
角加速度迭代公式
對1-1角速度公式求導,得到角加速度公式:
線加速度迭代
i+1ai+1=ii+1R(iai+iω˙i×iPi+1+iωi(iωi×iPi+1))^{i+1}a_{i+1} = \ ^{i+1}_iR(\ ^ia_i + \ ^i \dot \omega_i \times \ ^iP_{i+1} + \ ^i \omega_i(\ ^i \omega_i \times \ ^iP_{i+1}))i+1ai+1?=?ii+1?R(?iai?+?iω˙i?×?iPi+1?+?iωi?(?iωi?×?iPi+1?))
質(zhì)心加速度
iaci=iai+iω˙i×iPci+iωi×(iωi×iPci)^i a_{c_i} = \ ^ia_i + \ ^i \dot \omega_i \times \ ^iP_{c_i}+ \ ^i \omega_i \times(\ ^i \omega_i \times \ ^iP_{c_i})iaci??=?iai?+?iω˙i?×?iPci??+?iωi?×(?iωi?×?iPci??)
式中,cic_ici?表示連桿iii的質(zhì)心
2、力和力矩的迭代
利用牛頓、歐拉公式計算出作用在連桿上的力和力矩后,計算關節(jié)力矩,他們實際是施加在連桿上的力和力矩
將所有作用在
ifi=iFi+i+1iRi+1fi+1^if_i = \ ^iF_i+ \ ^i_{i+1}R \ ^{i+1}f_{i+1}ifi?=?iFi?+?i+1i?R?i+1fi+1?
ini=i+1iRi+1ni+1+iNi+iPci×iFi+iPi+1×i+1iRi+1fi+1^in_i = \ ^i_{i+1}R \ ^{i+1}n_{i+1} + \ ^iN_i + \ ^iP_{c_i}\times \ ^iF_i + \ ^iP_{i+1}\times \ ^i_{i+1}R \ ^{i+1}f_{i+1}ini?=?i+1i?R?i+1ni+1?+?iNi?+?iPci??×?iFi?+?iPi+1?×?i+1i?R?i+1fi+1?
在靜力學中,可通過計算一個連桿施加于相鄰連桿的力矩在Z^\hat ZZ^方向的分量求得關節(jié)力矩:
τ=iniTiZ^i\tau = \ ^in_i^T \ ^i \hat Z_iτ=?iniT??iZ^i?
總結(jié)
以上是生活随笔為你收集整理的【数学问题2】动力学建模的全部內(nèi)容,希望文章能夠幫你解決所遇到的問題。
- 上一篇: matlab drawnow连成曲线,p
- 下一篇: SCCM 2007系列教程之三日志文件