新建 文本文档.txt

VC开发

	for(i=0;i<100;i++)
		zx[i]=igx[i];

	for(i=0;i<98;i++)
		y[i]=zx[i+2];
	
	for (i=0;i<98;i++)
		{
		xx[i][0]=zx[i+1];
	xx[i][1]=zx[i];
	}

	for (i=0;i<98;i++)
		for(j=0;j<2;j++)
			xxt[j][i]=xx[i][j];	

		for(i=0;i<2;i++)
		for(j=0;j<2;j++)
		{
			aa[i][j]=0;
			for(t=0;t<98;t++)
				aa[i][j]+=xxt[i][t]*xx[t][j];
		}

	printf("输出矩阵aa(2,2)\n");
 for (i=0;i<2;i++)
	{
		for(j=0;j<2;j++)
			printf("%5.2e\n ",aa[i][j]);
	}
	hlsa=aa[0][0]*aa[1][1]-aa[0][1]*aa[1][0];
	ani[0][0]=aa[1][1]/hlsa;
	ani[0][1]=-aa[0][1]/hlsa;
	ani[1][0]=-aa[1][0]/hlsa;
	ani[1][1]=aa[0][0]/hlsa;
	printf("输出矩阵aa逆(2,2)\n");
	for (i=0;i<2;i++)
	{
		for(j=0;j<2;j++)
			printf("%5.2e ",ani[i][j]);
		printf("\n");
	}
		for(i=0;i<2;i++)
			for(j=0;j<98;j++)
		{
			cc[i][j]=0;
			for(t=0;t<2;t++)
				cc[i][j]+=ani[i][t]*xxt[t][j];
		}
	
		for(i=0;i<2;i++)
			
		{
			fai[i]=0;
			for(t=0;t<98;t++)
				fai[i]+=cc[i][t]*y[t];
		}
	printf("输出矩阵fai(2,1)\n");
    for(i=0;i<2;i++)
	printf("%f\n",fai[i]);
	yy1=0;
	for(t=0;t<98;t++)
	yy1+=y[t]*y[t];
			for(j=0;j<2;j++)
		{
			y2[j]=0;
			for(t=0;t<98;t++)
				y2[j]+=y[t]*xx[t][j];
		}
	y3=0;
	for(t=0;t<2;t++)
	y3+=y2[t]*fai[t];

	
	da=sqrt((yy1-y3)/98);
   printf("dax=%lf\n",da);	
 /*赋初值*/
a[0][0]=fai[0];
a[0][1]=fai[1];
a[1][0]=1;
a[1][1]=0;
b[0][0]=1;
b[0][1]=0;
b[1][0]=0;
b[1][1]=0;
c[0]=1;
c[1]=0;
p[0][0]=1;
p[0][1]=0;
p[1][0]=0;
p[1][1]=1;
q[0][0]=da*da;
q[0][1]=0;
q[1][0]=0;
q[1][1]=da*da;
x[0]=0;
x[1]=0;
for(i=0;i<100;i++)
{
	xk[0]=fai[0]*x[0]+fai[1]*x[1];
	xk[1]=x[0];
	pk[0][0]=fai[0]*fai[0]*p[0][0]+fai[0]*fai[1]*(p[1][0]+p[0][1])
		+fai[1]*fai[1]*p[1][1]+b[0][0]*b[0][0]*da*da
		+b[0][1]*b[0][1]*da*da;
	pk[0][1]=fai[0]*p[0][0]+fai[1]*p[1][0]+b[0][0]*b[1][0]*da*da
		+b[0][1]*b[1][1]*da*da;
	pk[1][0]=fai[0]*p[0][0]+fai[1]*p[0][1]
		+b[0][0]*b[1][0]*da*da
		+b[0][1]*b[1][1]*da*da;
	pk[1][1]=p[0][0]+b[1][0]*b[1][0]*da*da+b[1][1]*b[1][1]*da*da;
	k[0]=pk[0][0]/(pk[0][0]+dm*dm);
	k[1]=pk[1][0]/(pk[0][0]+dm*dm);
	p[0][0]=pk[0][0]*(1-k[0]);
	p[0][1]=pk[0][1]*(1-k[0]);
	p[1][0]=-k[1]*pk[0][0]+pk[1][0];
	p[1][1]=-k[1]*pk[0][1]+pk[1][1];
	x[0]=xk[0]+k[0]*(zx[i]-xk[0]);
	x[1]=xk[1]+k[1]*(zx[i]-xk[0]);
	lzx[i]=x[0];