youhua.rar_rod_四杆 优化_四杆机构优化_机构杆长优化_杆优化

#include<iostream> #include<cmath> using namespace std; #define pi 3.1416 void main() { double F[111], K[687],P[361],M[4]; double a,b,c,d,ac1,ac,q,r,g,b1,a1,a2,a3,w1,w2,w3,A,B,C,m; int i,j,k; for(i=0;i<=100;i++) F[i]=45+0.1*i; for(j=0;j<686;j++) K[j]=0.418+0.001*j; for(k=0;k<=360;k++) P[k]=0.5*k; //cout<<F[100]<<" "<<K[685]<<" "<<P[360]<<endl; for(i=0;i<=100;i++) { q=F[i]*pi/180; c=2.05/(1.35*q); r=c*sin(q/2)/sin(pi/7.5); g=c*sin(q/2+pi/7.5)/sin(pi/7.5); for(j=0;j<686;j++) { b=K[j]; b1=asin(b*q*0.137/sin(q/2))-pi/15; a=c*sin(q/2)*(sin(b1+pi/7.5)-sin(b1))/sin(pi/7.5); d=sqrt(r*r+g*g-2*r*g*cos(2*b1+pi/7.5)); m=10; for(k=0;k<=360;k++) { if(a*a+d*d<=b*b+c*c||(acos((b*b+c*c-(a+d)*(a+d))/2/b/c))*180/pi>=140) break; //a1=P[k]*pi/180; a1=P[k]*pi/180+acos(b/d); w1=15.5*pi/30; A=d-a*cos(a1); B=-a*sin(a1); C=(A*A+B*B+c*c-b*b)/(2*c); if(A!=C) a3=2*atan((B+sqrt(A*A+B*B-C*C))/(A-C)); else a3=2*atan(-A/B); a2=atan((B+c*sin(a3))/(A+c*cos(a3))); w3=w1*a*sin(a1-a2)/(c*sin(a3-a2)); w2=-w1*a*sin(a1-a3)/(b*sin(a2-a3)); ac1=(b*w2*w2+a*w1*w1*cos(a1-a2)-c*w3*w3*cos(a3-a2))/(c*sin(a3-a2)); ac=sqrt(ac1*ac1); //z=abs(ac); if (ac<m) { m=ac; // cout<<ac<<endl; M[0]=a; M[1]=b; M[2]=c; M[3]=d; } } if(a*a+d*d<=b*b+c*c||(acos((b*b+c*c-(a+d)*(a+d))/2/b/c))*180/pi>=140) continue; cout<<m<<" "<<a<<" "<<b<<" "<<c<<" "<<d<<endl; } } }