牛头刨床(c语言源程序)

《牛头刨床(c语言源程序)》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、班级：机制07-3姓名：杨开成学号：200702010350牛头刨床（C语言源程序）#include#include#definePI3.14159#defineE11e-3#defineE01e-9#definem4#defineN0500//控制牛顿迭代次数doubleF(doublex[m],doublet2,intn)//角位移代数式组{doublep[m];p[0]=L2*cos(x[0])-L4*cos(x[2])-(x[3])+L5*cos(T);p[1]=-L2*sin(x[0])-L4*sin(x[2])+L5*s

2、in(T);p[2]=L2*cos(x[0]-PI/3)-L3*cos(x[1])-(x[3])-e+L5*cos(T);p[3]=L2*sin(x[0]-PI/3)-L3*sin(x[1])+L5*sin(T);returnp[n];}doubleA(doublex[m],inti,intj)//建立雅可比矩阵{doublep[m][m];p[0][0]=-L2*sin(x[0]);p[0][1]=0;p[0][2]=L4*sin(x[2]);p[0][3]=-1;p[1][0]=-L2*cos(x[0]);p[1][1]=0;p[1][2]=-L4*cos(x[

3、2]);p[1][3]=0;p[2][0]=-L2*sin(x[0]-PI/3);p[2][1]=L3*sin(x[1]);p[2][2]=0;p[2][3]=-1;p[3][0]=L2*cos(x[0]-PI/3);p[3][1]=-L3*cos(x[1]);p[3][2]=0;p[3][3]=0;returnp[i][j];}doubleG(doublea[m][m],intn,doubleb[m])//用高斯消去法求解线性方程组（系数矩阵为方阵）{inti,j,k,i1,j1;doubletemp;introw_maxmod;doubleelement_max

4、mod;for(j=0;j

5、;k

6、[j]*temp;}}for(i=m-2;i>=0;i--)//逆序求线性方程组的解for(j=3;j>i;j--)b[i]-=a[i][j]*b[j];returnb[n];}doubleC(doublex[m],doublev[m],doublet2,intn)//建立角加速度方程常数项{doublep[m];p[0]=3.0*v[2]*v[2]*cos(x[2]);p[1]=3.0*v[2]*v[2]*sin(x[2]);p[2]=-0.5*cos(t2*PI/180)+2*(v[1])*(v[2])*sin(x[2])+(x[1])*(v[2])*(v[2]

7、)*cos(x[2]);p[3]=-0.5*sin(t2*PI/180)-2*(v[1])*(v[2])*cos(x[2])+(x[1])*(v[2])*(v[2])*sin(x[2]);returnp[n];}intmain(){班级：机制07-3姓名：杨开成学号：200702010350inti1=0,i,j;doublex[4],a[4][4],b[4];doubles[4],v[4],p[4],c[4];doublet2;printf("求解：tr1r3t4(rad)r5");x[0]=1.1;x[1]=1.4;x[2]=1.2*PI/180;x[