拉杆机构源程序.doc

《拉杆机构源程序.doc》由会员上传分享，免费在线阅读，更多相关内容在工程资料-天天文库。

1、拉杆机构（C语言源程序）#inelude#include#definePI3.14159#defineElle-2#defineEOle-9#definem4#defineNO500〃控制牛顿迭代次数doubleF(doublex[mj,doublet2,intn)〃角位移代数式组{doublep[m];p[0]=0.4*cos(t2*PI/180)4-1.650*cos(x[0])+1.0*cos(x[l])-x[3];p[l]=0・4*sin(t2*PI/l8

2、0)+1.650*sin(x[0])-1.0*sin(x[l])-0.358;p[2]=0・4*cos(t2*PI/180)+l・650*cos(x[0])+0・6*cos(x[l])-0.800*cos(x⑵)・l・0；p⑶=0.4*sin(t2*PI/180)+l・650*sin(x[0])・0.6*sin(x[l])-0・800*sin(x[2J)；returnp[n];}doubleA(doublex[m]Jnti,intj)〃建立雅可比矩阵{doublep[m][m];p[0][0]=-

3、1.650^sin(x[0]);p[0][1]=-1.0*sin(x[1]);p[0][2]=0;p[0][3]=-1■'p[l][0]=1.650*cos(x[0]);p[l][l]=-1.0*cos(x[l]);p[l][2]=0;p[l]⑶=0;p[2][0]=l・650*sin(x[0]);p⑵[1]=-0.600*sin(x[l]);p[2][2]=0.800*sin(x[2]);p[2][3]=0;p[3][0]=l・650*cos(x[0]);p[3][l]=0・600*cos(x[

4、l]);p⑶[2]=-0.800*cos(x[2]);p[3][3]=0;returnp[i][j];}doubleG(doublea[mj[mj,intn,doubleb[mj)〃用高斯消去法求解线性方程组(系数矩阵为方阵){inti,j,k,il,jl;doubletemp;introw_maxmod;doubleelement_maxmod;for(j=0;j

5、最大元索if(fabs(element_maxmod)

6、p;}temp=b[j];b[j]=b[row_maxmod];b[row_maxmod]=temp;}for(k=j;kvm;k++)〃高斯消元a[jj[kj/=element_maxmod;b[jj/=element_maxmod;for(订=j+1;il<4;il++){temp=a[il][j];for(jl=j;jl<4;jl++)aLilJ[jlJ-=a[jJ[jlJ:

7、ctemp;b[ilJ-=b[j]*temp;}}for(i=m-2;i>=0;i-)〃逆序求线性方程组的解for(

8、j=3;j>i;j-)b[i]-=a[i][j]*bU];returnb[n];doubleC(doublex[mj,doublev[mj,doublet2,intn)〃建立角加速度方程常数项{doublep[m];p[0]=0・400*cos(t2*PI/180)+l・650*v[0]*v[0]*cos(x[0])+l・000*v[l]*v[l]*cos(x[l]);p[l]=0・400*sin(t2*PI/180)+1.650*v[0]*v[0]*sin(x[0])-l・000*v[l]*v[

9、l]*sin(x[l]);p[2]=0・400*cos(t2*PI/180)+l・650*v[0]*v[0]*cos(x[0])+0・600*v[l]*v[1]*cos(x[1])-0.800*v[2]*v[2]*cos(x[2]);p[3]=0・400*sin(t2*PI/180)+l・650*v[0]*v[0]*sin(x[0])-0・600*v[l]*v[l]*sin(x[l])-0・800*v[2]*v[2]*sin(x[2]);returnp[n];}intmain()i