二连杆动力学建模
仿真環(huán)境:matlab
內容涉及:拉格朗日方程,動力學建模。
實現(xiàn)效果:將關節(jié)視為軸承連接,無動能損耗,連桿擺動過程中,動能與勢能相互轉換,但是連桿的總能量恒定,如下圖紅線所示,黑線和藍線分別代表動能和勢能。
(一)歐拉-拉格朗日方程推導
根據(jù)牛頓第二定律:
定義:
那么牛頓第二定律可以表示為:
L稱為拉格朗日算子,上式稱為歐拉-拉格朗日方程。
將上述用廣義坐標q=(q1,q2,q3,…qn)的形式表示,n為系統(tǒng)的自由度數(shù)目。
是與廣義坐標qk相關的廣義力。
(二)二連桿動能勢能計算
2.1 速度傳遞(以轉動關節(jié)為例)
其中vk表示k桿中任意位置pk處的速度,wk表示k桿的角速度。(從中我們可以發(fā)現(xiàn),線速度表示的某點的屬性,而角速度在同一桿件上處處相同,是桿件坐標系的屬性。)
使用以上公式可以計算桿件上任意一點的角速度和線速度,首先應表達出桿件重心和桿件末端的坐標,坐標的表示可參照上期內容。
兩個關節(jié)的絕對角速度表示如下:
aw1=[w1_x,w1_y,w1_z]’;
aw2=[w2_x,w2_y,w2_z]’;
以矢量的形式表示:
w0_1=aw1.x1;
w1_2=aw2.x2;
速度傳遞:
w1=w0_1;
w2=w1+(R0_1w1_2);
v_a=v0;
v_e=v_a+w1xr_ae;
v_b=v_a+w1xr_ab;
v_c=v_b+w2xr_bc;
v_f=v_b+w2xr_bf;
2.2動能計算
K=平動動能+轉動動能
平動動能=0.5m1v_ev_e+0.5m2v_fv_f;
轉動動能=0.5w1’I1_ww1+0.5w2’I2_ww2;
其中,I1_w,I2_w表示的是桿件的慣性張量。
I1_w=R0_1I1R0_1’;
I2_w=R0_2I2R0_2’;
I1,I2表示初始姿態(tài)(基態(tài))的慣性張量,常將容易計算的位置當做初始狀態(tài)。
2.3勢能計算
P=m1gdot(p_e,z0)+m2g*dot(p_f,z0));
dot表示在世界坐標系z0方向(重力方向)上的投影。
(三)狀態(tài)更新
問題描述:輸入關節(jié)力矩為零,求解關節(jié)變量角度和角速度。
問題轉換:即求解以下微分方程:
(四)仿真
關注公眾號獲取更多內容
總結
- 上一篇: java new数组_Java如何使用n
- 下一篇: c语言注释部分两侧的分界符号分别是,c语