# include <stdio.h>
# include <math.h>
# include <string.h>
# include <stdlib.h>
# define N 6
//double th0=2.182;
//double ph0=1.658;
double l=4.0;
int main(void)
{
int i, j, k, m, n;
double x[N], y[N], z[N];
double A, B, C;
double L[5], D[4], SW[5], CW[5], PH[4],APH[4], TPH=0;
FILE *fp;
fp=fopen("snp3","r");
for(i=0;i<N;i++)
{
fscanf(fp,"%lf %lf %lf",&x[i],&y[i],&z[i]);
}
fclose(fp);
A=((y[3]+y[1])/2-y[2])*((z[2]+z[0])/2-z[1])-((y[2]+y[0])/2-y[1])*((z[3]+z[1])/2-z[2]);
B=((x[2]+x[0])/2-x[1])*((z[3]+z[1])/2-z[2])-((x[3]+x[1])/2-x[2])*((z[2]+z[0])/2-z[1]);
C=((x[3]+x[1])/2-x[2])*((y[2]+y[0])/2-y[1])-((y[3]+y[1])/2-y[2])*((x[2]+x[0])/2-x[1]);
for(i=0;i<5;i++)
{
L[i]=sqrt((x[i+1]-x[i])*(x[i+1]-x[i])+(y[i+1]-y[i])*(y[i+1]-y[i])+(z[i+1]-z[i])*(z[i+1]-z[i]));
}
for(j=0;j<4;j++)
{
D[j]=sqrt((x[j+2]-x[j])*(x[j+2]-x[j])+(y[j+2]-y[j])*(y[j+2]-y[j])+(z[j+2]-z[j])*(z[j+2]-z[j]));
}
for(k=0;k<5;k++)
{
SW[k]=(fabs(A*(x[k+1]-x[k])+B*(y[k+1]-y[k])+C*(z[k+1]-z[k])))/(sqrt(A*A+B*B+C*C))/L[k];
}
for(m=0;m<5;m++)
{
CW[m]=sqrt(1-SW[m]*SW[m]);
}
for(n=0;n<4;n++)
{
PH[n]=(L[n]*L[n]+L[n+1]*L[n+1]+2*L[n]*L[n+1]*SW[n]*SW[n+1]-D[n]*D[n])/(2*L[n]*L[n+1]*CW[n]*CW[n+1]);
APH[n]=acos(PH[n]);
APH[n]=acos(-1.)-APH[n];
}
TPH=APH[0]+APH[1]+APH[2]+APH[3];
printf("TPH:%lf %lf\n",TPH,TPH*180/acos(-1.));
/*fp=fopen("snp0","w");
for(i=0;i<N;i++)
{
fprintf(fp,"%.3f %.3f %.3f\n",x[i],y[i],z[i]);
}
fclose(fp);*/
return 0;
}
C语言——一些处理脚本(13)——(待完善)
最新推荐文章于 2024-07-18 11:11:00 发布