/////////////////////////////////////////////////////////////////////
//
// 観測誤差共分散行列を求める部分
//
////////////////////////////////////////////////////////////////////
#include <iostream>
#include <math.h>
#include <stdlib.h>
#include <stdio.h>

void minv(double[],double,int);

void w_inverse(double w1[512], int satn, double std)
{
	int i;
	double eps;
	eps=1.0e-25;

	for(i=0;i<=511;i++)
		w1[i]=0;

	switch(satn)
	{
	case 2: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 3: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 4: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 5: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 6: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 7: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 8: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 9: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 10: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 11: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 12: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 13: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	case 14: 
		for(i=0;i<satn*satn;i++){
			if((i+satn+1)%(satn+1)==0)
				w1[i]=4*std*std;
			else
				w1[i]=2*std*std;
		}
		break;
	default: break; 
	}

	//逆行列を求める部分
	minv(w1,eps,satn);
}